四旋翼吊挂运输系统动态反馈线性化轨迹控制  

Trajectory Control of Quadrotor With Cable-Suspended Load via Dynamic Feedback Linearization

作　　者：梁晓 胡欲立 LIANG Xiao;HU Yu-Li(School of Marine Science and Technology,Institute of Underwater Vehicle,Northwestern Polytechnical University,Xi'an 710072)

机构地区：[1]西北工业大学航海学院水下航行器研究所,西安710072

出　　处：《自动化学报》2020年第9期1993-2002,共10页Acta Automatica Sinica

摘　　要：三维空间下的四旋翼吊挂运输系统是一种欠驱动、强耦合、多变量的非线性系统.根据系统的动力学特点,将系统分解为双质点系绳连接子系统和四旋翼姿态控制子系统.选择与系统自由度维数相同的广义坐标并基于虚位移原理计算对应的广义力,从而建立系统的拉格朗日动力学方程.利用微分平滑特性证明了运输系统存在平凡零动态,因此可通过动态反馈转化为线性和能控系统.经过2次动态扩展和变量代换,原系统扩展为总相对阶等于系统状态维度的线性能控系统.基于赫尔维茨稳定性判据,设计了跟踪误差指数收敛的动态反馈控制律.该方法可作为一类非线性系统控制器设计的标准方法.最后以三维空间的螺旋曲线及水平面内频率变化的圆周曲线为参考轨迹进行仿真,仿真结果验证了控制系统的有效性.A quadrotor with cable-suspended load in 3-D space is considered,which is underactuated,strongly coupling and nonlinear.According to the dynamic feature,the system is decoupled into quadrotor attitude control subsystem and double points link subsystem.The generalized coordinate with the same dimension of the system freedom is selected and the generalized force is calculated based on the principle of virtual displacement,then the Lagrange dynamic equation of the system is established.The quadrotor-load system is proved to have ordinary zero dynamics based on differentially flat property,so it can be transformed into linear and controllable system by dynamic feedback.After 2 dynamic expansions and variable substitutions,the original system is extended to a linear controllable system whose total relative orders are equal to the system state dimensions.Based on Hurwitz stability criterion,a dynamic feedback controller with exponential convergence of position error is designed.This method can be used as a standard method for a class of nonlinear systems.Finally,the spiral curve in 3-D space and the circular curve in the horizontal plane with varying frequency are taken as the reference trajectory for simulation.Simulation results demonstrate the effectiveness of the proposed method.

关 键 词：四旋翼 运输 零动态 动态反馈 

分 类 号：V249.1[航空宇航科学与技术—飞行器设计]