[发明专利]一种GPS拒止环境下基于异源图像匹配的无人机自主导航定位方法

摘要

本发明涉及一种GPS拒止环境下基于异源图像匹配的无人机自主导航定位方法，包括如下步骤：S1、读取无人机上相机、IMU、气压高度计输出的数据，从相机中读取视频流；S2、读取当前帧的地面正射影像，解算出无人机自身经纬度；S3、读取连续两帧地面正射影像；S3、得到无人机任一时刻的速度；S4、得到无人机在地球坐标系下的三维位置信息；S5、根据IMU测量信息进行惯性导航，读取加速度计的加速度值解算出无人机的位置、速度；S6、将步骤S4解算出的无人机三维位置信息、S3解算出的无人机实时速度和S5解算出的无人机位置姿态信息进行扩展卡尔曼滤波融合EKF，得到融合后的高频无人机位置、速度、姿态信息。解决了GPS拒止环境下无人机无法自主导航定位的问题。