Autoware 中 GPS 定位问题

问题描述

Autoware 主要使用 LiDAR 定位,在 ndt_matching 程序中实现。

GPS 只是作为辅助,用来设定初始定位信息或者在 LiDAR 定位偏差较大时重置位置信息。

在使用 GPS 定位时,Autoware 有严重的缺陷:由于采用 Japan rectangular coordinate system , 默认只能在日本使用,或者说在日本的定位才是准确的 (参考1, 参考2)。这个问题似乎还没有在正式发布版本中解决。

所谓 Japan rectangular coordinate system 就是将日本分为19个区域,每个区域(本质为球面)用平面近似,在此平面上选定原点,建立坐标系。

以下为具体的区域分布:

系番号 座標系原点の経度(東経) 座標系原点の緯度(北緯) 適用区域
I 129度30分0秒0000 33度0分0秒0000 長崎県 鹿児島県のうち北方北緯32度南方北緯27度西方東経128度18分東方東経130度を境界線とする区域内(奄美群島は東経130度13分までを含む。)にあるすべての島、小島、環礁及び岩礁
II 131度 0分0秒0000 33度0分0秒0000 福岡県 佐賀県 熊本県 大分県 宮崎県 鹿児島県(I系に規定する区域を除く。)
III 132度10分0秒0000 36度0分0秒0000 山口県 島根県 広島県
IV 133度30分0秒0000 33度0分0秒0000 香川県 愛媛県 徳島県 高知県
V 134度20分0秒0000 36度0分0秒0000 兵庫県 鳥取県 岡山県
VI 136度 0分0秒0000 36度0分0秒0000 京都府 大阪府 福井県 滋賀県 三重県 奈良県 和歌山県
VII 137度10分0秒0000 36度0分0秒0000 石川県 富山県 岐阜県 愛知県
VIII 138度30分0秒0000 36度0分0秒0000 新潟県 長野県 山梨県 静岡県
IX 139度50分0秒0000 36度0分0秒0000 東京都(XIV系、XVIII系及びXIX系に規定する区域を除く。) 福島県 栃木県 茨城県 埼玉県 千葉県 群馬県 神奈川県
X 140度50分0秒0000 40度0分0秒0000 青森県 秋田県 山形県 岩手県 宮城県
XI 140度15分0秒0000 44度0分0秒0000 小樽市 函館市 伊達市 北斗市 北海道後志総合振興局の所管区域 北海道胆振総合振興局の所管区域のうち豊浦町、壮瞥町及び洞爺湖町 北海道渡島総合振興局の所管区域 北海道檜山振興局の所管区域
XII 142度15分0秒0000 44度0分0秒0000 北海道(XI系及びXIII系に規定する区域を除く。)
XIII 144度15分0秒0000 44度0分0秒0000 北見市 帯広市 釧路市 網走市 根室市 北海道オホーツク総合振興局の所管区域のうち美幌町、津別町、斜里町、清里町、小清水町、訓子府町、置戸町、佐呂間町及び大空町 北海道十勝総合振興局の所管区域 北海道釧路総合振興局の所管区域 北海道根室振興局の所管区域
XIV 142度 0分0秒0000 26度0分0秒0000 東京都のうち北緯28度から南であり、かつ東経140度30分から東であり東経143度から西である区域
XV 127度30分0秒0000 26度0分0秒0000 沖縄県のうち東経126度から東であり、かつ東経130度から西である区域
XVI 124度 0分0秒0000 26度0分0秒0000 沖縄県のうち東経126度から西である区域
XVII 131度 0分0秒0000 26度0分0秒0000 沖縄県のうち東経130度から東である区域
XVIII 136度 0分0秒0000 20度0分0秒0000 東京都のうち北緯28度から南であり、かつ東経140度30分から西である区域
XIX 154度 0分0秒0000 26度0分0秒0000 東京都のうち北緯28度から南であり、かつ東経143度から東である区域

由于最初开发 Autoware 的是名古屋大学,其所在的爱知县属于 VII 区域,所以 Autoware GPS 定位默认是在该区域的平面坐标系上 ( plane 7 )。

平面坐标系比较直观而且容易计算。对于比较小的范围,这种以平面代替球面的方式是可以接受的。Autoware 接收 GPS 数据,将其中的经纬度转化成某一平面区域的坐标值。

但是如果是在距离日本比较远的地方使用 Autoware,那么无论选择上述 19 个平面中的哪一个都很难获得比较精确的定位。

解决方法

简单的说就是在局部区域建立自己的平面坐标系。具体步骤如下:

  1. 在实验场地附近选择某一点作为坐标原点,记录其经纬度
  2. 通过该网站可以查询所在地每 1 经纬度间隔对应的具体长度。每 1 经度间隔在赤道附近距离最大,两极最小;每 1 维度间隔在全球范围内都差不多。
  3. 实时地将车辆所在经纬度与坐标原点经纬度的差别转化成车辆相对于坐标系原点的位置。

例如
已知实验场地附近 (纬度 1.3410676543865188, 经度 103.68017346176953)

  • 纬线间距 1 度,长为 110574.8808516026 米
  • 经线间距 1 度,长为111289.17062452697 米

选定某点 A 为 x-y 坐标系原点 (0, 0),它的经纬度分别为: A_lon, A_lat,对于另一点 B ,经纬度为 B_lon, B_lat,则 B 点的 x-y 坐标为

  • x: (B_lon - A_lon) * 111289.17062452697 米
  • y: (B_lat - A_lat) * 110574.8808516026 米

注意:默认东方为 x 轴正方向,北方为 y 轴正方向。

最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 206,723评论 6 481
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 88,485评论 2 382
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 152,998评论 0 344
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 55,323评论 1 279
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 64,355评论 5 374
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 49,079评论 1 285
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 38,389评论 3 400
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 37,019评论 0 259
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 43,519评论 1 300
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 35,971评论 2 325
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 38,100评论 1 333
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 33,738评论 4 324
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 39,293评论 3 307
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 30,289评论 0 19
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 31,517评论 1 262
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 45,547评论 2 354
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 42,834评论 2 345

推荐阅读更多精彩内容