六轴运动机器人运动学求解分析_第一讲.pdfVIP

六轴联动机械臂运动学求解分析 第一讲 作者 朱森光 Email zsgsoft@ 1 引言 笔者研究六轴联动机械臂源于当前的机器人产业热，平时比较关注当前热门产业的发展方向。笔者工作主要从事软件开发跟机器人毫无关系，利用业余时间研究整 理机器人技术相关的文章，希望能够起到抛砖引玉的作用引发更多的人发表有关机器人技术的原创性技术资料。本系列文章的所有文字、图片及相关资料均为原创，内 容正确性经过笔者亲自编程仿真验证可以信赖。 2 机器建模 2.1 坐标系 既然要研究机器人，那么首先要建立一个机械模型，本文将以典型的六轴联动机器臂为例进行介绍，图 2-1 为笔者使用 3D 技术建立的一个简单模型。首先建立一 个大地坐标系，一般教科书上都是以大地为 XY 平面，垂直于大地向上方向为 Z 轴，本文为了跟教科书上有所区别同时不失一般性，将以水平向右方向为 X 轴，垂直于 大地向上方向为 Y 轴，背离机器人面向人眼的方向为 Z 轴，移到电脑屏幕上那就是屏幕水平向右为 X 轴，屏幕水平向上为 Y 轴，垂直于屏幕向外为 Z 轴，之所以建立 这样不合常规的坐标系是希望能够突破常规的思维定势训练在任意空间建立任意坐标系的能力。 图2-1 图 2-1 中的机械臂，灰色立方体为机械臂底座，定义为关节 1，它能绕图中 Y 轴旋转；青色为关节 2 ，它能绕图中的 Z1 轴旋转；蓝色为关节 3，它能绕图中的 Z2 轴旋转；绿色为关节 4 ，它能绕图中的X3 轴旋转；红色为关节 5，它能绕图中的Z4 轴旋转；黄色为关节 6，它能绕图中的X5 轴旋转。 2.2 齐次变换矩阵 齐次变换矩阵是机器人技术里最重要的数学分析工具之一，关于齐次变换矩阵的原理很多教科书中已经描述在此不再详述，这里仅针对图 2-1 的机械臂写出齐次变 换矩阵的生成过程。首先定义一些变量符号，关节 1 绕图中 Y 轴旋转的角度定义为θ0，当θ0=0 时，O1 点在 OXYZ 坐标系内的坐标是(x0,y0,0)；关节 2 绕图中的 Z1 轴旋转的角度定义为θ1，图中的θ1 当前位置值为+90 度；定义 O1O2 两点距离为 x1, 关节 3 绕图中的 Z2 轴旋转的角度定义为θ2，图中的θ2 当前位置值为-90 度； O2O3 两点距离为 x2，关节 4 绕图中的 X3 轴旋转的角度定义为θ3, 图中的θ3 当前位置值为-60 度；O3O4 两点距离为 x3，关节 5 绕图中的 Z4 轴旋转的角度定义为θ4, 图中的θ4 当前位置值为-60 度；O4O5 两点距离为 x4，关节 6 绕图中的X5 轴旋转的角度定义为θ5, 图中的θ5 当前位置值为+60 度。以上定义中角度正负值定义符合 右手法则。符号定义好了，接下来描述齐次变换矩阵。 定义 R0 为关节 1 绕 Y 轴的旋转矩阵 R0=[c0 0 s0 0 //c0 = cos θ0 s0 = sinθ0 0 1 0 0 -s0 0 c0 0 0 0 0 1] 定义 T0 为坐标系 O1X1Y1Z1 相对坐标系 OXYZ 的平移矩阵 T0=[1 0 0 x0 0 1 0 y0 0 0 1 0 0 0 0 1] 定义 R1 为关节 2 绕 Z1 轴的旋转矩阵 R1=[c1 –s1 0 0 s1 c1 0 0 0 0 1 0 0 0 0 1] 定义 T1 为坐标系 O2X2Y2Z2 相对坐标系 O1X1Y1Z1 的平移矩阵 T1=[1 0 0 x1 1 1 0 0 1 0 1 0 0 0 0 1] 定义 R2 为关节 3 绕 Z2 轴的旋转矩阵 R2=[c