CN103712620B - 一种利用车体非完整性约束的惯性自主导航方法 - Google Patents
一种利用车体非完整性约束的惯性自主导航方法 Download PDFInfo
- Publication number
- CN103712620B CN103712620B CN201310609301.XA CN201310609301A CN103712620B CN 103712620 B CN103712620 B CN 103712620B CN 201310609301 A CN201310609301 A CN 201310609301A CN 103712620 B CN103712620 B CN 103712620B
- Authority
- CN
- China
- Prior art keywords
- navigation
- module
- vehicle body
- body non
- integrity constraint
- 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
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
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
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
本发明公开了一种利用车体非完整性约束的惯性自主导航方法。本方法利用在运动过程中车体非完整性约束,通过平滑惯性自主导航***输出的侧向和垂向速度累积,构建卡尔曼滤波观测方程,并利用卡尔曼滤波方程周期性计算出载车的导航参数误差并修正导航参数,从而实现了利用车体非完整性约束惯性导航***的自主导航。本发明有效的解决了惯性导航***自主导航精度发散的问题,有效的保证了惯性定位定向设备的精度。该方法使用方便,无需增加额外辅助设备。
Description
技术领域
本发明涉及一种惯性自主导航方法,特别是一种利用车体非完整性约束的惯性自主导航方法。
背景技术
惯性导航***是一种直接利用惯性器件(陀螺仪和加速度计)的测量信息建立方向基准,并通过加速度信息自动完成解算,从而获得载车瞬时速度和位置的导航***。惯性导航***具有完全自主的特点,被广泛应用于陆海空天领域。由于惯性器件存在随机漂移,因此惯性导航***具有定向和定位误差随时间增长的特性。对于低精度器件(如MEMS),其定位定向误差随时间增长的特性尤为明显,因此很难用于自主导航定位。通常,采用***辅助设备和惯性导航***组成组合导航***,以抑制惯性导航***的误差发散,实现导航定位的功能。
在载车运动条件下,采用低精度器件的惯性导航***需要与GPS、里程计、高程计等外部设备组成组合导航***。外部设备可以通过载车速度或位置等信息,建立惯性导航***在运动条件下的误差模型,采用卡尔曼滤波器实现对惯性导航***的导航信息误差的补偿。这种方法有效解决了惯性导航***误差发散的问题,能够实现高精度的定位定向。但是这也破坏了惯性导航***完全自主的特点,同时当***设备故障或无法工作时,惯性导航***还存在误差发散的问题,这些问题导致采用低精度器件的惯性导航***在运动条件下无法实现自主导航。
发明内容
本发明目的在于提供一种利用车体非完整性约束的惯性自主导航方法,解决由于采用低精度器件的惯性导航***在运动条件下无法自主导航的问题。
一种利用车体非完整性约束的惯性自主导航方法,其具体步骤为:
第一步构建利用车体非完整性约束的惯性自主导航***
利用车体非完整性约束的惯性自主导航***,包括:三轴硅微陀螺仪、三轴硅微加速度计、导航计算机、惯性导航解算模块、导航修正模块和通讯模块。三轴硅微陀螺仪和三轴硅微加速度计分别与导航计算机实现SPI总线连接。惯性导航解算模块、导航修正模块和通讯模块分别置于导航计算机中。
惯性导航解算模块用于利用采集的角速率和加速度通过数学运算得到载体在地理坐标系内的姿态、速度和位置。
导航修正模块用于利用车体非完整性约束构建观测方程,采用卡尔曼滤波方程周期性修正利用车体非完整性约束的惯性自主导航***的导航参数,即载车的姿态、速度和位置。
通讯模块用于利用车体非完整性约束的惯性自主导航***内外的数据采集和通讯。
第二步惯性导航解算模块对导航参数初始化
载车静止条件下,惯性导航解算模块接收来自三轴硅微陀螺仪和三轴硅微加速度计的数据,对三轴硅微陀螺仪和三轴硅微加速度计的零偏进行补偿,同时接收预存信息完成对惯性自主导航***姿态、速度和位置信息的初始化。
第三步惯性导航解算模块进行导航解算
载车启动后,惯性导航解算模块接收三轴硅微陀螺仪和三轴硅微加速度计的数据,计算出载车在地理坐标系内的姿态、速度和位置。
第四步导航修正模块进行修正准备
导航修正模块接收导航解算模块输出的速度,并利用姿态转换矩阵将接收到的速度转换为车体的侧向速度和垂向速度。
转换公式为:
()T表示向量转置,为三维向量,其第一项和第三项为侧向和垂向速度为惯性自主导航***的姿态转换矩阵;为惯性导航解算模块解算的速度,为三维向量,表示为
导航修正模块同时计算载车运动情况下的***状态转移矩阵。
第五步导航修正模块利用车体非完整性约束计算观测向量和观测矩阵
车体在运动情况下,受非完整性约束的影响,其侧向和垂向速度为零,和就是车体的速度误差。
将 作为***的观测向量。导航修正模块在修正时刻,计算从上一次修正时刻到本次修正时刻累积接收的车体的侧向速度和垂向速度之和,并计算这两项的平均值,将这两项作为和
计算滤波时刻的观测矩阵H(k), 其中Cij为计算姿态矩阵的(i,j)项;和为惯性导航解算模块计算的速度分量的第一项和第三项。
第六步导航修正模块计算导航参数误差
导航修正模块利用计算得到的运动误差方程、观测向量、观测矩阵,采用卡尔曼滤波方程计算得到利用车体非完整性约束的惯性自主导航***的导航参数误差。
第七步惯性导航解算模块修正导航参数
惯性导航解算模块接收导航修正模块传递的导航参数误差,修正利用车体非完整性约束的惯性自主导航***的姿态、速度和位置误差,将导航参数误差和观测向量Z(k)值归零。
经过上述各步骤实现了利用车体非完整性约束的惯性自主导航。
本方法通过利用车体非完整性约束构建了***的观测向量,采用卡尔曼滤波器周期性计算出载车运动过程中的导航参数误差,并修正导航参数,从而实现了利用车体非完整性约束的惯性自主导航。本方法能有效克服惯性导航***由于器件零偏导致的导航误差累积,提高惯性导航***的导航精度,而且无需***辅助设备,仅需通过优化软件流程即可实现,实施简单方便。
具体实施方式
一种利用车体非完整性约束的惯性自主导航方法,其具体步骤为:
第一步构建利用车体非完整性约束的惯性自主导航***
利用车体非完整性约束的惯性自主导航***,包括:三轴硅微陀螺仪、三轴硅微加速度计、导航计算机、惯性导航解算模块、导航修正模块和通讯模块。三轴硅微陀螺仪和三轴硅微加速度计分别与导航计算机实现SPI总线连接。惯性导航解算模块、导航修正模块和通讯模块分别置于导航计算机中。
惯性导航解算模块用于利用采集的角速率和加速度通过数学运算得到载体在地理坐标系内的姿态、速度和位置。
导航修正模块用于利用车体非完整性约束构建观测方程,采用卡尔曼滤波方程周期性修正利用车体非完整性约束的惯性自主导航***的导航参数,即载车的姿态、速度和位置。
通讯模块用于利用车体非完整性约束的惯性自主导航***内外的数据采集和通讯。
第二步惯性导航解算模块对导航参数初始化
载车静止条件下,惯性导航解算模块接收来自三轴硅微陀螺仪和三轴硅微加速度计的数据,对三轴硅微陀螺仪和三轴硅微加速度计的零偏进行补偿,同时接收预存信息完成对惯性自主导航***姿态、速度和位置信息的初始化。
第三步惯性导航解算模块进行导航解算
载车启动后,惯性导航解算模块接收三轴硅微陀螺仪和三轴硅微加速度计的数据,计算出载车在地理坐标系内的姿态、速度和位置。
第四步导航修正模块进行修正准备
导航修正模块接收导航解算模块输出的速度,并利用姿态转换矩阵将接收到的速度转换为车体的侧向速度和垂向速度。
转换公式为:
()T表示向量转置,为三维向量,其第一项和第三项为侧向和垂向速度为惯性自主导航***的姿态转换矩阵;为惯性导航解算模块解算的速度,为三维向量,表示为
导航修正模块同时计算载车运动情况下的***状态转移矩阵。
第五步导航修正模块利用车体非完整性约束计算观测向量和观测矩阵
车体在运动情况下,受非完整性约束的影响,其侧向和垂向速度为零,和就是车体的速度误差。
将 作为***的观测向量。导航修正模块在修正时刻,计算从上一次修正时刻到本次修正时刻累积接收的车体的侧向速度和垂向速度之和,并计算这两项的平均值,将这两项作为和
计算滤波时刻的观测矩阵H(k), 其中Cij为计算姿态矩阵的(i,j)项;和为惯性导航解算模块计算的速度分量的第一项和第三项。
第六步导航修正模块计算导航参数误差
导航修正模块利用计算得到的运动误差方程、观测向量、观测矩阵,采用卡尔曼滤波方程计算得到利用车体非完整性约束的惯性自主导航***的导航参数误差。
第七步惯性导航解算模块修正导航参数
惯性导航解算模块接收导航修正模块传递的导航参数误差,修正利用车体非完整性约束的惯性自主导航***的姿态、速度和位置误差,将导航参数误差和观测向量Z(k)值归零。
经过上述各步骤实现了利用车体非完整性约束的惯性自主导航。
Claims (1)
1.一种利用车体非完整性约束的惯性自主导航方法,其特征在于具体步骤为:
第一步构建利用车体非完整性约束的惯性自主导航***
利用车体非完整性约束的惯性自主导航***,包括:三轴硅微陀螺仪、三轴硅微加速度计、导航计算机、惯性导航解算模块、导航修正模块和通讯模块;三轴硅微陀螺仪和三轴硅微加速度计分别与导航计算机实现SPI总线连接;惯性导航解算模块、导航修正模块和通讯模块分别置于导航计算机中;
惯性导航解算模块用于利用采集的角速率和加速度通过数学运算得到载体在地理坐标系内的姿态、速度和位置;
导航修正模块用于利用车体非完整性约束构建观测方程,采用卡尔曼滤波方程周期性修正利用车体非完整性约束的惯性自主导航***的导航参数,即载车的姿态、速度和位置;
通讯模块用于利用车体非完整性约束的惯性自主导航***内外的数据采集和通讯;
第二步惯性导航解算模块对导航参数初始化
载车静止条件下,惯性导航解算模块接收来自三轴硅微陀螺仪和三轴硅微加速度计的数据,对三轴硅微陀螺仪和三轴硅微加速度计的零偏进行补偿,同时接收预存信息完成对惯性自主导航***姿态、速度和位置信息的初始化;
第三步惯性导航解算模块进行导航解算
载车启动后,惯性导航解算模块接收三轴硅微陀螺仪和三轴硅微加速度计的数据,计算出载车在地理坐标系内的姿态、速度和位置;
第四步导航修正模块进行修正准备
导航修正模块接收导航解算模块输出的速度,并利用姿态转换矩阵将接收到的速度转换为车体的侧向速度和垂向速度;
转换公式为:
()T表示向量转置,为三维向量,其第一项和第三项为侧向和垂向速度 为惯性自主导航***的姿态转换矩阵;为惯性导航解算模块解算的速度,为三维向量,表示为
导航修正模块同时计算载车运动情况下的***状态转移矩阵;
第五步导航修正模块利用车体非完整性约束计算观测向量和观测矩阵
车体在运动情况下,受非完整性约束的影响,其侧向和垂向速度为零,和就是车体的速度误差;
将 作为***的观测向量;导航修正模块在修正时刻,计算从上一次修正时刻到本次修正时刻累积接收的车体的侧向速度和垂向速度之和,并计算这两项的平均值,将这两项作为和
计算滤波时刻的观测矩阵H(k), 其中Cij为计算姿态矩阵的(i,j)项;和为惯性导航解算模块计算的速度分量的第一项和第三项;
第六步导航修正模块计算导航参数误差
导航修正模块利用计算得到的运动误差方程、观测向量、观测矩阵,采用卡尔曼滤波方程计算得到利用车体非完整性约束的惯性自主导航***的导航参数误差;
第七步惯性导航解算模块修正导航参数
惯性导航解算模块接收导航修正模块传递的导航参数误差,修正利用车体非完整性约束的惯性自主导航***的姿态、速度和位置误差,将导航参数误差和观测向量Z(k)值归零;
经过上述各步骤实现了利用车体非完整性约束的惯性自主导航。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310609301.XA CN103712620B (zh) | 2013-11-27 | 2013-11-27 | 一种利用车体非完整性约束的惯性自主导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310609301.XA CN103712620B (zh) | 2013-11-27 | 2013-11-27 | 一种利用车体非完整性约束的惯性自主导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103712620A CN103712620A (zh) | 2014-04-09 |
CN103712620B true CN103712620B (zh) | 2016-03-30 |
Family
ID=50405782
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310609301.XA Active CN103712620B (zh) | 2013-11-27 | 2013-11-27 | 一种利用车体非完整性约束的惯性自主导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103712620B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CA2983574C (en) * | 2014-04-22 | 2021-11-16 | Blast Motion Inc. | Initializing an inertial sensor using soft constraints and penalty functions |
CN105509738B (zh) * | 2015-12-07 | 2018-06-29 | 西北工业大学 | 基于惯导/多普勒雷达组合的车载定位定向方法 |
CN109596139B (zh) * | 2019-01-22 | 2021-05-04 | 中国电子科技集团公司第十三研究所 | 基于mems的车载导航方法 |
CN111678514B (zh) * | 2020-06-09 | 2023-03-28 | 电子科技大学 | 一种基于载体运动条件约束和单轴旋转调制的车载自主导航方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102997915A (zh) * | 2011-09-15 | 2013-03-27 | 北京自动化控制设备研究所 | 一种闭环正向滤波结合反向平滑的pos后处理方法 |
CN103343498A (zh) * | 2013-07-24 | 2013-10-09 | 武汉大学 | 一种基于ins/gnss的轨道不平顺检测***及方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20120173195A1 (en) * | 2010-12-03 | 2012-07-05 | Qualcomm Incorporated | Inertial sensor aided heading and positioning for gnss vehicle navigation |
-
2013
- 2013-11-27 CN CN201310609301.XA patent/CN103712620B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102997915A (zh) * | 2011-09-15 | 2013-03-27 | 北京自动化控制设备研究所 | 一种闭环正向滤波结合反向平滑的pos后处理方法 |
CN103343498A (zh) * | 2013-07-24 | 2013-10-09 | 武汉大学 | 一种基于ins/gnss的轨道不平顺检测***及方法 |
Non-Patent Citations (3)
Title |
---|
The Aiding of a Low-Cost Strapdown Inertial Measurement Unit Using Vehicle Model Constraints For Land Vehicle Applications;Gamini Dissanayake et al;《IEEE TRANSACTIONS ON ROBOTICS AND AUTOMATION》;20011031;第17卷(第5期);第731-747页 * |
汽车状态软测量和车载组合导航***故障检测技术研究;任孝平;《中国博士学位论文全文数据库信息科技辑》;20121215;全文 * |
车辆动态数学模型辅助的惯性导航***;马昕等;《山东大学学报(工学板)》;20050430;第35卷(第2期);第67-71页 * |
Also Published As
Publication number | Publication date |
---|---|
CN103712620A (zh) | 2014-04-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
RU2662462C1 (ru) | Способ определения пространственного положения транспортного средства на базе gnss-ins с использованием одиночной антенны | |
CN107655476B (zh) | 基于多信息融合补偿的行人高精度足部导航方法 | |
CN107588769B (zh) | 一种车载捷联惯导、里程计及高程计组合导航方法 | |
CN109186597B (zh) | 一种基于双mems-imu的室内轮式机器人的定位方法 | |
CN103712620B (zh) | 一种利用车体非完整性约束的惯性自主导航方法 | |
US8467967B2 (en) | Smart-phone bracket for car and truck navigation | |
CN104061899A (zh) | 一种基于卡尔曼滤波的车辆侧倾角与俯仰角估计方法 | |
CN104198765A (zh) | 车辆运动加速度检测的坐标系转换方法 | |
CN104181573B (zh) | 北斗惯导深组合导航微*** | |
CN104697526A (zh) | 用于农业机械的捷联惯导***以及控制方法 | |
CN104898681A (zh) | 一种采用三阶近似毕卡四元数的四旋翼飞行器姿态获取方法 | |
CN105318876A (zh) | 一种惯性里程计组合高精度姿态测量方法 | |
CN111380516B (zh) | 基于里程计测量信息的惯导/里程计车辆组合导航方法及*** | |
CN102853837B (zh) | 一种mimu和gnss信息融合的方法 | |
CN105928515B (zh) | 一种无人机导航*** | |
CN101963512A (zh) | 船用旋转式光纤陀螺捷联惯导***初始对准方法 | |
CN106052684A (zh) | 采用多模式描述的移动机器人imu/uwb/码盘松组合导航***及方法 | |
CN105841698A (zh) | 一种无需调零的auv舵角精确实时测量*** | |
CN103398725A (zh) | 一种基于星敏感器的捷联惯导***初始对准的方法 | |
CN103900614A (zh) | 一种九加速度计无陀螺惯导***的重力补偿方法 | |
CN103900566A (zh) | 一种消除地球自转角速度对旋转调制型捷联惯导***精度影响的方法 | |
CN103712621A (zh) | 偏振光及红外传感器辅助惯导***定姿方法 | |
CN105157724A (zh) | 一种基于速度加姿态匹配的传递对准时间延迟估计与补偿方法 | |
CN117053782A (zh) | 一种水陆两栖机器人组合导航方法 | |
CN103557869A (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 |