[发明专利]一种基于多模型分布式滤波的无人机自主导航与定位方法

说明书

技术领域

本发明涉及一种无人机自主导航和定位方法，特别是一种基于多模型分布式滤波的无人机自主导航与定位方法，适用于无人飞行器和有人飞行器自主导航和定位系统。

背景技术

与有人机相比，无人机是低风险和低成本，而且在军民用领域中被广泛应用，例如空中监视、地面侦察、灾后重建、遥感探测以及地面目标跟踪等。在实际应用中，无人机对自主导航系统精度和可靠性要求越来越高，要求实时、可靠地提供无人飞行器的位置、速度和姿态信息。由于低成本惯性导航系统误差发散很快，依靠单一的低成本惯性导航系统很难满足要求。将惯性导航系统与卫星定位系统信息进行融合来提供载体的运动信息已被广泛应用。但由于卫星定位信号易受干扰或欺骗，甚至信号转发源被摧毁，不能够长期提供稳定可靠的定位信息，在军民用领域中尚不能完全依赖于卫星定位来辅助惯性导航实现飞行器的精确导航定位。因此，发展一些替代的导航系统用于处理卫星导航系统短期和长期故障时的无人机自主导航和定位问题，已成为军民用领域无人机应用研究的的重点。视觉相机作为无人机配重包中的标准传感器既可用于导航传感器获取无人机的导航和定位信息，又可以用于任务传感器执行特定的任务，例如侦查，运动目标跟踪以及遥感探测，已成为无人机自主导航和定位的有效补充导航源之一。

根据无人机飞行的环境是否已知将基于视觉信息的导航和定位分为两类，一类是飞行环境未知，常用的方法有同时完成定位和生成环境地图的SLAM算法和视觉测距方法，前者在室内无人机和机器人导航定位中已广泛应用，但在室外环境多变的大视场环境无法有效使用；虽然后者可以用于室外多变环境，但需要精确获取无人机的飞行姿态和稳定平台的姿态；另一类是飞行环境已知，常用方法有陆标匹配和图像匹配定位，可以给出无人机精确的导航和位置信息。

本发明为中提到的一种基于多模型分布式滤波的无人机自主导航与定位方法，该方法在东北天地里坐标系下，根据惯性导航系统力学方程编排以及惯性导航系统误差方程建立不同阶次的多模型分布式滤波状态估计的系统状态方程，利用不同量测系统和传感器获得无人机运动的量测值，采用分布式滤波方法来估计并补偿低成本惯性导航系统的误差，为无人机提供连续、可靠的导航和定位信息。

本发明与其它无人机导航和定位方法不同在于：在当前已公开发表的文献中，依靠惯性导航/GPS组合导航或者是依靠视觉辅助惯性导航来提供无人机的导航和定位信息，但这些导航方法在实际应用中依然存在计算复杂度高以及在一些环境中无法使用的局限性，特别是在卫星导航定位系统信号长时间不可用时，导航系统无法提供长时间稳定的姿态信息而导致无人机及其机载设备损毁的风险。

发明内容

本发明要解决的技术问题：为解决在卫星导航定位系统长时间不可用时，导航系统能够长时间提供稳定的姿态和定位信息来控制无人机稳定、可靠地飞行，提出一种基于多模型分布式滤波的无人机自主导航与定位方法。

本发明采用的技术方案为：一种基于多模型分布式滤波的无人机自主导航与定位方法，该方法在东北天地里坐标系下，根据惯性导航系统力学方程编排以及惯性导航系统误差方程建立不同阶次的多模型分布式滤波系统状态方程，利用不同量测系统和传感器获得无人机运动的量测值，采用分布式滤波方法来估计并补偿低成本惯性导航系统的误差，为无人机提供连续、可靠的导航和定位信息。保证在卫星导航定位系统短期或长期不可用时，能够长时间连续、稳定地为无人机提供精确的导航和定位信息。具体实现步骤为：

步骤（1）、当卫星导航系统可用时，采用七状态反馈Kalman滤波处理卫星导航定位系统输出的位置和速度信息来估计惯性导航系统水平通道和姿态误差，使惯性导航系统输出精确的位置、速度和姿态信息，其具体方法为：

a1、根据惯性导航系统力学方程编排，利用加速度计和陀螺仪的输出值实时计算无人机的运动信息，包括位置、速度和姿态；

a2、根据惯性导航系统误差方程建立惯性导航/卫星导航组合导航系统状态方程为：