一种基于视觉和激光测距的中高空无人机导航方法及系统

    公开(公告)号:CN117348021A

    公开(公告)日:2024-01-05

    申请号:CN202311276983.7

    申请日:2023-09-28

    申请人: 山东大学

    摘要: 本发明提出了一种基于视觉和激光测距的中高空无人机导航方法及系统,单目图像结合激光测距确定关键帧,获取准确的真实场景尺度信息,对当前帧和关键帧进行特征跟踪,根据特征跟踪中激光测距点在关键帧中位置以及激光测距点在当前帧的特征跟踪位置,并结合无人机POS数据计算相对水平位移及协方差;根据关键帧的特征块以及对应特征跟踪后当前帧的特征块的相对旋转角度,计算相对航向角及航向角协方差;根据计算得到的结果结合飞控系统内滤波算法,实现无人机的运动状态估计。本发明的方法能够在处理器算力受限、相机分辨率受限的微小型无人机平台实时运行,具有轻量、鲁棒、实用的优点。