空靶固定航路跟踪算法设计与实现

针对控制空中靶标沿给定顺序衔接直线段轨迹供靶飞行问题,提出一种跟踪预置顺序航路点的导航控制算法。该算法利用最大侧向可用过载确定空靶最小转弯半径,推算空靶前向探测距离,提取空靶速度偏差角和航线偏差角并输出至PID飞控系统,使空靶沿预定轨迹飞行的同时高度及倾斜保持稳定。某型飞控系统数字仿真结果表明本算法能很好地控制空靶跟踪单调顺时针或单调逆时针衔接的预置航迹。