系统仿真学报 ›› 2015, Vol. 27 ›› Issue (9): 1997-2007.

• 仿真建模与仿真算法及数值仿真 • 上一篇    下一篇

基于改进动态逆的PX4四旋翼三维轨迹跟踪

胡越黎1,2, 蔡伟平1, 杨文荣2   

  1. 1.上海大学机电工程与自动化学院,上海 200072;
    2.上海大学微电子研究与开发中心,上海 200072
  • 收稿日期:2015-05-15 修回日期:2015-07-10 出版日期:2015-09-08 发布日期:2020-08-07

3D Trajectory Tracking of PX4 Quadrotor Based on Improved Dynamic Inversion

Hu Yueli1,2, Cai Weiping1, Yang Wenrong2   

  1. 1. College of Mechatronic Engineering and Automation, Shanghai University, Shanghai 200072, China;
    2. Microelectronic Research and Development Center, Shanghai University, Shanghai 200072, China
  • Received:2015-05-15 Revised:2015-07-10 Online:2015-09-08 Published:2020-08-07
  • About author:Hu Yueli(1959-), male, Shanghai, China, Ph.D, professor, main research directions: image processing, machine vision, chip system and design, control theory; Cai Weiping(1989-), female, Hubei, China, master graduate student, main research directions: embedded system, research and design of control system; Yang Wenrong (1969-), male, Shanghai, China, Ph.D, associate professor, main research directions: mixed signal integrated circuit design.

摘要: 针对四旋翼飞行器欠驱动与姿态角变量间强耦合的问题提出了一种改进动态逆方法,即在系统快变量环路中引入模型参考自适应与动态逆相结合的方法。通过建立四旋翼动力学及电机模型推导出姿态角与位置控制律。对该改进方案进行MATLAB仿真分析,与常规动态逆进行比较,并在负载减少10%情况下跟踪给定轨迹,两种方法仿真实验结果表明,改进后的控制结构能较快适应外界干扰及负载的变化,具有更精确的路径跟踪性能。

关键词: 四旋翼飞行器, 轨迹跟踪, 动态逆, 模型参考自适应

Abstract: An improved dynamic inversion method was proposed for the underactuation and strong coupling in attitude variables of the quadrotors, namely, combining model reference adaptive control (MRAC) with dynamic inversion in the fast variable loop in the system. Through the establishment of dynamic model of the quadrotor and motor model, the control law of the attitude angle and position was deduced. The MATLAB simulation for the scheme was analysed and compared with conventional dynamic inversion, and also simulated in the situation that tracking a given tracjectory with a 10% weight reduction from it's load. Simulation with respect to both scheme show that the improved control structure can quickly adapt to external disturbance and mass change and have higher precision tracking performance than conventional ones.

Key words: quadrotor, trajectory tracking, dynamic inversion, MRAC

中图分类号: