机器狗运动分析Word文档格式.docx

机器狗运动分析Word文档格式.docx

《机器狗运动分析Word文档格式.docx》由会员分享，可在线阅读，更多相关《机器狗运动分析Word文档格式.docx（9页珍藏版）》请在冰豆网上搜索。

给出：

T2=A1A2．

同理，若A表示第三个连杆相对于第二个连杆的位置和姿态，则有：

T3=A1*A2*A3

对于六连杆机器人，有下列矩阵：

T6=Al*A2*A*3*A4*A5*A6．

一个六连杆机械手可具有六自由度，每个连杆含有一个自由度，并能在其运动范围内任意定位与定向．其中，3个自由度用于规定位置，而另外3个自由度用来规定姿态。

表示机械手末端相对于绝对坐标系的位置和姿态。

1．1位置和方向的表示方法

六连杆机器人的位姿矩阵用笛卡儿坐标系的位姿矩阵来表示是最简单和最实用的．图1表示机器人的一个夹手把所描述的坐标系的原点置于夹手指尖的中心，此原点由矢量表示。

描述夹手方向的3个单位矢量的指向如下向矢量处于夹手进人物体的方向上，并称之为接近矢量a；

Y向矢量的方向从一个指尖指向另一个指尖，处于规定夹手方向上，称为方向矢量0；

最后一个向矢量叫做法线矢量n，它与矢量。

和a一起构成一个右手矢量集合，并由矢量的交乘所规定：

n

=o×

a．因此，变换具有下列元素：

2六连杆机器人的正运动学方程

六连杆机器人在实际工作中大部分是从零位运动到工作位置，对于极特殊的情况机器人是从非零位运动到工作位置，对于这种特殊初始位置的机器人的正运动学方程的求解只需要将其初始位置时相邻杆件之间的a角度值代人式（3）中即可．

2．1零位时的各杆坐标系

零位时的各杆坐标系见图3．

2．2Denavit—Hartenberg参数表

六连杆机器人连杆与关节参数见表1

2．3运动学方程演算

应用法可得六连杆机器人的A变换如下：

其中，Cn=cosAn,Sn=sinAn,n=1,2,3,4,5,6．

机器人的A变换的积表示如下

（1）

（2）

（3）（4）

其中：

3六连杆机器人运动学方程的逆解

逆解是已知满足某作业要求时，末端执行器的空间位置和姿态以及各杆的结构参数，求关节变量，称作机器人运动学逆问题．这个问题，是机器人应用中极为重要的问题，是对机器人进行位置控制的关键．因为只有使各关节按逆解中所

得关节变量值进行移动或转动，才能使末端执行器达到作业所要求的位置和姿态．

3．1A矩阵的逆矩阵公式

由式（3）按逆矩阵求法可得A的逆矩阵公式

3．2六连杆机器人运动学方程的逆解公式

当式

（2）给出的已知时，由

T6=AlA2A3A4A5A6

两边左乘A1得：

其中，+号对应向左旋转，-号对应向右旋转。

4结论

1、从推导出的逆解可以看出，六连杆机器人的逆解是不唯一的（称多解）．机器人操作臂运动学反解的数目取决于关节数目和连杆参数（对于旋转关节操作臂指的是ai和di）和关节变量的取值范围.一般来说，非零的连杆参数愈多，到达某一目标的方式也愈多，即运动学反解数目愈多．对于六连杆机器人,表2列出了反解的最大数目与连杆长度ai≠0的数目之间的关系，可见，非零的连杆长度（a≠0）的数目越多，六连杆机器人的运动学反解的数目也越多，最多可达16．本文推导的六连杆机器人的运动反解共有16组解，但是，由于结构的限制，例如各关节变量不能全部在360.范围内运动，有些解不能实现．在六连杆机器人存在多种解的情况下，应该选择其中最满意的一组解，以满足机器人工作的要求，这就要求根据六连杆机器人的正解和反解对实际工作中的机器人的轨迹规划进行优化分析．

2、本文采用符号法推导出的六连杆机器人的正解和逆解具有通用性，对于任意的六连杆机器人都是适用的，在针对具体的六连杆机器人的运动学求解过程中，只需将具体的杆长和@角的具体值代入本文所推导的公式中即可．

3、本文推出的正向演算公式和逆解公式为实现六连杆机器狗的动力学研究和轨迹规划提拱了理论支持和数学模型，使对该机器人运动学的模拟仿真成为可能。