X型四旋翼无人机建模及四元数控制(共6页).doc

《X型四旋翼无人机建模及四元数控制(共6页).doc》由会员分享，可在线阅读，更多相关《X型四旋翼无人机建模及四元数控制(共6页).doc（6页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、精选优质文档-倾情为你奉上X型四旋翼无人机建模及四元数控制摘要：首先对X型四旋翼无人机做了合理假设以及受力分析，推导并建立了X型四旋翼无人机全面的动力学数学模型，考虑了无人机平动、转动空气阻力，并且将转子、螺旋桨和机体看成多刚体系统。在机体坐标系下推导了电动机转子动力学方程。在Solidworks软件中，建立了无人机实物模型以获得无人机惯性参数。采用四元数进行姿态解算从而避免产生奇点。直接以四元数作为反馈控制量，设计出多通道双回路矢量PD控制系统。最后以Matlab/Simulink为平台，分别对四元数反馈控系统和欧拉角反馈控制系统进行对比控制仿真。从仿真结果来看，这两种反馈模式都能对无人机模

2、型进行位置、姿态跟踪等控制，但是四元数反馈控制系统具有过渡时间短、计算量少以及无奇点产生的优点。关键词：X型四旋翼；多刚体系统；四元数；PD；中图分类号：TP391.9 文献标识码：AModeling and Quaterion Control of a X-Type QuadrotorAbstract: A comprehensive kinetic model of X-type quadrotor is established and simulated, the model treats rotors, propellers and the aircraft body as a mul

3、ti-rigid-body system. To avoid appearing singularity using quaternion for attitude calculation. A multi-channel-double-loop vector PD flight controller based on quaternion feedback is designed. The close-loop system is simulated on Matlab/Simulink, the inertial parameters are extracted from Solidwor

4、ks design data. Comparison of simulation results between quaternion feedback controller and euler feedback controller are made, shorter transition time, less calculation and non-singularity is observed during simulation.Key words: X-type quadrotor; multi-rigid-body system; quaternion; PD;专心-专注-专业引言目

5、前国内外学者基于所建立的十字型微小型四旋翼无人机数学模型1-10，提出了多种控制算法，做出了多种尝试。主要的控制算法有：经典PID23、非线性PID4-6、自抗扰控制7、模糊控制89、鲁棒控制10等。在缩短系统响应时间，提高系统稳定性等方面取得了相应的成果。精确地四旋翼无人机数学模型对控制算法实际应用具有重大的指导意义。然而在对无人机建模时，一些文献忽略飞行过程中空气阻力的影响13579；另一些文献则认为在小角度情况下认为欧拉角速度等于机体角速度24。而最主要的是，大多数文献将无人机看成完全对称的单刚体并且没有考虑电机角加速度的影响1-12，这种对称简化弱化了无人机三维转动之间的耦合以及螺旋桨

6、转子的陀螺效应；从而降低了控制器的控制性能。本文将机体、电机转子以及螺旋桨看成多刚体系统，在SolidWorks软件中建立X型四旋翼无人机三维实物模型，并从中获取其惯性参数。从刚体动力学原理出发建立了较为全面的无人机数学模型。用四元数进行姿态解算，设计了四元数反馈模式矢量PD控制系统。成功实现对四旋翼无人机的位置、姿态的控制。1 四旋翼无人机动力模型1.1 模型说明图1 无人机结构简图及受力分析如图1四旋翼无人机结构简图。首先我们做如下假设与说明： 取地面坐标系为惯性坐标系i(以下简称i系)，重力加速度g取固定值；机体坐标系b(以下简称b系)固连于机身，重心与原点重合3； 不考虑地球自转及公转

7、影响，不考虑螺旋桨挥舞特性； 机体和无刷电机转子视为刚体，螺旋桨视为与实际质量相等的均质等厚度圆盘刚体。在b系中，每个电机转子和螺旋桨看成一个整体，对其质心的惯量张量为Icr，机体对原点的总惯量张量为I； 考虑到i系下机体迎风面的不对称性对空气阻力的影响。假设平动空气阻力大小与b系中速度vb成正比；转动空气阻力矩大小与b系中机体角速度b成正比； 姿态四元数q=(q0 q1 q2 q3)，则从b系到i系的坐标转换矩阵为：1.2 受力分析如图1所示，四旋翼无人机受力分析： 重力：Mg，方向沿zi轴负方向； 平动空气阻力：f = tvb,t为平动空气阻力系数，方向与vb方向相反； 转动空气阻力矩：

