CN101493335B - Gps/dr组合导航方法及装置 - Google Patents
Gps/dr组合导航方法及装置 Download PDFInfo
- Publication number
- CN101493335B CN101493335B CN2009100665729A CN200910066572A CN101493335B CN 101493335 B CN101493335 B CN 101493335B CN 2009100665729 A CN2009100665729 A CN 2009100665729A CN 200910066572 A CN200910066572 A CN 200910066572A CN 101493335 B CN101493335 B CN 101493335B
- Authority
- CN
- China
- Prior art keywords
- gps
- data acquisition
- main control
- control cpu
- mouth
- 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.)
- Active
Links
Images
Abstract
本发明提供一种GPS/DR组合导航方法及装置,通过数据采集MCU采集GPS数据,按照NMEA 0183协议将GPS数据进行解析;同时对加速度传感器和陀螺仪的数据进行采样,传送给导航主控CPU;导航主控CPU存储GPS与DR的组合定位、DR航位推算两种定位机制;导航主控CPU根据GPS的信号强度选择具体的定位机制;根据GPS接收系统提供的位置和速度信息对DR系统的误差进行实时的校正和补偿,克服了GPS定位方法经常由于信号遮挡不能正常定位的缺欠,也解决了DR定位技术中由于方向传感器随时间积累误差较大,不能单独、长时间地使用的问题。
Description
技术领域
本发明涉及一种GPS/DR组合导航方法,本发明还公开了及装置,属于机动车辆定位指示技术领域。
背景技术:
随着汽车销量的上升,人们出行频率的增加,对GPS车载导航系统的需求日益增强。目前GPS水平定位精度已经达到3~5m,完全满足车辆定位精度的要求。但是,由于在城市高建筑群中或穿过立交桥时,常常会出现GPS信号遮挡问题,导致GPS不能正常定位。
车载定位定向导航系统是指装载在轮式及履带式车辆上,能自主地为车辆提供方位基准和位置信息的一种装置。航位推算(简称:DR)是常用的车辆定位技术,但方向传感器随时间积累误差较大,不能单独、长时间地使用。
发明内容
本发明的目的在于提供一种GPS/DR组合导航方法,克服了GPS定位方法经常由于信号遮挡不能正常定位的缺欠,也解决了DR定位技术中由于方向传感器随时间积累误差较大,不能单独、长时间地使用的问题。
本发明还提供了适用于上述导航方法的联合导航装置,利用GPS系统提供的位置和速度信息对DR系统的误差进行实时的校正和补偿。
本发明GPS/DR组合导航方法的解决方案如下:
通过数据采集MCU的UART接口采集GPS接收机的数据,并按照NMEA0183协议将GPS数据进行解析;数据采集MCU的SPI对加速度传感器和陀螺仪的数据进行采样,并按照固定格式对DR数据进行压缩;GPS数据和DR数据采样完成后,数据采集MCU通过UART接口将GPS数据和DR数据传送给导航主控CPU;导航主控CPU存储GPS与DR的组合定位、DR航位推算两种定位机制;导航主控CPU根据GPS的信号强度选择具体的定位机制:当导航主控CPU根据内部的GPS信息无法完成定位时,导航主控CPU利用陀螺仪和车速脉冲来推算车辆的瞬时相对位置和航向,采用DR航位推算定位机制实现连续自主式定位;当导航主控CPU内部的GPS信息能过完成定位时,导航主控CPU采用GPS与DR的组合定位机制实现连续自主式定位,同时利用GPS精确的定位结果辅助DR的初始化,并且定期地用它对DR的定位误差进行在线校正。
导航主控CPU部分主要完成数据滤波、微型惯性测量元件的误差补偿及初始校准、卡尔曼滤波和导航参数解算等功能。其系统组成主框图如图1所示。
车辆水平转角的判断:选取陀螺仪作为水平方向的转角传感器,系统以100ms每次的采样频率对陀螺仪进行采样,采集到的电压转换成该时刻的角速度,角速度与时间相乘得到角度的变化量,将角度变化量进行累加得到该时刻与基准时刻的角度变化量。
车辆位移的判断:根据车速信号推算下一点位置信息。
车辆行驶路面坡度的判断:根据加速度传感器输出信号可以推算出当前车辆的倾角。单片机对加速度传感器数据进行采样,由加速度传感器电压可以得到该时刻的加速度值,进而可知当前时刻的角度值。另外从GPS获取的车速值为车速脉冲获取的车速值在水平面上的分量,根据投影关系可以得到当前车辆在竖直面的角度,用这两种方式得到的数据可以推算出当前的路面坡度。根据角度变化可以判断车辆在多层立交桥的行驶状况。
根据本发明方法制成GPS/DR组合导航装置结构如下:
由车速脉冲、陀螺仪、加速度传感器、GPS接收系统,数据采集MCU、导航主控CPU组成,陀螺仪和加速度传感器的模拟信号输出端连接到A/D转换器的采样通道,通过高精度A/D转换器将陀螺仪和加速度传感器输出的模拟信号转换为12位数字信号;A/D转换器的数字信号输出端连接到数据采集MCU的SPI口,数据采集MCU对A/D转换器的数字信号进行实时采集;车速脉冲连接到数据采集MCU的脉冲捕捉IO口,数据采集MCU通过对车速脉冲的捕捉推算当前车速;温度传感器连接到数据采集MCU的I2C口采集DR系统的温度,对DR系统的温度补偿;GPS接收系统的UART1口连接到数据采集MCU的UART1口,完成对GPS接收系统信息的提取;数据采集MCU的UART口连接到导航主控CPU的UART口,导航主控CPU实时获取GPS接收系统信息和DR系统信息,导航主控CPU存储有GPS与DR的组合定位、DR航位推算两种定位机制。
采用加速度传感器测量行驶中汽车倾角的方法就可以帮助系统区分当前路况的坡度状况,当行使在多层立交桥和多层复合车库时可以提高汽车坐标的精度。
组合导航系统除了要完成大量运算处理工作外,还要实现惯性测量单元IMU(陀螺仪和加速度计)和GPS等传感器的数据采集、与外部系统的通信、时序逻辑控制和人机接口等功能。
本发明的积极效果在于:将GPS/DR技术有机结合,采用了多传感器数据融合,具有接收和处理里程计信息、惯性测量单元IMU以及GPS的信息的功能。数据采集MCU采集GPS数据和DR组合导航数据,导航主控CPU完成数据的融合处理,数据采集MCU和导航主控CPU通过UART口进行通信,完成实时数据交互。GPS与DR的结合,提高了系统的有效性、完整性和定位精度。实现了全方位、全天候、无遮挡、高精度定位的目的。
附图说明
图1为本发明系统组成主框图;
图2为本发明电路原理图。
具体实施方式
实施例1
根据图1所示,GPS/DR组合导航系统的工作流程可以分成以下5个主要步骤:
(1)通过GPS接收系统4接收卫星的定位数据;
(2)通过陀螺仪2对车辆转角进行推算;
(3)通过加速度传感器3对路面坡度进行推算;
(4)通过车速脉冲1对车辆行驶距离进行推算;
(5)数据采集MCU5将上述信息发送给通过导航主控CPU 6,对所有数据进行筛选、滤波,推算出车辆行驶的具体位置。
实施例2
根据图2所示,本发明装置由车速脉冲1、陀螺仪2(村田公司MEV50A)、加速度传感器3(KIONIX公司KXPA4)、GPS接收系统4(U-BLOX公司LEA-4H),数据采集MCU5(MC9S08AW60单片机)、导航主控CPU 6(采用瑞萨导航平台SH7770)组成,陀螺仪2和加速度传感器3的模拟信号输出端连接到A/D转换器7的采样通道,通过高精度A/D转换器7将陀螺仪2和加速度传感器3输出的模拟信号转换为12位数字信号;A/D转换器7的数字信号输出端连接到数据采集MCU 5的SPI口,数据采集MCU 5对A/D转换器7的数字信号进行实时采集;车速脉冲1连接到数据采集MCU 5的脉冲捕捉IO口,数据采集MCU 5通过对车速脉冲1的捕捉推算当前车速;温度传感器8连接到数据采集MCU5的I2C口采集DR系统的温度,对DR系统的温度补偿;GPS接收系统4的UART1口连接到数据采集MCU 5的UART1口,完成对GPS接收系统4信息的提取;数据采集MCU 5的UART口连接到导航主控CPU6的UART口,导航主控CPU6实时获取GPS接收系统4信息和DR系统信息,导航主控CPU6存储有GPS与DR的组合定位、DR航位推算两种定位机制,导航主控CPU6根据GPS系统的信号强度选择具体的定位机制,实现了全方位、全天候、无遮挡、高精度定位的目的。
Claims (1)
1.一种GPS/DR联合导航装置,其特征在于:由车速脉冲(1)、陀螺仪(2)、加速度传感器(3)、GPS接收系统(4),数据采集MCU(5)、导航主控CPU(6)组成,陀螺仪(2)和加速度传感器(3)的模拟信号输出端连接到A/D转换器(7)的采样通道,通过A/D转换器(7)将陀螺仪(2)和加速度传感器(3)输出的模拟信号转换为12位数字信号;A/D转换器(7)的数字信号输出端连接到数据采集MCU(5)的SPI口,数据采集MCU(5)对A/D转换器(7)的数字信号进行实时采集;车速脉冲(1)连接到数据采集MCU(5)的脉冲捕捉I0口,数据采集MCU(5)通过对车速脉冲(1)的捕捉推算当前车速;温度传感器(8)连接到数据采集MCU(5)的I2C口采集DR系统的温度,对DR系统的温度补偿;GPS接收系统(4)的UART1口连接到数据采集MCU(5)的UART1口,完成对GPS接收系统(4)信息的提取;数据采集MCU(5)的UART口连接到导航主控CPU(6)的UART口,导航主控CPU(6)实时获取GPS接收系统(4)信息和DR系统信息,导航主控CPU(6)存储有GPS与DR的组合定位、DR航位推算两种定位机制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2009100665729A CN101493335B (zh) | 2009-02-27 | 2009-02-27 | Gps/dr组合导航方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2009100665729A CN101493335B (zh) | 2009-02-27 | 2009-02-27 | Gps/dr组合导航方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101493335A CN101493335A (zh) | 2009-07-29 |
CN101493335B true CN101493335B (zh) | 2011-05-04 |
Family
ID=40924046
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2009100665729A Active CN101493335B (zh) | 2009-02-27 | 2009-02-27 | Gps/dr组合导航方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101493335B (zh) |
Families Citing this family (28)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101871782B (zh) * | 2010-05-19 | 2011-11-02 | 北京航空航天大学 | 基于set2fnn的gps/mems-ins组合导航系统定位误差预测方法 |
KR20110134633A (ko) * | 2010-06-09 | 2011-12-15 | 엠텍비젼 주식회사 | 속도 측정 장치 및 측정된 속도 보정 방법 |
US20120098700A1 (en) * | 2010-10-25 | 2012-04-26 | Diggelen Frank Van | Method and system for computing universal hybrid navigation information for a gnss enabled device |
US20120173195A1 (en) | 2010-12-03 | 2012-07-05 | Qualcomm Incorporated | Inertial sensor aided heading and positioning for gnss vehicle navigation |
CN102141629A (zh) * | 2010-12-31 | 2011-08-03 | 上海同想文化传播有限公司 | 基于加速度传感器的高尔夫球车导航系统 |
CN102645664A (zh) * | 2011-02-17 | 2012-08-22 | 上海航鼎电子科技发展有限公司 | 基于gps、gsm、加速度计的载体位置信息处理方法及装置 |
US9140562B2 (en) | 2011-03-24 | 2015-09-22 | Claude Mignen | System and method for transferring vehicle operating data to an external navigation system |
CN102243315A (zh) * | 2011-04-25 | 2011-11-16 | 惠州Tcl移动通信有限公司 | 具有辅助定位功能的移动终端及方法 |
CN102261915B (zh) * | 2011-04-27 | 2013-06-12 | 浙江大学 | 行人惯性导航装置和方法 |
CN102538790A (zh) * | 2011-11-23 | 2012-07-04 | 武汉光庭科技有限公司 | 惯性导航中陀螺仪参数的差异性解决方法 |
CN102589527A (zh) * | 2012-01-17 | 2012-07-18 | 中测新图(北京)遥感技术有限责任公司 | 具有旋偏修正的无人机航摄系统、无人机和航摄方法 |
CN102608641A (zh) * | 2012-03-30 | 2012-07-25 | 江苏物联网研究发展中心 | 单轴陀螺仪和单轴加速度计的车载组合导航系统及方法 |
CN102721418A (zh) * | 2012-06-20 | 2012-10-10 | 惠州市德赛西威汽车电子有限公司 | 一种基于航位推算技术的车载定位系统 |
CN103810898A (zh) * | 2012-11-15 | 2014-05-21 | 深圳市赛格导航科技股份有限公司 | 一种自动停车取车系统和方法 |
CN103884869A (zh) * | 2012-12-19 | 2014-06-25 | 北京百度网讯科技有限公司 | 一种校正传感器偏差的方法和装置 |
DE102013213067B4 (de) * | 2013-07-04 | 2018-09-20 | Volkswagen Aktiengesellschaft | Verfahren und Vorrichtung zur Bestimmung mindestens einer Zustandsgröße einer Eigenposition eines Fahrzeugs |
CN103954291B (zh) * | 2014-04-30 | 2017-01-25 | 深圳市财富之舟科技有限公司 | 一种电子设备的导航方法和一种电子设备 |
CN105300395A (zh) * | 2014-07-11 | 2016-02-03 | 北京协进科技发展有限公司 | 一种导航定位方法及装置 |
CN105526935A (zh) * | 2014-09-29 | 2016-04-27 | 博世汽车部件(苏州)有限公司 | 高架道路辅助判断方法及系统、导航设备 |
CN106595699A (zh) * | 2015-10-14 | 2017-04-26 | 陕西飞机工业(集团)有限公司 | 一种航空惯性导航装置标定提醒方法 |
CN105738655A (zh) * | 2015-12-23 | 2016-07-06 | 深圳市金立通信设备有限公司 | 一种方向传感器校准方法及终端 |
CN105973243A (zh) * | 2016-07-26 | 2016-09-28 | 广州飞歌汽车音响有限公司 | 一种车载惯性导航系统 |
CN107991693A (zh) * | 2017-11-24 | 2018-05-04 | 中国民用航空总局第二研究所 | 一种用于飞行校验的无人机定位方法及系统 |
CN108240809A (zh) * | 2017-12-08 | 2018-07-03 | 佛吉亚好帮手电子科技有限公司 | 一种基于l3gd20芯片在qnx车机系统中惯导导航的系统及方法 |
CN110199961A (zh) * | 2019-06-13 | 2019-09-06 | 浙江大学 | 一种自主避障寻迹识别的多功能智能捕鱼船 |
CN110324783B (zh) * | 2019-08-14 | 2021-06-18 | 百度在线网络技术(北京)有限公司 | 车辆航迹推算服务的控制方法、装置、设备及存储介质 |
CN110926481A (zh) * | 2019-12-03 | 2020-03-27 | 华安鑫创控股(北京)股份有限公司 | 一种车辆定位导航方法及其装置 |
CN111836187A (zh) * | 2020-06-16 | 2020-10-27 | 出门问问信息科技有限公司 | 一种数据处理方法、装置、系统及计算机可读存储介质 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN201145578Y (zh) * | 2007-12-20 | 2008-11-05 | 四川川大智胜软件股份有限公司 | 嵌入式车载组合导航仪 |
CN201163193Y (zh) * | 2008-02-14 | 2008-12-10 | 中国电子科技集团公司第三十八研究所 | 车辆连续定位系统 |
CN201359500Y (zh) * | 2009-02-27 | 2009-12-09 | 启明信息技术股份有限公司 | 一种用于车辆的gps/dr组合导航装置 |
-
2009
- 2009-02-27 CN CN2009100665729A patent/CN101493335B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN201145578Y (zh) * | 2007-12-20 | 2008-11-05 | 四川川大智胜软件股份有限公司 | 嵌入式车载组合导航仪 |
CN201163193Y (zh) * | 2008-02-14 | 2008-12-10 | 中国电子科技集团公司第三十八研究所 | 车辆连续定位系统 |
CN201359500Y (zh) * | 2009-02-27 | 2009-12-09 | 启明信息技术股份有限公司 | 一种用于车辆的gps/dr组合导航装置 |
Non-Patent Citations (4)
Title |
---|
JP特开2002-213979A 2002.07.31 |
JP特开平10-281781A 1998.10.23 |
沈晓蓉,滕继涛,范跃祖.GPS/DR组合导航系统在车辆连续定位中的研究.《压电与声光》.2003,第25卷(第6期),476-479. * |
王玉华,曾连荪,金志华.基于GPS/DR组合的新型车辆导航仪.《计算机测量与控制》.2004,(第12期),1237-1239. * |
Also Published As
Publication number | Publication date |
---|---|
CN101493335A (zh) | 2009-07-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101493335B (zh) | Gps/dr组合导航方法及装置 | |
CN101907714B (zh) | 基于多传感器数据融合的gps辅助定位方法 | |
CN201359500Y (zh) | 一种用于车辆的gps/dr组合导航装置 | |
CN103217157B (zh) | 一种惯导/里程计自主组合导航方法 | |
CN103162689B (zh) | 辅助车载定位系统及车辆的辅助定位方法 | |
CN103712622B (zh) | 基于惯性测量单元旋转的陀螺漂移估计补偿方法及装置 | |
CN102680002B (zh) | 汽车用微机械陀螺零点电压的在线标定方法 | |
CN101476891A (zh) | 移动物体的精确导航系统及方法 | |
CN102636166B (zh) | 基于航向角的wsn/ins组合导航系统的控制方法 | |
CN103343498A (zh) | 一种基于ins/gnss的轨道不平顺检测系统及方法 | |
CN102621570B (zh) | 基于双全球定位和惯性测量的汽车动力学参数测量方法 | |
CN101183008A (zh) | 一种用于地面车辆gps导航的惯性补偿方法 | |
CN102608641A (zh) | 单轴陀螺仪和单轴加速度计的车载组合导航系统及方法 | |
CN113029139B (zh) | 基于运动检测的机场飞行区车辆差分北斗/sins组合导航方法 | |
WO2018072279A1 (zh) | 一种定位方法及移动设备 | |
CN110907976A (zh) | 基于北斗卫星的高速铁路组合导航系统 | |
CN105403219A (zh) | 一种基于mems的自行车导航系统 | |
CN102538790A (zh) | 惯性导航中陀螺仪参数的差异性解决方法 | |
JP2007284013A (ja) | 車両位置測位装置及び車両位置測位方法 | |
Guo et al. | Navigation and positioning system applied in underground driverless vehicle based on IMU | |
CN102706364B (zh) | 一种汽车用微机械陀螺标度因子在线标定方法 | |
KR20120086571A (ko) | 차량용 네비게이션 장치 및 방법 | |
CN101571395B (zh) | 微小型惯性组合导航参数测量方法 | |
KR20110109614A (ko) | 차량의 경사각 보정방법 및 그 보정장치 | |
CN102830438A (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 | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |