CN104567888A - 基于速度在线修正的惯性导航车辆姿态测量方法 - Google Patents
基于速度在线修正的惯性导航车辆姿态测量方法 Download PDFInfo
- Publication number
- CN104567888A CN104567888A CN201410818049.8A CN201410818049A CN104567888A CN 104567888 A CN104567888 A CN 104567888A CN 201410818049 A CN201410818049 A CN 201410818049A CN 104567888 A CN104567888 A CN 104567888A
- Authority
- CN
- China
- Prior art keywords
- inertial navigation
- vehicle
- attitude
- online
- error
- 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
- 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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Manufacturing & Machinery (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
Abstract
本发明公开一种基于速度在线修正的惯性导航车辆姿态测量方法,是以惯性导航模块以随动的导航坐标系所测量的车辆前进方向速度Vy和修正间隔车辆转弯角度 以及从车辆OBD接口或转速传感器得到的速度信号建立卡尔曼滤波器的观测矩阵,得到姿态角误差并对惯性导航所测量的姿态角进行修正,即可得到高精度车辆姿态。无需外部信息,可实现自主姿态测量,避免现有技术因使用全球卫星导航系统(GNSS)所存在的问题,同时无需高精度惯性导航模块,降低了测量成本。另外,因采用速度在线修正,即对于惯性器件漂移所产生的误差随时在线修正,无需定时停车修正。
Description
技术领域
本发明涉及一种车辆姿态测量方法,尤其是一种无需外部信息,可实现自主姿态测量且成本低的基于速度修正的惯性导航车辆姿态测量方法。
背景技术
目前,对于车辆姿态所采用的测量方法及问题如下:
第一种是采用高精度惯性(INS)导航模块。惯性导航模块是由三轴陀螺(机械陀螺、激光陀螺、光纤陀螺以及MEMS陀螺)、三轴加速度计(摆式加速度计和振梁式加速度计)、信号采集和计算电路组成,能够测量车辆的三轴角速率和三轴线加速度,通过积分能够即可直接得到车辆的姿态角度、线速度和位置等信息。采用惯性导航模块无需外部信息,使用方便,但是却必需采用高精度惯性导航模块,存在着成本高的问题,而且因惯性器件漂移所产生的误差不能随时在线修正,需要定时停车修正。
第二种是采用惯性导航与全球卫星导航系统(GNSS)的组合测量方法。主要是由卡尔曼滤波器通过惯性导航误差方程进行预测,通过卫星导航作为观测量,计算出惯性导航误差(姿态角误差、速度误差以及位置误差),再将误差反馈给惯性导航进行补偿修正,最后得到精度较高的车辆姿态等信息。虽然目前大多使用该方法,但是如果在卫星导航信号丢失(比如车辆通过涵洞、茂密树林及城市高楼林立地方)或卫星信号受到干扰或车辆本身不具备接收卫星导航信息条件时,该方法就失去了意义。
第三种是用垂直陀螺进行测量,但是此方法只适合姿态测量精度低而且是匀速运动的车辆,适用面窄。
发明内容
本发明是为了解决现有技术所存在的上述技术问题,提供一种无需外部信息,可实现自主姿态测量且成本低的基于速度在线修正的惯性导航车辆姿态测量方法。
本发明的技术解决方案是:一种基于速度在线修正的惯性导航车辆姿态测量方法,其特征在于按照如下步骤进行:
步骤1:惯性导航以随动的导航坐标系测量姿态角、车辆前进方向速度Vy和修正间隔车辆转弯角度
;所述随动的导航坐标系即车前进方向为x轴、天向为y轴,z向按右手法则;
步骤2:判断是否为导航修正时间?否,则进行步骤6;是,则进行步骤3;
步骤3:读取车辆速度,则观测矩阵Z如下:
式中Vx为车辆行驶过程任意时刻的横向速度,为零;
步骤4:卡尔曼滤波计算速度误差及姿态角误差;
步骤5:用所得姿态角误差对惯性导航所测量的姿态角进行修正;
步骤6:输出姿态角。
本发明是以惯性导航模块以随动的导航坐标系所测量的车辆前进方向速度Vy和修正间隔车辆转弯角度以及从车辆OBD接口或转速传感器得到的速度信号建立卡尔曼滤波器的观测矩阵,得到姿态角误差并对惯性导航所测量的姿态角进行修正,即可得到高精度车辆姿态。无需外部信息,可实现自主姿态测量,避免现有技术因使用全球卫星导航系统(GNSS)所存在的问题,同时无需高精度惯性导航模块,降低了测量成本。另外,因采用速度在线修正,即对于惯性器件漂移所产生的误差随时在线修正,无需定时停车修正。
附图说明
图1是本发明实施例的流程图。
具体实施方式
如图1所示:按照如下步骤进行:
步骤1:惯性导航以随动的导航坐标系测量姿态角、车辆前进方向速度Vy和修正间隔车辆转弯角度 ;所述随动的导航坐标系即车前进方向为x轴、天向为y轴,z向按右手法则;一般计算周期为5毫秒至30毫秒;计算可以采用四元数计算;微分方程可以采用四阶龙格-库达方法或旋转矢量方法;
步骤2:判断是否为导航修正时间?否,则进行步骤6;是,则进行步骤3;
一般导航修正周期为1~300S,即导航至设定时间修订一次。设导航修正周期为50S,则判断导航时间是否为50S的倍数,否,则直接进行步骤6,即输出所测量的姿态角;是,则进行步骤3、4、5、6;
步骤3:读取车辆速度,则观测矩阵Z如下:
式中Vx为车辆行驶过程任意时刻的横向速度,为零;
车辆速度是从车辆OBD接口或里程计转速传感器得到的速度信号;
步骤4:卡尔曼滤波计算导航误差;
按照现有卡尔曼滤波计算方法,以观测矩阵Z作为观测量,计算出惯性导航误差(姿态角误差、速度误差以及位置误差),
步骤5:用所得姿态角误差对惯性导航所测量的姿态角进行修正;
步骤6:输出姿态角。
Claims (1)
1.一种基于速度在线修正的惯性导航车辆姿态测量方法,其特征在于按照如下步骤进行:
步骤1:惯性导航以随动的导航坐标系测量姿态角、车辆前进方向速度Vy和修正间隔车辆转弯角度
;所述随动的导航坐标系即车前进方向为x轴、天向为y轴,z向按右手法则;
步骤2:判断是否为导航修正时间?否,则进行步骤6;是,则进行步骤3;
步骤3:读取车辆速度 ,则观测矩阵Z如下:
式中Vx为车辆行驶过程任意时刻的横向速度,为零;
步骤4:卡尔曼滤波计算速度误差及姿态角误差;
步骤5:用所得姿态角误差对惯性导航所测量的姿态角进行修正;
步骤6:输出姿态角。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410818049.8A CN104567888A (zh) | 2014-12-25 | 2014-12-25 | 基于速度在线修正的惯性导航车辆姿态测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410818049.8A CN104567888A (zh) | 2014-12-25 | 2014-12-25 | 基于速度在线修正的惯性导航车辆姿态测量方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN104567888A true CN104567888A (zh) | 2015-04-29 |
Family
ID=53084500
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410818049.8A Pending CN104567888A (zh) | 2014-12-25 | 2014-12-25 | 基于速度在线修正的惯性导航车辆姿态测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104567888A (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105444764A (zh) * | 2015-11-24 | 2016-03-30 | 大连楼兰科技股份有限公司 | 一种基于车辆里程计辅助的姿态测量方法 |
CN110031646A (zh) * | 2019-05-10 | 2019-07-19 | 北京工业大学 | 一种利用行车方向振动加速度修正行车速度方法 |
CN110106755A (zh) * | 2019-04-04 | 2019-08-09 | 武汉大学 | 利用姿态重构铁轨几何形态的高铁轨道不平顺性检测方法 |
CN111678514A (zh) * | 2020-06-09 | 2020-09-18 | 电子科技大学 | 一种基于载体运动条件约束和单轴旋转调制的车载自主导航方法 |
CN112729274A (zh) * | 2020-12-11 | 2021-04-30 | 北京自动化控制设备研究所 | 一种组合导航系统及方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7257512B1 (en) * | 2006-04-07 | 2007-08-14 | Honeywell International Inc. | Methods and systems for vibropendulous error compensation of acceleration sensors |
CN101413800A (zh) * | 2008-01-18 | 2009-04-22 | 南京航空航天大学 | 导航/稳瞄一体化系统的导航、稳瞄方法 |
CN101696886A (zh) * | 2009-10-29 | 2010-04-21 | 哈尔滨工业大学 | 一种在gps盲区内的电子地图辅助惯性导航方法 |
CN103743414A (zh) * | 2014-01-02 | 2014-04-23 | 东南大学 | 一种里程计辅助车载捷联惯导系统行进间初始对准方法 |
-
2014
- 2014-12-25 CN CN201410818049.8A patent/CN104567888A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7257512B1 (en) * | 2006-04-07 | 2007-08-14 | Honeywell International Inc. | Methods and systems for vibropendulous error compensation of acceleration sensors |
CN101413800A (zh) * | 2008-01-18 | 2009-04-22 | 南京航空航天大学 | 导航/稳瞄一体化系统的导航、稳瞄方法 |
CN101696886A (zh) * | 2009-10-29 | 2010-04-21 | 哈尔滨工业大学 | 一种在gps盲区内的电子地图辅助惯性导航方法 |
CN103743414A (zh) * | 2014-01-02 | 2014-04-23 | 东南大学 | 一种里程计辅助车载捷联惯导系统行进间初始对准方法 |
Non-Patent Citations (1)
Title |
---|
徐田来: "车载组合导航信息融合算法研究与系统实现", 《中国优秀博士学位论文全文数据库信息科技辑》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105444764A (zh) * | 2015-11-24 | 2016-03-30 | 大连楼兰科技股份有限公司 | 一种基于车辆里程计辅助的姿态测量方法 |
CN110106755A (zh) * | 2019-04-04 | 2019-08-09 | 武汉大学 | 利用姿态重构铁轨几何形态的高铁轨道不平顺性检测方法 |
CN110106755B (zh) * | 2019-04-04 | 2020-11-03 | 武汉大学 | 利用姿态重构铁轨几何形态的高铁轨道不平顺性检测方法 |
CN110031646A (zh) * | 2019-05-10 | 2019-07-19 | 北京工业大学 | 一种利用行车方向振动加速度修正行车速度方法 |
CN111678514A (zh) * | 2020-06-09 | 2020-09-18 | 电子科技大学 | 一种基于载体运动条件约束和单轴旋转调制的车载自主导航方法 |
CN112729274A (zh) * | 2020-12-11 | 2021-04-30 | 北京自动化控制设备研究所 | 一种组合导航系统及方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105865461B (zh) | 一种基于多传感器融合算法的汽车定位系统及方法 | |
CN101608920B (zh) | 一种组合式空间位姿精密动态测量装置及方法 | |
WO2017107434A1 (zh) | 一种基于单天线的gnss-ins车辆定姿方法 | |
CN109186597B (zh) | 一种基于双mems-imu的室内轮式机器人的定位方法 | |
CN105547288A (zh) | 一种煤矿井下移动设备自主定位的方法及系统 | |
KR20170104623A (ko) | 관성 항법 장치의 초기 정렬 방법 | |
CN104567888A (zh) | 基于速度在线修正的惯性导航车辆姿态测量方法 | |
CN201561759U (zh) | 惯性姿态方位测量装置 | |
CN1932444B (zh) | 适用于高速旋转体的姿态测量方法 | |
CN201955092U (zh) | 一种基于地磁辅助的平台式惯性导航装置 | |
CN107202578B (zh) | 一种基于mems技术的捷联式垂直陀螺仪解算方法 | |
CN103900565A (zh) | 一种基于差分gps的惯导系统姿态获取方法 | |
CN105698822A (zh) | 基于反向姿态跟踪的自主式惯性导航行进间初始对准方法 | |
CN106405592B (zh) | 车载北斗载波相位周跳检测与修复方法及系统 | |
CN114739425A (zh) | 基于rtk-gnss及全站仪的采煤机定位标定系统及应用方法 | |
CN112595350A (zh) | 一种惯导系统自动标定方法及终端 | |
CN101617199A (zh) | 一种用于补偿位置测量设备中的漂移的方法 | |
CN103308071B (zh) | 一种gps/ins定位导航装置微机电陀螺仪零点电压校正方法 | |
CN103712622A (zh) | 基于惯性测量单元旋转的陀螺漂移估计补偿方法及装置 | |
CN105444764A (zh) | 一种基于车辆里程计辅助的姿态测量方法 | |
CN103017764A (zh) | 高速列车自主导航及姿态测量装置 | |
CN110631573A (zh) | 一种惯性/里程计/全站仪多信息融合方法 | |
CN106403999A (zh) | 基于gnss的惯性导航加速度计漂移实时补偿方法 | |
CN103557869A (zh) | 一种车载导航仪 | |
CN202837553U (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 | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20150429 |