一种基于非线性制导的四旋翼飞行器轨迹跟踪控制方法

摘要

本发明提供一种基于非线性制导的四旋翼飞行器轨迹跟踪控制方法，属于飞行器控制技术领域。本发明首先对四旋翼飞行器建立直线路径坐标系、圆弧路径极坐标系以及惯性坐标系；然后计算四旋翼飞行器跟踪轨迹所需的高度、期望的航向角、期望的俯仰角、期望的侧向加速度；四旋翼飞行器的高度控制器获取跟踪轨迹所需的高度，姿态角控制器获取期望航向角，俯仰角控制器获取期望的俯仰角，滚转角控制器获取期望的侧向加速度，最后四旋翼飞行器在高度控制器、姿态角控制器、俯仰角控制器以及滚转角控制器的控制下按照预定轨迹飞行。本发明解决了现有四旋翼飞行器跟踪控制无法保证匀速飞行、响应延时大的问题。本发明可用于四旋翼飞行器轨迹跟踪控制。