CN103575296A - 一种双轴旋转惯导***自标定方法 - Google Patents
一种双轴旋转惯导***自标定方法 Download PDFInfo
- Publication number
- CN103575296A CN103575296A CN201310463644.XA CN201310463644A CN103575296A CN 103575296 A CN103575296 A CN 103575296A CN 201310463644 A CN201310463644 A CN 201310463644A CN 103575296 A CN103575296 A CN 103575296A
- Authority
- CN
- China
- Prior art keywords
- navigation
- error
- navigation system
- inertial navigation
- calculation
- 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.)
- Granted
Links
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
-
- 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
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)
- Gyroscopes (AREA)
Abstract
本发明提供一种双轴旋转惯导***自标定方法,利用遗传算法对自标定方案进行优化,以提高标定精度。步骤1:选取双轴旋转惯导***的误差模型和导航误差方程;步骤2、根据步骤1得到的误差模型和导航误差方程,利用遗传算法找出八位置标定方案的七个最优转动角度;步骤3、预热陀螺仪和加速度计组件,进行粗对准;步骤4、根据粗对准结果转动环架,调整IMU位置到近似与导航坐标系重合;步骤5、开始导航解算并根据角度转动环架到对应的位置,在每个位置采集导航解算得到的速度误差,计算得观测量;步骤6、根据每个位置的导航结果利用最小二乘计算出需要标定的误差参数。
Description
技术领域
本发明属于旋转调制捷连惯性导航技术领域,涉及一种双轴旋转惯导***自标定方法。
背景技术
在提高光学捷联惯性导航***(SINS)精度方面,惯性测量单元(IMU)旋转自补偿技术越来越受到重视,该技术是通过对IMU的旋转对其误差进行自补偿,能够大幅提高长航时导航定位精度。但是***工作时,由于器件误差的存在,速度误差和位置误差周期震荡的幅度会增大。而且,在载体有角运动的时候,调制效果受到影响,导致器件误差不能被完全调制,此时长航时导航仍然会发散。因此对惯性***的误差进行标定具有重要意义。在现有的多位置标定方法中,往往是从特殊位置当中选取满足可观测性的位置组合作为转位方案,并没有优化方法作为选取准则。
发明内容:
本发明的目的在于提供一种双轴旋转惯导***自标定方法,利用遗传算法对自标定方案进行优化,以提高标定精度。
一种双轴旋转惯导***自标定方法,包括以下步骤:
步骤1:选取双轴旋转惯导***的误差模型和导航误差方程;
步骤2、根据步骤1得到的误差模型和导航误差方程,利用遗传算法找出八位置标定方案的七个最优转动角度;
步骤3、预热陀螺仪和加速度计组件,进行粗对准;
步骤4、根据粗对准结果转动环架,调整IMU位置到近似与导航坐标系重合;
步骤5、开始导航解算并根据角度转动环架到对应的位置,在每个位置采集导航解算得到的速度误差,计算得观测量;
步骤6、根据每个位置的导航结果利用最小二乘计算出需要标定的误差参数。
本发明的有益效果:
在使用最小二乘方法进行参数辨识的同时以最小二乘的估计误差的方差为适应度函数,利用遗传算法找出每次转动的最优角度,通过改善多位置标定的位置编排方案来减小误差参数的估计误差,提高标定精度。
附图说明
图1遗传算法流程图;
图2动基座下东向速度误差;
图3动基座下北向速度误差;
图4动基座下经度误差;
图5动基座下纬度误差。
具体实施方式
下面结合附图对本发明作进一步介绍。
如图1所示,本发明的一种双轴旋转惯导***自标定方法,包括以下步骤:
步骤1:选取双轴旋转惯导***的误差模型和导航误差方程;
加速度计的误差模型为:
其中δas为加速度计输出误差, 为从IMU坐标系(s系)到加速度计坐标系的转换矩阵,Saij为加速度计的安装误差,Kai为加速度计标度因数误差,▽=[▽x ▽y ▽z]T为加速度计零偏。
陀螺仪的误差模型为:
其中δωs为陀螺仪输出误差, 为从IMU坐标系到陀螺仪坐标系的转换矩阵,Sgij为陀螺仪的安装误差,Kgi为陀螺仪标度因数误差,为陀螺仪零偏。
设***从初始时刻t=0开始进入导航状态,速度误差和姿态误差的变化在t=T时刻的值可以通过下式获得:
其中,δan和φn可以采用下式计算:
将式(3)取一阶导数,忽略加速度计误差的变化率,得到
步骤2、根据惯导***的误差模型和导航误差方程,利用遗传算法找出八位置标定方案的七个最优转动角度,遗传算法的各项参数设定为
1)仿真代数:T=50;
2)群体规模:N=100;
3)交叉变异遗传概率:pm=0.05,pc=0.8,pr=0.15;
4)单个参数字串长度:L=10.
得到的最优角度为:
[Δθ1,Δθ2,Δθ3,Δθ4,Δθ5,Δθ6,Δθ7]
=[141.3°,56.4°,298.1°,127.2°,37.5°,68.7°,134.5°]
步骤3、预热陀螺仪和加速度计组件,进行粗对准;
步骤4、根据粗对准结果转动环架,调整IMU位置到近似与导航坐标系重合;
步骤5、开始导航解算并根据步骤1找到的角度转动环架到对应的位置,在每个位置采集导航解算得到的速度误差,计算得到观测量
步骤6、根据每个位置的导航结果利用最小二乘计算出需要标定的误差参数为
的估计值,H为系数矩阵。
利用Matlab软件仿真,在同样的条件下,分别进行100次蒙特卡洛仿真,得出的均值和方差如表1所示。加表零偏估计偏差减小了至少37.3%,加表安装误差估计偏差减小了至少58.4%,陀螺零偏估计偏差减小了至少19.5%,陀螺标度因数误差估计偏差减小了至少36.7%,陀螺安装误差估计偏差减小了至少40.7%。按照标定出的结果分别对***进行补偿,设定***进行水平方向的摆动,摆动的角度为η(t)=10°sin(2π10t),此时得到的8h的导航结果如图2-5所示。从导航发散的幅度上可以看出,方案1使8h长航时下东向速度误差的最大值减小了至少26.7%,北向速度误差的最大值减小了至少17.8%,精度误差的最大值减小了至少38.9%,纬度误差的最大值减小了至少22.3%。
表1误差参数在种标定方案下的标定结果
Claims (2)
1.一种双轴旋转惯导***自标定方法,其特征在于,包括以下步骤:
步骤1:选取双轴旋转惯导***的误差模型和导航误差方程;
步骤2、根据步骤1得到的误差模型和导航误差方程,利用遗传算法找出八位置标定方案的七个最优转动角度;
步骤3、预热陀螺仪和加速度计组件,进行粗对准;
步骤4、根据粗对准结果转动环架,调整IMU位置到近似与导航坐标系重合;
步骤5、开始导航解算并根据角度转动环架到对应的位置,在每个位置采集导航解算得到的速度误差,计算得观测量;
步骤6、根据每个位置的导航结果利用最小二乘计算出需要标定的误差参数。
2.如权利要求1所述的一种双轴旋转惯导***自标定方法,其特征在于,步骤2中所述的遗传算法的各项参数设定为
1)仿真代数:T=50;
2)群体规模:N=100;
3)交叉变异遗传概率:pm=0.05,pc=0.8,pr=0.15;
4)单个参数字串长度:L=10;
[Δθ1,Δθ2,Δθ3,Δθ4,Δθ5,Δθ6,Δθ7]
得到的最优角度为:=[141.3°,56.4°,298.1°,127.2°,37.5°,68.7°,134.5°]
。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310463644.XA CN103575296B (zh) | 2013-10-08 | 2013-10-08 | 一种双轴旋转惯导***自标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310463644.XA CN103575296B (zh) | 2013-10-08 | 2013-10-08 | 一种双轴旋转惯导***自标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103575296A true CN103575296A (zh) | 2014-02-12 |
CN103575296B CN103575296B (zh) | 2016-04-20 |
Family
ID=50047585
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310463644.XA Active CN103575296B (zh) | 2013-10-08 | 2013-10-08 | 一种双轴旋转惯导***自标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103575296B (zh) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103983274A (zh) * | 2014-04-11 | 2014-08-13 | 湖北航天技术研究院总体设计所 | 一种适用于低精度无方位基准双轴转位设备的惯性测量单元标定方法 |
CN104165638A (zh) * | 2014-08-07 | 2014-11-26 | 北京理工大学 | 一种双轴旋转惯导***多位置自主标定方法 |
CN105352527A (zh) * | 2015-05-25 | 2016-02-24 | 哈尔滨工程大学 | 一种基于双轴转位机构光纤陀螺标定方法 |
CN103994775B (zh) * | 2014-04-11 | 2017-01-04 | 湖北航天技术研究院总体设计所 | 一种适用于低精度有方位基准双轴转位设备的惯性测量单元标定方法 |
CN106597020A (zh) * | 2016-11-25 | 2017-04-26 | 中国船舶重工集团公司第七0五研究所 | 一种基于遗传算法的加速度计免转台标定方法 |
CN107577249A (zh) * | 2017-09-05 | 2018-01-12 | 北京航天发射技术研究所 | 一种用于标定激光捷联惯组的双轴转位装置 |
CN108036756A (zh) * | 2017-12-05 | 2018-05-15 | 中国船舶重工集团公司第七0七研究所 | 一种利用加速度计进行双轴旋转惯性测量装置相邻轴线垂直度检查的方法 |
CN108981751A (zh) * | 2018-08-16 | 2018-12-11 | 昆山天地睿航智能科技有限公司 | 一种双轴旋转惯导***的八位置在线自标定方法 |
CN111486871A (zh) * | 2020-04-27 | 2020-08-04 | 新石器慧通(北京)科技有限公司 | 传感器检测方法、装置、检测设备及可读存储介质 |
CN113390439A (zh) * | 2021-06-10 | 2021-09-14 | 中国人民解放军国防科技大学 | 一种双轴旋转捷联惯导***旋转调制和自标定一体式方法 |
CN114323064A (zh) * | 2021-11-16 | 2022-04-12 | 中国人民解放军战略支援部队航天工程大学 | 一种冗余旋转惯导***双轴转位机构自标定方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB955175A (en) * | 1961-05-05 | 1964-04-15 | North American Aviation Inc | Inertial system alinement |
US20040186676A1 (en) * | 2003-03-17 | 2004-09-23 | Liu G. Kevin | Method for measuring force-dependent gyroscope sensitivity |
CN101900573A (zh) * | 2010-07-15 | 2010-12-01 | 北京理工大学 | 一种实现陆用惯性导航***运动对准的方法 |
CN102506898A (zh) * | 2011-11-03 | 2012-06-20 | 中国科学院自动化研究所 | 一种基于遗传算法的惯性/地磁传感器标定方法 |
CN102519450A (zh) * | 2011-12-12 | 2012-06-27 | 东南大学 | 一种用于水下滑翔器的组合导航装置及方法 |
CN102692239A (zh) * | 2012-06-14 | 2012-09-26 | 辽宁工程技术大学 | 一种基于旋转机构的光纤陀螺八位置标定方法 |
-
2013
- 2013-10-08 CN CN201310463644.XA patent/CN103575296B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB955175A (en) * | 1961-05-05 | 1964-04-15 | North American Aviation Inc | Inertial system alinement |
US20040186676A1 (en) * | 2003-03-17 | 2004-09-23 | Liu G. Kevin | Method for measuring force-dependent gyroscope sensitivity |
CN101900573A (zh) * | 2010-07-15 | 2010-12-01 | 北京理工大学 | 一种实现陆用惯性导航***运动对准的方法 |
CN102506898A (zh) * | 2011-11-03 | 2012-06-20 | 中国科学院自动化研究所 | 一种基于遗传算法的惯性/地磁传感器标定方法 |
CN102519450A (zh) * | 2011-12-12 | 2012-06-27 | 东南大学 | 一种用于水下滑翔器的组合导航装置及方法 |
CN102692239A (zh) * | 2012-06-14 | 2012-09-26 | 辽宁工程技术大学 | 一种基于旋转机构的光纤陀螺八位置标定方法 |
Non-Patent Citations (1)
Title |
---|
郑伟: "模糊控制算法研究及其在导航中的应用", 《中国优秀硕士学位论文全文数据库信息科技辑》, no. 3, 15 March 2012 (2012-03-15) * |
Cited By (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103983274A (zh) * | 2014-04-11 | 2014-08-13 | 湖北航天技术研究院总体设计所 | 一种适用于低精度无方位基准双轴转位设备的惯性测量单元标定方法 |
CN103994775B (zh) * | 2014-04-11 | 2017-01-04 | 湖北航天技术研究院总体设计所 | 一种适用于低精度有方位基准双轴转位设备的惯性测量单元标定方法 |
CN104165638B (zh) * | 2014-08-07 | 2017-02-08 | 北京理工大学 | 一种双轴旋转惯导***多位置自主标定方法 |
CN104165638A (zh) * | 2014-08-07 | 2014-11-26 | 北京理工大学 | 一种双轴旋转惯导***多位置自主标定方法 |
CN105352527B (zh) * | 2015-05-25 | 2018-12-07 | 哈尔滨工程大学 | 一种基于双轴转位机构光纤陀螺标定方法 |
CN105352527A (zh) * | 2015-05-25 | 2016-02-24 | 哈尔滨工程大学 | 一种基于双轴转位机构光纤陀螺标定方法 |
CN106597020B (zh) * | 2016-11-25 | 2019-10-22 | 中国船舶重工集团公司第七0五研究所 | 一种基于遗传算法的加速度计免转台标定方法 |
CN106597020A (zh) * | 2016-11-25 | 2017-04-26 | 中国船舶重工集团公司第七0五研究所 | 一种基于遗传算法的加速度计免转台标定方法 |
CN107577249A (zh) * | 2017-09-05 | 2018-01-12 | 北京航天发射技术研究所 | 一种用于标定激光捷联惯组的双轴转位装置 |
CN107577249B (zh) * | 2017-09-05 | 2020-10-23 | 北京航天发射技术研究所 | 一种用于标定激光捷联惯组的双轴转位装置 |
CN108036756B (zh) * | 2017-12-05 | 2020-02-18 | 中国船舶重工集团公司第七0七研究所 | 一种利用加速度计进行双轴旋转惯性测量装置相邻轴线垂直度检查的方法 |
CN108036756A (zh) * | 2017-12-05 | 2018-05-15 | 中国船舶重工集团公司第七0七研究所 | 一种利用加速度计进行双轴旋转惯性测量装置相邻轴线垂直度检查的方法 |
CN108981751A (zh) * | 2018-08-16 | 2018-12-11 | 昆山天地睿航智能科技有限公司 | 一种双轴旋转惯导***的八位置在线自标定方法 |
CN111486871A (zh) * | 2020-04-27 | 2020-08-04 | 新石器慧通(北京)科技有限公司 | 传感器检测方法、装置、检测设备及可读存储介质 |
CN113390439A (zh) * | 2021-06-10 | 2021-09-14 | 中国人民解放军国防科技大学 | 一种双轴旋转捷联惯导***旋转调制和自标定一体式方法 |
CN113390439B (zh) * | 2021-06-10 | 2022-02-25 | 中国人民解放军国防科技大学 | 一种双轴旋转捷联惯导***旋转调制和自标定一体式方法 |
CN114323064A (zh) * | 2021-11-16 | 2022-04-12 | 中国人民解放军战略支援部队航天工程大学 | 一种冗余旋转惯导***双轴转位机构自标定方法 |
CN114323064B (zh) * | 2021-11-16 | 2023-10-13 | 中国人民解放军战略支援部队航天工程大学 | 一种冗余旋转惯导***双轴转位机构自标定方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103575296B (zh) | 2016-04-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103575296B (zh) | 一种双轴旋转惯导***自标定方法 | |
CN102003967B (zh) | 基于罗经原理的旋转式船用捷联惯导方位对准方法 | |
CN106525073B (zh) | 一种基于三轴转台的惯性空间陀螺标定试验方法 | |
CN108318052A (zh) | 一种基于双轴连续旋转的混合式平台惯导***标定方法 | |
CN108051866B (zh) | 基于捷联惯性/gps组合辅助水平角运动隔离的重力测量方法 | |
CN101975872B (zh) | 石英挠性加速度计组件零位偏置的标定方法 | |
CN105180968A (zh) | 一种imu/磁强计安装失准角在线滤波标定方法 | |
CN104165638B (zh) | 一种双轴旋转惯导***多位置自主标定方法 | |
CN103900608B (zh) | 一种基于四元数ckf的低精度惯导初始对准方法 | |
CN101893445A (zh) | 摇摆状态下低精度捷联惯导***快速初始对准方法 | |
CN101963512A (zh) | 船用旋转式光纤陀螺捷联惯导***初始对准方法 | |
CN103575299A (zh) | 利用外观测信息的双轴旋转惯导***对准及误差修正方法 | |
CN103245360A (zh) | 晃动基座下的舰载机旋转式捷联惯导***自对准方法 | |
CN106507913B (zh) | 用于管道测绘的组合定位方法 | |
CN102564455B (zh) | 星敏感器安装误差四位置标定与补偿方法 | |
CN101246023A (zh) | 微机械陀螺惯性测量组件的闭环标定方法 | |
CN101701825A (zh) | 高精度激光陀螺单轴旋转惯性导航*** | |
CN101629826A (zh) | 基于单轴旋转的光纤陀螺捷联惯性导航***粗对准方法 | |
CN103900566B (zh) | 一种消除地球自转角速度对旋转调制型捷联惯导***精度影响的方法 | |
CN102749079A (zh) | 一种光纤捷联惯导双轴旋转调制方法及双轴旋转机构 | |
CN102680000A (zh) | 应用零速/航向修正的光纤捷联惯组在线标定方法 | |
CN107677292B (zh) | 基于重力场模型的垂线偏差补偿方法 | |
CN103674059A (zh) | 一种基于外测速度信息的sins水平姿态误差修正方法 | |
CN105628025A (zh) | 一种恒速偏频/机抖激光陀螺惯导***导航方法 | |
CN102679978A (zh) | 一种旋转式捷联惯性导航***静基座初始对准方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |