一种基于地形高度的无人机轨迹平滑预测方法和系统

    公开(公告)号:CN116643580A

    公开(公告)日:2023-08-25

    申请号:CN202310392691.3

    申请日:2023-04-13

    IPC分类号: G05D1/10

    摘要: 本发明提供了一种基于地形高度的无人机轨迹平滑预测方法和系统,其中,无人机轨迹平滑预测方法包括:提取点云数据对应的原始地形高度并插入至双端队列;计算得到地形高度偏差,判断地形高度偏差的绝对值是否小于或等于限定高度偏差阈值;若是,则估计得到当前帧估算地形高度,插入至双端队列;若否,则对当前帧原始地形高度进行地形趋势过滤并插入至双端队列,计算得到当前帧估算地形高度并插入至双端队列;根据当前帧估算地形高度计算无人机的当前飞行高度并插入至双端队列;对队列进行样条平滑处理,得到平滑后的高程估计值;计算得到无人机的当前预测高度。本发明的技术方案能解决现有技术中无人机飞行高度变化大,飞行轨迹不够平滑的问题。