針對四軸飛行器飛行性能不穩定和慣性測量單元(IMU)易受干擾、存在漂移等問題,利用慣性傳感器MPU6050采集實時數據,以經典互補濾波為基礎,提出一種可以自適應補償系數的互補濾波算法,該算法在低通濾波環節加入PI控制器,依據陀螺儀測得的角速度實時調節PI控制器補償系數。飛行器姿態控制系統采用雙閉環PID控制方法,姿態解算的歐拉角作為系統外環,陀螺儀角速度作為系統內環。最后,搭建以NI my RIO為核心控制器的四軸飛行器,通過Lab VIEW實現算法和仿真,實驗結果表明,自適應互補濾波算法可以準確解算姿態信息,雙閉環PID控制超調量小、反應靈敏,控制系統基本滿足飛行要求。
