多旋翼PID调参教程

官网英文原文地址：http://px4.io/docs/multicopter-pid-tuning-guide/

本教程仅适用于高级用户/专家。如果你不理解PID调参代表什么，很可能导致炸机。

绝不带着碳纤维桨或者增强型碳纤维桨进行多旋翼调参。

绝不使用损坏的桨。

鉴于安全因素，默认的增益都设置成相应的较小的值。在你想要得到控制响应前，必须先增大相应的增益。

这个教程对所有的多旋翼(AR.Drone，PWM 四轴/六轴/八轴飞行器)都有效。比例-积分-微分(PID)控制器是应用最广泛的控制技术。在模型预测控制中有一些效果更好的控制技术(LQR/LQG)，但是由于这些控制技术或多或少地需要精确的系统模型，因此没能得到广泛应用。PX4系列飞控板的控制目标就是能在MPC之间尽可能快的切换，因为不是所有支持的系统模型都可用，因此PID调参非常重要(并且PID控制在许多情况下是足够的)。

介绍

PX4中的 multirotor_att_control 应用程序执行外环姿态控制器的外环，取决于以下参数：

  • 横滚比例控制 (MC_ROLL_P)
  • 俯仰比例控制 (MC_PITCH_P)
  • 偏航比例控制 (MC_YAW_P)

同时内环通过三个独立的PID控制器来控制姿态角速度：

  • 横滚角速度控制(MC_ROLLRATE_P, MC_ROLLRATE_I, MC_ROLLRATE_D)
  • 俯仰角速度控制(MC_PITCHRATE_P, MC_PITCHRATE_I, MC_PITCHRATE_D)
  • 偏航角速度控制 (MC_YAWRATE_P, MC_YAWRATE_I, MC_YAWRATE_D)

外环输出的是期望的机体角速度(例如：如果多旋翼应该处于水平，但是当前存在30度的横滚角，那么控制输出就将产生60度每秒的角速度)。内环(即角速度控制环)改变电机的输出以使飞行器按照期望的角速度旋转。

增益实际上有一个直观的意义，例如：如果将MC_ROLL_P增益值设置为6.0并且姿态角存在0.5弧度的偏移（大约30度)，那么飞行器将尝试以6倍的角速度来进行补偿，也就是3.0弧度每秒(rad/s)或者约170度每秒(deg/s)。对于内环来说，如果将MC_ROLLRATE_P增益设置成0.1，那么推力对横滚角的输出将会是3*0.1 = 0.3，这意味着飞行器一侧的电机将减速30%，同时另一侧的电机加速，以此来诱导角动量以便是飞行器回到水平状态。

参数MC_YAW_FF反映的是用户输入对偏航速度控制器的前馈比例。值为0代表极慢的响应速度，仅当偏航位置误差出现时，控制器才开始偏航运动；值为1代表响应非常灵敏的控制，但有一些超调，控制器将立刻进行偏航运动并始终保持偏航误差接近零，。

电机带限（Motor Band / Limiting）

如上述所示，在某些条件下，一个电机可能获得高于其最大速度的输入，而另一个电机获得低于零的输入。如果发生这种情况，由电机产生的力将违反控制模型，多旋翼飞行器很可能会翻转。为了防止这种情况发生，PX4上的多旋翼混控器使用了一个带限。如果有一个电机超出了安全范围，系统的总推力会被降低，使得控制器输出的相对百分比能得到满足。因此，多旋翼飞行器可能不会爬升，甚至稍微掉高，但它绝不会翻转。同样对于下侧，即使命令的横滚角度很大，它也将被缩放到一个不超过命令总推力的值，并且飞行器将不会在接近零推力起飞时发生翻转。

第1步：准备

首先将所有的参数都设置为初始值：

  1. 将所有的MC_XXX_P设置为0(ROLL, PITCH, YAW)
  2. 除了MC_ROLLRATE_P 和 MC_PITCHRATE_P之外，将所有的MC_XXXRATE_P、 MC_XXXRATE_I、 MC_XXXRATE_D设置为0
  3. 将MC_ROLLRATE_P和MC_PITCHRATE_P设置为一个比较小的值，例如0.02
  4. 将MC_YAW_FF设置为0.5

所有的增益都应该缓慢的增加，每次增加20%~30%，在最终微调时甚至应该降至10%。注意，增益太大(即使只比最优增益值大了1.5-2倍)可能会导致非常危险的振荡！

第2步:： 稳定横滚(ROLL)和俯仰(PITCH)角速度

P 增益调节

参数： MC_ROLLRATE_P，MC_PITCHRATE_P

