机器狗运动分析

1、1 六连杆机器狗机构运动学方程的建立机器狗机构是由一系列关节连接起来的连杆机构所组成，为机械手的每一连杆建立一个坐标 系，并用齐次变换来描述这些坐标系间的相对位置和姿态通常把描述一个连杆和下一个连杆间相对关系的齐次变换叫做a 矩阵a矩阵就是一个描述连杆坐标系间相对平移和旋转 的齐次变换如果a 表示第一个连杆对于基系的位置和姿态 ，a 2表示第二个连杆相对于第一个连杆的位置和姿态 ，那么第二个连杆在基系中的位置和姿态可由下列矩阵的乘积给 出 ： t2= a1a2同理，若a表示第三个连杆相对于第二个连杆的位置和姿态，则有 ：t3= a1*a2* a3对于六连杆机器人，有下列矩阵 ：t6= al*a

2、2*a*3*a4*a5*a6 一个六连杆机械手可具有六自由度，每个连杆含有一个自由度，并能在其运动范 围内任意定位与定向其中，3个自由度用于规定位置，而另外3个自由度用来 规定姿态。表示机械手末端相对于绝对坐标系的位置和姿态。11 位置和方向的表示方法六连杆机器人的位姿矩阵用笛卡儿坐标系的位姿矩阵来表示是最简单和最实用 的 图 1 表示机器人的一个夹手把所描述的坐标系的原点置于夹手指尖的中心，此原点由矢量表示。描述夹手方向的3个单位矢量的指向如下向矢量处于夹手进人物体的方向上 ，并称之为接近矢量 a ；y向矢量的方向从一个指尖指向另一个指尖 ，处于规定夹手方向上，称 为方向矢量 0；最后一个向

3、矢量叫做法线矢 量n，它与矢量。和a一起构成一个右手矢量集合，并由矢量的交乘所规定：n= o×a 因此，变换具有下列元素 ：2 六连杆机器人的正运动学方程六连杆机器人在实际工作中大部分是从零位运动到工作位置 ，对于极特殊的情况机器人是从非零位运动到工作位置 ，对于这种特殊初始位置的机器人的正运 动学方程的求解只需要将其初始位置时相邻杆件之间的a角度值代人式 ( 3 ) 中即可 21 零位时的各杆坐标系零位时的各杆坐标系见 图 3 22 d e n a v i t h a r t e n b e r g 参 数 表六连杆机器人连杆与关节参数见表 123 运动学方程演 算应用d.h法可得

4、六连杆机器人的a变换如下 ：其中，cn = cos an , sn=sin an,n= 1,2 ,3,4,5,6 机器人 的 a变换 的积表示 如下( 1 )( 2 )( 3 )( 4 )其中：3 六连杆机器人运动学方程的逆解逆解是已知满足某作业要求时，末端执行器的空间位置和姿态以及各杆的结构参数，求关节变量，称作机器人运动学逆问题这个问题，是机器人应用中极为重要的问题，是对机器人进行位置控制的关键因为只有使各关节按逆解中所 得关节变量值进行移动或转动 ，才能使末端执行器达到作业所要求的位置和姿态 31 a 矩阵的逆矩阵公式由式( 3 )按逆矩阵求法可得 a 的逆矩阵公式32 六连杆机器人运动

5、学方程的逆解 公式当式( 2 )给出的已知时，由t6 =al a2 a3 a4 a5 a6 两边左乘 a1得 ： 其中，+号对应向左旋转，-号对应向右旋转。4 结论1、从推导出的逆解可以看出，六连杆机器人的逆解是不唯一的(称多解 )机器人操作臂运动学反解的数目取决于关节数目和连杆参数(对于旋转关节操作臂指的是ai和di)和关节变量的取值范围.一般来说，非零的连杆参数愈多，到达某一目标的方式也愈多，即运动学反解数目愈多对于六连杆机器人,表2列出了反解的最大数目与连杆长度ai0的数目之间的关系，可见，非零的连杆长度(a0)的数目越多，六连杆机器人的运动学反解的数目也越多 ，最多可达16本文推导的六连杆机器人的运动反解共有 16 组解，但是，由于结构的限制，例如各关节变量不能全部在 360.范围内运动，有些解不能实现在六连杆机器人存在多种解的情况下，应该选择其中最满意的一组解，以满足机器人工作的要求，这就要求根据六连杆机器人的正解和反解对实际工作中的机器人的轨迹规划进行优化分析 2、本文采用符号法推导出的六连杆机器人的正解和逆解具有通用性，对于任意的六 连杆机器人都是适用的，在针对具体的六连杆机器人的运动学求解过程中，只需将具体的杆长