摘要
研究了小型四旋翼飞行器惯导系统的姿态解算和控制问题.首先,文章采用三阶近似毕卡四元数算法来解决四旋翼飞行器的姿态解算问题,进而将该算法与卡尔曼滤波器相结合,避免了陀螺仪的积分累积误差,有效消除了四旋翼飞行器机体振动引起的传感器测量误差.其次,根据姿态解算得到的姿态角,设计了积分分离PID和串级PID控制器进行姿态控制.最后,将设计的姿态解算算法和姿态控制算法应用到四旋翼飞行器平台上,实现了四旋翼飞行器的姿态控制,验证了文章算法的有效性.
This paper is concerned with the attitude determination and control for a small four-rotor aircraft plant. First, a third-order approximated Peano-Baker Quaternion algorithm is used to solve the attitude determination problem for the aircraft. Then, the algorithm combined with Kalman filter is introduced to avoid accumulated errors of gyroscope and to eliminate the sensor measurement errors induced by the four-rotor aircraft airframe vibration. Second, based on the obtained attitude solution, the integral separating PID and cascaded PID controllers are designed for the attitude control. Finally, a four-rotor aircraft platform is developed, and the effectiveness of designed attitude determination and control algorithms is illustrated by this platform.
作者
叶孝璐
章志诚
俞立
张文安
张丹
YE Xiaolu ZHANG Zhicheng YU Li ZHANG Wen-an ZHANG Dan(College of Information Engineering, Zhejiang University of Technology, Hangzhou 310023)
出处
《系统科学与数学》
CSCD
北大核心
2016年第11期1825-1836,共12页
Journal of Systems Science and Mathematical Sciences
基金
国家自然科学基金(61273117)
浙江省自然科学基金重点项目(LZ15F03003)
浙江省大学生科技创新活动计划(新苗人才计划)(2014R403087)资助课题
