一种可装订任意航迹点的飞行器航迹规划方法及装置

摘要

本发明公开了一种可装订任意航迹点的飞行器航迹规划方法及装置。该方法包括装订航迹点位置，并计算航迹点位置的射向射程和侧偏；根据射向射程和侧偏计算航迹点的航迹指令斜率；基于航迹指令斜率计算相邻航迹点区间的航迹曲线指令以及航迹斜率指令，并组成当前航向机动飞行任务对应飞行段的航迹指令；基于航迹指令确定飞行任务所需航迹角指令以及侧偏指令；根据航迹角指令以及侧偏指令生成飞行器航迹指令跟踪控制信号，飞行器航迹指令跟踪控制信号用于飞行器执行机构控制飞行器飞行。本发明实现了保证了航程尽可能短、航迹光滑、不存在尖点或折角，使得飞行器以尽可能短的航程途径经过各预期航迹点或附近，且飞行器姿态角不会有短周期的明显振荡。