如果飞行器是对称的，那么ROLL和PITCH的值应该是相同的；如果不是——则应该分别进行调节。

用手牢牢抓住多旋翼并将油门推到大约50%，使飞机的重量几乎为零。用手让飞机在横滚或俯仰方向上倾斜，并观察其响应。飞机应该会温和的对抗该运动，但它不会试图回到水平。如果飞机发生了振荡，则需要将RATE_P调低。一旦控制响应变慢但是正确了，则继续增加RATE_P直到飞机再次开始振荡。接下来降低RATE_P直到飞机只有轻微的振荡或者完全没有振荡(降低大约10%)，只剩下超调。典型值约为0.1。

D 增益调节

参数：MC_ROLLRATE_D， MC_PITCHRATE_D

假设增益处于多旋翼振荡的状态下，并且RATE_P略微减小。从0.01开始慢慢增加RATE_D，直到消除最后一点振荡。如果电机发生颤抖，那么说明RATE_D太大了，需要将其调低。通过调节RATE_P和 RATE_D的大小，飞机的响应能够达到恰到好处。典型值大约在0.01~0.02之间。

在QGroundControl地面站中，你可以画出横滚和俯仰角速度图(ATTITUDE.rollspeed/pitchspeed)。这里曲线不会振荡，但是有一些超调(10%~20%)是没有关系的。

I 增益调节

如果横滚和俯仰角速度始终达不到设定值，并且存在漂移，从MC_ROLLRATE_P增益值的5%-10%处开始，将MC_ROLLRATE_I和MC_PITCHRATE_I 增益相加

第3步： 稳定横滚和俯仰角

P增益调节

参数 ： MC_RATE_P， MC_RATE_P

将MC_ROLL_P以及MC_PITCH_P设置为一个较小的值，例如设置为3。

用手牢牢抓住多旋翼并将油门推到大约50%，使飞机的重量几乎为零。用手让飞机在横滚或俯仰方向上倾斜，并观察其响应。飞机应该会缓慢地回到水平。如果飞机发生振荡，则应该将P调低。一旦控制响应变慢但是正确了，则继续增加P直到飞机再次开始振荡。最优的响应是带有一些超调(大约10%~20%)。在得到稳定的响应之后再次对RATE_P，RATE_D进行微调。

在QGroundControl地面站中，你可以画出横滚和俯仰角示意图 (ATTITUDE.roll/pitch)以及控制输出(ctrl0, ctrl1)。姿态角的超调量应该不超过10-20%。

第4步： 稳定偏航角速度

P增益调节

参数： MC_YAWRATE_P

将MC_YAWRATE_P设置为一个较小的值，例如设置为0.1。

用手牢牢抓住多旋翼并将油门推到大约50%，使飞机的重量几乎为零。用手让飞机在偏航方向上转动，并观察其响应。电机的声音应该会发生改变，同时飞机应该会对抗这个偏航转动。飞机的响应将基本上弱于横滚和俯仰运动，这是正常的。如果飞机发生振荡或者颤抖，则需要将RATE_P调低。如果对于很小的运动(油门到顶vs空转螺旋桨)飞机的响应也非常剧烈，则继续减少RATE_P。典型值大约在0.2~0.3之间。

如果偏航角速度控制非常灵敏或者发生振荡，可能会恶化横滚和俯仰响应。可以通过转向、横滚、俯仰和偏航检查系统的总响应。

第5步： 稳定偏航角

P增益调节

参数： MC_YAW_P

将MC_YAW_P设置为一个较低的值，例如设置为1。

用手牢牢抓住多旋翼并将油门推到大约50%，使飞机的重量几乎为零。用手让飞机在偏航方向上转动，并观察其响应。飞机应该会慢慢地回到初始航向上。如果飞机发生振荡，则需要将MC_YAW_P调低。一旦控制响应变慢但是正确了，则需要增加MC_YAW_P直到响应变得稳定，同时不能有振荡。典型值大约在2~3之间。

可以在QGroundControl地面站中查看ATTITUDE.yaw偏航角曲线。偏航角的超调应该不超过2~5%。

前馈调节

参数：MC_YAW_FF

此参数不是特别重要并且可以在飞行过程中调节，在最坏的情况下，偏航响应将会滞后或者太快。调节前馈参数FF以获得一个舒适的响应。有效范围在0~1之间。典型值为0.8….0.9。(对于航拍视频，为获得平滑的响应，最佳值可能小得多)

可以在QGroundControl地面站中查看ATTITUDE.yaw偏航角曲线。偏航角的超调应该不超过2~5%。