摘要

根据刚体动力学原理,建立了四旋翼飞行器的动力学模型,利用捷联惯导和GPS组合作为四旋翼飞行器的导航系统,采用方向余弦矩阵的变换方法,实现了对飞行器的姿态解算;采用卡尔曼滤波算法实现姿态角信号的校正,实现了四旋翼飞行器的导航;采用基于PID算法的悬停状态的控制策略,实现了四旋翼飞行器的垂直起降和稳定的悬停.