深度解读电磁组直立行走车模运动控制任务分解

1 直立行走任务分解

电磁组比赛要求车模在直立的状态下以两个轮子着地沿着赛道进行比赛，相比四轮着地状态，车模控制任务更为复杂。为了能够方便找到解决问题的办法，首先将复杂的问题分解成简单的问题进行讨论。

为了分析方便，根据比赛规则，假设维持车模直立、运行的动力都来自于车模的两个后车轮，后轮转动由两个直流电机驱动。因此从控制角度来看，由控制车模两个电机旋转方向及速度实现对车模的控制。车模运动控制任务可以分解成以下三个基本任务，如图2- 1所示：

▲ 图2-1 车模控制任务分解

（1） 控制车模直立：通过控制两个电机正反向运动保持车模直立状态；
（2） 控制车模速度：通过调节车模的倾角来实现车模速度控制。
（3） 控制车模转向：通过控制两个电机之间的转动差速实现车模转向控制。

车模直立和方向控制任务都是直接通过控制车模两个后轮驱动电机完成的。可以假设车模的电机可以虚拟地被拆解成两个不同功能的驱动电机，它们同轴相连，分别控制车模的直立平衡、左右方向。在实际控制中，是将控制车模直立和方向的控制信号叠加在一起加载电机上，只要电机处于线性状态就可以同时完成上面两个任务。

车模的速度是由车模倾角控制完成的。车模不同的倾角会引起车模向前和向后速度变化，从而达到对于速度的控制。

▲ 图2-2 车模倾角引起车速变化

在上述三个任务中保持车模直立是关键。由于车模同时受到三种控制的影响，从车模直立控制的角度，其它两个控制就成为它的干扰。因此在速度、方向控制的时候，应该尽量平滑，以减少对于直立控制的干扰。三者之间的配合如图2- 3所示。

▲ 图2-3 三层控制之间相互配合

上述三个控制各自独立进行控制，它们各自假设其它两个控制都已经达到稳定。比如速度控制时，需要车模已经能够保持直立控制，通过调节车模倾角的偏移量，改变车模的实际物理倾角。车模前倾和后倾会改变车模的速度。为了避免影响车模直立控制，在进行速度控制时，对于车模倾角的改变一定需要非常的缓慢。这一点将会在后面速度控制中进行详细讨论。

下面分别讨论以上三个控制的实现方式。

2 车模直立控制

控制车模直立的直观经验来自于杂技表演。一般的人通过简单练习就可以让一个直木棒在手指尖上保持直立。这需要两个条件：一个是托着木棒的手掌可以移动；另一个是眼睛可以观察到木棒的倾斜角度和倾斜趋势（角加速度）。通过手掌移动抵消木棒的倾斜角度和趋势，从而保持木棒的直立。这两个条件缺一不可，实际上就是控制中的负反馈机制，参见图2- 4。

▲ 图2-4 保持木棒直立的反馈控制

世界上还没有任何一个天才杂技演员可以蒙着眼睛使得木棒在自己手指上直立，因为没有了负反馈。

车模直立也是通过负反馈实现的。但相对于上面的木棒直立相对简单。因为车模有两个轮子着地，因此车体只会在轮子滚动的方向上发生倾斜。控制轮子转动，抵消倾斜的趋势便可以保持车体直立了。如图2- 5所示。

▲ 图2-5 通过车轮运动保持车模直立

那么车轮如何运行，才能够最终保持车体垂直稳定？为了回答这个问题，一般的做法需要建立车模的运动学和动力学数学模型，通过设计最优控制来保证车模的稳定。为了使得同学们能够比较清楚理解其中的物理过程。下面通过对比单摆模型来说明保持车模稳定的控制规律。

重力场中使用细线悬挂着重物经过简化便形成理想化的单摆模型。直立着的车模可以看成放置在可以左右移动平台上的倒立着的单摆。如图2- 6所示。

▲ 图2-6 车模简化成倒立的单摆

普通的单摆受力分析如图2- 7所示。

▲ 图2-7 普通单摆受力分析

当物体离开垂直的平衡位置之后，便会受到重力与悬线的作用合力，驱动重物回复平衡位置。这个力称之为回复力，其大小为：

F = − m g ⋅ sin ⁡ θ ≈ − m g θ F = - mg \cdot \sin \theta \approx - mg\theta

在此回复力作用下，单摆便进行周期运动。在空气中运动的单摆，由于受到空气的阻尼力，单摆最终会停止在垂直平衡位置。空气的阻尼力与单摆运行速度成正比，方向相反。阻尼力越大，单摆越会尽快在垂直位置稳定下来。图2- 8显示出不同阻尼系数下，单摆的运动曲线。

▲ 图2-8 不同阻尼力下的单摆运动

总结单摆能够稳定在垂直位置的条件有两个：
（1） 受到与位移（角度）相反的恢复力；
（2） 受到与运动速度相反的阻尼力。

如果没有阻尼力，单摆会在垂直位置左右摆动。阻尼力会使得单摆最终停止在垂直位置。阻尼力过小（欠阻尼）会使得单摆产生震荡，阻尼力过大（过阻尼）会使得单摆到达平衡位置时间拉长。存在一个阻尼临界阻尼系数，使得单摆最快稳定在平衡位置。

为什么倒立摆在垂直位置时，在受到外部扰动的情况下，无法保持稳定呢？分析倒立摆的受力，如图2- 9所示。

▲ 图2-9 在车轮上的参照系中的车模受力分析

倒立摆之所以不能象单摆一样可以稳定在垂直位置，就是因为在它偏离平衡位置的时候，所受到的回复力与位移方向相同，而不是相反！因此，倒立摆便会加速偏离垂直位置，直到倒下。

如何通过控制使得倒立摆能够像单摆一样，稳定在垂直位置呢？要达到这一目的，只有两个办法：一个是改变重力的方向；另一个是增加额外的受力，使得恢复力与位移方向相反才行。由此，能够做的显然只有第二种方式。

控制倒立摆底部车轮，使得它作加速运动。这样站在小车上（非惯性系）看倒立摆，它就会受到额外的力(惯性力)，该力与车轮的加速度方向相反，大小成正比。这样倒立摆所受到的回复力为

式中，假设控制车轮加速度与偏角θ \thetaθ 成正比，比例为k 1 k_1k1​ 。显然，如果k 1 > g k_1 > gk1​>g ，（g gg 是重力加速度）那么回复力的方向便于位移方向相反了。

此外，为了使得倒立摆能够尽快地在垂直位置稳定下来，还需要增加阻尼力，与偏角的速度成正比，方向相反。因此式（2-1）可变为

按照上面的控制方法，可把倒立摆模型变为单摆模型，能够稳定在垂直位置。因此，可得控制车轮加速度的控制算法

编辑：hfy