四旋翼飞行器串级PID控制设计与实现

针对四旋翼飞行器姿态与高度控制问题进行了分析,设计了串级PID姿态和高度控制器。以功能强大的STM32F407芯片作处理器,由MPU6050测量模块、磁力计、气压计和超声波模块进行姿态角度的检测与高度测量,结合四元数姿态表示方法,以多种传感器数据进行姿态解算,提高了测量精度;姿态与高度控制都使用串级控制算法,由于增加了内环角速度和高度速度的控制,提高了系统的抗干扰能力。最后根据MATLAB仿真对比实验和飞行实验平台验证,结果表明,所设计的控制器不仅提高了系统的抗干扰能力而且提高了系统的控制精度,具有较好的飞行控制效果。