CN112747772B - 一种基于request的惯性里程计动基座粗对准方法 - Google Patents
一种基于request的惯性里程计动基座粗对准方法 Download PDFInfo
- Publication number
- CN112747772B CN112747772B CN202011585048.5A CN202011585048A CN112747772B CN 112747772 B CN112747772 B CN 112747772B CN 202011585048 A CN202011585048 A CN 202011585048A CN 112747772 B CN112747772 B CN 112747772B
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- matrix
- request
- attitude
- inertial
- 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
- 238000000034 method Methods 0.000 title claims abstract description 49
- 239000011159 matrix material Substances 0.000 claims abstract description 57
- 239000013598 vector Substances 0.000 claims abstract description 35
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 9
- 230000007704 transition Effects 0.000 claims abstract description 5
- 230000009286 beneficial effect Effects 0.000 claims abstract description 4
- 238000012545 processing Methods 0.000 claims abstract description 4
- 238000005259 measurement Methods 0.000 claims description 14
- 230000003068 static effect Effects 0.000 claims description 6
- 230000000694 effects Effects 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 238000006467 substitution reaction Methods 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 abstract description 6
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000002401 inhibitory effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000008092 positive effect Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 238000010626 work up procedure Methods 0.000 description 1
Images
Classifications
-
- 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)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种基于REQUEST的惯性里程计动基座粗对准方法,利于REQUEST解决双矢量定姿问题,实现惯导/里程计组合导航系统在动基座下的粗对准,通过采集和处理陀螺和加速度计数据,建立过渡坐标系,将姿态求解转换为双矢量定姿问题,运用REQUEST方法解决双矢量定姿问题,进而根据矩阵链乘求得姿态矩阵,完成动基座粗对准。发明的方法充分利用了矢量观测信息,通过在REQUEST算法引入衰减因子有效抑制了新近观测信息中累积的器件误差的影响,并且具有计算量小和对准时间短的优点,有效地提升了动基座粗对准速度和精度。
Description
技术领域
本发明属于捷联惯导初始对准领域,尤其是涉及一种基于REQUEST的惯性里程计动基座粗对准方法。
背景技术
惯性/里程计组合导航系统是一种具备完全的自主性的导航系统,能够提供全方位的导航信息,因此在陆用领域得到了广泛的应用。初始对准是惯性导航系统导航解算的前提,根据载体的运动状态可划分为静基座对准和动基座对准,相比于静基座对准,动基座对准在提高载体机动性、缩短准备时间上有着明显的优势。通常动基座对准需要引入外部量测信息,对于惯性/里程计而言,外部量测信息为里程计在载体系上测得的速度。
现有的惯性/里程计动基座粗对准方法有三轴姿态确定算法(TRIDE)、q-方法和QUEST方法等,上述方法均可以在动基座下实现较高的粗对准精度,但是 TRIDE算法无法充分利用观测矢量信息,因此会有精度损失;q-方法和QUEST方法能够充分利用所有的观测向量,但是计算量较大;REQUEST是一种用于解决双矢量定姿的递推优化算法,能够充分利用对准时间内所有的观测矢量信息,并且计算量较小,对于提高动基座条件下惯导/里程计组合导航系统的导航精度具有一定的理论和工程应用价值。
发明内容
为解决上述技术问题,本发明提供一种基于REQUEST的惯性里程计动基座粗对准方法。
本发明采用的技术方案是:一种基于REQUEST的惯性里程计动基座粗对准方法,利于REQUEST解决双矢量定姿问题,实现惯导/里程计组合导航系统在动基座下的粗对准,包括如下步骤:
步骤一 装订初始位置信息,执行动基座粗对准;
步骤二 采集和处理陀螺和加速度计数据,建立过渡坐标系,将姿态求解转换为双矢量定姿问题;
步骤三 运用REQUEST方法解决双矢量定姿问题;
步骤四 进而根据矩阵链乘求得姿态矩阵,完成动基座粗对准。
优选地,坐标系定义如下:
i系,地心惯性坐标系:oxi轴在赤道平面内且指向春分点,ozi轴指向地球自转方向,三轴构成右手坐标系;
e系,地球坐标系:oxe轴在赤道平面内且指向中央子午线,oze轴沿地球自转方向,三轴构成右手坐标系;
n系,导航坐标系:定义“东-北-天”坐标系为导航坐标系;
b系,载体坐标系:定义“右-前-上”坐标系为载体坐标系;
i0系,初始时刻惯性坐标系:把初始对准开始时刻的惯性坐标系定义为i0系;
e0系,初始时刻地球坐标系:把初始对准开始时刻的导航坐标系定义为e0系,它相对惯性空间固定不动;
n0系,初始时刻导航坐标系:把初始对准开始时刻的导航坐标系定义为n0系,它相对地球表面固定不动,即不随捷联惯组在地球表面运动而运动;
其中,
优选地,惯导比力方程可表示为:
其中,表示载体速度在n系下的投影;fb表示加速度计量测信息在b系下的投影;gn=[0 0 -g]T表示重力信息在n系下的投影;表示地球自转在n系下的投影;表示e系下的角速度到n系的投影;RM和RN分别表示子午圈曲率半径和卯酉圈曲率半径。
优选地,进一步整理,得到:
化简为:
为了平滑器件量测噪声的影响,等式两边进一步积分得到:
式中,αi是一组在载体系中观测得到的单位矢量,βi是相应的参考系中的单位矢量,ai是非负的权重系数;
利用矩阵迹的轮换不变性,整理得到:
g(q)≡g(A(q))=tr(ABT)=qTKq;
K可用递推算法实现:
δS=B+BT;
δz=[B23-B32 B31-B13 B12-B21]T;
使得增益函数最g(A)最大化的四元数为矩阵K的最大特征值对应的特征向量,即:
Kqopt=λmaxqopt。
本发明具有的优点和积极效果是:充分利用对准时间内所有的观测矢量信息,降低导航计算机的运算负荷,在一定时间内实现惯性/里程计组合导航系统的动基座粗对准,通过在REQUEST算法引入衰减因子有效抑制了新近观测信息中累积的器件误差的影响,并且具有计算量小和对准时间短的优点,有效地提升了动基座粗对准速度和精度。
附图说明
图1是本发明一个实施例基于REQUEST的惯性/里程计动基座粗对准方法的总体流程图;
图2是实施例中不同动基座粗对准方法的俯仰角误差对比曲线;
图3是实施例中不同动基座粗对准方法的横滚角误差对比曲线;
图4是实施例中不同动基座粗对准方法的航向角误差对比曲线
具体实施方式
下面结合附图对本发明的一个实施例做出说明。
如图1所示,一种基于REQUEST的惯性/里程计动基座粗对准方法,利于 REQUEST解决双矢量定姿问题,实现惯导/里程计组合导航系统在动基座下的粗对准。本发明包括以下步骤:
步骤0:将惯导和里程计通过过渡板安装到载车上,并上电启动;
步骤1:装订初始位置信息至导航计算机,执行动基座粗对准后发动载车;
步骤2:采集和处理陀螺和加速度计数据,建立过渡坐标系,将姿态求解转换为双矢量定姿问题;
步骤3:运用REQUEST方法解决双矢量定姿问题;
步骤4:进而根据矩阵链乘求得姿态矩阵,完成动基座粗对准。
本方法坐标系定义如下:
地心惯性坐标系(i系):oxi轴在赤道平面内且指向春分点,ozi轴指向地球自转方向,三轴构成右手坐标系;
地球坐标系(e系):oxe轴在赤道平面内且指向中央子午线,oze轴沿地球自转方向,三轴构成右手坐标系;
导航坐标系(n系):定义“东-北-天”坐标系为导航坐标系;
载体坐标系(b系):定义“右-前-上”坐标系为载体坐标系;
初始时刻惯性坐标系(i0系):把初始对准开始时刻的惯性坐标系定义为i0系;
初始时刻地球坐标系(e0系):把初始对准开始时刻的导航坐标系定义为e0系,它相对惯性空间固定不动;
初始时刻导航坐标系(n0系):把初始对准开始时刻的导航坐标系定义为n0系,它相对地球表面固定不动,即不随捷联惯组在地球表面运动而运动;
其中,
为n系相对于i系的运动角速度在n系上的投影,为b系相对于系的运动角速度在b系上的投影,(J×)表示矢量转换成斜对称矩阵。由于该对准方法无法实时定位,载体位置可直接用初始位置代替,因此为单位阵;可根据陀螺的量测信息求得,且有矩阵初值因此,求解姿态矩阵的问题可转换为求解常值矩阵
惯导比力方程可表示为:
其中,表示载体速度在n系下的投影;fb表示加速度计量测信息在b系下的投影;gn=[0 0 -g]T表示重力信息在n系下的投影;表示地球自转在n系下的投影;表示e系下的角速度到n系的投影;RM和RN分别表示子午圈曲率半径和卯酉圈曲率半径。
进一步整理,得到:
化简为:
为了平滑器件量测噪声的影响,等式两边进一步积分得到:
此时,捷联惯导晃动基座初始粗对准问题便转化成为了姿态确定问题。
式中,αi是一组在载体系中观测得到的单位矢量,βi是相应的参考系中的单位矢量,ai是非负的权重系数。
利用矩阵迹的轮换不变性,整理(13)式得到:
利用四元数参数化姿态矩阵A,可得:
g(q)≡g(A(q))=tr(ABT)=qTKq (15)
K可用递推算法实现:
δS=B+BT (18)
δz=[B23-B32 B31-B13 B12-B21]T (19)
使得增益函数最g(A)最大化的四元数为矩阵K的最大特征值对应的特征向量,即:
Kqopt=λmaxqopt (21)
将求得的qopt转化为姿态矩阵形式,根据(1)式便可求得当前时刻的载体姿态矩阵,完成惯性/里程计动基座粗对准。
本方法充分利用了矢量观测信息,通过在REQUEST算法引入衰减因子有效抑制了新近观测信息中累积的器件误差的影响,并且具有计算量小和对准时间短的优点,有效地提升了动基座粗对准速度和精度。
下面通过具体实施例对本发明进一步说明。
实施例:
按照上述步骤进行车载测试,车载平台包括惯导、里程计、差分GPS、高度计及电源。其中惯导的陀螺零偏稳定性为0.01°/h,加速度计的零偏稳定性为 50ug,惯导和里程计的数据采集频率均为100Hz,高度计抑制惯导高度通道发散,惯导/DGPS组合导航得到的姿态作为姿态基准,按轨迹跑车。通过利用惯性/里程计在载车上采集到的实测数据,将所提出的方法与现有的TRIDE、Q-方法和 QUEST三种动基座粗对准方法进行对比,验证所提出方法的优越性和实用性,仿真时动基座对准时间为5min。
图2~图4为不同动基座粗对准方法的姿态误差对比曲线,不同粗对准方法的对准对比结果见表1所示,可以看出,所提出方法的水平姿态精度与传统方法精度相当,而航向角精度有了明显的提升;同时,在对准过程中对各个方法的动态模块的计算耗时进行了监测,可以看出所提出方法的计算耗时最短,有很强的工程实用价值。
表1不同动基座粗对准方法的对准结果
以上对本发明的一个实施例进行了详细说明,但所述内容仅为本发明的较佳实施例,不能被认为用于限定本发明的实施范围。凡依本发明申请范围所作的均等变化与改进等,均应仍归属于本发明的专利涵盖范围之内。
Claims (7)
1.一种基于REQUEST的惯性里程计动基座粗对准方法,其特征在于:利于REQUEST解决双矢量定姿问题,实现惯导/里程计组合导航系统在动基座下的粗对准,包括如下步骤:
步骤一 装订初始位置信息,执行动基座粗对准;
步骤二 采集和处理陀螺和加速度计数据,建立过渡坐标系,将姿态求解转换为双矢量定姿问题;
式中,αi是一组在载体系中观测得到的单位矢量,βi是相应的参考系中的单位矢量,ai是非负的权重系数;
利用矩阵迹的轮换不变性,整理得到:
步骤四进而根据矩阵链乘求得姿态矩阵,完成动基座粗对准。
2.根据权利要求1所述的基于REQUEST的惯性里程计动基座粗对准方法,其特征在于:坐标系定义如下:
i系,地心惯性坐标系:oxi轴在赤道平面内且指向春分点,ozi轴指向地球自转方向,三轴构成右手坐标系;
e系,地球坐标系:oxe轴在赤道平面内且指向中央子午线,oze轴沿地球自转方向,三轴构成右手坐标系;
n系,导航坐标系:定义“东-北-天”坐标系为导航坐标系;
b系,载体坐标系:定义“右-前-上”坐标系为载体坐标系;
i0系,初始时刻惯性坐标系:把初始对准开始时刻的惯性坐标系定义为i0系;
e0系,初始时刻地球坐标系:把初始对准开始时刻的导航坐标系定义为e0系,它相对惯性空间固定不动;
n0系,初始时刻导航坐标系:把初始对准开始时刻的导航坐标系定义为n0系,它相对地球表面固定不动,即不随捷联惯组在地球表面运动而运动;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011585048.5A CN112747772B (zh) | 2020-12-28 | 2020-12-28 | 一种基于request的惯性里程计动基座粗对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011585048.5A CN112747772B (zh) | 2020-12-28 | 2020-12-28 | 一种基于request的惯性里程计动基座粗对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112747772A CN112747772A (zh) | 2021-05-04 |
CN112747772B true CN112747772B (zh) | 2022-07-19 |
Family
ID=75646503
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011585048.5A Active CN112747772B (zh) | 2020-12-28 | 2020-12-28 | 一种基于request的惯性里程计动基座粗对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112747772B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113405563B (zh) * | 2021-05-25 | 2023-09-05 | 北京机械设备研究所 | 一种惯性测量单元对准方法 |
CN114993242B (zh) * | 2022-06-17 | 2023-03-31 | 北京航空航天大学 | 一种基于加速度匹配的阵列式pos安装偏差角标定方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103245360A (zh) * | 2013-04-24 | 2013-08-14 | 北京工业大学 | 晃动基座下的舰载机旋转式捷联惯导系统自对准方法 |
CN105698822A (zh) * | 2016-03-15 | 2016-06-22 | 北京航空航天大学 | 基于反向姿态跟踪的自主式惯性导航行进间初始对准方法 |
CN106595711A (zh) * | 2016-12-21 | 2017-04-26 | 东南大学 | 一种基于递推四元数的捷联惯性导航系统粗对准方法 |
CN108592943A (zh) * | 2018-03-16 | 2018-09-28 | 东南大学 | 一种基于opreq方法的惯性系粗对准计算方法 |
CN110806220A (zh) * | 2019-11-23 | 2020-02-18 | 中国船舶重工集团公司第七一七研究所 | 一种惯导系统初始对准方法及装置 |
AU2020101268A4 (en) * | 2020-07-06 | 2020-08-13 | Harbin Engineering University | The initial alignment method for sway base |
CN112697141A (zh) * | 2020-12-16 | 2021-04-23 | 北京航空航天大学 | 基于逆向导航的惯导/里程计动基座姿态与位置对准方法 |
-
2020
- 2020-12-28 CN CN202011585048.5A patent/CN112747772B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103245360A (zh) * | 2013-04-24 | 2013-08-14 | 北京工业大学 | 晃动基座下的舰载机旋转式捷联惯导系统自对准方法 |
CN105698822A (zh) * | 2016-03-15 | 2016-06-22 | 北京航空航天大学 | 基于反向姿态跟踪的自主式惯性导航行进间初始对准方法 |
CN106595711A (zh) * | 2016-12-21 | 2017-04-26 | 东南大学 | 一种基于递推四元数的捷联惯性导航系统粗对准方法 |
CN108592943A (zh) * | 2018-03-16 | 2018-09-28 | 东南大学 | 一种基于opreq方法的惯性系粗对准计算方法 |
CN110806220A (zh) * | 2019-11-23 | 2020-02-18 | 中国船舶重工集团公司第七一七研究所 | 一种惯导系统初始对准方法及装置 |
AU2020101268A4 (en) * | 2020-07-06 | 2020-08-13 | Harbin Engineering University | The initial alignment method for sway base |
CN112697141A (zh) * | 2020-12-16 | 2021-04-23 | 北京航空航天大学 | 基于逆向导航的惯导/里程计动基座姿态与位置对准方法 |
Non-Patent Citations (2)
Title |
---|
"Odometer Aided SINS in-Motion Alignment Method Based on Backtracking Scheme for Large Misalignment Angles";Zeyang Wen 等;《IEEE Access》;20191226;第8卷;正文第7937-7948页 * |
"基于ADIS16488 MEMS IMU标定测试方法研究";段祥玉 等;《测试技术学报》;20180228;第32卷(第1期);正文13-18页 * |
Also Published As
Publication number | Publication date |
---|---|
CN112747772A (zh) | 2021-05-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110398257B (zh) | Gps辅助的sins系统快速动基座初始对准方法 | |
CN111323050B (zh) | 一种捷联惯导和多普勒组合系统标定方法 | |
CN106289246B (zh) | 一种基于位置和姿态测量系统的柔性杆臂测量方法 | |
CN103917850B (zh) | 一种惯性导航系统的运动对准方法 | |
CN106871928B (zh) | 基于李群滤波的捷联惯性导航初始对准方法 | |
CN112697141A (zh) | 基于逆向导航的惯导/里程计动基座姿态与位置对准方法 | |
CN103344260B (zh) | 基于rbckf的捷联惯导系统大方位失准角初始对准方法 | |
CN112762961B (zh) | 一种车载惯性里程计组合导航在线标定方法 | |
CN112747772B (zh) | 一种基于request的惯性里程计动基座粗对准方法 | |
CN103822633A (zh) | 一种基于二阶量测更新的低成本姿态估计方法 | |
CN107065025A (zh) | 一种基于重力梯度不变量的轨道要素估计方法 | |
CN110285838B (zh) | 基于重力矢量时间差分的惯性导航设备对准方法 | |
CN103076026B (zh) | 一种捷联惯导系统中确定多普勒计程仪测速误差的方法 | |
CN113405563A (zh) | 一种惯性测量单元对准方法 | |
CN106052686A (zh) | 基于dsptms320f28335的全自主捷联惯性导航系统 | |
CN101900573B (zh) | 一种实现陆用惯性导航系统运动对准的方法 | |
CN102607330B (zh) | 惯导系统传递对准中基准信息的优化处理方法 | |
CN113834483A (zh) | 一种基于可观测度的惯性/偏振/地磁容错导航方法 | |
CN107764261A (zh) | 一种分布式pos传递对准用模拟数据生成方法和系统 | |
CN112229421B (zh) | 基于李群最优估计的捷联惯性导航晃动基座粗对准方法 | |
CN106802143A (zh) | 一种基于惯性仪器和迭代滤波算法的船体形变角测量方法 | |
CN104121930B (zh) | 一种基于加表耦合的mems陀螺漂移误差的补偿方法 | |
CN111207773A (zh) | 一种用于仿生偏振光导航的姿态无约束优化求解方法 | |
CN108981691B (zh) | 一种天空偏振光组合导航在线滤波与平滑方法 | |
CN112857400B (zh) | 一种基于十表冗余捷联惯组的运载火箭初始对准方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |