发 帖  
[经验] 四轴无人机的结构与基本飞行原理和双闭环PID控制解读
2018-7-14 12:26:59  827 无人机 PID
收藏 0 收藏 推荐 0 推荐
分享
四轴飞行器是微型飞行器的其中一种,相对于固定翼飞行器,它的方向控制灵活、抗干扰能力强、飞行稳定,能够携带一定的负载和有悬停功能,因此能够很好地进行空中拍摄、监视、侦查等功能,在军事和民用上具备广泛的运用前景。 四轴飞行器关键技术在于控制策略。由于智能控制算法在运行复杂的浮点型运算以及矩阵运算时,微处理器计算能力受限,难以达到飞行控制实时性的要求;而PID控制简单,易于实现,且技术成熟,因此目前主流的控制策略主要是围绕传统的PID控制展开。

1 四轴飞行器的结构与基本飞行原理
四轴飞行器结构主要由主控板和呈十字交叉结构的4个电子调速器、电机、旋浆组成,电机由电子调速器控制,主控板主要负责解算当前飞行姿态、控制电调等功能。 以十字飞行模式为例,l号旋翼为头,1、3号旋翼逆时针旋转,2、4号旋翼顺时针旋转,如图1所示。                  
图1 四轴飞行器结构图

参照飞行状态表1变化电机转速,由于四个电机转速不同,使其与水平面倾斜一定角度,如图l所示。四个电机产生的合力分解为向上的升力与前向分力。当重力与升力相等时,前向分力驱动四轴飞行器向倾斜角度的方向水平飞行。空间三轴角度欧拉角分为仰俯角、横滚角、航向角:倾斜角是仰俯角时,向前、向后飞行;倾斜角是横滚角时,向左、向右飞行;而倾斜航向角时,向左、右旋转运动,左(右)旋转是由于顺时针两电机产生的反扭矩之和与逆时针两电机产生的反扭矩之和不等,即不能相互抵消,机身便在反扭矩作用下绕z轴自旋转。


                  

2 姿态解算
四轴飞行器运用姿态解算计算出空间三轴欧拉角。结构框架如图2所示,陀螺仪采样三轴角速度值,加速度传感器采样三轴加速度值,而磁力传感器采样得到三轴地磁场值,将陀螺仪、加速度传感器、磁力传感器采样后的数据进行标定、滤波、校正后得到三轴欧拉角度,其中陀螺仪和加速度传感器选用MPU6050芯片,磁力传感器选用HMC5883L芯片,采用IIC总线与主控板通信。                  
图2 姿态解算结构图

由于传感器存在器件误差,因此在使用前需要标定。陀螺仪在静止时,角速度为0;但实际情况由于器件误差并不为0,因此可在静止时采样500次数据,再求平均,得出偏移量,标定陀螺仪数据;加速度传感器可依据在静止时,三轴重力加速度平方和的开方为重力加速度的标定方程,利用最小二乘法求出标定偏移值和误差值进行标定。而磁力传感器校正,可将器件静置于桌面旋转一周找出最小值和最大值,通过电子罗盘校正计算公式计算出标定偏移值和误差值。 由于陀螺仪长时间采集角速度会有飘移,因此需要使用加速度传感器的值与磁力传感器的值进行校正。将加速度的测量矢量和磁场的测量矢量与参考矢量做叉积后相加

                  

式(1)中:ex、ey、ez为两叉积之和,ax、ay、az为加速度的测量矢量,mx、my、mz为磁场的测量矢量,axref、ayref、azref为加速度的参考矢量,mxref、myref、mzref为磁场的参考矢量,参考矢量是通过实时四元数值与本次测量值计算出来。 再将叉积修正角速度漂移值:                  式(2)中ωx(t)、ωy(t)、ωz(t)为角速度,kpex(t)为比例项修正,
                  为积分修正项。 将校正后的角速度通过二阶毕卡算法转化为四元数,公式如式(3)。                  

