基于STM32的四旋翼飞行控制系统毕业设计 - 图文(9)

2020-04-17 21:21

西华大学毕业设计说明书

图6.10 飞行器万向轮调试

调整PID时遵循以下口诀: 先整定内环,后整定外环。 参数整定找最佳,从小到大顺序查 先是比例后积分,最后再把微分加 曲线振荡很频繁,比例度盘要放大 曲线漂浮绕大湾,比例度盘往小扳 曲线偏离回复慢,积分时间往下降 曲线波动周期长,积分时间再加长 曲线振荡频率快,先把微分降下来 动差大来波动慢。微分时间应加长 理想曲线两个波,前高后低4比1

调整PID参数过程如下:

在串级PID调试中,内环的参数最为关键!理想的内环参数能够很好地跟随打舵(角速度控制模式下的打舵)控制量。具体情况大概是在平衡位置附近(正负30度左右),舵量突加,飞机快速响应;舵量回中,飞机立刻停止运动(几乎没有回弹和震荡)。

为了调节好角速度内环首先改变程序,将角度外环去掉,将打舵量作为角速度内环的期望值(即角速度控制模式)。

1.先调节角速度内环P参数,如果P参数太小,表现是不能修正角速度误差,感觉飞行

第 34 页

西华大学毕业设计说明书 器很“软”倾斜后难以修正,打舵响应也差。如果P参数太大,在平衡位置容易抖动,并且在打舵回中或给干扰(用手突加干扰)时会震荡。合适的P能较好的对打舵进行响应,又不太会震荡,但是舵量回中后会回弹好几下才能停止(没有D)。

2.然后加上角速度内环D参数,D参数可以加快打舵响应,最大的作用是能很好地抑制舵量回中后的震荡,可谓立竿见影。但是过大的D会在横滚俯仰混和控制时表现出来,具体表现是四轴抓在手里推油门会抽搐。

3.加上角速度内环I参数,立马感觉飞行器的调节过程变得柔和了些。I参数表现是:若打舵使得飞机偏离平衡位置,舵量回中后飞机立刻停止转动,若没有I或太小,飞机会由于重力继续转动。

4.第四步是增添角度外环参数P(这里需要修改程序,改为角度作为控制信号)。将外环P加上,打舵会对应到期望的角度。同理,如果P参数太小,打舵不灵敏,P参数太大,打舵回中易震荡。以合适的打舵反应速度为良好的P参数。

5.加上角度外环参数I, 这里参数I的最大作用是修正静态误差,让飞行器在稳定飞行时让机身保持在平衡位置。

至此,在万向轮的模拟调试基本完成,在飞行器试飞过程中,还需要根据飞行器的表现微调PID参数,直到飞行器能够平稳起飞、降落和正常飞行。

第 35 页

西华大学毕业设计说明书

7系统功能、指标参数

7.1系统能实现的功能

经过了长达一周的系统PID参数调试,飞行器可以实现平稳起飞,正常飞行和平稳降落功能。使用上位机发送命令,飞行器接收命令,飞行器可以灵敏地响应。飞行情况如图7.1所示。

图7.1 飞行器飞行情况

7.2系统指标参数

在进行试飞调试前,飞行器在万向轮上模拟调试,得到了一组PID参数,如下表7.1所示。

表7.1 PID万向轮模拟参数

角度PITCH.P\\ROLL.P=35 速度PITCH.P\\ROLL.P=180 速度YAW.P=80 角度PITCH.I\\ROLL.I=5 速度PITCH.I\\ROLL.I=6 速度YAW.I=80 油门值=1350 角度PITCH.D\\ROLL.D=0 速度PITCH.D\\ROLL.D=8 速度YAW.D=0 第 36 页

西华大学毕业设计说明书 从参数表中可以看出,Pitch和Roll的P,I,D三组参数分别相等,这主要是三方面的原因:

1. Pitch和Roll在物理模型上具有相似性。

2. 表中P,I,D参数其实是放大了1000倍,在程序里除以1000后值很小。 3. 在万向轮上只是模拟飞行调试,相等是为了方便观察调试现象。

