四旋翼飞行器控制系统设计

  • 格式:doc
  • 大小:15.00 KB
  • 文档页数:3

龙源期刊网 http://www.qikan.com.cn
四旋翼飞行器控制系统设计
作者:吕国强 郑德峰
来源:《价值工程》2014年第20期

摘要: 本文对四旋翼飞行器的结构及特点进行了简单介绍,研究了基于四元数法的四旋
翼飞行器姿态解算方法,同时对其进行了仿真分析,得出了有益结论,为进一步研究提高提供
参考依据。

Abstract: The structure and characteristics of the four-rotor aircraft were briefly studied in this
paper, and the attitude algorithm method of four-rotor aircraft based on the quaternion is studied,
its simulation analysis is made and useful conclusions are drawn to provide reference for the further
research and improvement.

关键词: 四旋翼飞行器;姿态解算;惯性测量单元;四元数算法
Key words: four-rotor aircraft;attitude algorithm;inertial measurement unit;quaternion
algorithm

中图分类号:V249.1 文献标识码:A 文章编号:1006-4311(2014)20-0213-02
0 引言
在日常生活和工程中,四旋翼飞行器的应用非常广泛,是目前人们研究的热点。本文笔者
分析了四旋翼飞行器的结构和特点,对四旋翼飞行器的姿态解算采用了四元数法,得出了数学
模型,将四旋翼无人飞行器数据代入数学模型,对其进行仿真分析,得出了有益结论。

1 结构和特点分析
四旋翼飞行器飞行的直接动力源采用的是四个旋翼,旋翼对称分布在机体的前后、左右四
个方向,且处于同一高度平面,它的结构和半径都相同,旋翼2和旋翼4顺时针旋转,旋翼1
和旋翼3逆时针旋转,飞行器的支架端对称的安装着四个电机,飞行控制计算机和外部设备安
放在支架中间空间。结构形式如图1所示。

与普通的固定翼飞行器、单旋翼飞行器相比,四旋翼无人飞行器具有机动性强、能源利用
率高、结构设计巧妙、安全性等特点。但其本身也有其不足之处,例如有效载荷较小、续航时
间较短、抗干扰能力不强、精确建模困难等。

2 基于四元数法的四旋翼飞行器姿态解算
2.1 四元数定义 通过阅读文献得知,四元数就是由四个元构成的数:
龙源期刊网 http://www.qikan.com.cn
Q(q0,q1,q2,q3)=q0+q1i+q2j+q3k (1)
式中,q0,q1,q2,q3是实数,i、j、k既是互相正交的单位向量,又是虚单位■。
2.2 四元数的大小范数 四元数的大小用四元数的范数来表示:■=q■■+q■■+q■■+q■■
(2)

若■=1,则Q称为规范化四元数。
2.3 四旋翼飞行器的数学模型 采用空间矢量变换方法对四旋翼飞行器的俯仰(pitch)、偏
航(yaw)、横滚(roll)等姿态信息进行描述。由于四旋翼飞行器飞行高度低、行速度小,因
此可以忽略地球自转等因素的影响。在空间范围内仅定义2个不同的三维坐标系,分别为参考
坐标系、载体坐标系。参考坐标系又称之为导航坐标系,载体的旋转中心为坐标原点;飞行器
载体的中心为载体坐标系原点。

本文采用方向余弦矩阵进行表述,其形式如式(3)所示:
R■■=r■ r■ r■r■ r■ r■r■ r■ r■=
cosθcosψ -cos?准sinψ+sin?准sinθcosψ sin?准sinψ+cos?准sinθsinψcosθsinψ cos?准
cosψ+sin?准sinθsinψ -sin?准cosψ+cos?准sinθsinψ -sinθ sin?准cosθ cos?准cosθ(3)

式中,ψ为偏航角、?准为横滚角、θ为俯仰角,用3个姿态角对飞行器的姿态加以描
述。

在已知初始姿态,也就已知初始四元数的情况下通过式(4)就可实时更新姿态信息。
■■■■■■■■=■0 -ω■ -ω■ -ω■ω■ 0 ω■ ω■ω■ ω■ 0 ω■ω■ ω■ ω■ 0q■q■q■q■ (4)
2.4 仿真图 将某型四旋翼无人飞行器数据代入式(4),在设定已知初始状态下,对其进
行仿真分析,可得到如图2所示的仿真图形,图中波动幅度较大的直线是加速度计直接求出的
角度,平滑的是四元数算法求出的角度。实际应用中该算法可以较准确的求出飞行器的姿态角
度克服震动等干扰。

3 结束语
本文通过四元数法对四旋翼飞行器姿态解算进行建模,并对其数学模型进行仿真,仿真结
果表明:应用四元数法设计的四旋翼飞行器系统满足实际应用稳定性和精度的要求,该飞行器
能够在室内及户外气象条件较好的情况下稳定飞行。

参考文献:
龙源期刊网 http://www.qikan.com.cn
[1]孙书诚,郎朗,陈孟元.模糊自适应PID控制器在交流伺服控制系统中的研究[J].长春工
程学院学报(自然科学版),2012(02).

[2]潘海珠.四旋翼无人机自适应导航控制[J].计算机仿真,2012(05).
[3]李秀英,刘彦博.基于PWM的四旋翼飞行器控制方法[J].吉林大学学报(信息科学
版),2011(05).