8、= r b, r为转动空气阻力系数，方向与b方向相反； 螺旋桨推力：Ftj,其大小Ftj = kj2 ,j=1,2,3,4；k为螺旋桨升力系数，方向沿zb轴正方向3 7； 螺旋桨阻力矩：dj，其大小dj =j2 ,j=1,2,3,4；为螺旋桨阻力系数，方向与螺旋桨角速度方向相反3 7。1.3 动力学方程 由牛顿第二定律可得平动方程： (1)式中，表示b系下速度，表示b系下的平动空气阻力大小，表示i系下的平动空气阻力大小。 由角动量定理及哥氏定理有转动方程： (2)合外力矩： (3) 其中： 电机角速度矢量：1.4 无刷电机方程无刷电机电压方程参考文献3： (4)以螺旋桨转子为研究对象。螺旋桨转

9、子以角速度绕其质心做定点转动。由角动量定理及哥氏定理有： (5)由于。等式(8)左边第二项的第三个分量为0。取出上式第三个分量： (6)其中：为电磁转矩，为粘滞摩擦阻力矩。 根据以上数学公式在Matlab/Simulink中建立X型四旋翼无人机动力模型和无刷电机模型。1.5 模型参数图2 无人机Solidworks模型为了获得无人机的惯性参数，在Solidworks软件中建立X型四旋翼无人机实物模型，如图2所示。无人机惯性参数由Solidworks软件计算得到，其他参数参考文献1-12取合理值，如表1。表1 模型参数参数单位数值gm.s-29.81KV.s0.002LH0.001Res0.1f

10、mN.s.m-12.010-5Jkg.m21.68610-4ktN.s23.510-5N.m.s28.010-7tN.s.m-1diag1 1 1.2rN.m.sdiag0.3 0.3 0.2Mkg1.849Ikg.m210-2 4.34 -0.0215 0.11; -0.0215 5.344 0.0571; 0.11 0.0571 8.657Icrkg.m2diag10-5 9.5 9.5 16.862 控制系统设计对无人机姿态的控制一般是以欧拉角作为反馈量，将三个欧拉角分开单独控制2-10。这种方式比较直观，也最为常用。另外一种方式是，以旋转矩阵、罗德里格斯参数或四元数作为反馈量1112。

11、此种控制方式的控制量以矢量形式呈现。第一种控制方式直接用经典 PID控制器。第二种控制方式中的四元数反馈，参数个数少，计算简单，无奇点产生。以下是四元数反馈模式矢量PD控制系统设计过程。2.1 四元数姿态控制设期望姿态的坐标系为d系。姿态控制的目的就是让b系跟踪d系。四元数q表示i系到b系的转动；四元数qd表示i系到d系的转动；误差四元数qe表示b系到d系的转动。根据四元数转动的合成公式有：。其中q、qd在i系中表示，qe在b系中表示，q、qd、qe均为规范化四元数。则，*表示共轭运算。其矢量部分vet(qe)反映了从b系直接转动到d系所需要的力矩大小及其方向。为了解决四元数的双值性引起的退绕

12、问题，不直接以vet(qe)做反馈误差，而以sgn(scal(qe)vet(qe)作为反馈误差。sgn(.)为符号函数，scal(.)取四元数标量部分。类似以PID控制器求出姿态角速度误差：由得，因为是d系中的映像，需要转换到b系统才能与相减。所以：。图3 无人机姿态控制系统框图取如下控制律： (6)线性转换是将控制量f, M转换为电压u： (7)其中C为适当常数。2.2 四元数位置跟踪控制无人机位置跟踪控制系统框图如图4。此时推力控制律改为： (8)其中：,。 无人机平动加速度的大小与方向主要由推力f决定。f的方向适中始终沿着b系z轴正方向。可用位置误差矢量表示期望加速度方向，即期望zb轴方

13、向。四元数qc表示zi轴到zb转动。取单位向量, 则： 再加上偏角四元数限制，根据转动合成有。将其送入姿态控制器。组成两级多回路位置跟踪控制系统。图4 无人机位置跟踪控制系统框图3 仿真结果分析在Matlab/Simulink中将四元数反馈控制系统加入到无人机模型中。四元数反馈用下标q表示。作为对比同时建立欧拉角反馈的经典PID系统，用下标e表示。仿真步长取0.001s，求解方法采用ode4(Runge-Kutta)。控制器的参数以超调尽量小、兼顾缩短响应时间为原则，采取试凑法确定。分别对x，y，z进行幅值为1m的阶跃跟踪；对偏航角、俯仰角、滚转角进行幅值为30的阶跃跟踪。仿真结果如图5 8：

14、图4 z阶跃跟踪对比曲线图5 x,y阶跃跟踪对比曲线图6 阶跃跟踪对比曲线图7 ,阶跃跟踪对比曲线由图58可知，四元数反馈模型矢量PD控制系统和欧拉角反馈的经典PID控制系统，都能够对无人机位置、姿态角进行有效的阶跃跟踪控制。但四元数反馈模式矢量PD控制系统，过渡时间更短。而且以四元数作为反馈控制量，避开了三角函数的计算，计算量少。也避免了在大姿态角时奇点的产生。4 结论本文建立了较为全面的X型四旋翼无人机多刚体动力学模型。根据X型四旋翼飞行控制特点，设计了四元数反馈模式矢量PD控制系统。通过Solidworks软件获取无人机模型的惯性参数。在Matlab/Simulink平台上进行仿真，通过

15、与欧拉角反馈模式的经典PID控制系统的仿真对比得出：四元数反馈模式矢量PD控制系统对无人机阶跃跟踪具有过渡时间更短，计算量少，无奇点产生的优点。文中建立的多刚体的无人机全面数学模型，更符合实际情况。为将来控制算法研究提供了可靠的理论模型。在有外界干扰以及无人机自身参数不确定的情况下，如何提高控制算法的鲁棒性，将是未来主要的工作。 参考文献：1 Fernando H.C.T.E, De Silva A.T.A, De Zoysa M.D.C, et al. Modelling,Simulation and Implementation of a Quadrotor UAVC. in Procee

16、dings of the IEEE 8th International Conference on Industrial and Information Systems, ICIIS, Aug.18-20,2013, Sri Lanka, pp. 207-212.2 Atheer L.Salih, M.Moghavvemi, Haider A.F. Mohamed, et al. Modelling and PID Controller Design for a Quadrotor Unmanned Air VehicleC. in Proceedings of the IEEE Intern

17、ational Conference on Automation Quality and Testing Robotics (AQTR), 2010, pp. 1-5.3 庞庆霈.四旋翼飞行器设计与稳定控制研究D.北京：中国科技大学，2011.5.4 Pisan MOONUMCA, Yoshio YAMAMOTO, Nattawoot DEPAIWA. Adaptive PID for Controlling a Quadrotor in a Virtual Outdoor Scenario: Simulation StudyC. In Proceedings of the IEEE Inte

18、rnational Conference on Mechatronics and Automantion, Takamatsu, Japan, August 2013, pp.1080-1086.5 Iman Sadeghzadeh，Ankit Mehta,Abbas Chamseddine,et al.ACTIVE FAULT TOLERANT CONTROL OF A QUADROTOR UAV BASED ON GAINSCHEDULEDC. in Proceedings of the IEEE 25th Canadian Conference on Electrical and Com

19、puter Engineering, 2012, pp.1-4.6 李一波，宋述锡.基于模糊自整定PID四旋翼无人机悬停控制J.控制工程，2013.9, 20(5):910-914.7 聂博文.微小型四旋翼无人直升机建模及控制算法研究D长沙：国防科技大学，2006.11.8 Mohammad Reza Mehranpour, Omid Emamgholi, Alireza Mohammad Shahri, et al. A New Fuzzy Adaptive Control for a Quadrotor Flying RobotC. in Proceedings of 13th Irani

20、an Conference on Fuzzy Systems (IFSC), 2013, pp.1-5.9 Soroush Sheikhpour, Saeed Bagheri Shouraki. A Model-Based Fuzzy Controller Using the Parellel Distributed Compensation Method for Quadrotor Attitude StabilizationC. in Proceedings of the 21st Iranian Conference on Electrical Engineering (ICEE), 2

21、013, pp.1-6.10 Angelica Torres Gaitan, Yolanda Bolea. Modeling and Robust Attidue Control of a Quadrotor SystemC. in Proceedings of the 10th Internatonal Conference on Electrical Engineering, Computing Science and Automatic Control (CCE), Mexico City,Mexico, September 2013, pp.8-12.11 Chaturvedi,N.A

22、, Sanyal,A.K, McClamroch,N.H.Rigid-Body Attitude ControlC. in Proceedings of IEEE CONTROL SYSTEMS MAGAZINE,JUNE 2011,pp.30-51.12 Taeyoung Lee*, Melvin Leok, N.Hattis McClamroch. Geometric tracking control of a quadrotor UAV on SE(3)C. in Proceedings of IEEE Conference on Decision and control, December 2011,pp.5020-5425.