CN103644911A - 陀螺仪辅助定位方法 - Google Patents
陀螺仪辅助定位方法 Download PDFInfo
- Publication number
- CN103644911A CN103644911A CN201310607804.3A CN201310607804A CN103644911A CN 103644911 A CN103644911 A CN 103644911A CN 201310607804 A CN201310607804 A CN 201310607804A CN 103644911 A CN103644911 A CN 103644911A
- Authority
- CN
- China
- Prior art keywords
- gyroscope
- attitude
- speed
- calculating
- quaternion
- 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
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/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
技术领域
本发明涉及辅助定位方法,尤其是涉及一种脱落及辅助定位及其方法。
背景技术
现有的陀螺仪辅助导航方法是采用陀螺仪定位方式,陀螺仪定位方式是基于角速度检测的原理而设计,通过一系列的运算,得到的定位位置是相对于上次定位的一个相对值。现有的陀螺仪辅助导航方法虽然已经使得空中指向定位成为可能,但由于得到的定位位置只是相对于上次定位的一个相对值,指向性存在一定的偏差,当长时间偏差得不到补偿时,偏差就会在一定程度上进行累加,以至于体验越来越差,在某些特定场合,它还不能完全满足需要,另外传统的陀螺仪辅助导航是基于最后的位置点进行导航,在导航过程中会因为时间的增加累计误差不断的增大。
发明内容
本发明所要解决的技术问题是针对上述现有技术的不足,提供一种精度高、误差小的陀螺仪辅助定位方法。
为解决上述技术问题,本发明采取的技术方案为:陀螺仪辅助定位方法,其特征在于包括以下步骤:
首先、姿态角的测量:对加速度计的测量值和磁传感器的测量值分别经过高斯牛顿迭代得到姿态误差速率,陀螺仪直接通过四元数微分方程得到姿态四元数速率,两个加起来积分得到姿态四元数;
其次、初始点的获取:利用加速度计和陀螺仪芯片两者的数据,进行轨迹推算,以将轨迹周期提高到惯性测量单元的数据周期;
第三、速度和移动距离的计算:根据修正过的欧拉角,计算三轴的加速度的分量,从而计算出实际的加速度;在已知初速度,加速度和时间的情况下,通过对初速度积分和加速度二次积分,计算出移动距离;
第四、计算位置点: 根据移动距离和方向计算当前的位置点的经纬度;
第五:纠正位置: 根据计算的位置点,在道路上进行投影,进行平滑处理,得到纠正后的位置点。
陀螺仪的漂移、载体的线性加速度和周围局部磁场的干扰是制约MARG传感器姿态测量精度的主要问题。本发明基于已有的惯性测量单元,设计了一个基于四元数的Kalman滤波器,通过建立MARG传感器模型,引入传感器偏差补偿和自适应的测量噪声协方差矩阵构造方法来提高姿态测量精度,减小载体线性加速度和周围局部磁场的干扰,实现三自由度的姿态测量。传统的陀螺仪辅助导航是基于最后的位置点进行导航,在导航过程中会因为时间的增加累计误差不断的增大,本发明是根据道路数据,对定位结果进行投影修正,并利用修正结果计算下一个位置点,这样就有效地减小累计误差。总之,现有技术没有解决陀螺仪的漂移、载体的线性加速度和周围局部磁场的干扰和长时间的累积误差问题,本发明针对性的解决了陀螺仪的漂移、载体的线性加速度和周围局部磁场的干扰问题,并把陀螺仪的空间定位技术和实际的导航应用相结合,解决了长时间的累积误差问题,而且根据道路数据,对定位结果进行投影修正,并利用修正结果计算下一个位置点,这样就有效地减小累计误差。
附图说明
图1为姿态角测量的数学式图。
图2为惯性加速度矢量图。
图3为纠正后的位置点图。
具体实施方式
实施例1
本陀螺仪辅助定位方法,包括以下步骤:
首先、姿态角的测量:对加速度计的测量值和磁传感器的测量值分别经过高斯牛顿迭代得到姿态误差速率,陀螺仪直接通过四元数微分方程得到姿态四元数速率,两个加起来积分得到姿态四元数。参见图1,本陀螺仪辅助定位方法基于已有的惯性测量单元,设计了一个基于四元数的Kalman滤波器,通过建立MARG传感器模型,引入传感器偏差补偿和自适应的测量噪声协方差矩阵构造方法来提高姿态测量精度,减小载体线性加速度和周围局部磁场的干扰,实现三自由度的姿态测量。
其次、初始点的获取:利用加速度计和陀螺仪芯片两者的数据,进行轨迹推算,以将轨迹周期提高到惯性测量单元的数据周期。众所周知GPS 有一定的误差,如果GPS 的误差在15 米范围的话,远超过了车道的宽度,要想定位在车道上,确实是个难度。可以利用固定GPS 基站的方式来校准精度,但还有一个问题,芯片提供的定位周期最快只有一秒。就是说,这一秒范围内的轨迹是空白的,当速度达到一定程度的时候,一秒的距离已经很远,甚至已经完成了一个快速小角度偏转动作。那么这样的话精度将会大大降低。为了填补这一秒中的轨迹空白,于是我们利用加速度计和陀螺仪芯片,利用两者数据推算轨迹,将轨迹周期提高到惯性测量单元的数据周期,即20 毫秒。
第三、速度和移动距离的计算:根据修正过的欧拉角,计算三轴的加速度的分量,从而计算出实际的加速度;在已知初速度,加速度和时间的情况下,通过对初速度积分和加速度二次积分,计算出移动距离;惯性加速度矢量图如图2所示,得到了惯性加速度矢量的三个分量,根据计算得出的欧拉角即可计算出我们实际方向的加速度。
第四、计算位置点: 根据移动距离和方向计算当前的位置点的经纬度,即在地球上已知一点,距离和方向,可以求出另一点的经纬度。
第五:纠正位置: 根据计算的位置点,在道路上进行投影,进行平滑处理,得到纠正后的位置点,如图3所示。
Claims (1)
1.一种陀螺仪辅助定位方法,其特征在于包括以下步骤:
首先、姿态角的测量:对加速度计的测量值和磁传感器的测量值分别经过高斯牛顿迭代得到姿态误差速率,陀螺仪直接通过四元数微分方程得到姿态四元数速率,两个加起来积分得到姿态四元数;
其次、初始点的获取:利用加速度计和陀螺仪芯片两者的数据,进行轨迹推算,以将轨迹周期提高到惯性测量单元的数据周期;
第三、速度和移动距离的计算:根据修正过的欧拉角,计算三轴的加速度的分量,从而计算出实际的加速度;在已知初速度,加速度和时间的情况下,通过对初速度积分和加速度二次积分,计算出移动距离;
第四、计算位置点: 根据移动距离和方向计算当前的位置点的经纬度;
第五:纠正位置: 根据计算的位置点,在道路上进行投影,进行平滑处理,得到纠正后的位置点。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310607804.3A CN103644911A (zh) | 2013-11-27 | 2013-11-27 | 陀螺仪辅助定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310607804.3A CN103644911A (zh) | 2013-11-27 | 2013-11-27 | 陀螺仪辅助定位方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN103644911A true CN103644911A (zh) | 2014-03-19 |
Family
ID=50250163
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310607804.3A Pending CN103644911A (zh) | 2013-11-27 | 2013-11-27 | 陀螺仪辅助定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103644911A (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106680597A (zh) * | 2016-12-13 | 2017-05-17 | 云南电网有限责任公司电力科学研究院 | 确定最强场源方位的方法及系统 |
CN107038874A (zh) * | 2017-06-01 | 2017-08-11 | 广东工业大学 | 一种车祸监测方法及装置 |
CN109211230A (zh) * | 2018-09-07 | 2019-01-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态和加速度计常值误差估计方法 |
CN109211231A (zh) * | 2018-09-07 | 2019-01-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态估计方法 |
CN109795592A (zh) * | 2019-01-30 | 2019-05-24 | 武汉齐物科技有限公司 | 骑行姿势识别方法及应用装置 |
CN110530396A (zh) * | 2019-07-31 | 2019-12-03 | 苏州浪潮智能科技有限公司 | 一种陀螺仪传感器误差的处理方法及设备 |
CN111248922A (zh) * | 2020-02-11 | 2020-06-09 | 中国科学院半导体研究所 | 基于加速度计和陀螺仪的人体呼吸情况采集贴及制备方法 |
CN111637887A (zh) * | 2020-06-01 | 2020-09-08 | 太原理工大学 | 一种基于惯性模块的矿用单轨吊机车定位方法 |
CN111966130A (zh) * | 2020-06-28 | 2020-11-20 | 上海伊涵家居饰品有限公司 | 座椅自动归位控制方法、系统及其存储介质 |
CN113227714A (zh) * | 2018-12-21 | 2021-08-06 | 赛峰电子与防务公司 | 用于表征惯性测量单元的方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100079334A1 (en) * | 2008-09-24 | 2010-04-01 | Texas Instruments Incorporated | Low-complexity tightly-coupled integration filter for sensor-assisted gnss receiver |
CN101907714A (zh) * | 2010-06-25 | 2010-12-08 | 陶洋 | 基于多传感器数据融合的gps辅助定位系统及其定位方法 |
CN103212188A (zh) * | 2013-05-13 | 2013-07-24 | 中山大学 | 一种辅助步态训练的方法及系统 |
CN103343315A (zh) * | 2013-06-04 | 2013-10-09 | 南京理工大学 | 一种掺杂铁酸铋半导体薄膜材料及其制备方法 |
WO2013155919A1 (zh) * | 2012-04-16 | 2013-10-24 | 中兴通讯股份有限公司 | 一种定位方法和系统 |
-
2013
- 2013-11-27 CN CN201310607804.3A patent/CN103644911A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100079334A1 (en) * | 2008-09-24 | 2010-04-01 | Texas Instruments Incorporated | Low-complexity tightly-coupled integration filter for sensor-assisted gnss receiver |
CN101907714A (zh) * | 2010-06-25 | 2010-12-08 | 陶洋 | 基于多传感器数据融合的gps辅助定位系统及其定位方法 |
WO2013155919A1 (zh) * | 2012-04-16 | 2013-10-24 | 中兴通讯股份有限公司 | 一种定位方法和系统 |
CN103212188A (zh) * | 2013-05-13 | 2013-07-24 | 中山大学 | 一种辅助步态训练的方法及系统 |
CN103343315A (zh) * | 2013-06-04 | 2013-10-09 | 南京理工大学 | 一种掺杂铁酸铋半导体薄膜材料及其制备方法 |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106680597B (zh) * | 2016-12-13 | 2019-02-15 | 云南电网有限责任公司电力科学研究院 | 确定最强场源方位的方法及系统 |
CN106680597A (zh) * | 2016-12-13 | 2017-05-17 | 云南电网有限责任公司电力科学研究院 | 确定最强场源方位的方法及系统 |
CN107038874A (zh) * | 2017-06-01 | 2017-08-11 | 广东工业大学 | 一种车祸监测方法及装置 |
CN107038874B (zh) * | 2017-06-01 | 2024-01-23 | 广东工业大学 | 一种车祸监测方法及装置 |
CN109211230B (zh) * | 2018-09-07 | 2022-02-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态和加速度计常值误差估计方法 |
CN109211231B (zh) * | 2018-09-07 | 2022-02-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态估计方法 |
CN109211231A (zh) * | 2018-09-07 | 2019-01-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态估计方法 |
CN109211230A (zh) * | 2018-09-07 | 2019-01-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态和加速度计常值误差估计方法 |
CN113227714A (zh) * | 2018-12-21 | 2021-08-06 | 赛峰电子与防务公司 | 用于表征惯性测量单元的方法 |
CN113227714B (zh) * | 2018-12-21 | 2022-09-27 | 赛峰电子与防务公司 | 用于表征惯性测量单元的方法 |
CN109795592A (zh) * | 2019-01-30 | 2019-05-24 | 武汉齐物科技有限公司 | 骑行姿势识别方法及应用装置 |
CN109795592B (zh) * | 2019-01-30 | 2024-01-05 | 武汉齐物科技有限公司 | 骑行姿势识别方法及应用装置 |
CN110530396A (zh) * | 2019-07-31 | 2019-12-03 | 苏州浪潮智能科技有限公司 | 一种陀螺仪传感器误差的处理方法及设备 |
CN111248922A (zh) * | 2020-02-11 | 2020-06-09 | 中国科学院半导体研究所 | 基于加速度计和陀螺仪的人体呼吸情况采集贴及制备方法 |
CN111637887A (zh) * | 2020-06-01 | 2020-09-08 | 太原理工大学 | 一种基于惯性模块的矿用单轨吊机车定位方法 |
CN111966130A (zh) * | 2020-06-28 | 2020-11-20 | 上海伊涵家居饰品有限公司 | 座椅自动归位控制方法、系统及其存储介质 |
CN111966130B (zh) * | 2020-06-28 | 2023-06-27 | 上海伊涵家居饰品有限公司 | 座椅自动归位控制方法、系统及其存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103644911A (zh) | 陀螺仪辅助定位方法 | |
CN107315345B (zh) | 基于双天线gnss和预瞄追踪模型的农机自动导航控制方法 | |
CN105509738B (zh) | 基于惯导/多普勒雷达组合的车载定位定向方法 | |
CN105300410B (zh) | 采煤机惯性导航定位误差校准装置及方法 | |
CN102901977B (zh) | 一种飞行器的初始姿态角的确定方法 | |
CN102508277A (zh) | 精密单点定位与惯性测量紧组合导航系统及数据处理方法 | |
CN104121905A (zh) | 一种基于惯性传感器的航向角获取方法 | |
CN103630137A (zh) | 一种用于导航系统的姿态及航向角的校正方法 | |
CN103235328A (zh) | 一种gnss与mems组合导航的方法 | |
CN103439727B (zh) | 一种地面坐标的测量方法 | |
JPWO2014002210A1 (ja) | 測位装置 | |
CN114739425A (zh) | 基于rtk-gnss及全站仪的采煤机定位标定系统及应用方法 | |
CN104049269B (zh) | 一种基于激光测距和mems/gps组合导航系统的目标导航测绘方法 | |
CN103149571B (zh) | 一种基于gnss信号辅助的时频差综合修正方法 | |
CN102508280B (zh) | 陀螺辅助双天线测量单元确定整周模糊度和航向的方法 | |
JP2012173190A (ja) | 測位システム、測位方法 | |
CN104359496B (zh) | 基于垂线偏差补偿的高精度姿态修正方法 | |
CN106840154A (zh) | 地下空间惯性测量与无线传感器组合定位系统与方法 | |
CN103645485A (zh) | 一种基于双星时差频差无源定位的伪距差分方法 | |
CN103453903A (zh) | 一种基于惯性测量组件的管道探伤系统导航定位方法 | |
JP2014102137A (ja) | 自己位置推定装置 | |
CN103900566A (zh) | 一种消除地球自转角速度对旋转调制型捷联惯导系统精度影响的方法 | |
CN110207694A (zh) | 一种基于相对位置信息的极区格网惯导/超短基线组合导航方法 | |
CN113236363A (zh) | 开采设备导航定位方法、系统、设备及可读存储介质 | |
CN202305821U (zh) | 精密单点定位与惯性测量紧组合导航系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20140319 |