CN106767925B - 带双轴转位机构的惯导***三位置参数辨识对准方法 - Google Patents
带双轴转位机构的惯导***三位置参数辨识对准方法 Download PDFInfo
- Publication number
- CN106767925B CN106767925B CN201611248849.6A CN201611248849A CN106767925B CN 106767925 B CN106767925 B CN 106767925B CN 201611248849 A CN201611248849 A CN 201611248849A CN 106767925 B CN106767925 B CN 106767925B
- Authority
- CN
- China
- Prior art keywords
- alignment
- angle
- inertial navigation
- navigation system
- phi
- 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
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
Description
技术领域
本发明提供了一种带双轴转位机构的惯导***三位置参数辨识对准方法,属于惯性导航领域。
背景技术
为了提高惯性传感器精度成本高、周期长、难度大,通过对模型的改进和算法的合理设计可以有效的提高惯导***的精度。
与平台式惯性导航***相比,捷联惯导***具有反应快、成本低、信息全、可靠性高的优点。为避免反复将捷联惯导***从载体上拆下进行参数标定,节约使用成本。捷联惯导增加双轴转位机构,使捷联惯导***的免拆自检、标定和维护,有利于提高可操作性和机动性。
捷联惯导***自对准,由惯性敏感元件的输出信息,经过导航计算机按照对准程序实时运算,不断地将数学平台变换到能精确描述理想载体坐标系到地理坐标系的方向余弦阵。传统的捷联式惯导***由于无转位机构,自对准为单位置自对准,其本质是将重力加速度的方向做为水平对准的基准,其对准精度主要取决于两个加速度计的精度。用于方位对准本质是将地球角速率的北向分量方向做为方位对准的基准,其对准精度主要取决于东向陀螺漂移,参见(杨晓霞,黄一.外场标定条件下捷联惯导***误差状态可观测性分析.中国惯性技术学报,2008,16(6):657-664.)、(严恭敏,翁浚,赵长山,等.捷联惯导***改进参数辨识初始对准方法.中国惯性技术学报,2010,18(5):523-526.)。带有单轴转位机构的捷联惯导***能够在姿态接近水平的条件下,对等效东向陀螺的漂移进行辨识,进而提高自对准的精度(白亮,秦永元,孙丽.晃动基座下的双位置参数辨识精对准仿真研究.计算机仿真,2009,26(1):83-87.)。对双轴转位机构的捷联惯导***,由于存在双轴转位机构,可以通过旋转转位机构进行多位置对准,通过对自对准误差模型分析,设计了三位置的快速自对准方法,可有效提高带双轴转位机构的捷联惯导***的自对准精度。
发明内容
为了克服现有单位置自对准和双位置自对准技术的不足,针对当前带双轴转位机构的捷联惯导***,本发明提出了一种带双轴转位机构的捷联惯导三位置参数辨识自对准方法,通过设置双轴转位机构的旋转次序和位置,提出了有效提高自对准精度的三位置自对准方法。
本发明的技术解决方案是提供一种带双轴转位机构的惯导***三位置参数辨识对准方法,包括以下步骤:
(1)在初始位置按照转位机构先绕其中一个框架(记为X框架)转动一定角度(记为a角度),再绕另一框架(记为Y框架)转动一定角度(记为b角度),作为捷联惯导***自对准的第一位置,采集惯导***的陀螺和加速度计数据;
(2)绕Y框架转动-b角度得到第二位置,在第二位置采集陀螺和加速度计的输出;
(3)绕X框架转动-a角度,回到初始位置,作为第三位置,在第三位置采集陀螺和加速度计的输出;
以第一角度为a=-90°,第二角度为b=-90°。
静态情况下,捷联惯导***通过自身的导航解算得到的速度信息即为速度误差[ΔVE(t) ΔVN(t) ΔVU(t)]T通过对速度误差按照公式(5)进行参数辨识,具体辨识方法可采用最小二乘法或卡尔曼滤波法。
可将式(5)改写成:
对a1E、a2E、a3E、a1N、a2N、a3N和a1U辨识得到后,利用式(7)和(8)求解得到uE、uN、uU、φE0、φN0和φU0。
其中,ωie为地球自转角速度,L为对准所处的当地纬度。
得到uE、uN、uU、φE0、φN0和φU0后,按照式(9)求解得到姿态误差角φ=[φE φNφU]T。
依据式(9)得到的φ=[φE φN φU]T,按照式(10)对第三位置的姿态矩阵进行更新
与现有技术相比,本发明的有益效果:
1)提出了一种带双轴转位机构的惯导***三位置参数辨识对准方法;
2)本方法适用于捷联惯导***在初始任意姿态角条件下的快速自对准;
3)本发明可以有效缩短对准时间,提高带双轴转位机构的捷联惯导***的自对准精度。
附图说明
图1为零位锁定时坐标系与两框架轴编排示意图;
图2为初始位置及转位过程示意图;
图3至图5分别为捷联惯导在第1、第2、第3三个位置的等效北向陀螺漂移和等效天向加速度计零偏的估计曲线;
图6至图8为利用单位置自对准方法和基于参数辨识法三位置对准法的对准误差比较图。
具体实施方式
下面结合附图对本发明方法的实施方式做详细说明。其具体步骤包括:
步骤1,参数辨识法测漂模型
以东北天坐标系作为导航坐标系,其中导航坐标系用n表示;以捷联惯导***的右前上为机体坐标系,用b表示;惯性坐标系用i表示。
设实际导航坐标系n′系偏离理想导航坐标系n系的对准失准角为φE、φN、φU,φ=[φE φN φU]T可看作为n系到n′系的等效旋转矢量,由于失准角经粗对准后均为小角,因此,略去高阶小量后得
其中:
因此,
由推导知,姿态误差角满足如下关系式:
其中φ0=[φE0 φN0 φU0]T为姿态误差角初值,εn=[εE εN εU]T为导航坐标系内的等效常值漂移。
进一步,可求得速度误差方程为:
可将式(5)改写成:
参数辨识法确定的误差方程为三次曲线,而三次曲线在短时间内只呈现线性特性,所以辨识天向加速度计零偏所需时间最短,北向陀螺等效漂移所需时间较长,估计天向陀螺漂移所需时间更长。因此,为了尽可能缩短对准时间,对天向加速度计零偏和北向陀螺漂移进行估计。同时,由式(8)和(9)可以看出,φE0的极限精度为φN0的极限精度为φU0的极限精度为εN的极限精度为εU的极限精度为
步骤3,三位置自对准方法
本发明原理:
由式(8)可得,若εE、和能够快速准确辨识出,即可提高初始失准角φE,φN,φU的计算精度,最终可大大的提高对准精度。因此,自对准的问题转化为如何快速准确辨识εE、和基于双轴捷联惯导***的特点,本专利提出了基于改进模型的三位置对准法。在实际对准过程中,与相比,εE的影响较大。为减小εE的的影响,双位置中提出绕方位轴正向转90°再次进行对准。在该位置东向等效陀螺漂移的计算值其中为第二个位置处等效的北向陀螺漂移。但存在两个问题,第一:若初始对准时载体不在水平面,即存在一定的俯仰角或者横滚角,如导弹发射车处于斜坡或者一侧轮胎处于台阶上,此时第二位置的等效北向陀螺漂移不等于第一位置的等效东向陀螺漂移,此时,第一位置的等效东向陀螺漂移不可测;第二,两位置测漂法中,无法对与和进行辨识,水平对准的精度无法进一步提高。基于以上两个问题,本专利提出了三位置参数辨识对准法。
本发明的推导过程:
双轴捷联惯导***内框架可以沿惯导***的Z轴转动,外框架沿惯导***的Y轴转动。在初始对准时,首先控制内框架绕内台体的Z轴转动-90°,然后控制外框架绕内台体的X轴转动-90°,作为初始对准的第一个位置。按照式(1)~式(9)在此位置进行参数辨识法精对准。
控制外框架绕内台体的X轴转动90°,作为初始对准的第二个位置。按照式(1)~式(9)在此位置进行参数辨识法精对准。
控制外框架绕内台体的Z轴转动90°,作为初始对准的第三个位置。按照式(1)~式(9)在此位置进行参数辨识法精对准。
其中
若矩阵A满秩,此时εx、εy和εz可由式(21)唯一确定。
其中C=[cosγcosψ-sinγsinθsinψ -cosθsinψ sinγcosψ+cosγsinθsinψ]。
步骤4,殊情况的讨论
定理1:齐次线性方程组的系数矩阵秩rank(A)=n,方程组有唯一解。齐次线性方程组的系数矩阵秩rank(A)<n,方程组有无数多解。
定理2:A是n×n矩阵,则
a)rank(A)=n的充要条件为|A|≠0,称A为满秩矩阵;
b)rank(A)<n的充要条件为|A|=0。
式(19)能够求解陀螺漂移的前提是矩阵A满秩,因此,求解使得|A|=0时的初始姿态角θ0、γ0和ψ0,出当初始姿态角为θ0、γ0和ψ0时,εx、εy和εz不完全可观测。同理可以求出 和不可观测的姿态角初值。
在导弹武器***的实际的应用过程中,导弹发射车的初始姿态角受到实际应用环境的限制,俯仰角、横滚角在一定范围内变化,根据实际使用情况,取-45°≤θ≤45°,-45°≤γ≤45°,-180°<ψ≤180°。求解|A|=0得:当θ0=0°,ψ0=0°(或ψ0=180°)时,|A|=0,rank(A)<3。此时εx、εy和εz不完全可观测。当θ0=0°,ψ0=0°时,初始位置时Y向指北,第一位置和第二位置时X向指南,第三位置时Y向指北,此时,X向和Y向的陀螺漂移εx和εy均可通过等效北向陀螺测漂得到,Z向陀螺的漂移εz不可观测。当θ0=0°,ψ0=180°时,初始位置时Y向指南,第一位置和第二位置时X向指北,第三位置时Y向指南,此时,X向和Y向的陀螺漂移εx和εy均可通过等效北向陀螺测漂得到,Z向陀螺的漂移εz不可观测。此时,由分析可知,陀螺漂移εx和εy可以观测,εz不可观测,只能设置为εz=0。
当θ0≠0°或ψ0≠0°和180°时,|A|≠0,rank(A)=3。此时εx、εy和εz可由式(21)唯一确定。
求解|B|=0得:当θ0=0°和γ0=0°同时成立时,|B|=0,rank(B)<3。此时和不完全可观测。当θ0=0°,γ0=0°时,初始位置时Z向指天,第一位置Y向指地,第二位置和第三位置时Z向指天,此时,Y向和Z向的加速度计零偏和均可通过等效天向加速度计测漂得到,X向加速度计的零偏不可观测。此时,由分析可知,加速度计零偏和可以观测,不可观测,只能设置为
方法验证
为验证分析的正确性,进行了仿真验证,陀螺仪的等效漂移取为[0.020.040.03]°/h,加速度计等效零偏取为[405060]μg,采样频率为200Hz,双轴惯组的初始姿态为att_0=[17°8°60°]。开始对准时双轴惯组先绕内框Z轴转动-90°,再绕外框X轴转动-90°作为对准的第一位置,转动过程10s,在第一位置采集数据90s。然后绕外框X轴转动90°度作为对准的第二位置,转动过程10s,在第二位置采集数据90s。再绕内框Z轴转动90°作为对准的第三位置,转动过程10s,在第三位置采集数据90s,对准时间共计300s。分别采用单位置参数辨识对准法、双位置参数辨识对准法和三位置参数辨识对准法进行对准,图3~图5为三个位置上的等效北向陀螺漂移和等效加速度计天向零偏的估计曲线。表1为利用不同方法进行对准的试验结果,图6~图8为不同方法进行姿态估计的曲线。由图中可以看出,三位置参数辨识对准方法的航向角收敛速度和精度明显优单位置参数辨识对准法。
表1 不同对准方法的结果
通过由仿真结果可以看出,在相同的时间内,三位置参数辨识对准法可以有效的提高带双轴转位机构的捷联惯导***的初始对准精度,其对准误差是双位置参数辨识对准法误差的10%,是单位置参数辨识对准法误差的5%。使用三位置改进模型参数辨识对准法可以使捷联惯导***的航向对准误差极大的减小。
Claims (3)
1.一种带双轴转位机构的惯导***三位置参数辨识对准方法,其特征在于:包括以下步骤:
(1)在初始位置按照转位机构先绕其中一个框架,记为X框架,转动一定角度,记为a角度,再绕另一框架,记为Y框架,转动一定角度,记为b角度,作为捷联惯导***自对准的第一位置,采集惯导***的陀螺和加速度计数据;
(2)绕Y框架转动-b角度得到第二位置,在第二位置采集陀螺和加速度计的输出;
(3)绕X框架转动-a角度,回到初始位置,作为第三位置,在第三位置采集陀螺和加速度计的输出;
2.根据权利要求1所述的带双轴转位机构的惯导***三位置参数辨识对准方法,其特征在于:以第一角度为a=-90°,第二角度为b=-90°。
3.根据权利要求1或2所述的带双轴转位机构的惯导***三位置参数辨识对准方法,其特征在于:
静态情况下,捷联惯导***通过自身的导航解算得到的速度信息即为速度误差[ΔVE(t) ΔVN(t) ΔVU(t)]T通过对速度误差按照公式(5)进行参数辨识,具体辨识方法可采用最小二乘法或卡尔曼滤波法;
可将式(5)改写成:
其中,φE0、φN0、φU0分别为姿态误差角初值;
对a1E、a2E、a3E、a1N、a2N、a3N和a1U辨识得到后,利用式(7)和(8)求解得到uE、uN、uU、φE0、φN0和φU0;
其中,ωie为地球自转角速度,L为对准所处的当地纬度;
得到uE、uN、uU、φE0、φN0和φU0后,按照式(9)求解得到姿态误差角φ=[φE φN φU]T;
依据式(9)得到的φ=[φE φN φU]T,按照式(10)对第三位置的姿态矩阵进行更新
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611248849.6A CN106767925B (zh) | 2016-12-29 | 2016-12-29 | 带双轴转位机构的惯导***三位置参数辨识对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611248849.6A CN106767925B (zh) | 2016-12-29 | 2016-12-29 | 带双轴转位机构的惯导***三位置参数辨识对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106767925A CN106767925A (zh) | 2017-05-31 |
CN106767925B true CN106767925B (zh) | 2020-06-23 |
Family
ID=58927904
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611248849.6A Active CN106767925B (zh) | 2016-12-29 | 2016-12-29 | 带双轴转位机构的惯导***三位置参数辨识对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106767925B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108872636B (zh) * | 2018-06-26 | 2021-02-09 | 北京航天控制仪器研究所 | 一种两轴框架摆式加速度计 |
CN110887507B (zh) * | 2019-10-22 | 2021-05-25 | 中国人民解放军战略支援部队航天工程大学 | 一种快速估计惯性测量单元全部零偏的方法 |
CN110987008B (zh) * | 2019-12-10 | 2023-08-11 | 上海航天控制技术研究所 | 一种低精度mems陀螺组合零位偏置快速标定方法 |
CN112611887B (zh) * | 2020-12-11 | 2022-09-27 | 北京航天控制仪器研究所 | 一种基于模型参数辨识的陀螺加速度计输出补偿方法 |
CN113551688A (zh) * | 2021-05-27 | 2021-10-26 | 北京航天发射技术研究所 | 车载定位定向导航设备无依托快速免拆卸标定方法及装置 |
CN115615431B (zh) * | 2022-12-21 | 2023-04-07 | 中国船舶集团有限公司第七0七研究所 | 一种等效北向加速度计斜坡漂移的实时补偿方法及车辆 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102927994B (zh) * | 2012-10-23 | 2015-08-05 | 北京航空航天大学 | 一种斜置冗余捷联惯性导航***的快速标定方法 |
CN202974286U (zh) * | 2012-12-03 | 2013-06-05 | 西安航天精密机电研究所 | 一种陀螺多位置寻北仪定位装置 |
CN103453917A (zh) * | 2013-09-04 | 2013-12-18 | 哈尔滨工程大学 | 一种双轴旋转式捷联惯导***初始对准与自标校方法 |
CN104697550A (zh) * | 2013-12-10 | 2015-06-10 | 中国航空工业第六一八研究所 | 一种惯性导航***实现免拆装精确自标定的方法 |
CN103913168B (zh) * | 2014-03-06 | 2016-09-14 | 哈尔滨工程大学 | 一种双轴旋转式捷联惯导***转位方法 |
CN103983274B (zh) * | 2014-04-11 | 2016-12-07 | 湖北航天技术研究院总体设计所 | 一种适用于低精度无方位基准双轴转位设备的惯性测量单元标定方法 |
-
2016
- 2016-12-29 CN CN201611248849.6A patent/CN106767925B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN106767925A (zh) | 2017-05-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106767925B (zh) | 带双轴转位机构的惯导***三位置参数辨识对准方法 | |
CN105203129B (zh) | 一种惯导装置初始对准方法 | |
CN111878064B (zh) | 一种姿态测量方法 | |
CN107525503B (zh) | 基于双天线gps和mimu组合的自适应级联卡尔曼滤波方法 | |
CN113029199B (zh) | 一种激光陀螺惯导***的***级温度误差补偿方法 | |
CN107270893B (zh) | 面向不动产测量的杆臂、时间不同步误差估计与补偿方法 | |
CN105180968B (zh) | 一种imu/磁强计安装失准角在线滤波标定方法 | |
CN100516775C (zh) | 一种捷联惯性导航***初始姿态确定方法 | |
CN106840201B (zh) | 一种带双轴转位机构捷联惯导的三位置自对准方法 | |
CN109443349A (zh) | 一种姿态航向测量***及其融合方法、存储介质 | |
CN113008227B (zh) | 一种基于三轴加速度计测姿的地磁二分量测量方法 | |
CN104764463B (zh) | 一种惯性平台调平瞄准误差的自检测方法 | |
CN110926468A (zh) | 基于传递对准的动中通天线多平台航姿确定方法 | |
CN109612460B (zh) | 一种基于静止修正的垂线偏差测量方法 | |
CN105910606A (zh) | 一种基于角速度差值的方向修正方法 | |
CN103900566B (zh) | 一种消除地球自转角速度对旋转调制型捷联惯导***精度影响的方法 | |
CN110954102A (zh) | 用于机器人定位的磁力计辅助惯性导航***及方法 | |
CN103674059A (zh) | 一种基于外测速度信息的sins水平姿态误差修正方法 | |
CN110361031A (zh) | 一种基于回溯理论的imu全参数误差快速标定方法 | |
CN106017452A (zh) | 双陀螺抗扰动寻北方法 | |
CN111189474A (zh) | 基于mems的marg传感器的自主校准方法 | |
CN102607330A (zh) | 惯导***传递对准中基准信息的优化处理方法 | |
CN110887472A (zh) | 一种偏振-地磁信息深度融合全自主姿态解算方法 | |
CN111307114B (zh) | 基于运动参考单元的水面舰船水平姿态测量方法 | |
CN105735969A (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 |