第八章 机器人运动学

第二章 机器人运动学

第二章 机器人运动学 机器人，尤其是其中最为常用的关节型机器人，由若干个关节所联系起来的一种开链，其一端固结在机座上，另一端安装有末端执行器。已知所有关节变量确定机器人末端执行器的位姿或者由末端手的位姿计算出每一个关节变量值是机器人运动学研究的主要内容。 本章主要介绍机器人运动学，首先介绍了 1.1齐次坐标与齐次变换 在描述刚体（如零件、工具或机械手）间关系时，要用到点、向量、坐标系、平移、旋转以及变换等概念，这些概念可用齐次矩阵来表示。 1.1.1空间点的表示 在指定的直角坐标系{}A 中，空间任一点P （图2-1）的位置可用13?的列矢量P A 表 示： [ ] z y x A p p p P = （2.1） 其中x p ，y p ，z p 为点P 的三个坐标分量，P A 的上标A 代表参考坐标系{}A ，称P A 为位置矢量。 图2-1位置表示 1.1.2空间向量的表示 将一个n 维空间的点用1+n 维坐标表示，则该1+n 维坐标即为n 维坐标的齐次坐标，即： [ ] T z y x A p p p P 1= （2.2） 在上式中加入一个比例因子w ，点P 表示为： [ ] T z y x A w c b a P = （2.3） 其中，w p a x x =，w p b y y =，w p c z z =。式2.2和2.3表示同一个点P 。 起始于原点，终止于P 点的空间向量也可以采用齐次矩阵形式表示：

[ ] T z y x w c b a P = （2.4） 若比例因子w 变化，向量的大小也会发生变化，w 大于1，向量所有的分量都变大，如果w 小于1，向量所有的分量都变小，w 等于1，各分量的大小保持不变。w 等于0表示该向量的方向，称为方向向量。如图2-2中，i 、j 、k 分别表示直角坐标系中X 、Y 、Z 坐标轴的单位矢量，用齐次坐标表示为： []T X 0001= []T Y 0010=[]T Z 0100= （2.5） 图2-2中所示的矢量u 的方向表示为： []T u 0cos cos cos γ β α= （2.6） 其中α、β、γ分别为矢量u 与坐标轴的夹角。 1.1.3刚体位姿的表示 为了研究机器人的运动，往往不仅要表示空间某个点的位置，而且需要表示刚体的姿态。指定一个坐标系与此刚体固接，再将此坐标系在空间表示出来，该坐标系称为动坐标系。如 图2-3所示，O '为刚体上任一点，Z Y X O ''' '为固接在刚体上的一个动坐标系，动坐标系的原点与固定坐标系原点之间做一个向量P 来表示动坐标系的位置，即为式2.2。动坐标系的姿态可由其坐标轴方向来表示，令n 、o 、a 分别为X '、Y '、Z '坐标轴的单位向量，每个向量都由其所在固定坐标系中的三个分量表示： [] [][ ] ?? ? ??===T z y x T z y x T z y x a a a a o o o o n n n n 000 （2.7） 动坐标系的位姿可以由三个表示方向的单位向量以及第四个位置向量来表示，式中前三个向量是0=w 的方向向量，表示该坐标系的三个单位向量n 、o 和a 的方向，而第四个 1=w 的向量表示动坐标系的原点相对于固定坐标系的位置。与单位向量不同，向量P 的长 度十分重要，因而比例因子为1。 []????? ???????==10 00 z z z z y y y y x x x x p a o n p a o n p a o n p a o n F （2.8） 由于动坐标系一直固接在该刚体上，只要动坐标系在空间表示出来，刚体相对于固定坐

第二章 2.3工业机器人运动学(二)

第二章机器人基础知识 2.3工业机器人运动学(二) 【内容提要】 本课主要学习工业机器人技术的运动学基础知识，涉及连杆参数及连杆坐标系的建立、连杆坐标系之间的变换矩阵、机器人运动学一般方程，并介绍了正逆向运动学以及实例。 知识要点： ?连杆坐标系 ?连杆坐标系之间的变换矩阵 ?机器人运动学一般方程 重点： ?掌握连杆坐标系之间的变换矩阵 ?掌握机器人运动学一般方程的建立 ?掌握机器人正逆向运动学的实例 难点： ?机器人运动学一般方程的建立 关键字： ?连杆参数、变换矩阵、运动学一般方程、

【本课内容相关资料】 2.3.4 工业机器人的连杆参数和齐次变换矩阵 1. 连杆参数及连杆坐标系的建立 工业机器人相邻连杆之间的关系，与连杆自身的特征和连杆之间的连接方式有关。因此，我们首先应该清楚如何对连杆的特征和连接方式进行描述。 1）连杆特征的描述 如图2.35所示，连杆i 两端有关节i 和i +1。该连杆的特征可以用两个参数来描述：一个是两个关节轴线沿公垂线的距离l i ，称为连杆长度；另一个是在垂直于公垂线的平面内两个轴线的夹角αi ，称为连杆扭角。这两个参数为表述连杆特征的尺寸参数。连杆长度l i 恒为非负数，但连杆扭角αi 可正、可负。αi 的正负是这样规定的：公垂线的正向规定为从 关节i 指向关节i +1，按右手法则从轴线i 绕公垂线转至轴线i +1，逆时针为正，瞬时针为负。两轴线平行时，αi ＝0；两轴线相交时，l i ＝0，此时扭角αi 为两轴线的夹角，正负与X i 轴选向有关。 2）连杆连接方式的描述 如图2.36所示，连杆i 与连杆i -1通过关节i 相连，因此，关节i 的轴线有两条公垂线与它垂直。两条公垂线的相对位置可用两个参数d i 和θi 来确定，其中d i 是沿关节i 轴线测量的两个公垂线与i 轴线交点的距离，当关节轴线相交时，d i 为i 轴线上两交点的距离；θi 是在关节i 轴线的垂直平面内两个公垂线的夹角，当公垂线不存在时，对旋转关节θi 仍然存在。d i 和θi 是表达相邻连杆连接关系的参数。d i 和θi 都可正、可负(详见表2.8)。 这样，相邻两个连杆之间的关系可以由四个参数所描述：其中两个参数（l i 和αi ）描述连杆i 的尺寸；另外两个参数（d i 和θi ）描述连杆i 和连杆i -1之间的连接关系。对于旋转关节，θi 是关节变量，其它三个参数固定不变；对于移动关节，d i 是关节变量，其它三个参数固定不变。(对照图2.36解释，一个关节即为一个自由度) 3）连杆坐标系的建立 D-H 法要求按下面规则建立连杆i 的坐标系{i }（简称i 系）： 1）坐标系{i }与连杆i 固连。Z i 轴与关节i +1的轴线重合，指向任意； 2） X i 轴与连杆i 的两个关节轴线的公垂线重合，方向从关节i 指向关节i +1。当l i 连杆i 关节+1 αi l i 图2.35 连杆尺寸参数l i 及αi