轻巧四旋翼无人机|旋翼无人机

   四旋翼无人机的基本飞行须参考3个测量量，Pitch，Roll和yaw，然后控制4个电机的转速以达到升降、悬停等动作。

   四旋翼无人机的动力学模型复杂，受外界环境影响大，对控制器的自适应和鲁棒性要求都比较高，故控制方法挺多，比如什么反步法（Backstepping），LQ，ADRC。

   首先，四个电机，如何控制侧倾？ 如果单单考虑控制一个电机来侧倾，这不严谨，因为当动作其中一个电机时转速的变化改变了反扭矩的大小而对角的另一个电机产生的扭矩没有改变，此时四旋翼不仅侧倾还会在yaw上面产生额外的运动，所以控制电机应该成对去控制，比如：

定义电机排布方式如下：

                    M1

                     |

                M2 —— M3          

                     |

                    M4

   这就是 四旋翼 “+” 飞行模式，不难理解，要调整pitch，只要改变M1与M4的转速，调整roll，则改变M2与M3的转速，所以可以得到如下控制规律：

              M1   M2   M3   M4      (H为Hold 保持)

正俯仰   +       H      H     -

反俯仰    -       H      H    +

正横滚   H       +      -     H

反横滚   H        -     +     H

顺航向   +        -      -     +

反航向    -       +     +      -

上升       +      +      +     +

下降       -       -       -      -

   不过自己搞的四轴并不是使用 “+” 模式，那没意思，我喜欢 “X” 模式。 咋一看，似乎复杂了，其实不然，只不过是在每次动作时要操作四个电机而已。

      定义电机排布方式如下：

                       M1     M2

                          \    /

                          /    \

                       M3     M4

   可以这么看，把 M1&M2当成 ’+‘ 模式中的M1；M3&M4当成 ’+‘模式中的M4，另外两组类推。

所以也可得到 “X” 模式的控制规律：

              M1   M2   M3   M4    

正俯仰   +       +      -     -

反俯仰    -       -      +    +

正横滚   -       +      -     +

反横滚   +        -     +     -

顺航向   +        -      -     +

反航向    -       +     +      -

上升       +      +      +     +

下降       -       -       -      -

   好了，两种模式的控制规律表都在手了，接下来是如何控制，使其能自主悬停？这里实质上也没什么奥妙，就是通过PID，调整电机PWM，减小期望与当前姿态的误差，即可实现悬停、航线等复杂动作。