基于先验知识的多旋翼无人机自适应悬停位置优化算法

摘要

本发明公开了一种基于先验知识的多旋翼无人机自适应悬停位置优化算法，包括以下步骤：S1：在已有3D杆塔模型空间中点选需检测点，并获取需检测点的3D坐标；S2：根据先验知识包括先验杆塔模型、先验历史巡查数据，并结合待执行任务，获得若干个悬停位估计点和姿态角估计点；S3：通过无人机执行指令，调整摄像云台角度和相机倍率对单个悬停位估计点及姿态角估计点进行修正；S4：重复步骤S3，得到优化后的悬停点位置和姿态角。本发明根据先验知识对悬停位估计点和姿态角估计点进行修正，通过优化算法找到最佳悬停点以及姿态角，进而提高了无人机的工作质量。