机器人协调爬台阶研究和仿真.docVIP

机器人协调爬台阶研究和仿真 【摘要】本文针对两个机器人协调爬台阶的任务， 建立了基于DH参数的机器人的坐标系，基于静力学分析了 最大台阶高度与机器人构型的关系，以及运动学之间的约束 关系，并进行了基于OpenGL的三维运动学仿真。结果表明， 两个机器人协调能够跨越的台阶最大高度与机器人构型和 机器人与台阶间的摩擦系数相关。两个协调机器人可以跨越 的台阶高度大于单个机器人轮子的半径。 【关键词】机器人协调；运动学分析；三维仿真 引言 近年来，基于广泛的应用背景，多机器人协调成为了机 器人领域一个研究热点［1］。两个或更多共同作业的移动机 器人的组合通常称为移动机器人团队或多移动机器人群体， 或者更简明地称为多机器人协调［2 ］。 本文研究的多机器人系统如图1所示［3?6］，由车体和 多个支撑车体的轮子组成，每个轮子都是可拆卸的。车体上 运载着主控制系统、太阳能电池板、通信系统等设备。车体 为父机器人，每个轮子都是个子机器人。当子机器人与车体 连接时，作为车体的一个轮子；当它处于自主分布模式时， 能够自动地从车体上分离，并且独立于车体实现运动和采样 工作。当某个子机器人遇到不可逾越的沟壑等障碍时，其它 子机器人可以与它重构成一个更大的机器人，提高通过能 力，从而实现跨越障碍的目的。在这个系统中，子机器人之 间需要实现重构，子机器人和车体（父机器人）之间也要实 现重构，而且这些重构都是机器人之间自主动态实现的。子 机器人实物照片如图2所示。子机器人的手臂在子机器人运 动的时候，提供了轮子驱动力矩的反作用力；同时，手臂也 可以在子机器人转弯时候，通过调节手臂末端的轮脚角度来 控制子机器人的运动方向。 本文深入分析了多机器人系统的特点，针对两个子机器 人协调爬台阶的任务开展分析研究，经过静力学分析确定了 协调跨越的条件，以及通过运动学逆解算确定了重构构型， 并通过基于OpengGL的三维仿真平台进行了运动学仿真。为 协调控制算法的研究提供了有力的支撑。 运动学分析 该机器人虽然只有5个自由度，由于它的移动性特点， 有两种不同的工作模式：操作模式和运动模式。在运动模式 下，子机器人的大轮子相对于地面作纯滚动。因此，为了能 够同时描述操作模式和运动模式的运动学关系，根据 Denavit-Hartenberg方法，建立了子机器人坐标系，如图3 所示，相应的D-H参数如表1所示。 为便于确定重构构型，开发了图4所示的逆解计算程序， 对于确定跨越台阶时的机器人协调构型将是有力的工具。 静力学分析 3.1任务描述 这里研究两个子机器人通过重构在一起，形成一个环 形，相互协调实现跨越台阶的任务，如图5所示。前边机器 人robot2命名为leader；后边的robot 1命名为followero leader具有运动能力、调节各个关节角度的能力、感知 自身位置和姿态的能力、感知台阶位置与高度的能力和通信 的能力。follower具有运动能力，调节各个关节角度的能 力、感知自身位置和姿态的能力和通信的能力。 3.2静力学分析 设子机器人的大轮子质量为M，手臂部分质量m，手臂 质心到大轮子轴心距离。两个子机器人距离为L。那么当两 个子机器人协调上台阶，robot2与robot 1的重心连线与水 平线的夹角为，系统的受力图可以简化成图6所示。其中表 示robot2要能够爬上台阶所需要的向上的摩擦力。如果， 从静力平衡方程解出的有如下关系：，则能够爬上台阶。 列方程如下： 因此，能够爬上台阶的条件是，摩擦系数必须满足（10） 的条件。或者说，能否爬上台阶由、和三个变量决定。 下边取b=2，，绘制和的关系曲线如图7所示。而且 中曲线上的对应的弧度。 可见，对摩擦系数要求最严格的时刻并不在水平位置 当a=2，时，对应的，即就是必须的条件下，才能够让robot2 爬上台阶。 由此，我们得到在确定的摩擦系数条件下，能够爬上的 台阶最大高度为： 3.3运动学约束 静力学分析说明了在结构参数和摩擦系数符合一定关 系的时候，爬上台阶是可能的。而在图5所示的跨越台阶过 程中，两个机器人必须保持如图所示的构型，或者说两个机 器人必须满足一定的运动约束关系。 在图6所示的坐标系下，令和的坐标分别为：和。那么 构型约束关系描述如下： 爬台阶过程中，在的条件下，只有和是变量，和以及其 它是不变的。 基于OpenGL的三维仿真 在静力学分析和运动学约束研究的基础上，利用已有的 三维仿真实验平台［5］，进行了两个子机器人协调跨越台阶 运动学仿真实验研究。 8中，子图(a)为两个机器人协调运动到台阶前， 子图(b), (c), (d)，(e), (f)，(g)依次为协调爬台阶 的过程，子图(h)是已经爬上台阶的状态。从图8可以看 出，采用两个子机器人协调的方法成功地爬上了台阶，而且 能够