3 高度计算
高度计算是通过气压传感器采集的大气压值计算出来,将气压传感器采集值进行校正后,在通过温度二阶补偿,得到准确的大气压值,最后经过气压转换为高度公式                  式(6)中Altitude为计算出来的实际高度,CurrentPressure为当前气压值,StartPressure为起飞之前气压值。气压传感器选用MS5611芯片,其中集成了温度传感器和气压传感器,采用IIC总线与主控板通信。

4 PID控制

4.1 双闭环PID控制
当四轴飞行器正常飞行时,突遇外力(风等)或磁场干扰,使加速度传感器或磁力传感器采集数据失真,造成姿态解算出来的欧拉角错误,只用角度单环情况下,使系统很难稳定运行,因此可以加入角速度作为内环,角速度由陀螺仪采集数据输出,采集值一般不存在受外界影响情况,抗干扰能力强,并且角速度变化灵敏,当受外界干扰时,回复迅速;同理,高度环中气压传感器同样也会受到外界干扰,引入z轴加速度环可有效避免外界干扰造成的影响,增强了系统的鲁棒性。 四轴飞行器双闭环PID控制,如图3、图4所示。角度作为外环,角速度作为内环,进行姿态PID控制;当需要定高时,高度作为外环,z轴加速度作为内环,进行高度PID控制。其中,PID输出为油门值,油门给定电子调速器值,电子调速器控制电机使空间三轴欧拉角和高度变化。

                  
图3姿态PID控制总体流程图
                  
图4高度PID控制总体流程图
PID控制算法采用位置式数字PID控制:

                  

式(7)中u(t)为PID输出值,e(t)为期望值与实际值之差,                  为积分量,                  为微分量,kp,、ki、kd。为比例、积分、微分系数。 在将积分量,微分量离散化得到PID计算公式                  

式(8)中T为更新时间。 基于公式(8),姿态PID控制算法                  

式(9)为角度环PID计算公式,(10)为角速度环PID计算公式。AngelPIDOut(t)为角度环PID输出,AngelRatePIDOut(t)为角速度环PID输出,e(t)=期望角度一实际角度,e'(t)=AngelPIDOut(t) - 实际角速度。 同理高度PID控制算法:

                  

式(11)为高度环PID计算公式,公式(12)为加速度环PID计算公式,AltitudePIDOut(t)为高度环PID输出,AcceleratePIDOut(t)为加速度环PID输出。e(t)=期望高度一实际高度,e'(t)=AltitudePIDOut(t) - (z轴加速度 - 重力加速度值)。

4.2 油门输出计算
PID输出值先经过限幅处理,再输出给油门,防止某些时刻输出油门值过大,造成过冲,使系统难以稳定,公式如下 AngelOut=AngelPIDOut(t)(限制范围 - 100到100) (13) AltitudeOut=AcceleratePIDOut(t)(限制范围 - 10到10) (14) 式中AngelOut。为欧拉角输出值,AltitudeOut为高度输出值。 最后经过十字飞行模式油门输出公式,计算出4个电机输出油门                  

式(15)中throttlelOut到throttle4Out为油门1到油门4输出值,依据公式(13)输出的AngelOut分为三轴角度:pitchOut为仰俯角输出值,rollOut为横滚角输出值,yawOut为航向角输出值。


4.3 油门补偿
以十字飞行模式为例,PID控制条件为线性环境,而给出的油门值与转速的关系为非线性,且两对向电机再同一油门下转速存在差异。运用光电传感器测出不同油门量对应的转速,通过matlab软件绘制出该曲线,其中一对向电机油门与转速的关系如图5所示,两电机在相同油门下转速存在差异且不平行,因此将油门曲线分段,并通过计算公式 补偿油门值 =α(实际油门值 - β) (16) 进行油门补偿,式(16)中α、β为补偿偏移系数,得出曲线如图5(b)所示。

                  
图5 油门 - 转速曲线图


