外文翻译-立方机器人：一个可以跳跃和平衡的立方体

毕业论文（设计）外文文献翻译系 部：专 业：学 号：姓 名：指导教师： 2016年 02 月 23日立方机器人：一个可以跳跃和平衡的立方体Mohanarajah Gajamohan, Michael Merz, Igor Thommen and Raffaello DAndrea摘要：本文介绍了一个15x15x15cm可以跳跃并通过一角保持平衡的立方体。飞轮安装于立方体的三个面上如图1所示，以高角速度转动并紧急制动，来让立方体机器人跳跃。当立方机器人即将达到以一角保持平衡的时候，控制电机扭矩可使其于一角点保持平衡。这篇文章延续着立方体机器人在ETH苏黎世和现有预算结果的发展。1介绍倒立摆系统有着丰富的历史并且已经运用于测试，演示并用来检测新的控制概念和理论。此外，倒立系统新控制算法的发展仍然是一个活跃的探索领域。相比于其他的3D倒摆测试平台，此立方体机器人具有两个独特的特征。其一是它相对小的步态，（因此它叫立方体机器人，这源于瑞典的德语“立方体”的小型）。另一点在于他不通过其他来自另外支撑来保持静止，其不仅是一个有趣的控制概念并且具有对普通大众有吸引力的演示效果。图1 去除盖子的立方体机器人图2显示了立方体机器人的跳跃方式。最初立方体机器人以一面平放地面，将通过它的边缘来跳跃，并通过及时制动其飞轮。一旦立方体机器人通过其一边来平衡，接下来的两个轮子都是瞬间制动，使其通过一角来站立。最后，惯性测试单元（IMU）基于状态预估将会执行，同时电机扭矩将会精确的控制来使立方机器人持续站立。然而研究的一大部分就是尽量避免影响或者克服它的影响10-12，只有一小部分13，包括立方体机器人本身也需要利用它的影响。然而冲击力是被执行机构的扭矩范围限制的，需求的冲击力是远远超出了执行力的上限。图2 立方体机器人的跳跃方式：（a）以一边平躺：最初以一面平躺，这立方体机器人跳起来通过他的一边来站立。（b）一边平衡到一角平衡：这立方体机器人从通过一边的平衡转换到通过一角来平衡。一旦完成，这个立方体机器人将提供一个廉价，开源具有相对小步态的测试平台，用于估计和控制领域的研究和教育。立方体机器人的三维模型设计开始于以下的问题：如何使用现成的电机、电池、电子元器件建立一个15厘米为边长的立方体，并使其可以实现跳跃和利用其一角来平衡的功能呢？由于结构的刚度和现有的组件的约束，在飞轮允许的条件下设计质量分布特性灵活的立方体是基础要求。跳跃时必要的飞轮的角速度是在飞轮和摆动体间的一个完全无弹性计算的假设。虽然在制动之前飞轮拥有高的角速度会被因增加转动惯量所增大的质量而降低。增加飞轮最大质量虽然飞轮的尺寸大小是被限制的。这不是走向一个极端，因为这样会导致减少恢复的角度而平衡。飞轮与电机之间的使用齿轮连接是需要避免的，因为它不允许在较高的角速度下的跳跃，同时那样会增加额外的重量和体积。虽然保持平衡的动作需要较高扭矩，这会受到无齿轮传动方案所影响，但无刷直流电机仍能提供足够的扭矩来恢复其角速度。本文的目的是提出一个三维立方体机器人的概念与一个三维模型设计的发展，模型，识别和控制。这篇文章也展示了一个消除平衡机动过程中传感器的偏移的控制理念。2三维模型图片3说明了一个建造来测试立方体机器人灵活度和发展控制理念的三维模型。基于倒立摆设计的相似动量飞轮，除了制动机制以外，还可以在 5 中找到 7 。原型包括持有动量转移的正方形塑料板，飞轮通过电机在其中心和制动机制使它可以通过一角来站立。塑料的尺寸板与该立方体机器人一个面的尺寸想符合，这被称为以后的钟摆机构。这个塑料板是连接在底部轴承上的，这给它单自由度来使它可以绕着它在水平面转动。A系统动力图3 由一个正方形组成的一维原型的其重心在其中心，通过电机保持动量轮的塑料板的重心在其中心。这个塑料板是安装于轴承底部的。让来表示摆体的倾斜角度，代表旋转位移的飞轮与摆体的夹角。非线性动力学给出了图3所示坐标下的动力学方程定义，为摆动体和飞轮的质量，为摆动体绕支点的转动惯量，为飞轮绕电动机转子为转轴的转动惯量，为电机轴到支点之间的距离，为摆体质量中心和支点之间的距离，g=9.81为重力加速度，为电机产生的扭矩，同时，为钟摆体和飞轮之间的动态摩擦系数。因为我们使用了一个电机，允许电流设定点控制在10Hz的内部循环，目前的转矩关系可以建模为（2）当14为所用的无刷直流电动机的转矩常数，并且为电流值。输入B参数识别本节介绍了确定（1）不能直接测量的参数的程序。是用来识别自由悬挂摆体偏向的不同角度。为识别和,在飞轮以不同的速度驱动时，而摆身体直挺挺地固定，同时的痕迹被记录。通过最小二乘法来测量可得到和。为识别和，经过严格的飞轮和摆体整体安装倒挂了摆动。通过最小二乘法来测量可得到和。下面的表格可以显示所有测量和计算得到的参数值：C制动机制图4，说明了刹车机制的全部原理。金属栅栏和RC伺服器使用薄的金属板连接，以确保大部分的冲击由金属栅栏承受。此外，该设计确保了金属栅栏可以轻易更换。使用RC伺服器的制动机制相较于传统的基于螺旋线圈的制动机制，在质量（少了39g）,供电和耐用性上都有一些优势。为了测试制动机制的耐用性。选择合适的金属作为金属栅栏，做了如下的测试，在摆动体上固定了额外的钢板，以使得整体的质量及惯性与完整的立方体机器人在做边缘起跳时相等。如图8所示。图4. 使用RC伺服器的制动机制的CAD绘图：一个RC伺服器用以将一个金属栅栏（蓝色）与动力轮上的螺栓头（红色）快速碰撞。D电子和软件为防止第一个模型太过复杂，在模型制作时，电源，计算和控制的元件并没有被安装到整体上去。图5表明了除电源以外的全部的电子元件配置。电源采用恒压源。图5 电子装置示意图因为意法半导体的 STM3210E（Cortex-M3内核，72MHz时钟）开发板拥有快速开发原型和高效的社区支持，我们选择其作为主控芯片。IMU（Inertial Measurement Unit，惯性测量单元）由Analog Devices（美国模拟器件公司）的三轴加速度计ADXL345和InvenSense（美国应美盛公司）的三轴陀螺IDG-500/ISZ-500组成。这两个IMU,挂在如图6所示的摆动体的相应位置上。使用两组分立SPI总线与开发板相连。使用一个50W的直流无刷电机，EC-45-flat，从MAXON电机被选为驱动的飞轮为其提供动能，与刷直流相比，它们是高能量密度的马达。嵌入式霍尔传感器的电机被用于测量飞轮转速，传感。电机控制使用现成的数字四象限电机控制器EPOS250/5，来自MAXON公司。CANopen协议用于电机控制器与电机控制器之间的通信板。注意，立方体机器人的微型上述控制器版本，12月模块36 / 2，将被使用。刹车机制的RC伺服器HSG-5084MG,由开发板给出的PPM信号驱动。为了便于调STM32搭载FreeRTOS（类似uc/os的操作系统）用于软件框架中调度程序。因其调度器所提供的区分优先级的多任务处理功能，以及其内核占用空间小（4KB）。ODeV是基于Eclipse IDE开发的完整的且免费的嵌入式系统开发环境，我们使用它作为软件的开发工具。 3、估算与控制A、基于IMU估算倾斜角度和IMU调零为了估计摆动体的倾斜角度,仅使用两个加速度计可以实现基于加速度的倾斜估计。注意该方法可以扩展到立方体机器人的的3D倾斜估计。两个加速度计被安置在摆动体沿着多角线方向，与旋转中心距离，如图6所示。最灵敏的两个测量轴线放置在摆动体平面上，指向切线方向，指向旋转方向。这种安装方式，测量出的加速度计i（i=1,2）的数值，在加速度计坐标系内应当满足如下所给出的公式：动态关系可以消去：其中，估计摆动体的倾斜角度由公式给出。以下的步骤可以鉴别出加速度计在机械定位上的错误：在多个倾斜角度下（），固定摆动体，记录加速度计的测量值。做原理组成分析，以找到符合加速度计坐标系的旋转平面。使测量深入到旋转平面，定义一个参考坐标系，以计算定向偏移。图6,图为使用了两个加速度计来估算摆动体倾斜情况下的示意图。两个加速度计放置在沿着摆动体对角线方向,距离旋转中心为ri（i=1,2）的位置。距离的比值被用来排除测量过程中的动态关系B、起跳过程假定这是一次完美的非弹性碰撞，零回弹系数，起跳所需的动量轮的角速度这样来计算在碰撞中角动量的转换其中为摆动体碰撞后的角速度。碰撞后能量的转换，到摆动体到达顶点 两边消去（3）参数中的不确定因素或者非零的回弹系数会使得脱离计算值。如果这样，利用碰撞后的单调性和 ，可以应用简单的二分法尝试和错误学习步骤到这里来找到所需要的，公式（3）中所给出的可以用做最开始的调解中。在碰撞后，一旦摆动体到达平衡位置附件，基于LQR（线性二次调节器）的控制器，接下来的章节会介绍的，将会开始平衡系统。C、平衡控制将线性化当针对开环不稳定杆（4）（637:4 MS）和安全系数为30选定20毫秒的采样时间为数字控制。使用该采样时间使（4）的连续时间系统进行了离散化零级保持和由此产生的离散时间模型通过当和是连续时间状态矩阵和输入矩阵B的离散时间的连续状态时，为了研究我们用简单的符号来代表相同的连续和离散版本的x和输入状态u。 反馈控制器使用上述的离散时间模型，线性二次型调节器（LQR）的形式设计出来。当为LQR反馈增益，最大限度地减少了成本函数。是速度陀螺仪的角速度估计量，是霍尔传感器的飞轮角速度估计量。图9说明（6）下的平衡性能。从图中可以看出，系统的估计状态收敛。这种行为可以被解释为以下属性的系统：当为尺寸3的恒等矩阵，此属性的物理解释是，如果AD、BD、和KD给出一个稳定的系统，在测量任何常数偏移会导致稳定状态下的一个非零的轮速。使用连接到摆体在枢轴点的绝对编码器的读数，我们定位的偏移在倾斜角度和偏移内的倾斜角度估计量为为了自动消除上述恒定的倾斜角度偏移，在（5）中给出的离散时间系统进行了扩展通过引入一个低通滤波器和状态和下面的动力学方程当同时控制器修改为由闭环系统（5）、（8）和（9）稳定为。现在让表示系统的稳定状态，解决问题的方法为与（8）得出最后，（10）和（11）得到显示系统达到理想的平衡状态。滤波器状态收敛于倾斜角度的偏移量。虽然零均值传感器噪声的测量避免了简单的制定，结果仍然有效的减小此类噪声。图片10显示一个平衡实验与偏移校正。估计状态收敛于同时滤波器状态收敛的偏移值为-0.058度。图片11显示一个平衡的实验系统在外部干扰的时间t=26s。此外，图片12显示了完整的跳跃和平衡动作开始在停止。图7 开始时一维状态下平衡图8. 该图显示了另一个一维模型，在其摆动体左侧增加了一块额外的负重，用来测试制动机制的耐用性。加上所有负重后，便能