(10)申请公布号 CN 102564452 A
(43)申请公布日 2012.07.11C N 102564452 A
*CN102564452A*
(21)申请号 201110409988.3
(22)申请日 2011.12.09
G01C 25/00(2006.01)
G01C 21/18(2006.01)
(71)申请人北京理工大学
地址100081 北京市海淀区中关村南大街5
号
(72)发明人付梦印 邓志红 王博 汪顺亭
周元
(74)专利代理机构北京理工大学专利中心
11120
代理人李爱英
郭德忠
(54)发明名称
(57)摘要
本发明属于自主标定领域,为了解决双轴旋
无法消除的问题,本发明提供了一种基于惯性导
航系统的在线自主标定方法,该方法通过步骤二
中陀螺的常值漂移和刻度因数以及步骤三中加表
的零偏和刻度因数的求取,从而实现了惯性导航
导航系统中系统横滚轴与水平面夹角无法消除的
问题,为其姿态角的预先估计提供了可靠依据,实
现了在线自主标定的目的。
(51)Int.Cl.
权利要求书3页 说明书7页 附图3页
(19)中华人民共和国国家知识产权局(12)发明专利申请
权利要求书 3 页 说明书 7 页 附图 3 页
1.一种基于惯性导航系统的在线自主标定方法,其特征在于:该方法实现的具体步骤如下:
步骤一:惯性导航系统初始对准
对于双轴旋转调制式惯性导航系统,采用捷联算法对其进行初始对准,得到三个轴的初始姿态角;采用角度传感器与转轴上的伺服电机构成的回路控制方位轴的旋转,使北向陀螺的横滚轴在水平面上的投影指向正北;再采用该回路控制横滚轴旋转,使东向陀螺的俯仰轴指向正东;
根据初始姿态角和回路控制的方位轴和横滚轴旋转的角度计算垂向陀螺的坐标与天向的夹角为θ;此时该夹角与载体的实际俯仰角相同,是横滚轴与水平面的夹角;
步骤二:采用地球自转角速度标定陀螺的常值漂移和刻度因数
地球自转角速度北向分量为ω
ie cosL,天向分量为ω
ie
sinL,其中ω
ie
为地球自转角速
率,L为当地纬度;通过惯性导航系统的初始对准,将系统的俯仰轴x、横滚轴y、方位轴z的位置记为位置1;
在系统三轴处于位置1的情况下,将系统绕方位轴旋转180°,此时横滚轴在水平面的投影指向正南,将该位置记为位置2;
回路稳定后,根据数据波动情况和噪声水平连续采样一段时间的数据,求取均值,得到:
δω
y1=k
y
ω
ie
cosLcosθ+k
y
ω
ie
sinLsinθ+ε
y
(1)
δω
z1=-k
z
ω
ie
cosLsinθ+k
z
ω
ie
sinLcosθ+ε
z
(2)
δω
y2=-k
y
ω
ie
cosLcosθ-k
y
ω
ie
sinLsinθ+ε
y
(3)
其中,δω
y1、δω
z1
、δω
y2
分别为y轴陀螺在位置1时的输出数据均值、z轴陀螺在位
置1时的输出数据均值和y轴陀螺在位置2时的输出数据均值;
通过方程(1)和(3),求得横滚轴陀螺的常值漂移ε
y 以及刻度因数k
y
为:
在系统三轴处于位置1的情况下,将系统绕横滚轴旋转180°,此时方位轴与地向轴的夹角为θ,将该位置记为位置3;
回路稳定后,根据数据波动情况和噪声水平连续采样一段时间的数据,求取均值,得到:
δω
z3=k
z
ω
ie
cosLsinθ-k
z
ω
ie
sinLcosθ+ε
z
(4)
其中,δω
z3
表示z轴陀螺在位置3时的输出数据均值;
通过方程(2)和(4),求得方位轴陀螺的常值漂移ε
z 以及刻度因数k
z
为:
在系统三轴处于位置1的情况下,将系统绕方位轴旋转90°,此时东向陀螺的俯仰轴
在水平面上的投影指向正北,将该位置标记为位置4;
在系统三轴处于位置1的情况下,将系统绕方位轴旋转270°,此时东向陀螺的俯仰轴在水平面上的投影指向正南,将该位置标记为位置5;
回路稳定后,根据数据波动情况和噪声水平连续采样一段时间的数据,求取均值,得到:
δω
x4=k
x
ω
ie
cosLcosθ+k
x
ω
ie
sinLsinθ+ε
x
(5)
δω
x5=-k
x
ω
ie
cosLcosθ-k
x
ω
ie
sinLsinθ+ε
x
(6)
通过方程(5)和(6),求得俯仰轴陀螺的常值漂移ε
x 和刻度因数k
x
为:
从而求得系统俯仰轴、横滚轴和方位轴陀螺的常值漂移和刻度因数,完成陀螺的常值漂移和刻度因数的标定;
步骤三:利用重力加速度标定加表的零偏和刻度因数
将惯性导航系统三轴旋转到位置1′,所述位置1′中,方位轴与天向轴成θ角,横滚轴与北向轴的夹角为θ,俯仰轴与东向轴重合;在该位置情况下,采集一段时间的方位轴加表的输出,求取平均值,得到:
A z1=B
z
+K
z
gcosθ (7)
其中,A
z1
表示z轴加表在位置1′时的输出数据均值;
在系统三轴处于位置1′的情况下,将系统绕横滚轴旋转90°,此时方位轴指向西,俯仰轴与天向轴的夹角为θ,将该位置记为位置2′;在该位置情况下,采集一段时间的俯仰轴加表的输出,求取平均值,得到:
A x2=B
x
+K
x
gcosθ (8)
其中,A
x2
表示x轴加表在位置2′时的输出数据均值;
在系统三轴处于位置2′的情况下,将系统绕横滚轴旋转90°,此时俯仰轴指向西,方位轴与地向轴的夹角为θ,将该位置记为位置3′;在该位置情况下,采集一段时间的方位轴加表的输出,求取平均值,得到:
A z3=B
z
-K
z
gcosθ (9)
其中,A
z3
表示z轴加表在位置3′时的输出数据均值;
在系统三轴处于位置3′的情况下,将系统绕横滚轴旋转90°,此时方位轴指向东,俯仰轴与地向轴的夹角为θ,将该位置记为位置4′;在该位置情况下,采集一段时间的俯仰轴加表的输出,求取平均值,得到:
A x4=B
x
-K
x
gcosθ (10)
其中,A
x4
表示x轴加表在位置4′时的输出数据均值;
联立方程式(7)到(10),求得俯仰轴加表的零偏B
x 和刻度因数K
x
以及方位轴加表的
零偏B
z 和刻度因数K
z
为:
采用惯性导航系统方位轴的自由度将将惯性导航系统三轴旋转到位置5′,所述位置5′中,方位轴与天向轴的夹角为θ,方位轴与南向轴成θ角,俯仰轴与东向轴重合;
在系统三轴处于位置5′的情况下,将系统绕俯仰轴旋转90°,此时方位轴指向西,横滚轴与天向轴的夹角为θ,将该位置记为位置6′;在该位置情况下,采集一段时间的横滚轴加表的输出,求取平均值,得到:
A y6=B
y
+K
y
gcosθ (11)
其中,A
y6
表示y轴加表在位置6′时的输出数据均值;
在系统三轴处于位置6′的情况下,将系统绕俯仰轴旋转180°,此时方位轴指向东,横滚轴与地向轴之间的夹角为θ,将该位置记为位置7′;在该位置情况下,采集一段时间的横滚轴加表的输出,求取平均值,得到:
A y7=B
y
-K
y
gcosθ (12)
其中,A
y7
表示y轴加表在位置7′时的输出数据均值;
根据方程(11)和(12),求得到横滚轴加表的零偏B
y 和刻度因数K
y
为:
从而求得系统俯仰轴、横滚轴和方位轴加表的零偏和刻度因数,完成加表的零偏和刻度因数的标定;
步骤四:通过步骤二中陀螺的常值漂移和刻度因数以及步骤三中加表的零偏和刻度因数的求取,从而实现了惯性导航系统的在线自主标定。
2.如权利要求1所述的一种基于惯性导航系统的在线自主标定方法,其特征在于:采集数据的时间为5分钟。
3.如权利要求1所述的一种基于惯性导航系统的在线自主标定方法,其特征在于:采集数据时采样的频率为100Hz。
1/7页
一种基于惯性导航系统的在线自主标定方法技术领域
[0001] 本发明属于自主标定领域,涉及一种基于惯性导航系统的在线自主标定的方法,特别涉及一种基于双轴旋转的光纤陀螺平台捷联混合式系统的在线自主标定方法。背景技术
[0002]
对于长航时惯性导航系统,重调周期为几天甚至十几天,因此在线自主标定惯性器件关键参数的方法是十分必要的。实验室标定方法仅能利用已知地点的重力加速度和地球自转角速度进行惯性器件的关键参数检测。
[0003] 由于双轴旋转调制惯性导航系统俯仰轴与载体固连,使得系统横滚轴与水平面的夹角无法消除;同时双轴旋转调制惯性导航系统的方位轴和横滚轴有全自由度,因此双轴旋转调制惯性导航系统既有平台式惯性导航系统能够隔离载体运动的特点,同时其导航算法与捷联式惯性导航系统又有相似之处,因而在进行自主在线标定时需要对其姿态角进行预先估计。发明内容
[0004]
为了解决双轴旋转调制惯性导航系统中系统横滚轴与水平面夹角无法消除的问题,本发明提供了一种基于惯性导航系统的在线自主标定方法,解决了双轴旋转调制惯性导航系统中系统横滚轴与水平面夹角无法消除的问题,为其姿态角的预先估计提供了可靠依据,实现了在线自主标定的目的。
[0005] 一种基于惯性导航系统的在线自主标定方法,该方法实现的具体步骤如下:
[0006] 步骤一:惯性导航系统初始对准
[0007] 对于双轴旋转调制式惯性导航系统,采用捷联算法对其进行初始对准,得到三个轴的初始姿态角;采用角度传感器与转轴上的伺服电机构成的回路控制方位轴的旋转,使北向陀螺的横滚轴在水平面上的投影指向正北;再采用该回路控制横滚轴旋转,使东向陀螺的俯仰轴指向正东;
[0008] 根据初始姿态角和回路控制的方位轴和横滚轴旋转的角度计算垂向陀螺的坐标与天向的夹角为θ;此时该夹角与载体的实际俯仰角相同,是横滚轴与水平面的夹角;
[0009] 步骤二:采用地球自转角速度标定陀螺的常值漂移和刻度因数
[0010] 地球自转角速度北向分量为ωie cosL ,天向分量为ωie sinL ,其中ωie 为地球自转角速率,L 为当地纬度;通过惯性导航系统的初始对准,将系统的俯仰轴x 、横滚轴y 、方位轴z 的位置记为位置1;
[0011] 在系统三轴处于位置1的情况下将系统绕方位轴旋转180°,此时横滚轴在水平面的投影指向正南,将该位置记为位置2;
[0012] 回路稳定后,根据数据波动情况和噪声水平连续采样一段时间的数据,求取均值,得到:
[0013] δωy1=k y ωie cosLcos θ+k y ωie sinLsin θ+εy (1)说 明 书CN 102564452 A