CN105628025B - 一种恒速偏频/机抖激光陀螺惯导系统导航方法 - Google Patents
一种恒速偏频/机抖激光陀螺惯导系统导航方法 Download PDFInfo
- Publication number
- CN105628025B CN105628025B CN201511028707.4A CN201511028707A CN105628025B CN 105628025 B CN105628025 B CN 105628025B CN 201511028707 A CN201511028707 A CN 201511028707A CN 105628025 B CN105628025 B CN 105628025B
- Authority
- CN
- China
- Prior art keywords
- offset frequency
- gyro
- systems
- formula
- error
- 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
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
Abstract
本发明属于惯性导航领域,针对正反转速率偏频方式激光陀螺惯导系统要求偏频机构瞬间反转、实现难度大,以及恒速偏频方式激光陀螺惯导系统无法克服与偏频旋转轴方向陀螺标度因数误差相关的等效漂移误差、纯惯性导航误差大的问题,公开了一种恒速偏频/机抖激光陀螺惯导系统导航方法。本发明通过机械抖动偏频激光陀螺安装、坐标系及安装关系定义、偏频旋转轴方向等效陀螺采样值计算、精确标校安装关系矩阵、精确标校机械抖动激光陀螺敏感轴的单位矢量、初始对准卡尔曼滤波器设计、纯惯导误差修正补偿的步骤,实现了快速高精度初始对准,减小了纯惯导的北向和东向位置误差,提高了导航精度。
Description
技术领域:
本发明涉及惯性导航系统领域,特别是一种恒速偏频/机抖激光陀螺惯导系统导航方法。
背景技术:
单轴旋转调制技术可以平均调制与旋转轴垂直的惯性器件误差,对于旋转轴轴向的器件误差,有学者采用在线标定与补偿的方法,但标定时间普遍较长,无法满足快速性要求。速率偏频激光陀螺惯导系统方案不仅可以克服机械抖动偏频激光陀螺过锁区随机游走误差影响,而且正反转的方式还能抵消与偏频旋转轴方向陀螺标度因数误差相关的等效漂移误差,提高惯导系统精度,但正反转交替旋转的偏频方式要求偏频机构瞬间反转,实现难度大。恒速偏频方式可实现高精度的寻北,但由于偏频机构以恒定角速率旋转,造成与偏频旋转轴方向陀螺标度因数误差相关的等效漂移误差,纯惯性导航误差大。因此,寻找一种单轴恒速偏频旋转且能抑制偏频旋转轴方向陀螺标度因素误差的惯导系统方案具有重要意义。
发明内容:
本发明针对现有的单轴恒速偏频激光陀螺导航系统不能解决偏频旋转轴方向陀螺标度因素误差的问题,提出了一种恒速偏频/机抖激光陀螺惯导系统导航方法。该方案在三个陀螺、三个加速度计构成的高精度激光陀螺恒速偏频寻北系统的基础上,增加一个不随偏频机构旋转的固定在基座上的机械抖动偏频激光陀螺,用于敏感偏频旋转轴方向的载体角运动,避免了沿恒速偏频旋转轴方向的陀螺标度因数误差造成的姿态误差积累。
为解决上述技术问题,本发明采用以下技术方案:
一种恒速偏频/机抖激光陀螺惯导系统导航方法,其步骤为:
步骤一:机械抖动偏频激光陀螺安装:在三个陀螺(gx、gy、gz)、三个石英挠性加速度计(ax、ay、az)构成的高精度激光陀螺恒速偏频寻北系统的基础上,安装一个不随偏频机构旋转的固定在基座上的机械抖动偏频激光陀螺gdz,其敏感轴与旋转轴一致,提供偏频旋转轴方向的载体角运动信息;
步骤二:坐标系及安装关系定义:
定义n系为当地水平地理坐标系,N-E-D(北-东-地)方向;
bg系为斜装的恒速偏频IMU(惯性测量单元)坐标系,其轴与gx陀螺敏感轴重合,轴在gx陀螺与gy陀螺敏感轴所确定的平面内且gy陀螺敏感轴方向偏离轴一个小的安装偏差角,轴方向符合右手规则且gz陀螺敏感轴方向偏离轴一个小的安装偏差角;
b系为变换后的IMU坐标系,采用前-右-下方向,zb轴与恒速偏频旋转轴重合,xb轴、yb轴与偏频旋转轴正交,xb轴与轴及zb轴在同一平面内,与n系间的方向余弦矩阵为
bg系、b系固联于旋转台面中并随转台连续转动,转速Ω(转台旋转轴指向下方,顺时针方向为正),周期T,t时刻与转台零位夹角α(t);
bp系为转台台体坐标系,与b系在t=0时刻重合,与n系间的方向余弦矩阵为
为b系与bp系之间的转换矩阵,可由α(t)表示为:
步骤三:偏频旋转轴方向等效陀螺采样值计算:
b系下偏频旋转轴方向敏感角速率可表示为,
式中,是b系下载体角速度,bp系中机械抖动激光陀螺敏感轴单位矢量为[kdxkdy kdz]T,其敏感角速率理论值为ωdz,上标T表示向量或矩阵的转置,Δt是采样时间间隔;
由式(2)积分可得相应的陀螺角增量采样值,根据b系中恒速偏频激光陀螺IMU提供的垂直于旋转轴的角增量固联于bp系中的机抖陀螺的角增量偏频旋转机构的角位置α(t)和角增量Δα(t),可计算出b系沿偏频旋转轴方向的角增量
步骤四:精确标校bg系与b系之间的安装关系矩阵设置bg系三个恒速偏频激光陀螺工作在机械抖动偏频模式下,利用水平姿态角γ(滚动角)和θ(俯仰角)的计算结果对进行精确标校;
步骤五:精确标校机械抖动激光陀螺敏感轴的单位矢量[kdx kdy kdz]:设置三个恒速偏频激光陀螺工作在机械抖动偏频模式下,保持不变时有:
式中,表示bp系的旋转角速率;
整个惯导系统按照不同的倾斜方式置于单轴转台上,单轴转台正反方向旋转,消除地球自转角速度及陀螺常值漂移误差影响,根据即可估计出参数[kdx kdy kdz];
步骤六:初始对准卡尔曼滤波器设计:
选取三个姿态误差(φN、φE、φD)和三个速度误差(δVN、δVE、δVD)作为误差状态,器件误差中,选取三个加速度计零偏作为误差状态,选取偏频旋转轴方向等效陀螺采样值常值零偏偏差耦合造成的北向等效陀螺漂移εN作为误差状态,即
构建系统状态方程如下:
式中,x表示系统误差状态,表示系统误差状态微分,F表示系统误差矩阵,G表示系统噪声输入矩阵,w表示系统噪声:
w=[wgx wgy wgz wax way waz]T (6)
式中,wgx、wgy和wgz为陀螺测量噪声,wax、way、waz为加速度计测量噪声;
选取n系下速度误差δVN、δVE和δVD作为观测量,构建观测方程如下:
z=Hx+υ (7)
式中,z为观测量,H为测量矩阵,υ为测量噪声;
步骤七:纯惯导误差修正补偿:
利用初始对准卡尔曼滤波对和εN的估计值,在纯惯导过程中进行修正补偿,完成导航解算,修正补偿方法如下:
步骤三中偏频旋转轴方向等效陀螺采样值计算中求解方法为:
机抖陀螺敏感角速率理论值可表示为:
又式中,则有:
把式(1)代入式(12)变换后可得的表达式。
步骤四中所述的精确标校方法为:
设真实的IMU坐标系为b′系,则有:
式中,是bp与n系间的方向余弦矩阵的真实值,可表示为:
是b′系与n系间的方向余弦矩阵,可表示为:
将式(14)和(15)代入式(13)两边同时消去得:
设ξx和ξy为b系和b′系之间的转换的小角度偏差,则
将式(1)和式(17)代入式(16)解得:
静基座下分别选取α(t)=0和α(t)=π两个时刻,从而解得:
则可根据式对进行精确标校。
步骤六中所述初始对准卡尔曼滤波器设计中系统状态方程和观测方程构建方法为:
系统状态方程构建如下:
式中,φn=[φN φE φD]T代表失准角,fn表示n系下的比力值,是n系的旋转角速率;
根据系统误差方程得到的系统状态方程中系统误差矩阵F和系统噪声输入矩阵G相应为:
卡尔曼滤波观测方程构建如下:
观测量z=[δVN δVE δVD]T,则在观测方程z=Hx+υ中:
υ=[υN υE υD]T。 (24)
与现有技术相比,本发明具有以下优点:
(1)在三个陀螺三个加速度计构成的高精度激光陀螺恒速偏频寻北系统的基础上增加一个不随偏频机构旋转的固定在基座上的机械抖动偏频激光陀螺,改善偏频轴方向载体角速度测量精度,采用单轴恒速偏频旋转方式,避免了速率偏频技术要求偏频机构瞬间反转的难点;
(2)以姿态角误差、速度误差、加速度计零偏、偏频旋转轴方向陀螺漂移和偏差耦合造成的北向等效陀螺漂移为误差状态,以速度误差为观测量,构建卡尔曼滤波器,对加速度计零偏和偏差耦合造成的北向等效陀螺漂移进行在线标定补偿,对偏频旋转轴方向陀螺漂移进行预先标定补偿,改善了现有的卡尔曼滤波初始对准方位角波动幅度大的问题,进一步提高了恒速偏频激光陀螺惯导系统的导航定位精度;
(3)IMU与转台安装关系的精确标校,改善水平姿态角波动幅度。
附图说明:
1、图1为本发明方案的流程图;
2、图2为滚动角收敛曲线对比图;
3、图3为俯仰角收敛曲线对比图;
4、图4为改进卡尔曼滤波与标准卡尔曼滤波初始对准方位角收敛曲线对比图;
5、图5为4小时纯惯导北向速度误差曲线对比图;
6、图6为4小时纯惯导东向速度误差曲线对比图;
7、图7为4小时纯惯导位置误差曲线对比图;
8、图8为第一组24小时纯惯导速度误差曲线图;
9、图9为第一组24小时纯惯导位置误差曲线图;
10、图10为第二组24小时纯惯导速度误差曲线图;
11、图11为第二组24小时纯惯导位置误差曲线图。
具体实施方式:
下面结合附图对本发明中的方法作进一步详细描述。
步骤一:机械抖动偏频激光陀螺安装:在三个陀螺(gx、gy、gz)、三个石英挠性加速度计(ax、ay、az)构成的高精度激光陀螺恒速偏频寻北系统的基础上,安装一个不随偏频机构旋转的固定在基座上的机械抖动偏频激光陀螺gdz,其敏感轴与旋转轴一致,提供偏频旋转轴方向的载体角运动信息;
步骤二:坐标系及安装关系定义:
定义n系为当地水平地理坐标系,N-E-D(北-东-地)方向;
bg系为斜装的恒速偏频IMU(惯性测量单元)坐标系,其轴与gx陀螺敏感轴重合,轴在gx陀螺与gy陀螺敏感轴所确定的平面内且gy陀螺敏感轴方向偏离轴一个小的安装偏差角,轴方向符合右手规则且gz陀螺敏感轴方向偏离轴一个小的安装偏差角;
b系为变换后的IMU坐标系,采用前-右-下方向,zb轴与恒速偏频旋转轴重合,xb轴、yb轴与偏频旋转轴正交,xb轴与轴及zb轴在同一平面内,与n系间的方向余弦矩阵为
bg系、b系固联于旋转台面中并随转台连续转动,转速Ω(转台旋转轴指向下方,顺时针方向为正),周期T,t时刻与转台零位夹角α(t);
bp系为转台台体坐标系,与b系在t=0时刻重合,与n系间的方向余弦矩阵为
为b系与bp系之间的转换矩阵,可由α(t)表示为:
步骤三:偏频旋转轴方向等效陀螺采样值计算:
b系下偏频旋转轴方向敏感角速率可表示为,
式中,是b系下载体角速度,bp系中机械抖动激光陀螺敏感轴单位矢量为[kdxkdy kdz]T,其敏感角速率理论值为ωdz,上标T表示向量或矩阵的转置,Δt是采样时间间隔;
由式(2)积分可得相应的陀螺角增量采样值,根据b系中恒速偏频激光陀螺IMU提供的垂直于旋转轴的角增量固联于bp系中的机抖陀螺的角增量偏频旋转机构的角位置α(t)和角增量Δα(t),可计算出b系沿偏频旋转轴方向的角增量
偏频旋转轴方向等效陀螺采样值计算中求解方法为:
机抖陀螺敏感角速率理论值可表示为:
又式中,则有:
把式(25)代入式(28)变换后可得的表达式;
步骤四:精确标校bg系与b系之间的安装关系矩阵设置bg系三个恒速偏频激光陀螺工作在机械抖动偏频模式下,利用水平姿态角γ(滚动角)和θ(俯仰角)的计算结果对进行精确标校;
精确标校具体方法为:
设真实的IMU坐标系为b′系,则有:
式中,是bp与n系间的方向余弦矩阵的真实值,可表示为:
是b′系与n系间的方向余弦矩阵,可表示为:
将式(30)和代(31)入式(29)两边同时消去得:
设ξx和ξy为b系和b′系之间的转换的小角度偏差,则
将式(25)和式(33)代入式(32)解得:
静基座下分别选取α(t)=0和α(t)=π两个时刻,从而解得:
则可根据式对进行精确标校;
步骤五:精确标校机械抖动激光陀螺敏感轴的单位矢量[kdx kdy kdz]:设置三个恒速偏频激光陀螺工作在机械抖动偏频模式下,保持不变时有:
式中,表示bp系的旋转角速率;
整个惯导系统按照不同的倾斜方式置于单轴转台上,单轴转台正反方向旋转,消除地球自转角速度及陀螺常值漂移误差影响,根据即可估计出参数[kdx kdy kdz];、
步骤六:初始对准卡尔曼滤波器设计:
选取三个姿态误差(φN、φE、φD)和三个速度误差(δVN、δVE、δVD)作为误差状态,器件误差中,选取三个加速度计零偏作为误差状态,选取偏频旋转轴方向等效陀螺采样值常值零偏偏差耦合造成的北向等效陀螺漂移εN作为误差状态,即
构建系统状态方程如下:
式中,x表示系统误差状态,表示系统误差状态微分,F表示系统误差矩阵,G表示系统噪声输入矩阵,w表示系统噪声:
w=[wgx wgy wgz wax way waz]T (39)
式中,wgx、wgy和wgz为陀螺测量噪声,wax、way、waz为加速度计测量噪声;
选取n系下速度误差δVN、δVE和δVD作为观测量,构建观测方程如下:
z=Hx+υ (40)
式中,z为观测量,H为测量矩阵,υ为测量噪声;
卡尔曼滤波系统状态方程和观测方程构建方法为:
系统状态方程构建如下:
式中,φn=[φN φE φD]T代表失准角,fn表示n系下的比力值,是n系的旋转角速率;
根据系统误差方程得到的系统状态方程中系统误差矩阵F和系统噪声输入矩阵G相应为:
卡尔曼滤波观测方程构建如下:
观测量z=[δVN δVE δVD]T,则在观测方程z=Hx+υ中:
υ=[υN υE υD]T (45)
步骤七:纯惯导误差修正补偿:
利用初始对准卡尔曼滤波对和εN的估计值,在纯惯导过程中进行修正补偿,完成导航解算,修正补偿方法如下:
下面是利用实验室自主设计的高精度恒速偏频激光陀螺寻北系统对本文提出的参数标校方法、初始对准算法和纯惯导精度进行半实物仿真验证评估。方法如下:
1)在实验室内进行恒速偏频静基座实验,转台转速设定为40°/s,采样频率设定为500Hz,采集5组实际的5小时数据,两组实际的24小时数据。
2)机抖陀螺角增量输出从机械抖动激光陀螺静态数据中获得,采用理论值加机抖陀螺静态噪声和漂移实际采样数据的方式仿真生成。
3)用本专利提出的方案进行初始对准及纯惯性导航实验,进行验证评估。
初始对准水平姿态角收敛曲线如图2、图3,其中(a)为用本文方法精确标校后的结果,(b)为原标校方法的结果。精确标校后,水平姿态角收敛曲线波动从10角秒减小到3角秒,从而有效地改善了初始对准水平姿态角精度。
方位角收敛曲线如图4,粗实线是采用本专利提出的改进的卡尔曼滤波初始对准算法,细实线是采用标准卡尔曼滤波初始对准算法。
5组数据初始对准10分钟方位角结果如表1所示:
表1 5组数据初始对准10分钟方位角结果
实验编号 | 方位角(°) |
1 | 264.167 |
2 | 264.165 |
3 | 264.164 |
4 | 264.166 |
5 | 264.168 |
标准差(1σ) | 5.7角秒 |
由图4和表1可知,本专利提出的初始对准算法不仅能有效地减小方位角周期性波动幅度,且10min精度优于10角秒。
图5、图6和图7中,粗实线是20分钟初始对准补偿加速度计零偏、偏差耦合的北向等效陀螺漂移和预先标定补偿偏频旋转轴方向陀螺漂移后的纯惯导4小时结果。细实线是10分钟初始对准仅补偿加速度计零偏的纯惯导4小时结果。由图7可以看出,补偿陀螺漂移后北向位置误差最大值从774米减小到96米,东向位置误差最大值从252米减小到89米。
5组数据纯惯导4小时位置误差最大值如表2所示:
表2 5组数据纯惯导4小时位置误差结果
实验编号 | 北向位置误差(m) | 东向位置误差(m) |
1 | 153 | 122 |
2 | 144 | 37 |
3 | 158 | 111 |
4 | 96 | 89 |
5 | 127 | 184 |
均值 | 135.6 | 108.6 |
由表2可知5次实验结果表明,4小时纯惯导北向、东向位置误差最大值均小于200m。
图8、图9和图10、图11分别是两组长时间数据进行20分钟初始对准补偿加速度计零偏、偏差耦合的北向等效陀螺漂移和预先标定补偿偏频旋转轴方向陀螺漂移后的纯惯导24小时结果,速度误差均小于0.2米/秒,北向位置误差优于450米/24小时,东向位置误差优于750米/24小时。
以上仅是本发明的优选实施方式,本发明的保护范围并不仅限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,应当视为落入本发明的保护范围。
Claims (4)
1.一种恒速偏频/机抖激光陀螺惯导系统导航方法,其特征在于包含以下步骤:
步骤一:机械抖动偏频激光陀螺安装:在三个陀螺gx、gy、gz,三个石英挠性加速度计ax、ay、az构成的高精度激光陀螺恒速偏频寻北系统的基础上,安装一个不随偏频机构旋转的固定在基座上的机械抖动偏频激光陀螺gdz,其敏感轴与旋转轴一致,提供偏频旋转轴方向的载体角运动信息;
步骤二:坐标系及安装关系定义:
定义n系为当地水平地理坐标系,N-E-D(北-东-地)方向;
bg系为斜装的恒速偏频IMU(惯性测量单元)坐标系,其轴与gx陀螺敏感轴重合,轴在gx陀螺与gy陀螺敏感轴所确定的平面内且gy陀螺敏感轴方向偏离轴一个小的安装偏差角,轴方向符合右手规则且gz陀螺敏感轴方向偏离轴一个小的安装偏差角;
b系为变换后的IMU坐标系,采用前-右-下方向,zb轴与恒速偏频旋转轴重合,xb轴、yb轴与偏频旋转轴正交,xb轴与轴及zb轴在同一平面内,与n系间的方向余弦矩阵为
bg系、b系固联于旋转台面中并随转台连续转动,转速Ω,转台旋转轴指向下方,顺时针方向为正,周期T,t时刻与转台零位夹角α(t);
bp系为转台台体坐标系,与b系在t=0时刻重合,与n系间的方向余弦矩阵为
为b系与bp系之间的转换矩阵,可由α(t)表示为:
步骤三:偏频旋转轴方向等效陀螺采样值计算:
b系下偏频旋转轴方向敏感角速率可表示为,
式中,是b系下载体角速度,bp系中机械抖动激光陀螺敏感轴单位矢量为[kdx kdykdz]T,其敏感角速率理论值为ωdz,上标T表示向量或矩阵的转置,Δt是采样时间间隔;
由式(2)积分可得相应的陀螺角增量采样值,根据b系中恒速偏频激光陀螺IMU提供的垂直于旋转轴的角增量固联于bp系中的机抖陀螺的角增量偏频旋转机构的角位置α(t)和角增量Δα(t),可计算出b系沿偏频旋转轴方向的角增量
步骤四:精确标校bg系与b系之间的安装关系矩阵设置bg系三个恒速偏频激光陀螺工作在机械抖动偏频模式下,利用水平姿态角的滚动角γ和俯仰角θ的计算结果对进行精确标校;
步骤五:精确标校机械抖动激光陀螺敏感轴的单位矢量[kdx kdy kdz]:设置三个恒速偏频激光陀螺工作在机械抖动偏频模式下,保持不变时有:
式中,表示bp系的旋转角速率;
整个惯导系统按照不同的倾斜方式置于单轴转台上,单轴转台正反方向旋转,消除地球自转角速度及陀螺常值漂移误差影响,根据即可估计出参数[kdx kdy kdz];
步骤六:初始对准卡尔曼滤波器设计:
选取三个姿态误差φN、φE、φD和三个速度误差δVN、δVE、δVD作为误差状态,器件误差中,选取三个加速度计零偏作为误差状态,选取偏频旋转轴方向等效陀螺采样值常值零偏偏差耦合造成的北向等效陀螺漂移εN作为误差状态,即
构建系统状态方程如下:
式中,x表示系统误差状态,表示系统误差状态微分,F表示系统误差矩阵,G表示系统噪声输入矩阵,w表示系统噪声:
w=[wgx wgy wgz wax way waz]T (6)
式中,wgx、wgy和wgz为陀螺测量噪声,wax、way、waz为加速度计测量噪声;
选取n系下速度误差δVN、δVE和δVD作为观测量,构建观测方程如下:
z=Hx+υ (7)
式中,z为观测量,H为测量矩阵,υ为测量噪声;
步骤七:纯惯导误差修正补偿:
利用初始对准卡尔曼滤波对和εN的估计值,在纯惯导过程中进行修正补偿,完成导航解算,修正补偿方法如下:
。
2.根据权利要求1所述的一种恒速偏频/机抖激光陀螺惯导系统导航方法,其特征在于:
步骤三中偏频旋转轴方向等效陀螺采样值计算中求解方法为:
机抖陀螺敏感角速率理论值可表示为:
又式中,则有:
把式(1)代入式(12)变换后可得的表达式。
3.根据权利要求1所述的一种恒速偏频/机抖激光陀螺惯导系统导航方法,其特征在于:
步骤四中所述的精确标校方法为:
设真实的IMU坐标系为b′系,则有:
式中,是bp与n系间的方向余弦矩阵的真实值,可表示为:
是b′系与n系间的方向余弦矩阵,可表示为:
将式(14)和(15)代入式(13)两边同时消去得:
设ξx和ξy为b系和b′系之间的转换的小角度偏差,则
将式(1)和式(17)代入式(16)解得:
静基座下分别选取α(t)=0和α(t)=π两个时刻,从而解得:
则可根据式对进行精确标校。
4.根据权利要求1所述的一种恒速偏频/机抖激光陀螺惯导系统导航方法,其特征在于:
步骤六中所述初始对准卡尔曼滤波器设计中系统状态方程和观测方程构建方法为:
系统状态方程构建如下:
式中,φn=[φN φE φD]T代表失准角,fn表示n系下的比力值,是n系的旋转角速率;
根据系统误差方程得到的系统状态方程中系统误差矩阵F和系统噪声输入矩阵G相应为:
卡尔曼滤波观测方程构建如下:
观测量z=[δVN δVE δVD]T,则在观测方程z=Hx+υ中:
υ=[υN υE υD]T (24) 。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201511028707.4A CN105628025B (zh) | 2015-12-31 | 2015-12-31 | 一种恒速偏频/机抖激光陀螺惯导系统导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201511028707.4A CN105628025B (zh) | 2015-12-31 | 2015-12-31 | 一种恒速偏频/机抖激光陀螺惯导系统导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105628025A CN105628025A (zh) | 2016-06-01 |
CN105628025B true CN105628025B (zh) | 2018-06-29 |
Family
ID=56043175
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201511028707.4A Active CN105628025B (zh) | 2015-12-31 | 2015-12-31 | 一种恒速偏频/机抖激光陀螺惯导系统导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105628025B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106248078B (zh) * | 2016-07-12 | 2018-12-28 | 中国人民解放军国防科学技术大学 | 机抖激光陀螺敏感轴动态偏移误差参数估计与补偿方法 |
CN106017452B (zh) * | 2016-08-10 | 2019-01-01 | 中国电子科技集团公司第二十六研究所 | 双陀螺抗扰动寻北方法 |
CN107388904B (zh) * | 2017-06-13 | 2019-01-22 | 河北汉光重工有限责任公司 | 激光信号解算与伺服控制一体化处理系统 |
CN107167134B (zh) * | 2017-06-22 | 2019-06-14 | 中国人民解放军国防科学技术大学 | 冗余配置激光陀螺航海惯导协同定位方法 |
CN109883444B (zh) * | 2019-02-25 | 2022-03-25 | 航天科工防御技术研究试验中心 | 一种姿态角耦合误差补偿方法、装置及电子设备 |
CN113220139B (zh) * | 2019-07-30 | 2022-08-02 | 荣耀终端有限公司 | 控制大屏设备显示的方法、移动终端及第一系统 |
CN110823254A (zh) * | 2019-11-14 | 2020-02-21 | 北京航天时代激光导航技术有限责任公司 | 一种基于双轴转台的速率偏频激光陀螺惯导系统对准测试方法 |
CN111795695B (zh) * | 2020-05-15 | 2022-06-03 | 阿波罗智联(北京)科技有限公司 | 位置信息确定方法、装置及设备 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004264240A (ja) * | 2003-03-04 | 2004-09-24 | Japan Aviation Electronics Industry Ltd | 慣性装置のミスアライメント計測方法 |
CN101514899A (zh) * | 2009-04-08 | 2009-08-26 | 哈尔滨工程大学 | 基于单轴旋转的光纤陀螺捷联惯性导航系统误差抑制方法 |
CN103090866A (zh) * | 2012-11-02 | 2013-05-08 | 哈尔滨工程大学 | 一种单轴旋转光纤陀螺捷联惯导系统速度误差抑制方法 |
CN103630134A (zh) * | 2013-11-14 | 2014-03-12 | 哈尔滨工程大学 | 一种基于2d-hmm/kf预滤波器的系泊对准方法 |
CN103697878A (zh) * | 2013-12-16 | 2014-04-02 | 北京自动化控制设备研究所 | 一种单陀螺单加速度计旋转调制寻北方法 |
-
2015
- 2015-12-31 CN CN201511028707.4A patent/CN105628025B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004264240A (ja) * | 2003-03-04 | 2004-09-24 | Japan Aviation Electronics Industry Ltd | 慣性装置のミスアライメント計測方法 |
CN101514899A (zh) * | 2009-04-08 | 2009-08-26 | 哈尔滨工程大学 | 基于单轴旋转的光纤陀螺捷联惯性导航系统误差抑制方法 |
CN103090866A (zh) * | 2012-11-02 | 2013-05-08 | 哈尔滨工程大学 | 一种单轴旋转光纤陀螺捷联惯导系统速度误差抑制方法 |
CN103630134A (zh) * | 2013-11-14 | 2014-03-12 | 哈尔滨工程大学 | 一种基于2d-hmm/kf预滤波器的系泊对准方法 |
CN103697878A (zh) * | 2013-12-16 | 2014-04-02 | 北京自动化控制设备研究所 | 一种单陀螺单加速度计旋转调制寻北方法 |
Non-Patent Citations (3)
Title |
---|
基于全信息的捷联惯导初始对准方法;郑振宁等;《火力与指挥控制》;20140331;第39卷(第3期);全文 * |
捷联惯导一种优化的惯性系粗对准方法;王跃钢等;《科学技术与工程》;20130228;第13卷(第4期);全文 * |
捷联惯性导航系统旋转调制技术研究;杨建业等;《电光与控制》;20091231;第16卷(第12期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN105628025A (zh) | 2016-06-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105628025B (zh) | 一种恒速偏频/机抖激光陀螺惯导系统导航方法 | |
CN1330935C (zh) | 安装误差角与标度因数解耦的微惯性测量单元精确标定方法 | |
CN103090867B (zh) | 相对地心惯性系旋转的光纤陀螺捷联惯性导航系统误差抑制方法 | |
CN101706287B (zh) | 一种基于数字高通滤波的旋转捷联系统现场标定方法 | |
Sun et al. | MEMS-based rotary strapdown inertial navigation system | |
CN101514899B (zh) | 基于单轴旋转的光纤陀螺捷联惯性导航系统误差抑制方法 | |
CN104501838B (zh) | 捷联惯导系统初始对准方法 | |
CN103900608B (zh) | 一种基于四元数ckf的低精度惯导初始对准方法 | |
CN102564452B (zh) | 一种基于惯性导航系统的在线自主标定方法 | |
CN104596546B (zh) | 一种单轴旋转惯导系统的姿态输出补偿方法 | |
CN106052682B (zh) | 一种混合式惯性导航系统及导航方法 | |
CN101713666B (zh) | 一种基于单轴转停方案的系泊估漂方法 | |
CN1330934C (zh) | 一种捷联惯性导航系统的任意双位置初始对准方法 | |
CN103697878B (zh) | 一种单陀螺单加速度计旋转调制寻北方法 | |
CN102589546B (zh) | 一种抑制器件斜坡误差影响的光纤捷联惯组往复式两位置寻北方法 | |
CN107270893A (zh) | 面向不动产测量的杆臂、时间不同步误差估计与补偿方法 | |
CN106441357B (zh) | 一种基于阻尼网络的单轴旋转sins轴向陀螺漂移校正方法 | |
CN101629826A (zh) | 基于单轴旋转的光纤陀螺捷联惯性导航系统粗对准方法 | |
CN105973271A (zh) | 一种混合式惯导系统自标定方法 | |
CN102679978B (zh) | 一种旋转式捷联惯性导航系统静基座初始对准方法 | |
CN101963512A (zh) | 船用旋转式光纤陀螺捷联惯导系统初始对准方法 | |
CN104864874B (zh) | 一种低成本单陀螺航位推算导航方法及系统 | |
CN103743413A (zh) | 倾斜状态下调制寻北仪安装误差在线估计与寻北误差补偿方法 | |
CN105136166B (zh) | 一种指定惯导位置精度的捷联惯导系统误差模型仿真方法 | |
CN101706284A (zh) | 提高船用光纤陀螺捷联惯导系统定位精度的方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |