CN106443737A - 基于多点gps的无人驾驶汽车行驶中的航迹推算算法 - Google Patents
基于多点gps的无人驾驶汽车行驶中的航迹推算算法 Download PDFInfo
- Publication number
- CN106443737A CN106443737A CN201610872840.6A CN201610872840A CN106443737A CN 106443737 A CN106443737 A CN 106443737A CN 201610872840 A CN201610872840 A CN 201610872840A CN 106443737 A CN106443737 A CN 106443737A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- pilotless automobile
- gps navigation
- gps
- location
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种基于多点GPS的无人驾驶汽车行驶中的航迹推算方法,具有如下步骤:步骤1:首先通过激光扫描雷达建立环境地图,获取车辆周围的地理位置信息;步骤2:两个GPS导航***分别安装在车辆的左、右侧,两个GPS导航***对车辆进行定位;步骤3:通过两个GPS导航***分别获取左边目标地点以及车身方位角信息以及获取右边目标地点以及车身方位角信息;步骤4:采用航迹推算算法分别对两个定位***获取到的信息进行处理,计算出车辆的位置信息和行驶轨迹。本发明采用两个GPS导航***定位,降低了GPS导航***在动态环境下出现的失灵现象;航迹推算算法的改进,加快了定位的速度,同时也提高了定位的准确性。
Description
技术领域
本发明涉及无人驾驶汽车行驶中的航迹推算算法,尤其是一种基于多点GPS的无人驾驶汽车行驶中的航迹推算算法。
背景技术
无人驾驶车辆在国际上也称为机器人车辆,属于室外移动机器人的一种,是一个集环境感知、规划与决策、控制等多项功能于一体的综合智能***,涵盖了机械、控制、传感器技术、信号处理、模式识别、人工智能和计算机技术等多学科知识。近年来,各国加大了对无人驾驶汽车的研究,无人驾驶汽车的发展也成为衡量一个国家工业化发展程度的重要标志。无人驾驶汽车作为一个复杂的智能***,涉及的内容主要有如下几个方面:体系结构、环境感知、定位导航、路径规划、运动控制和一体化设计。
在导航定位***中,最常用的是GPS卫星导航定位技术,但是GPS导航***在动态环境和遮挡地域可能出现接收机不易捕获和跟踪GPS信号,导致GPS功能失效,造成无人驾驶汽车行驶轨迹出现断点,轨迹不连续,当断点持续的时间较长时,无人驾驶汽车将会出现监控空白,存在严重的安全隐患。
发明内容
本发明要解决的技术问题是:提供一种基于多点GPS的无人驾驶汽车行驶中的航迹推算方法,降低GPS导航***在动态环境下出现的失灵现象。
本发明解决其技术问题所采用的技术方案是:一种基于多点GPS的无人驾驶汽车行驶中的航迹推算方法,具有如下步骤:
步骤1:首先通过激光扫描雷达建立环境地图,获取车辆周围的地理位置信息;
步骤2:两个GPS导航***分别安装在车辆的左、右侧,两个GPS导航***对车辆进行定位;
步骤3:通过两个GPS导航***分别获取左边目标地点以及车身方位角信息以及获取右边目标地点以及车身方位角信息;
步骤4:采用航迹推算算法分别对两个定位***获取到的信息进行处理,计算出车辆的位置信息和行驶轨迹。
具体地,所述航迹推算算法步骤如下:
(1)该算法采用绝对坐标系,用纵坐标轴(Y)指向北方即磁北向,用横轴(X)指向东方;
(2)获取采样时间间隔i(i=0,1,2,····n)的纵向距离为d(i);
(3)获取无人驾驶汽车纵向与磁北向的夹角α(i),磁北向与真北向之间的夹角为αb;
(4)无人驾驶汽车纵向与真北向的夹角α′(i)为如下公式所得出;
α′(i)=α(i)+αb;
(5)根据以下公式确定无人驾驶汽车在第n个采样时刻的位置(x(n),y(n)):
(6)设定采样周期T固定,在第i(i=0,1,2,····n)个采样时刻无人驾驶汽车的纵向速度为v(i),小车的行驶轨迹由以下公式得出:
本发明的有益效果是:本发明采用两个GPS导航***定位,降低了GPS导航***在动态环境下出现的失灵现象;航迹推算算法的改进,加快了定位的速度,同时也提高了定位的准确性。
附图说明
下面结合附图对本发明进一步说明。
图1是本发明的控制流程图;
图2是本发明的航迹推算算法流程图;
图3是本发明的航迹推算坐标定位图;
具体实施方式
现在结合附图对本发明作进一步的说明。这些附图均为简化的示意图仅以示意方式说明本发明的基本结构,因此其仅显示与本发明有关的构成。
如图1所示,一种基于多点GPS的无人驾驶汽车行驶中的航迹推算方法,具有如下步骤:
步骤1:首先通过激光扫描雷达建立环境地图,获取车辆周围的地理位置信息;
步骤2:两个GPS导航***分别安装在车辆的左、右侧,两个GPS导航***对车辆进行定位;
步骤3:通过两个GPS导航***分别获取左边目标地点以及车身方位角信息以及获取右边目标地点以及车身方位角信息;
步骤4:采用航迹推算算法分别对两个定位***获取到的信息进行处理,计算出车辆的位置信息和行驶轨迹。
具体地,如图2,土3所示,所述航迹推算算法步骤如下:
(1)该算法采用绝对坐标系,用纵坐标轴(Y)指向北方即磁北向,用横轴(X)指向东方;
(2)获取采样时间间隔i(i=0,1,2,····n)的纵向距离为d(i);
(3)获取无人驾驶汽车纵向与磁北向的夹角α(i),磁北向与真北向之间的夹角为αb;
(4)无人驾驶汽车纵向与真北向的夹角α′(i)为如下公式所得出;
α′(i)=α(i)+αb;
(5)根据以下公式确定无人驾驶汽车在第n个采样时刻的位置(x(n),y(n)):
(6)设定采样周期T固定,在第i(i=0,1,2,····n)个采样时刻无人驾驶汽车的纵向速度为v(i),小车的行驶轨迹由以下公式得出:
本发明对无人驾驶汽车的导航不稳定性提供了解决方案。改进航迹推算算法,加快了GPS导航***的定位,同时,提高了定位的准确性,降低了GPS导航***在动态环境和遮挡区域可能出现接收机不易捕获和跟踪GPS信号,导致GPS功能失效的可能,保证了无人驾驶汽车的稳定运行。
车身所载的两个GPS导航***,分别获取左、右目标地点及车身方位角信息;
改进航迹推算算法,该算法相对于原有的航迹推算算法,加快了位置定位的速度,同时也提高了定位的准确性;
本发明采用两个GPS导航***定位,降低了GPS导航***在动态环境下出现的失灵现象;航迹推算算法的改进,加快了定位的速度,同时也提高了定位的准确性。
以上述依据本发明的理想实施例为启示,通过上述的说明内容,相关工作人员完全可以在不偏离本项发明技术思想的范围内,进行多样的变更以及修改。本项发明的技术性范围并不局限于说明书上的内容,必须要根据权利要求范围来确定其技术性范围。
Claims (2)
1.一种基于多点GPS的无人驾驶汽车行驶中的航迹推算方法,其特征在于:具有如下步骤:
步骤1:首先通过激光扫描雷达建立环境地图,获取车辆周围的地理位置信息;
步骤2:两个GPS导航***分别安装在车辆的左、右侧,两个GPS导航***对车辆进行定位;
步骤3:通过两个GPS导航***分别获取左边目标地点以及车身方位角信息以及获取右边目标地点以及车身方位角信息;
步骤4:采用航迹推算算法分别对两个定位***获取到的信息进行处理,计算出车辆的位置信息和行驶轨迹。
2.根据权利要求1所述的基于多点GPS的无人驾驶汽车行驶中的航迹推算方法,其特征在于:所述航迹推算算法步骤如下:
(1)该算法采用绝对坐标系,用纵坐标轴(Y)指向北方即磁北向,用横轴(X)指向东方;
(2)获取采样时间间隔i(i=0,1,2,····n)的纵向距离为d(i);
(3)获取无人驾驶汽车纵向与磁北向的夹角α(i),磁北向与真北向之间的夹角为αb;
(4)无人驾驶汽车纵向与真北向的夹角α′(i)为如下公式所得出;
α′(i)=α(i)+αb;
(5)根据以下公式确定无人驾驶汽车在第n个采样时刻的位置(x(n),y(n)):
(6)设定采样周期T固定,在第i(i=0,1,2,····n)个采样时刻无人驾驶汽车的纵向速度为v(i),小车的行驶轨迹由以下公式得出:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610872840.6A CN106443737A (zh) | 2016-09-30 | 2016-09-30 | 基于多点gps的无人驾驶汽车行驶中的航迹推算算法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610872840.6A CN106443737A (zh) | 2016-09-30 | 2016-09-30 | 基于多点gps的无人驾驶汽车行驶中的航迹推算算法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106443737A true CN106443737A (zh) | 2017-02-22 |
Family
ID=58171571
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610872840.6A Pending CN106443737A (zh) | 2016-09-30 | 2016-09-30 | 基于多点gps的无人驾驶汽车行驶中的航迹推算算法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106443737A (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107389064A (zh) * | 2017-07-27 | 2017-11-24 | 长安大学 | 一种基于惯性导航的无人车变道控制方法 |
CN107907894A (zh) * | 2017-11-09 | 2018-04-13 | 上汽通用五菱汽车股份有限公司 | 无人驾驶汽车定位方法、装置、存储介质及无人驾驶汽车 |
CN109285248A (zh) * | 2018-08-30 | 2019-01-29 | 蚌埠中科工业设备有限公司 | 一种采样箱安全解锁方法 |
CN110109161A (zh) * | 2018-02-01 | 2019-08-09 | 高德信息技术有限公司 | 一种指纹特征采集方法和装置 |
CN114440864A (zh) * | 2020-10-30 | 2022-05-06 | 华为技术有限公司 | 一种汽车定位的方法及装置 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102165880A (zh) * | 2011-01-19 | 2011-08-31 | 南京农业大学 | 一种自主导航的履带式移动水果采摘机器人及水果采摘方法 |
-
2016
- 2016-09-30 CN CN201610872840.6A patent/CN106443737A/zh active Pending
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102165880A (zh) * | 2011-01-19 | 2011-08-31 | 南京农业大学 | 一种自主导航的履带式移动水果采摘机器人及水果采摘方法 |
Non-Patent Citations (2)
Title |
---|
张晅 等: "车载GPS与双DR组合定位***的设计与实现", 《微计算机信息》 * |
徐晓东: "GPS/GIS/GSM/DR智能车辆***研究", 《中国优秀硕士学位论文全文数据库(电子期刊)》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107389064A (zh) * | 2017-07-27 | 2017-11-24 | 长安大学 | 一种基于惯性导航的无人车变道控制方法 |
CN107907894A (zh) * | 2017-11-09 | 2018-04-13 | 上汽通用五菱汽车股份有限公司 | 无人驾驶汽车定位方法、装置、存储介质及无人驾驶汽车 |
CN110109161A (zh) * | 2018-02-01 | 2019-08-09 | 高德信息技术有限公司 | 一种指纹特征采集方法和装置 |
CN109285248A (zh) * | 2018-08-30 | 2019-01-29 | 蚌埠中科工业设备有限公司 | 一种采样箱安全解锁方法 |
CN114440864A (zh) * | 2020-10-30 | 2022-05-06 | 华为技术有限公司 | 一种汽车定位的方法及装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106443737A (zh) | 基于多点gps的无人驾驶汽车行驶中的航迹推算算法 | |
CN106840179B (zh) | 一种基于多传感器信息融合的智能车定位方法 | |
CN109946731B (zh) | 一种基于模糊自适应无迹卡尔曼滤波的车辆高可靠融合定位方法 | |
CN105928531B (zh) | 一种适用于无人驾驶汽车的行进路线精准生成方法 | |
CN110208842A (zh) | 一种车联网环境下车辆高精度定位方法 | |
Milanés et al. | Autonomous vehicle based in cooperative GPS and inertial systems | |
CN106123908B (zh) | 车辆导航方法和*** | |
CN105180933B (zh) | 基于直行路口检测的移动机器人航迹推算修正***及方法 | |
CN109946732A (zh) | 一种基于多传感器数据融合的无人车定位方法 | |
CN108052107A (zh) | 一种融合磁条、磁钉和惯导的agv室内外复合导航***及方法 | |
CN107132563B (zh) | 一种里程计结合双天线差分gnss的组合导航方法 | |
CN106225789A (zh) | 一种具有高安全性的车载导航***及其引导方法 | |
CN102591332A (zh) | 用于无人驾驶汽车局部路径规划的装置及方法 | |
US20220035036A1 (en) | Method and apparatus for positioning movable device, and movable device | |
CN104535061A (zh) | 一种基于多传感器数据融合的导航*** | |
CN101201255A (zh) | 基于智能导航算法的车辆组合导航*** | |
CN105955257A (zh) | 基于固定路线的公交车自动驾驶***及其驾驶方法 | |
CN111176298B (zh) | 一种无人车轨迹录制与轨迹跟踪方法 | |
CN110045727B (zh) | 一种园区无人车路径规划与控制方法 | |
CN111137298B (zh) | 一种车辆自动驾驶方法、装置、***和存储介质 | |
CN107219542B (zh) | 基于gnss/odo的机器人双轮差速定位方法 | |
CN105278533A (zh) | 一种全向移动平台导航方法 | |
CN104502942A (zh) | 基于卫星导航和航位推测实现农业机械定位的***及方法 | |
CN111077890A (zh) | 一种基于gps定位与自动避障的农业机器人的实现方法 | |
CN109946648B (zh) | 一种车路协同下基于超宽带的车辆高精度定位方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20170222 |