在试飞期间,导入的是万向轮模拟PID参数,然后在试飞的过程中通过人眼观察飞行器在空中是否能保持平稳,有无大幅度摆动,根据实际情况再微调PID参数值。经过不断修正,整定出一组合理的飞行PID参数,如下表7.2所示。

表7.2 PID飞行参数

角度PITCH.P=50 角度 ROLL.P=48 速度PITCH.P=150 速度 ROLL.P=151 速度YAW.P=80 角度PITCH.I=4 角度 ROLL.I=4 速度PITCH.I=6 速度 ROLL.I=6 速度YAW.I=78 油门值=1250 角度PITCH.D=0 角度 ROLL.D=0 速度PITCH.D=10 速度 ROLL.D=9 速度YAW.D=0

第 37 页

西华大学毕业设计说明书

8结论

8.1

回顾

受限于本人知识水平,本文主要做了:

1.简单分析了四旋翼飞行器的机械结构,并对飞行器的硬件、软件底层做了设计 2.分析对比了两种姿态解算方式,采用了全新的DMP解算方式,相比于其他解算方法,DMP这种解算方式数据同样精确稳定,并且可以配置中断来及时更新飞行姿态数据,这种解算方法可以减轻单片机处理姿态数据的时间,让单片机可以处理其他的任务。

3.分别阐述了普通单环PID和串级PID两种控制策略。因为串级 PID 超调量小,响应快且参数整定难度较低,所以选取了串级PID。串级PID策略有两个控制器控制飞行器,它会比单个控制器控制更多的变量,使得飞行器的适应能力更强,增强了系统的抗干扰性,能够更加灵敏快速的调节飞行姿态,实验表明,串级 PID 能够很好的满足四旋翼飞行器的控制需求。

4.为了更好地监测和控制四旋翼飞行器,使用C语言编写了四旋翼飞行器虚拟控制上位机软件。

本文着重对四旋翼飞行器的姿态估计与控制系统设计进行了阐述,但是四旋翼飞行器的相关技术中依然有许多不足,由于传感器误差导致的长期姿态估计产生的积分漂移误差、强烈的外界干扰下的控制系统震荡等不稳定因素。因此,姿态估计算法的精度与长期稳定性还有待考证,控制算法的精度及稳定程度还可以进一步提高。

8.2 展望

鉴于时间与精力的限制,本文尚有许多不完善以及未完成的部分,希望今后有时间能深入研究。飞行器室内定位技术:在户外可以通过GPS和气压计完成定位操作,但是在室内定位的技术尚不成熟,在室内,GPS无法接收到卫星信号,只能采取视觉和超声波构成定位系统。借助超声波模块可以精确采集到飞行器距离地面的高度数据。通过摄像头可以采集图像,摄像头采用成本较低的OV7670带FIFO的彩色摄像头。再借助图像处理的相关算法能够得到当前飞行器的运动轨迹,综合两者信息,利用PID控制算法,可以让飞行器稳定于室内的固定位置。自适应摄像头云台:云台可用来搭载摄像头,这样在飞行器飞行过程中,可采集大量的航拍数据,比如勘探地形,巡线等。云台由两个舵机及其机架与摄像头组成,通过姿态估计的姿态角信息计算出云台的角度补偿值,使云台在飞行器飞行时能够自动与地面保持一定夹角。通过GPS还可以规划航线,让飞行器按预定轨迹飞行。

第 38 页


基于STM32的四旋翼飞行控制系统毕业设计 - 图文(9).doc 将本文的Word文档下载到电脑 下载失败或者文档不完整,请联系客服人员解决!

下一篇:违法占地行政案件若干问题研究

相关阅读
本类排行
× 注册会员免费下载(下载后可以自由复制和排版)

马上注册会员

注:下载文档有可能“只有目录或者内容不全”等情况,请下载之前注意辨别,如果您已付费且无法下载或内容有问题,请联系我们协助你处理。
微信: QQ: