一种自适应双轴旋转调制惯性导航方法与流程

摘要: 本发明涉及惯性导航,尤其涉及一种自适应双轴旋转调制惯性导航方法。背景技术:1、惯性导航是一种只依靠自身传感器进行导航定位的技术,导航精度受到器件精度的影响,尤其...
一种自适应双轴旋转调制惯性导航方法与流程

本发明涉及惯性导航,尤其涉及一种自适应双轴旋转调制惯性导航方法。

背景技术:

1、惯性导航是一种只依靠自身传感器进行导航定位的技术,导航精度受到器件精度的影响,尤其是器件零偏,是惯性导航最大的误差源。旋转调制技术是通过电机的周期性旋转,将惯性器件的零偏形成周期性补偿,在一个旋转周期内积分为0,达到抑制惯导误差快速发散的目的,旋转调制方案通常根据结构复杂度,分为单轴旋转和双轴旋转,其中单轴旋转调制方案,通过方位轴运动,使与旋转轴垂直的两个轴向的惯性器件误差在一个调制周期内的积分均值为零;其中双轴协同旋转调制方案,通过方位轴和横滚轴的协同运动,使三个轴向的惯性器件误差在一个调制周期内的积分均值为零;

2、传统旋转调制方案大多采用固定转速和固定转停方案,当载体处于高动态环境时,载体的角运动和线运动会与imu的旋转运动产生耦合,引入额外的线角耦合等动态误差,甚至导致误差发散,固定转速方案无法根据载体动态特性进行调整,在复杂环境下导航精度显著下降,另外,传统的旋转调制主要对零偏误差进行了周期性调制,而未考虑高频噪声误差对导航精度带来的影响,基于上述所存在的缺陷,我们提出了一种自适应双轴旋转调制惯性导航方法。

技术实现思路

1、基于背景技术存在的技术问题,本发明提出了一种自适应双轴旋转调制惯性导航方法。

2、本发明提出的一种自适应双轴旋转调制惯性导航方法,包括以下步骤:

3、s1:双轴旋转调制惯性导航设备设计16个调制位置,其中双轴旋转调制惯性导航设备主要由imu和双轴转位机构组成,双轴转位机构的方位轴垂直于载体安装平面,双轴转位机构的横滚轴沿载体横向安装,双轴旋转调制惯性导航设备的方位轴依次旋转到0°、45°、90°、135°、180°、225°、270°、315°共8个位置,在每个方位位置的横滚轴分别在0°和180°两个位置停留,形成16个调制位置,每个位置停留的时间t1=10s,位置之间的转位过程采用加减速曲线;

4、s2:在每个位置停留期间,控制横滚轴和方位轴同时进行幅度±1°和频率1hz的小角度正弦抖动,进一步调制高频噪声误差和量化噪声,在一个周期内,三个轴向的陀螺零偏和加速度计零偏在i系下的投影积分均值严格为零,实现常值误差的完全自补偿;

5、s3:构建自适应转速调节机制:实时监测载体动态强度和环境振动水平,采用模糊控制算法动态调整旋转角速度,在高动态环境下自动降低转速或暂停旋转,有效抑制运动耦合误差;

6、s4:实时采集imu实时输出的过载信息,计算载体动态强度d,

7、然后实时采集imu实时输出的角速度信息,计算振动强度v;

8、s5:建立转速调节的模糊控制规则库,模糊控制规则库的输入为动态强度d和振动强度v,模糊控制规则库的输出为控制转速ω,然后设定静态工作状态阀值,静态工作状态阀值具体为d0=3m/s2,v0=10°/s,标准转速ω0=6°/s,当d<d0且v<v0时,工作在标准状态;当d或v超过阈值时,按比例降低转速;

9、 s6:控制最低转速不低于1°/s;当检测到载体角速度大于50°/s或过载大于10m/s2时,判定为大机动状态,立即锁定转台位置,暂停旋转调制,待机动结束后恢复正常旋转调制;

10、s7:在惯性坐标系下进行机械编排解算,将调制补偿后的惯性测量数据进行积分,得到惯性空间下的导航结果,导航结果再通过坐标变换转换到导航坐标系,并进行输出。

11、优选地,所述s1中,双轴转位机构采用u-o-o架构,方位轴和横滚轴均采用力矩电机直接驱动,配以高精度圆光栅编码器作为角位置反馈,角位置测量精度优于±1″。

12、优选地,所述s1中,转位过程的最大角加速度为10°/s2,转位过程的最大角速度为6°/s,以此避免加减速过程引入过大的冲击和振动。

13、优选地,所述s2中,完全自补偿的高频振动模式公式如下:,t为时间变量。

14、优选地,所述s4中,载体动态强度d的计算公式如下:

15、,式中过载量测值。

16、优选地,所述s4中,振动强度v的计算公式如下:

17、,式中陀螺量测值。

18、优选地,所述s5中,转速的计算公式如下:

19、。

20、优选地,所述s7中,导航结果包括经度、纬度、高度、北向速度、东向速度、天向速度、航向角、俯仰角和横滚角。

21、本发明在双轴协同旋转调制的基础上,构建自适应转速调节机制,根据载体实时动态特性和环境振动水平,动态优化旋转角速度,解决高动态下引起的额外动态误差,另在位置停留期间进行连续小角度抖动调制,抖动幅度为±1°和抖动频率为1hz,进一步抑制高频噪声误差。

1.一种自适应双轴旋转调制惯性导航方法,其特征在于,包括以下步骤:

2.根据权利要求1所述的一种自适应双轴旋转调制惯性导航方法,其特征在于,所述s1中,双轴转位机构采用u-o-o架构,方位轴和横滚轴均采用力矩电机直接驱动,配以高精度圆光栅编码器作为角位置反馈,角位置测量精度优于±1″。

3.根据权利要求1所述的一种自适应双轴旋转调制惯性导航方法,其特征在于,所述s1中,转位过程的最大角加速度为10°/s2,转位过程的最大角速度为6°/s,以此避免加减速过程引入过大的冲击和振动。

4.根据权利要求1所述的一种自适应双轴旋转调制惯性导航方法,其特征在于,所述s2中,完全自补偿的高频振动模式公式如下:,t为时间变量。

5.根据权利要求1所述的一种自适应双轴旋转调制惯性导航方法,其特征在于,所述s4中,载体动态强度d的计算公式如下:

6.根据权利要求1所述的一种自适应双轴旋转调制惯性导航方法,其特征在于,所述s4中,振动强度v的计算公式如下:

7.根据权利要求1所述的一种自适应双轴旋转调制惯性导航方法,其特征在于,所述s5中,转速的计算公式如下:

8.根据权利要求1所述的一种自适应双轴旋转调制惯性导航方法,其特征在于,所述s7中,导航结果包括经度、纬度、高度、北向速度、东向速度、天向速度、航向角、俯仰角和横滚角。