[发明专利]一种天空偏振光组合导航在线滤波与平滑方法

说明书

本发明涉及一种天空偏振光组合导航在线滤波与平滑方法，首先一个导航处理器采集惯性导航数据进行捷联解算，然后将捷联解算结果发送给另外一个处理器；另外一个导航处理器利用前一时间段收到的捷联解算历史数据以及外部卫星导航模块、偏振传感器等修正数据进行滤波与平滑，对组合导航中状态量进行最优估计，然后将结果发送给第一个导航处理器；最后第一个导航处理器完成导航误差修正。如此往复，直至导航结束。本发明借助天空偏振光提高了组合导航系统可观测度，此外利用了历史导航数据对捷联解算结果进行滤波与平滑，实现了组合导航在线后处理，减小了状态反馈时所产生的锯齿波现象，在保证滤波实时性的同时，提高了组合导航系统整体精度。

技术领域

本发明涉及无人机天空偏振光组合导航领域，尤其涉及一种天空偏振光组合导航在线滤波与平滑方法。

背景技术

生物经过亿万年地进化具有了高超的导航能力。1985年，科学家Wehner发现沙蚁可以利用天空中的偏振光进行导航，此外科学研究表明自然界中的帝王蝶、蜣螂等昆虫也将偏振导航作为自己的主要或者辅助的导航方式。受昆虫利用偏振光导航的启发，近些年来，偏振光导航逐步发展成为一种新型的导航方式。大气层中的偏振光分布模式稳定，所以具有误差不随时间积累、在较大范围内不易受人为因素干扰、自主性强等优点，是一种精度高、鲁棒性强的全自主导航方式。

现有的传统捷联式组合导航算法通常首先进行捷联导航解算，在GNSS、光流、地磁等导航纠正数据采集完毕时再进行集中式卡尔曼滤波，对组合导航中的误差量进行估计，然后将各个误差量的最优估计值反馈给系统完成校正。在滤波过程中，通常仅利用当前时刻的捷联解算结果，又因为捷联解算的频率要远远高于卡尔曼滤波的频率，在对姿态、速度、位置等导航结果进行误差修正的时候会产生锯齿波，影响组合导航系统的精度甚至造成滤波器发散。同时锯齿波还会对后续控制系统带来很大的影响，如果飞行器控制率选取不当，会对无人机的飞行带来巨大的安全隐患。

为提高组合导航系统整体精度，通常还需要对组合导航过程中的数据进行后处理，补偿组合导航中各传感器采集时间不同步问题，平滑组合导航过程中的锯齿波现象。但是后处理通常需要事后离线进行解算，无法实时对导航滤波结果进行平滑。

发明内容

本发明的技术解决问题是：克服现有组合导航方法在误差修正时会产生锯齿波的缺点，提供一种天空偏振光组合导航在线滤波与平滑方法，通过双处理器协同分工，共同完成导航解算。相比以往的捷联组合导航方法，本发明借助天空偏振光信息对组合导航中三轴失准角进行修正，提高了三轴平台失准角的可观测度，此外利用了历史导航数据对捷联解算结果进行在线平滑处理，减小了修正误差时所产生的锯齿波现象，提高了组合导航系统整体精度。

本发明的技术解决方案是：一种天空偏振光组合导航在线滤波与平滑方法，通过下列步骤实现：

(1)导航处理器1采集惯性导航数据，进行捷联导航解算，将姿态、速度和位置解算结果发给导航处理器2；

(2)导航处理器2将采集到的卫星导航模块、偏振传感器的数据，以及结合前m秒接收到的捷联解算历史数据，共同代入R-T-S滤波器进行平滑处理，对组合导航中状态量进行最优估计；

(3)导航处理器2将最优估计中的组合导航系统状态量发送给导航处理器1，导航处理器1对捷联解算结果进行导航误差修正；

(4)如此往复上述(1)-(3)步骤，直至组合导航结束。

所述步骤(2)中，最优估计具体过程为：

(21)根据组合导航误差方程建立滤波模型，系统方程为：

其15维系统状态量为：

分别是三轴平台失准角、东北天速度误差、经纬高位置误差、三轴陀螺仪零偏、三轴加速度计零偏；