《四轴PID调试心得》由会员分享,可在线阅读,更多相关《四轴PID调试心得(9页珍藏版)》请在金锄头文库上搜索。
1、本人曾在大二, 大三参加过第六, 第七届飞思卡尔智能车比赛,之后在考研过后在飞思卡尔智能车为我打下的良好基础下开始制作四轴飞行器。在年中到现在陆续调试了两架四轴,一架十字,一架X。其中四轴的平衡是很重要的一环,其中涉及到的 PID 整定,因为听闻今年摄像头也要站起来了,个人认为 PID整定过程都有可以互相借鉴之处,顾在此一贴,也顺便为我的ARM-ST 校园比赛求支持。PID 调试心得本人不是自动化出身, 也没有受过专业训练, 都是自己摸索, 在这里浅述一下自己的 PID 参数整定心得。 所言之物皆由实践及自己的理解得出,如有不当之处还请指正。首先例举第一个例子, 我调的第一台四轴飞行器, 十字
2、型四轴飞行器, 讲下配置:网上一百多的 650 机架, 好赢 20A电调,新西达 2212 1000kV,1045 的桨,2200mah电池。采用位置式 PID 控制,位置式 PID 公式如下PID 的基本意义我在次就不作阐述了,我只讲我的设计,我以姿态角作为被控制对象,所以e(k) = 期望-测量 = 给定值 -测量姿态角对于微分项 D,我做了一点改变,标准PID 的微分项 D=kd*(e(k)-e(k-1),我在实践过程中因为角度的微分就是角速度,而陀螺仪可以直接测出角速度, 所以我没有将微分项作为偏差的差而是直接用D=kd*Gyro 实现代码如下 float pidUpdate(pids
3、uite* pid, const float measured,float expect,float gyro) float output; static float lastoutput=0; pid-desired=expect; / 获取期望角度pid-error = pid-desired - measured; /偏差:期望 - 测量值pid-integ += pid-error * IMU_UPDATE_DT; /偏差积分if (pid-integ pid-iLimit) /作积分限制 pid-integ = pid-iLimit; else if (pid-integ iLimi
4、t) pid-integ = -pid-iLimit; / pid-deriv = (pid-error - pid-prevError) / IMU_UPDATE_DT; / 微分应该可用陀螺仪角速度代替pid-deriv = -gyro; if(fabs(pid-error)Piddeadband) /pid 死区 pid-outP = pid-kp * pid-error; / 方便独立观察pid-outI = pid-ki * pid-integ; pid-outD = pid-kd * pid-deriv; output = (pid-kp * pid-error) + (pid-k
5、i * pid-integ) + (pid-kd * pid-deriv); else output=lastoutput; pid-prevError = pid-error; /更 新 前 一次偏差lastoutput=output; return output; 我这么做的原因是因为, 如果使用传统的D的形式,在我快速打舵时会产生输入的设定值变化频繁且幅度较大, 四轴飞行器会迅速回到新的期望点,说白了就是非常灵活,四轴回复很猛,也许造成系统的振荡,对PID 参数要求较高。如果用角速度代替的话, 那怕你打舵非常快, 四轴会较平稳的回到新位置, 运动较柔和。对于我这种操作菜鸟来说无疑后面一种
6、会更合适,所以我选择了 D=kd*Gyro的方式。PID 控制器我大概就是这么实现的,下面讲讲我在调试过程中具体遇到的问题。首先我将四轴固定在单轴平衡平台上,让飞行器完成单轴平衡, 主要观察姿态角的(1)稳定性,能否平衡在期望角度; (2)响应性,当操纵命令改变时,四轴能否即时的响应期望的变化; (3)操纵性,由操纵员感受四轴的姿态是否已与操纵,会不会产生响应过冲。我先调一个轴的平衡再调另外一个轴,最后调YAW 轴。A:开始只调 P,将 I,D 置 0。由于不知道 PID 的大致范围我就随便给了一组值:P=1,I=0,D=0 观察现象。一开电机四轴就开始剧烈左右摇摆,很明显 P给大了。然后 P
7、从小了往上加。 从 P=0.1 开始试。调试的时候我就发现了一个现象就是我的四轴往一边歪, 离平衡的 0 度差了那么一个角度A,P=0.1 时 A较大,除非油门推到很大否则四周根本起不来, 这是 P说明给小了, 我再将 P=0.2 这时四轴状况无明显改善。于是我直接将 P加大一点 P=0.8,P=0.8 时已经可以看出在等幅震荡了,但是不是在0 度的平衡位置,也是偏离的一个角度B,此时 B较小了。之后我再加大 P到 1 四轴震荡又变大了, 但是到震荡中心到零度的静差还是存在。由于此时 I=0, 所以我决定不管这个静差, 先把 P的临界震荡点找到。 P=0.8 时可以观察到比较明显的等幅震荡了,
8、 P=0.2 时四轴又嫌的无力,所以 P应该在 0.20.8之间。临界震荡点就是P从为震荡到,刚开始震荡的点。在这里还应注意一点, 当 P太小时,四轴在很大倾斜的地方, 在重力与 P的作用下也会震荡, 这种震荡不是等幅的, 对称的,震荡波谷明显要比波峰绝对值大而且距离 0 度会很远。这种情况要加以区分。我把 P从 0.2 到 0.8 开始尝试,找到一个适合的点,最后我定为0.5 。在这个过程中一开始我一直想通过P来消除静差, 但是我发现我把 P加到很大,已经震荡的很剧烈了,四轴的震荡中心都不是在0 度位置。所以我只能选择先选好P,D最后加入 I 来解决这个问题。P=0.5 时四轴在他的稳定位置
9、震荡比较小了,但是在外力干扰下很难在稳定下来,抗干扰能力较差。然后我开始调D,在平衡过程中P 相当于四轴的回复力,它要努力时四轴在一个稳定的平衡位置,但这个位置不一定是你的期望点。个人认为就是当偏差不在变化时,pid 的输出也没有变化了,所以有可能光用P时稳定的位置不一定是平衡的期望的位置。而 D是阻尼力,他在四轴有速度的情况下才发挥作用, 它与速度方向相反始终是抑制运动。所以他可以抑制震荡, 但是他同样也可以抑制 P的作用,当震动产生时,在震动的中心点四轴震动速度最大,也是 D作用最强的时刻。刚开始调 D的时我就范了一个错误。 因为我该了 D的标准型,而 D应该是抑制运动的但是陀螺仪输出的数
10、据符号导致我这里D变成了增加运动,所以一开始无论我怎么调整D,都会激发震荡。后来我在参数前加了个符号就好了。在这里我提醒要始终注意 D是阻尼力,是其抑制震荡也就是运动的作用的,它始终期望的是它所作用的对象没有运动, 至于停在什么位置不是D所关心的,那是 P,I 所关心的。所以直接用陀螺仪数据代替偏差的差得话就得注意下。修正这个问题后加了D效果就比较明显了,四轴在外力的干扰先能明显的有回复力且,能快速稳定在平衡点了, 调 D就是试,当然 D大了也会产生震荡, 但是此时不加 D时光 P作用时的震荡就很小, 很明显就可以看出随着D的增大,震荡减小又增大的过程。 最后 P=0.4,D=0.15 。最后
11、定好了 P,D 后我的四轴还是有静差, 不能稳定在期望的0 点。网上有很多四轴只用 PD,在这里我决定根据我的实际情况加入I 。调 I 的时候我先把积分限幅去掉。然后从小往大加,当调平衡时,随着油门的变大,静差应该是越来小的。我将油门推到差不多快要将四轴推离地面的位置,看 I 能不能消除静差。 因为如果油门给小了, 静差较大, 调出来的 I 虽然能消除静差但是I 比较大,在加油门时有可能也会产生超调震荡。 最后 I 要再能消除静差又不产生震荡, 个人认为要竟可能小。最后加上合适的积分限幅。P:0.4,I:0.35,D:0.15 。别忘了以上调试过程中每次都需要给予平衡一个干扰,看看参数在外界干
12、扰情况下做的如何, 会不会产生超调震荡, 会不会长时间才能稳定。 以上就是我第一台四轴的 PID 调试。下面我讲讲我在调第二个X四轴过程中遇到的问题。第二架四轴是我做了用来参加爱板网的ARM-STM32 校园比赛的,因为第一架属于学校了财产留在学校了, 手里没有。第二架的配置采用的是飞越的650 碳纤机架,电调用的是好赢的奔腾40A,电机同样是新西达2212 1000kV。其实这个机架和电调配这个电机是大才小用了, 但是我的预算实在不够了就只好买了个水一点的电机,等以后在升级。这次我才用X型四轴,主要是挂了云台。 PID 的设计与之前讲的一样,就不多说了直接说调试中遇到的问题。调试方法还是先调
13、平衡杆,如图:刚开始调 X的时候我以为跟十字的差不多, 于是我只是简单的把原有PID 参数按照新的程序里面的PWM 值域缩放了一下倍数,但是发现不行,PID 完全没有起作用。具体表现为四轴开机后直往一边倒到底。只好重新开始调。还是 P=1,I=0,D=0 开始,这组参数我发现, 开机后四轴往一边倒, 但是没有倒下就起不来了。 在倒到一个很大的角度, 大概 70 度左右,电机力量像是突然加大,四轴起来,反向,接着倒向另外一边。进入失控的大幅震荡。因为一开始就倒,所以是P太小。于是我开始加大P,但是当我把 P加到很大时,四轴还是一开始往一边倒, 然后电机力量增大, 四轴翻倒向另外一边, 开始发散性
14、的震荡。此时我觉得开始 P比较小的时候是P不足,电机的惯性的作用下开始震荡。到后来是 P太大了,直接进入震荡。 我始终没有观察到一个等幅震荡或者说接近小幅震荡的点。 无论 P大 P小我的四轴都会进入失控的发散震荡。换而言之这个 X四轴光靠 P根本进入不不了一个比较稳定的状态或者接近稳定的状态。连相对稳定的等幅震荡都观察不到就直接进入发散的震荡。此时我开始困惑了。这个情况跟十字的很不一样。 我没有明显观察到网上流传最通俗的调节PID 说法的那种情况,即:逐渐加大P直到开始发生等幅震荡,然后P不变,加入 D抑制震荡。 。 。我观察到的是 P 无论怎么给,我的四轴都倒向一边然后开始进入发散的震荡,唯
15、一的区别就是 P 小一开始倒下的角度大, P越大一开始倒下得角度越小,进入震荡的越快。此种情况与前一个四轴的情况截然不同。当我潜入困境时,以为名叫螃蟹的网友帮助了我。 他告诉我定 P要定在把手放开,开始震荡,只要左右晃二三次就达到大晃动幅度,大晃动幅度大概是45 度左右。定下这个 P值后然后加入 D,而且 D有可能比 P 大。在这个基础上我又开始了调试。从头来调P,这次我观察到新现象。我把四轴稍微倾向一边几度,比如说左边,当 P小时,启动电机松手后,四轴向左倒,如果P大了,四轴回向右倒。前者是补偿不足,后者是补偿过度。 在这个两个 P值得区间就有我们要找的P,合适的 P就是能在平衡位置挣扎左右
16、晃几下的值。此时我的 P=3.0 但是光靠 P四轴还是站不住,只能在平衡位置坚持个1,2s。所以得加入 D,尝试 D=1,2,3 时没什么明显的效果只能观察到起初的短时平衡跟稳定了点。D=10 时可明显观察到平衡的时间跟长了,但还是会倒。当D=20 ,可明显观察到四轴可以基本平衡了,但还是有有小幅震荡,一但有干扰还是不能很快恢复稳定了,D=30 时四轴已经开始比之前大的等幅震荡了, 此时说明 D大了。在这种情况下说明 P还是给小了。 我把D定在 25,再开始调节 P,把 P加大。增强恢复力。后免得的调节过程中我就是感觉我就觉得, P会产生一种震荡A,这种 A震荡是会发散的,频率较低。D也会产生一种震荡B,B 是等幅的,频率较高的。然后P 会抑制震荡 B,但会激发 A,D会抑制震荡 A,但会激发 B。后面的调节参数就是要调好P后再调 D,定好 D再调节 P,两个参数互相扶持的趋近一个最佳点。当然机体表现出的等幅震荡时也不一定是 D大了,P