四旋翼无人机建模及其PID控制律设计

《四旋翼无人机建模及其PID控制律设计》由会员分享，可在线阅读，更多相关《四旋翼无人机建模及其PID控制律设计（6页珍藏版）》请在装配图网上搜索。

1、四旋翼无人机建模及其 PID 控制律设计 时间：2012-10-27 来源：现代电子技术 作者：吴成富，刘小齐，袁 旭 关键字：PID 无人机建模 摘要：文中对四旋翼无人机进行建模与控制。 在建模时采用机理建模和实验测 试相结合的方法，尤其是对电机和螺旋桨进行了详细的建模。首先对所建的模型 应用PID进行了姿态角的控制。在此基础上又对各 个方向上的速度进行了 PlD 控制。然后在四旋翼飞机重心进行偏移的情况下进行PID控制，仿真结果表明 PID 控制律能有效的控制四旋翼无人机在重心偏移情 况下的姿态角和速度。最 后为了方便控制加入了控制逻辑。 关键词：四旋翼；建模；PID；控制；重心偏移

2、；控制逻辑 四旋翼无人机是一种具有 4 个旋翼的飞行器，有 X 型分布和十字型分布 2 种。文中采用的是 X 型分布的四旋翼，四旋翼无人机只能通过改变旋翼的转速来 实现各种运 动。国外对四旋翼无人直升机的研究非常活跃。加拿大雷克海德大 学的 Tavebi 和 McGilvrav 证明了使用四旋翼设计可以实现稳定的飞行。澳大利 亚卧 龙岗大学的 McKerrow 对 Dragantlyer 进行了精确的建模。目前国外四旋翼 无人直升机的研究工作主要集中在以下3个方面：基于惯导的自主飞 行、基于 视觉的自主飞行和自主飞行器系统。而国内对四旋翼的研究主要有：西北工业大 学、国防科技大学、南京航天航

3、空大学、中国空空导弹研究院第27所、吉 林大 学、北京科技大学和哈工大等。大多数的研究方式是理论分析和计算机仿真，提 出了很多控制算法。例如，针对无人机模型的不确定性和非线性设计的 DI／ QFT（动态逆/定量反馈理论）控制器，国防科技大学提出的自抗扰控制器可以对 小型四旋翼直升机实现姿态增稳控制，还有一些经典的方法比如PID控 制等， 但是都不能很好地控制四旋翼速度较大的情况。本文对四旋翼无人机设计了另外 一种不同的控制方法即四旋翼的四元数控制律设计，仿真结果表明这种控制方 法是一种有效的方法。尤其是对飞机的飞行速度较大的情况，其能稳定地控制四 旋翼达到预期的效果。 1 四旋翼的模型 文

4、中所研究的四旋翼结构属于X型分布，即螺旋桨Ml和M4与M2和M3关于 X轴对称，螺旋桨Ml和M2与M3和M4关于Y轴对称，如图1所示。对于四旋翼 的模型本文主要根据四旋翼的物理机理进行物理建模，并做以下2条假设。 图I凹旋拋外形乐離图 1) 四旋翼无人机是绝对的刚体，不考虑其结构和弹性形变，而且机体的重心 位置不变，其质量为常数； 2) 假设地面为惯性参考系，即假设地面坐标系为惯性坐标系。 利用电子秤测出各个零部件的质量，利用游标卡尺和直尺测出各个零部件的 尺寸，应用悬吊法测出其机体的重心。立机体坐标系并求出四旋翼的转动惯量， 对于不规 则的物体进行必要的简化和等效，对于螺旋桨

5、的建模忽略了其所受的 空气阻力和侧向力矩，只考虑螺旋桨的升力和扭矩。 1．1 四旋翼动力学方程 在机体坐标系下的受力与力矩关系式： F7 =m*(Vh+w*kb) (1) F. X 閘F M 二严IF+IF*(/*W) (2) ./V : * 1 sinZ*taiw^ cosZ*tariff \P 0 COfM^ -sin^ if 0 g [皆 C(is4> T」 ．2 四旋翼无人机动力系统建模 1. 2・1电机动力学模型 Q二 KJ (4) VTtJg (5) ]^Q-Ql ⑹ 有武和《4)

6、可钳； 片wK卜Q、 <7) 由式(门和试(5〉町得匚丿则皿“』虬仇 (8) 其中，JTM为电机的转动惯量，QL为负载扭矩，Q是电机扭矩.V是电机两 端电压，I是电机通过的电流，3是电机转动角速率，Kq, Ra和Ke是电机的特 定常数，Kq将电流和扭矩关联，Ra是电机转子的总阻抗，Ke将电机转速关联到 电动势。 1．2．2 螺旋桨的模型 文中只考虑螺旋桨沿构造旋转轴的升力T和扭矩Q,忽略其受到的阻力和侧 向力矩。这些力或力矩均与旋翼转速的平方(Q 2)成一定比例关系 T=^-pACTR^ (9) (10) 其中，CT, CQ分别为旋翼的拉力系数、阻力系数、扭矩系数和侧倾力矩系 数

7、，p为空气密度，R为桨叶半径，A=n R2浆盘面积。 2 四旋翼无人机 PID 控制律设计 2. 1四旋翼无人机PID控制结构 文中的主要目的是基于PID的四旋翼控制问题研究，其最终目标是要验证 PID 能有效的控制四旋翼在没有重心偏移和有重心偏移下情况下的姿态角和速 度。故而首先要对所用的四旋翼飞机进行建模，然后进行控制器的设计，最后进 行仿真验证。 2. 2四旋翼无人机PID控制参数和PID控制器结构图 3 实验结果与分析 3．1 在没有重心偏移情况下的控制结果 在没有重心偏移情况下俯仰角和滚转一起控制5度的结果表明pid能有效的 控制控制量在很快的时间内达到

8、预期的效果。 在姿态角控制基础上近一步加入速度控制，而且速度控制只是简单的比例控 制，实验结果很好。 3．2 重心偏移条件下的控制结果 为了检验PID控制效果，文中对四旋翼的重心进行了偏移，控制结果表明控 制量的快速性变差，但是控制依然平滑有效。 图5滚转控制曲线 "s 图6 Vx控制曲线 4 控制逻辑 为了方便人能更加简单的控制四旋翼，文中加入了控制逻辑

9、。操作者面北朝 南，飞机机头可以在你前方的任意一个方向，操作者只要按自己的方位进行前后 左右控制。 公式推导：Vxcmd和Vycmd是操作者控制输入。 首先将速度分解到飞机所在的地轴系下： V^V^CG^I psippsip) ⑴) 人r==PE性Egip)卡丫血恤试网p} 门2) 然疥将連度转换到机体轴上； (psi)+V^infpsi / (⑶ V^-V^in( PXHFjA：昭(p£i) (14) 最后将速度送入控制器进行控制。 5 结论 PID 控制器能有效的控制四旋翼无人机的姿态角和速度，而且当四旋翼的重 心发生偏移时，虽然控制的快速性有所下降，但控制效果依然满足要求。