CN112945247A - 一种无人车的地图匹配定位方法及自动驾驶车辆 - Google Patents
一种无人车的地图匹配定位方法及自动驾驶车辆 Download PDFInfo
- Publication number
- CN112945247A CN112945247A CN202110136503.1A CN202110136503A CN112945247A CN 112945247 A CN112945247 A CN 112945247A CN 202110136503 A CN202110136503 A CN 202110136503A CN 112945247 A CN112945247 A CN 112945247A
- Authority
- CN
- China
- Prior art keywords
- map
- unmanned vehicle
- pitch angle
- vehicle
- main road
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 19
- 238000005259 measurement Methods 0.000 claims abstract description 4
- 230000004807 localization Effects 0.000 claims 1
- 238000004891 communication Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000008447 perception Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
- G01C21/30—Map- or contour-matching
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3407—Route searching; Route guidance specially adapted for specific applications
- G01C21/343—Calculating itineraries, i.e. routes leading from a starting point to a series of categorical destinations using a global route restraint, round trips, touristic trips
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本申请提供一种地图匹配定位方法,包括开启无人车地图定位;当无人车位于主道路进出口附近时,利用无人车上的IMU获取车身俯仰角,其中,所述主道路进出口附近包含至少一条匝道;当所述车身俯仰角超过预定阈值时,获取高精地图存储的无人车所在的主道路进出口附近的主道路及匝道的倾斜度;比较车身俯仰角与各道路的倾斜度,将倾斜度最接近车身俯仰角的道路赋予最高的匹配权重值;基于最高的匹配权重值,将无人车的位置匹配到地图中与该最高的匹配权重值对应的道路上,并对地图中的定位进行更新,本发明能够实现高速公路进入口附近的精确定位。
Description
技术领域
本申请涉及自动驾驶领域,具体而言,涉及一种无人车的地图匹配定位方法。
背景技术
无人驾驶车辆是通过车载传感系统感知道路环境,自动规划行车路线并控制车辆到达预定目标的智能汽车,其是利用车载传感器来感知车辆周围环境,并根据感知所获得的道路、车辆位置和障碍物信息,控制车辆的转向和速度,从而使车辆能够安全、可靠地在道路上行驶。
在无人驾驶车辆的地图/导航类软件中,常采用高精地图匹配算法,根据定位数据(经纬度坐标+惯导推算)和高精地图数据,将定位数据匹配道路的某一点,用于确定车的实际位置。
通常匹配的方式有以下几种(含组合):
1、GPS位置+地图 匹配
2、GPS+IMU惯导推算+地图 匹配
3、视觉+地图 匹配
4、雷达点云扫描+点云地图 匹配
上述方案中,1,2精度较差,GPS定位米级误差,RTK定位分米级误差。3,4依赖感知传感器,尤其是雷达点云地图匹配,还需要依赖事先采集的点云地图数据,一版车辆不具备此功能。
在指定场景,如并行道路、微小角度、高速匝道,相邻道路之间距离很小,地图匹配算法由于定位精度较差,可能会导致车辆定位位置匹配到隔壁道路上,例如,告诉路口的匝道,往往与主道路的位置偏差很小,车辆定位道路错位会导致无法即刻返回。
发明内容
本申请实施例的目的在于提供一种用无人车自身的惯导设备测量车辆俯仰角度,将无人车定位在与俯仰角度对应的道路上,从而解决了,在交叉路口特别是高速路口的匝道上定位不准的问题,具体方案如下:
第一方面,本申请实施例提供了一种无人车的地图匹配定位方法,包括如下步骤:
开启无人车地图定位;
当无人车位于主道路进出口附近时,利用无人车上的IMU获取车身俯仰角,其中,所述主道路进出口附近包含至少一条匝道;
当所述车身俯仰角超过预定阈值时,获取高精地图存储的无人车所在的主道路进出口附近的主道路及匝道的倾斜度;
比较车身俯仰角与各道路的倾斜度,将倾斜度最接近车身俯仰角的道路赋予最高的匹配权重值;
基于最高的匹配权重值,将无人车的位置匹配到地图中与该最高的匹配权重值对应的道路上,并对地图中的定位进行更新;
具体的,所述车身俯仰角为预设时间段内的车身俯仰角均值;
具体的,当倾斜度最接近车身俯仰角的道路为多条时,增加预设时间段的长度,重新获取车身俯仰角;
具体的,所述主道路进出口附近的各个道路的倾斜角各不相同;
具体的,当无人车远离主道路进出入口时,停止获取车身俯仰角;
具体的,定期更新高精地图中存储的主道路进出口附近的主道路及匝道的倾斜度;
具体的,对于俯仰角未存储在地图中的道路,不获取车身俯仰角;具体的,所述获取车身俯仰角为周期性地获取;
具体的,定期更新高精地图中存储的主道路进出口附近的主道路及匝道的倾斜度,包括:人工上传主道路进出口附近的主道路及匝道的倾斜度;
另一方面,提供一种能够执行上述的无人车的地图匹配定位方法的自动驾驶车辆。
本发明通过无人车自身的传感器设备测量车身的俯仰角,和道路的倾斜度做匹配,基于匹配情况判断无人车位于哪条道路上,该方案能够准确判断出车辆位置,特别适用于包含多条匝道的高架道路的进出口附近。
附图说明
为了更清楚地说明本申请实施例的技术方案,下面将对本申请实施例中所需要使用的附图作简单地介绍,应当理解,以下附图仅示出了本申请的某些实施例,因此不应被看作是对范围的限定,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他相关的附图。
图1为本申请实施例提供的无人车的地图匹配定位方法的流程图。
具体实施方式
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行描述。
为使本申请实施例的目的、技术方案和优点更加清楚,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请一部分实施例,而不是全部的实施例。通常在此处附图中描述和示出的本申请实施例的组件可以以各种不同的配置来布置和设计。
因此,以下对在附图中提供的本申请的实施例的详细描述并非旨在限制要求保护的本申请的范围,而是仅仅表示本申请的选定实施例。基于本申请中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
应注意到:相似的标号和字母在下面的附图中表示类似项,因此,一旦某一项在一个附图中被定义,则在随后的附图中不需要对其进行进一步定义和解释。
在本申请的描述中,需要说明的是,术语“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,或者是该申请产品使用时惯常摆放的方位或位置关系,仅是为了便于描述本申请和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本申请的限制。此外,术语“第一”、“第二”等仅用于区分描述,而不能理解为指示或暗示相对重要性。
在本申请的描述中,还需要说明的是,除非另有明确的规定和限定,术语“设置”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通,也可以是通信连接。对于本领域的普通技术人员而言,可以具体情况理解上述术语在本申请中的具体含义。
本发明的无人车可以为无人网约车,无人卡车等自动驾驶车辆,车辆上搭载有地图导航功能。由于现实的道路环境中,主干道的匝道与主干道之间的距离往往很小,甚至小于两个车道之间的间距,导致无人车在由匝道驶入主道路或者由主道路驶入匝道时,地图上定位不准确,会导致后续的自动驾驶的行驶路径出现错误,另外,车内乘客观看地图数据时候容易产生错觉,且会误导乘客。本发明基于主道路的各个匝道与主道路的海拔高度不同,且各个匝道的海拔高度也不同,提供一种基于无人车的俯仰角来判断车辆位于哪条道路上。
如图1所示,本申请实施例提供了一种无人车的地图匹配定位方法,包括如下步骤:首先,用户上车,车辆自动或被动开启无人车地图定位;
当无人车位于主道路进出口附近时,利用无人车上的IMU获取车身俯仰角,其中,所述主道路进出口附近包含至少一条匝道;
当所述车身俯仰角超过预定阈值时,例如,10度,周期性地获取高精地图存储的无人车所在的主道路进出口附近的主道路及匝道的倾斜度;比较车身俯仰角与各道路的倾斜度,将倾斜度最接近车身俯仰角的道路赋予最高的匹配权重值;基于最高的匹配权重值,将无人车的位置匹配到地图中与该最高的匹配权重值对应的道路上,并对地图中的定位进行更新;具体的,所述车身俯仰角为预设时间段内的车身俯仰角均值,以防止道路上的坑洼造成误判为。
具体的,当倾斜度最接近车身俯仰角的道路为多条时,增加预设时间段的长度,重新获取车身俯仰角;具体的,所述主道路进出口附近的各个道路的倾斜角各不相同;当无人车远离主道路进出入口时,停止获取车身俯仰角;为了使得道路进出口附近的道路倾斜度更加准确,需要定期更新高精地图中存储的主道路进出口附近的主道路及匝道的倾斜度;
另一方面,对于俯仰角未存储在地图中的道路,不获取车身俯仰角;
具体的,定期更新高精地图中存储的主道路进出口附近的主道路及匝道的倾斜度,包括,人工上传主道路进出口附近的主道路及匝道的倾斜度。
以上所述仅为本申请的实施例而已,并不用于限制本申请的保护范围,对于本领域的技术人员来说,本申请可以有各种更改和变化。凡在本申请的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本申请的保护范围之内。应注意到:相似的标号和字母在下面的附图中表示类似项,因此,一旦某一项在一个附图中被定义,则在随后的附图中不需要对其进行进一步定义和解释。
以上所述,仅为本申请的具体实施方式,但本申请的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本申请揭露的技术范围内,可轻易想到变化或替换,都应涵盖在本申请的保护范围之内。因此,本申请的保护范围应所述以权利要求的保护范围为准。
Claims (10)
1.一种无人车的地图匹配定位方法,其特征在于,包括如下步骤:
开启无人车地图定位;
当无人车位于主道路进出口附近时,利用无人车上的IMU获取车身俯仰角,其中,所述主道路进出口附近包含至少一条匝道;
当所述车身俯仰角超过预定阈值时,获取高精地图存储的无人车所在的主道路进出口附近的主道路及匝道的倾斜度;
比较车身俯仰角与各道路的倾斜度,将倾斜度最接近车身俯仰角的道路赋予最高的匹配权重值;
基于最高的匹配权重值,将无人车的位置匹配到地图中与该最高的匹配权重值对应的道路上,并对地图中的定位进行更新。
2.根据权利要求1所述的无人车的地图匹配定位方法,其特征在于,所述车身俯仰角为预设时间段内的车身俯仰角均值。
3.根据权利要求2所述的无人车的地图匹配定位方法,其特征在于,当倾斜度最接近车身俯仰角的道路为多条时,增加预设时间段的长度,重新获取车身俯仰角。
4.根据权利要求3所述的无人车的地图匹配定位方法,其特征在于,所述主道路进出口附近的各个道路的倾斜角各不相同。
5.根据权利要求4所述的无人车的地图匹配定位方法,其特征在于,还包括步骤:当无人车远离主道路进出入口时,停止获取车身俯仰角。
6.根据权利要求5所述的无人车的地图匹配定位方法,其特征在于,还包括步骤:定期更新高精地图中存储的主道路进出口附近的主道路及匝道的倾斜度。
7.根据权利要求6所述的无人车的地图匹配定位方法,其特征在于,还包括步骤:对于俯仰角未存储在地图中的道路,不获取车身俯仰角。
8.根据权利要求7所述的无人车的地图匹配定位方法,其特征在于,所述获取车身俯仰角为周期性地获取。
9.根据权利要求6所述的无人车的地图匹配定位方法,其特征在于,定期更新高精地图中存储的主道路进出口附近的主道路及匝道的倾斜度,包括:人工上传主道路进出口附近的主道路及匝道的倾斜度。
10.一种自动驾驶车辆,其特征在于,能够执行权利要求1-9中任一项所述的无人车的地图匹配定位方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110136503.1A CN112945247A (zh) | 2021-02-01 | 2021-02-01 | 一种无人车的地图匹配定位方法及自动驾驶车辆 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110136503.1A CN112945247A (zh) | 2021-02-01 | 2021-02-01 | 一种无人车的地图匹配定位方法及自动驾驶车辆 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112945247A true CN112945247A (zh) | 2021-06-11 |
Family
ID=76240767
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110136503.1A Pending CN112945247A (zh) | 2021-02-01 | 2021-02-01 | 一种无人车的地图匹配定位方法及自动驾驶车辆 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112945247A (zh) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100241355A1 (en) * | 2007-05-14 | 2010-09-23 | Thinkware Systems Corporation | Method for correcting map matching and navigation system implementing the method |
CN108195388A (zh) * | 2017-12-25 | 2018-06-22 | 千寻位置网络有限公司 | 低成本高精度的高架上下坡检测方法 |
CN109581449A (zh) * | 2018-12-14 | 2019-04-05 | 安徽江淮汽车集团股份有限公司 | 一种自动驾驶汽车的定位方法及系统 |
CN109917440A (zh) * | 2019-04-09 | 2019-06-21 | 广州小鹏汽车科技有限公司 | 一种组合导航方法、系统及车辆 |
-
2021
- 2021-02-01 CN CN202110136503.1A patent/CN112945247A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100241355A1 (en) * | 2007-05-14 | 2010-09-23 | Thinkware Systems Corporation | Method for correcting map matching and navigation system implementing the method |
CN108195388A (zh) * | 2017-12-25 | 2018-06-22 | 千寻位置网络有限公司 | 低成本高精度的高架上下坡检测方法 |
CN109581449A (zh) * | 2018-12-14 | 2019-04-05 | 安徽江淮汽车集团股份有限公司 | 一种自动驾驶汽车的定位方法及系统 |
CN109917440A (zh) * | 2019-04-09 | 2019-06-21 | 广州小鹏汽车科技有限公司 | 一种组合导航方法、系统及车辆 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3570061B1 (en) | Drone localization | |
CN106352867B (zh) | 用于确定车辆自身位置的方法和设备 | |
CN105937912B (zh) | 车辆的地图数据处理装置 | |
EP3637371B1 (en) | Map data correcting method and device | |
US10809076B2 (en) | Active driving map for self-driving road vehicle | |
KR101454153B1 (ko) | 가상차선과 센서 융합을 통한 무인 자율주행 자동차의 항법시스템 | |
CN112074885A (zh) | 车道标志定位 | |
US20210199437A1 (en) | Vehicular component control using maps | |
JP2799324B2 (ja) | 路線案内システムの路線決定方法および路線案内モジュール | |
US7471212B2 (en) | Method and device for guiding a vehicle, as well as a corresponding computer program and a corresponding computer-readable storage medium | |
CN109477728B (zh) | 用于确定车辆相对于路面行车道的横向位置的方法和装置 | |
CN109313033B (zh) | 导航数据的更新 | |
WO2018181974A1 (ja) | 判定装置、判定方法、及び、プログラム | |
US7869943B1 (en) | Flight management systems and methods for use with an aerial vehicle | |
US7937191B2 (en) | Termination secured route planning | |
US20080243378A1 (en) | System and method for vehicle navigation and piloting including absolute and relative coordinates | |
EP0762363A1 (en) | Apparatus and method for tracking a vehicle | |
US20190316929A1 (en) | System and method for vehicular localization relating to autonomous navigation | |
JP4652097B2 (ja) | 高度算出装置及びナビゲーション装置 | |
US20160202352A1 (en) | Determination of the position of a vehicle on or above a planet surface | |
CN109923375A (zh) | 道路确定装置和车辆控制系统 | |
KR20180103462A (ko) | 라이더 스캔 데이터의 누적에 의한 자율주행 자동차의 위치인식 시스템 및 그 방법 | |
US20230010175A1 (en) | Information processing device, control method, program and storage medium | |
JP6968877B2 (ja) | 自己位置推定装置、制御方法、プログラム及び記憶媒体 | |
US11866167B2 (en) | Method and algorithm for flight, movement, autonomy, in GPS, communication, degraded, denied, obstructed non optimal environment |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
TA01 | Transfer of patent application right | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20230412 Address after: 100000 1703, floor 17, building 1, No. 10, Ronghua Middle Road, Beijing Economic and Technological Development Zone, Daxing District, Beijing (Yizhuang group, high-end industrial area of Beijing Pilot Free Trade Zone) Applicant after: NEOLIX TECHNOLOGIES Co.,Ltd. Address before: 101300 Shunyi District, Beijing Applicant before: Neolithic Huiyi Zhixing Zhichi (Beijing) Technology Co.,Ltd. |
|
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20210611 |