两个轮子也不倒，这是一个DIY的自平衡机器人

雷锋网 • 9年前扫码分享

我是创始人李岩：很抱歉！给自己产品做个广告，点击进来看看。

编者注：本项目编译自 Makezine ，来自3D Robotics设计主管Jason Short。Makezine将本项目的难度定位为：Very Difficult（非常难），够自信你也来挑战一下吧！

想要提高自己的机器人制作水平吗？那你可来对地方了。今天我们的主角ArduRoller就是一台可以自动平衡的倒立摆机器人，此外它还拥有室内外自主导航的能力。这台非传统车辆可以快速自主通过一系列障碍、转角、崎岖路面，水桶和斜坡等对它来说都小菜一碟。此外，它也是我在一年一度的SparkFun无人驾驶车辆竞赛中的参赛作品。

首先，我选择了来自3D Robotics的APM 2.5多模式自动控制系统，因为它集成了几乎所有机器人所需的传感器。此外，它构造简单，开源，而且相关软件免费，ArduPilot系统也较为成熟。对于刚上手智能机器人的人来说，这绝对是个好平台。

这款自动平衡机器人采用惯性测量装置（IMU）作为核心，该装置包括三轴速率陀螺，加速度计和磁力计，共计九个传感器，总采样速率可以达到千次∕秒，此外它还采用了方向余弦矩阵算法（DCM），其搭载的数学滤波器则可更好地利用每个传感器的性能。该机器人还搭载了更高级别的代码，这样就可快速计算出机器人的实时状态（角度和转速等），以更好的保持平衡。先来看个视频吧：

怎样能使机器人保持平衡？

倒立摆平衡机器人的内在特点决定了它其实是不稳定的，不过高重心的优势却给它创造了一个很大的惯性矩，从而放缓了它倾斜的速度。在操作中我们就可以利用这一特性，不断移动轮子来抵消这部分倾斜所产生的力，以保持机器人的平衡。

机器人内置软件中的一个简单的PID回路负责控制它的平衡：

比例项会探测到机器人倾斜的角度误差，随后便会换算出来回传给电机，电机就可以控制轮子来抵消这部分力，从而保持平衡。
积分项和上面的原理类似，不过它搜集的是所有角度误差的总和，从而解决重心问题。
相比前两项，微分项更加关键，少了它我们就无法控制机器人的加减速。

让它动起来

随后，这个简单的机器人就可以开始动起来了。不过平衡没能保持多久，它就因为不断加速而摔倒了。如果在过程中机器人试图调整姿态，那么它就无法继续前行了。

所以我们只好采用垂直滚动的方法来保持前进。首先，要让轮子的旋转保持一个合理的速度，这样才能产生足够抵消机器人倾斜的力。然后，在机器人角度快速变化时再提供一个补偿力，以保持它的稳定。这一算法来自于对人类的观察研究，因为人在受外力推挤时会努力保持平衡。举例来说，足球运动员在碰撞时就会收腿并倾斜身体来保持平衡。

以上两点是机器人平衡算法的关键，只有这样机器人才能走的更顺，走的更远。

自主导航

想要实现自主导航，我们要精确计算出机器人所在方位和其目的地。GPS很有用，但其精度只有几米，而机器人需要的是精确到厘米的定位准确度。

轮式编码器则可将精度提高到毫米级，同时也对GPS起到了很好的辅助。来自Pololu公司的电机则搭载了可选的霍尔效应传感器，让它可以这样工作：小型磁铁旋转着掠过传感器，这样就可以计算出车轮的速度。机器人搭载的 Arduino Pro Mini也很强大，它可以读取来自编码器的每秒数千次的脉冲，然后将这些数据通过I2C接口传送给自动驾驶系统。只要知道了轮子的半径，机器人就可计算出行走的速度和里程。此外，机器人知道自己的前进方向，这样它就可以在二维空间里精确的给自己定位。GPS在整个过程中反而扮演了辅助的角色，它只要保证机器人能精确的执行这一系列动作就行。

如果在行驶中被卡住，机器人也能感觉到，它会倒转轮子行驶并稍微右转再次进行尝试。

机器人的其它控制软件，包括路径导航系统，基本都是ArduCopter上的改进版，这样我们就站在了前人的肩膀上，省下了大量的精力和时间。

别墨迹了，快自己装一个吧，3-5个小时就能搞定，总花费大约在400到500美元。下面我会列出详细的装配步骤。

第一步：准备好所有零件

Pololu有刷直流电机已经装上了编码器，此外，一个34:1的齿轮减速装置有助于提高电机的扭矩。