本C和H文件实用于四旋翼飞行器的姿态环控制,建议再PID内回路引入阻尼器。如有问题,希望指正!