四旋翼PID控制原理

Posted by Beyonderwei on 2018-07-26
Words 560 and Reading Time 1 Minutes
Viewed Times

一、PID 原理

   偏差控制,利用目标值(期望值)与实际测量值构成的偏差(误差)对被控对象进行线性的控制。偏差 = 目标值 - 测量值

二、四旋翼串级双闭环 PID 控制

  对于四旋翼,可以理解外环为角度环,内环是角速度环。

1. 外环

  1. 目标值:期望轨迹,即期望的姿态角度。
  2. 测量值:实际的姿态角度。
  3. PID控制器的输入:目标值 - 测量值。
  4. PID控制器的输出:提供使测量值趋近于目标值的方法
    注:
    ①. 外环是位置反馈 -> 反馈了当前的位置,即当前偏航了多少角度。
    ②. 外环控制是为了达到期望的角度,因为角度是由角速度积分得到,dT时间,外环输出的控制量反应角度的偏差值,dT时间的角度偏差即角速度,所以把外环PID的输出作为角速度来用,外环的输出就是我们想要达到的角速度。把外环的输出作为内环的输入(内环的目标值),即我们期望角速度进行怎么样的变化,才能使姿态角度达到我们期望的姿态角度。

    2.内环

  5. 目标值:外环的输出,即期望的角速度。
  6. 测量值:实际的角速度。
  7. PID 输入:目标值减去测量值。
  8. PID 输出:提供使测量值趋近目标值的方法。
    注:
    ①. 内环的目的是要达到期望的角速度,角速度直接与电机的转速有关系。所以内环 PID 的输出,作为实际调节电机转速的参数去使用。
    ②. 在纯姿态模式下,四旋翼电机的转速由两部分组成,遥控油门提供的是基础转速,PID的输出作为维持姿态平稳的调节转速。这就是纯姿态模式下飞机的高度不好控制的原因,要使飞机维持在一个高度,就需要基础转速所提供的升力刚好与重力相等。飞行过程中维持飞机平稳的是调节转速,它保证了飞机平衡的姿态。

本文为作者原创文章,未经作者允许不得转载。

...

...

00:00
00:00