做四轴也有一段时间了,最近一直在做PID方面的工作。现在四轴基本可以实现室内比较稳定的飞行,操控手感也可以接受。稍后上试飞视频。在此把一些PID方面的经验总结总结和大家分享一下。
首先介绍一下大概的硬件组成:
MCU:Freescale MK60D
传感器(IMU):GY-86模块(MPU6050 + HMC5883L + MS5611)
433MHz数据传输模块
DC-DC可调式开关稳压模块
遥控设备:JR XG7发射机 + JR 611B接收机
机架:普通红白f450机架
电机:朗宇2212kv880高效能电机(黑色)
电调:天行者40A
桨:仿APC1047
电池:DUPU 2200mah 25c
电路很简单用洞洞板搭的简易测试电路。
软件方面最主要的是姿态解算,最终用的是MPU6050的DMP(Digital Motion Process)输出,遥控器控制的目标姿态也是四元数表示的。为了有较好的线性度,将两者的姿态差转换为欧拉角后再进行PID的控制。
下面进入正题。PID算法很大程度上参考了APM(国外成熟开源飞控项目,官网