方向控制中的动态比例值-P

 

01问题提出


卓大大,我有一个问题想要请教。对于舵机的转向控制,高速的时候需要动态P才能得到平滑的控制效果(也就是偏差越小P越小,偏差越大P越大)。

但对于电机的速度控制,在任何期望速度下,P参数不需要动态都可得到很好的效果,请问这个如何用理论解释?是因为电机的惯性比较大吗?

方向控制中的动态比例值-P

▲ 车模在不同速度下运行出现的振荡

 

02理论分析


对于电机转速ω(t)\omega \left( t \right)控制,如果采用电流串激闭环控制(这样建模分析比较简单),电机的转速ω(t)\omega \left( t \right)的加速度正比于转子力矩,二转子的力矩正比于转子电流。因此如果控制速度环空置率采用比例控制,整个系统就是一个典型的二阶控制系统。在电机带有阻尼负载(即力矩与转速成正比),该系统可以稳定,并且稳定性与转速无关。这是因为整个系统反馈控制比例控制增益与转速没有关系。

方向控制中的动态比例值-P

对于车模在赛道上循迹运行控制时,舵机的输出正比于车模前轮的转角θ(t)\theta \left( t \right)。前轮转角相对于车模位移x(t)x\left( t \right)积分就形成车模与赛道线中心的偏移量y(t)y\left( t \right)

方向控制中的动态比例值-P

而位移x(t)x\left( t \right)是车模速度v(t)v\left( t \right)的积分:
方向控制中的动态比例值-P

将(2)式代入(1)可以得到:
方向控制中的动态比例值-P

分析(3)可以看到,相对于舵机输出角度θ(t)\theta \left( t \right)对于车模偏移量影响是一个积分关系,其中积分项系数包括kv(t)k \cdot v\left( t \right),这一项与速度成正比。如果同样使用比例负反馈来对车模偏移量进行控制的话,反馈比例系数与车模运行速度成正比。这一点与前面电机控制是不同的。

下图显示了车模运行速度v(t)v\left( t \right)为恒速VcV_c时,车模的偏移量与舵机输出转角θ(t)\theta \left( t \right)之间的关系。

方向控制中的动态比例值-P

▲ 在恒速下,车模的偏移量与舵机输出转角之间的关系

考虑到车模的惯性以及舵机执行过程的延迟等特点,当车模方向控制比例超过一定限度后,方向控制就会变得不稳定了。

由此,可以知道车模方向比例控制的时候,需要根据车速调整比例系数。

方向控制中的动态比例值-P

▲ 车模在转关过程中的动态特性

 

03仿真实验


由于舵机输出转角的转动速度是有限值,而且近似为 一个恒速转动,这是一个非线性的环节。为了简化分析,下面将舵机简化成一个纯延迟环节。比如延迟100ms。将这个延迟环节重新增加在上面的仿真系统中,就会发现,随着比例控制的增加增加,系统的单位阶跃响应就会变得不稳定。

方向控制中的动态比例值-P

▲ 带有纯延时环节的一阶积分环节的比例控制

通过上面的仿真可以看出,比例增益过大会使得系统变得越来越不稳定。根据02节叙述的,车模方向控制的比例系数是与车速成正比,所以当车速增加是,车模运行就会变得原来也不稳定了。

 

04如果解决方向不稳定?


解决车模方向控制不稳定的方法:

  • 动态调整控制参数,比如等候车速增加是,需要适当减少P的大小,从而抑制振荡的产生。这种方法在直道运行是比较有效果,但在弯道时,车模轨迹就会距离赛道中心线有较大的偏差。
  • 通过增加赛道检测的前瞻距离,也就是将车模相对赛道的偏差位置尽可能往前移,这样就可以抵消舵机执行过程中所带来的时间延迟。使用摄像头可以有效提高赛道前方检测的距离。
  • 通过机器学习的方法进行赛道预测。由于赛道元素的组合是有限的,并且是提前公布的。可以通过机器学习的方法将赛道偏移控制信息存储在人工神经网络中,来提高控制的精度。比如今年AI电磁组,虽然赛道检测的电感传感器非常短,但是经过机器学习也可以获得与摄像头相近的性能。
  • 提高舵机的性能。舵机的惯性(延迟)是造成方向控制不稳定的内因。可以适当通过改造舵机输出机械连杆,增加它的机械传动比例,可以在一定程度上提高车模控制的快速性。
  • 在控制算法中引入微分量,来抑制振荡的现象。

下图是通过在控制环节中引入微分控制项,可以看到微分系数在一定范围内可以减少系统输出的振荡。但是当微分系数过大时,也会引起系统的不稳定性。

方向控制中的动态比例值-P

▲ 增加控制中的微分项,在一定参数范围内可以抑制振荡

■ 相关文献链接