SpotMini末端控制策略

　　相信很多人都注意到了“机器人学家”两天前推送的Boston Dynamics新机器人Spot-Mini。除了一如既往独领风骚的步态控制外，这次BD还给机器人增加了一个机械臂。视频中的一幕挺有趣，就是Spot-Mini全身都在摆动，但机械臂末端基本保持稳定。

matlab做的GIF好棒，都找不到循环点

　　使机器人消除底座运动影响，并保持机械臂末端相对于环境稳定（维持期望运动状态），是移动机械臂领域的关键技术之一。那么BD是如何做到这一点的呢？

　　先把BD放一边，在移动机器人领域，一般有两种方法来保持机械臂末端稳定：基于误差的控制、基于模型的控制（视频在文末）。

　　其中，两种方法都需要用到雅克比，或者叫做微分运动学（n为机械臂自由度）：

　　利用雅克比矩阵，可以将每个关节的速度换算成机械臂末端速度（反之亦然）。

　　1. 基于误差的控制

　　基于误差的控制是将机械臂与移动底座分开考虑，只关注机械臂末端与预期运动状态的误差。通过传感器（加速度计、视觉等）可以实时测量得到机械臂末端的误差，之后利用雅克比（伪）逆转换成机械臂各关节运动状态，从而使得机械臂往误差减小的方向运动（接近期望运动轨迹）。

　　由于手头没有合适的移动机械臂平台，这里我用上面这个平台代替：认为整个地球+Baxter左臂是移动机械臂，而小车是环境（world）。当小车被拉动时，从小车上看，可以认为是移动机械臂的底座发生了移动（等效于下面这个模型）。

　　在这里，我利用摄像机识别小车上二维码的位置，并利用如下控制方法确保机械臂末端与二维码相对位置不变，及机械臂在world坐标系下保持稳定。

　　演示视频见最后（由于摄像机帧率为20Hz，所以控制效果可以看出较明显延时）。

　　【note】欧拉角表示姿态时，角速度用如下公式计算：

　　这个方法的优点是不管什么样的底座均可以使用相同的方法进行控制，而缺点就是对传感器精度、实时性要求高，机械臂也容易出现奇异、超出工作空间等问题。

　　2. 基于模型的控制

　　基于模型的控制是通过建立整个移动机械臂模型，通过系统冗余性计算控制指令。

　　当机器人的自由度大于6的时候，便会呈现一定的冗余特性，换句话说，机器人末端的某一动作，可以通过无数种关节运动方式获得。国内做控制的人喜欢将这个特性称为机器人的自运动，但是我个人更喜欢用线性空间的概念（雅克比零空间）。简而言之，如果知道机器人的完整模型，就能利用零空间实现所有关节都运动而末端不动。

　　后面的视频中，我会用7自由度的Motoman SDA5F左臂来演示这个方法：假设第一个旋转关节是移动底座，后面六个关节是固定在底座上的机械臂。当然，与我在视频中使用的例子不同，移动底座的运动状态往往与下发的控制指令有较大偏差（与地面打滑等），所以，必须增加底座运动状态估计（卡尔曼滤波）模块，利用估计的运动状态作为整个机器人模型前几个广义坐标数值。这个方法的优点是拥有整个机器人的模型，可以实现一些二级任务（保证末端任务的前提下，完成其他优化任务），同时更容易避免机械臂超出工作空间等情况；但是缺点就是底座的运动状态难以准备获得。

　　3. BD是怎么做的

　　我没找到他们的论文，所以只能靠猜了。通过仔细观看高清视频，SpotMini底部运动时，机械臂末端会发生（较高频率）抖动，这种感觉非常类似于PID控制时P增益稍微太大的情况；另一方面，BD底座的控制应该是力矩控制，无法保证高精度的位置，采用基于误差的控制可以大大降低建模和控制的复杂度。所以，我猜是采用基于误差的控制方式。

　　4. 我的视频

　　我的视频在这里看：