5 测试
本次测试姿态解算更新周期T ≈ 4 mS,PID控制更新周期T ≈ 10 ms,期望值为水平0度。将四轴飞行器控制仰俯角的一对电机固定住,另一对边能自由旋转,即能改变横滚角度,如图6所示。将横滚角倾斜到 - 70°,遥控器油门迅速推到1400,平衡后如图6所示。                  
图6 姿态PID控制测试
将四轴飞行器采集的欧拉角值通过无线模块NRF24L01发送到PC机上,接收的数据显示到上位机进行分析。上位机显示横滚角波形如图7所示,波形图横坐标单位为10 ms,纵坐标单位为度。                  
图 7双闭环PID控制横滚角波形图
由图7可知,横滚角波形经过一大波一小波震荡后近似归为期望值零点,且超调量较小,系统很快进入稳定状态。 其他欧拉角测试结果类似。 在加入双闭环高度PID控制,四轴飞行器在室外飞行效果如图8所示,可以看出飞行器飞行稳定,达到设计要求。

                  
图8 室外飞行测试

6 结论
主要研究了基于四轴飞行器的双闭环PID控制算法。在姿态PID控制和高度PID控制中分别增加了内环角速度环和加速度环,不仅抗干扰能力强,并且回复迅速,增强了系统的鲁棒性。
2018-7-14 12:26:59   评论
2 个讨论
没有接触过,学习了
2018-7-14 12:46:48 评论

举报

学习了                                                     
2018-7-25 21:22:48 评论

举报

高级模式
您需要登录后才可以回帖 登录 | 注册

发表新帖
关闭

站长推荐 上一条 /9 下一条

快速回复 返回顶部 返回列表
-

推荐专区

技术干货集中营

专家问答

用户帮助┃咨询与建议┃版主议事

工程师杂谈

项目|工程师创意

招聘|求职}工程师职场

论坛电子赛事

社区活动专版

发烧友活动

-

嵌入式论坛

ARM技术论坛

Linux论坛

单片机/MCU论坛

MSP430技术论坛

FPGA|CPLD|ASIC论坛

STM32/STM8技术论坛

NXP MCU 技术论坛

DSP论坛

嵌入式系统论坛

-

电源技术论坛

电源技术论坛

无线充电技术

-

硬件设计论坛

电路设计论坛

电子元器件论坛

传感技术

总线技术|接口技术

-

测试测量论坛

LabVIEW论坛

Matlab论坛

测试测量技术专区

-

EDA设计论坛

multisim论坛

PCB设计论坛

PADS技术论坛

Protel|AD|DXP论坛

Allegro论坛

proteus论坛|仿真论坛

Orcad论坛

-

综合技术与应用

电机控制

工程资源中心

汽车电子技术论坛

医疗电子论坛

-

开源硬件

-

无线通信论坛

物联网技术

天线|RF射频|微波|雷达技术

-

IC设计论坛

芯片测试与失效分析

Analog/RF IC设计

设计与制造封装测试

-

厂商专区

TI论坛

TI Deyisupport社区

-

检测技术与质量

电磁兼容(EMC)设计与整改

安规知识论坛

检测与认证

-

消费电子论坛

手机技术论坛

平板电脑/mid论坛

音视/视频/机顶盒论坛

-

电子论坛综合区

聚丰众筹官方社区

新人报道区

聚丰供应链

-

论坛服务区

-

高校联盟

深圳大学电子协会

西藏民族学院电子设计协会

西安电子科技大学西电实验室

桂林电子科技大学机电工程协会

鉴鹰电子科技协会

广东海洋大学科技创新协会

福建农林大学电子科技创新协会

湖北理工学院电子技术协会

深圳职业技术学院电子精英训练营

浙江科技学院Zuster

湘潭大学电子科技协会

青岛理工大学琴岛学院天宏开发团队

河南理工大学大学生电器开发部

广西科技大学电气信息创新协会

浙江机电职业技术学院电子制作协会

郑州大学西亚斯国际学院爱电工作室

新乡学院电子创新工作室

洛阳理工学院SmartTeam

苏州工业职业技术学院创新工作室

浙江工业大学GC315团队

杭电-微芯大学生科技创新孵化器

西安工业大学电信科协

商洛学院科技创新协会

大连民族学院创新工作室

南京信息工程大学帆木工作室

-

供求信息发布

方案交易

供需广告

芯片求购|供应发布区