资源描述：
《机器人正运动学和逆运动学课件.pptx》由会员上传分享，免费在线阅读，更多相关内容在教育资源-天天文库。
1、3.机器人正逆运动学3.1机器人正运动学方程3.2机器人逆运动学方程本章主要内容机器人运动学研究的问题：机器人末端在空间的运动与各个关节的运动之间的关系。3.1机器人正运动学方程定义：描述机器人末端相对于绝对坐标系或基座坐标系的位置姿态的数学表达式运动学方程的模型：M——机器人手在空间的位姿qi——机器人各个关节变量已知杆件几何参数和关节角求机器人末端相对于参考坐标系的位置和姿态。3.1机器人正运动学方程3.1机器人正运动学方程连杆描述连杆连接的描述对连杆附加坐标系的规定机器人运动学PUMA560运动
2、学方程机器人的各连杆通过关节连接在一起，关节有移动副与转动副两种。关节和连杆的编号：机座称杆件0，…机座与杆件1的关节编号—关节1,类推之.关节编号3.1.1连杆描述描述一个连杆的两个参数:1、连杆长度ai-1关节轴i-1和关节轴i之间的公垂线的长度ai-1假设条件把连杆看作是一个刚体2、连杆扭角αi-1假设作一个平面,并使该平面与两关节轴之间的公垂线垂直,然后把关节轴i-1和关节轴i投影到该平面上,在平面内轴i-1按照右手法则转向轴i,测量两轴角之间的夹角为αi-1.3.1.2连杆连接的描述描述连杆
3、连接的两个参数:1)linkoffset连杆偏距di.相邻两个连杆之间有一个公共的关节，沿着两个相邻连杆公共法线线的距离可以用一个参数描述为连杆偏距di.当i为移动关节时,连杆偏距为一变量.（1）连杆中的中间连杆2)jointangle关节角θi.描述两个相邻连杆绕公共轴线旋转的夹角θi.当i为转动关节时,关节角为一变量.3.1.2连杆连接的描述（2）连杆中的首尾连杆对于运动链中的末端连杆,其参数习惯设为0,即从关节2到关节n的连杆偏距di和关节角θi.是根据前面的规定进行定义.关节1(或n)如果为转
4、动关节,则θ1的零位可以任意选取,规定d1=0.0，关节1(或n)如果为移动关节,则d1的零位可以任意选取,规定θ1=0.0;3.1.2连杆连接的描述（3）连杆参数对于转动关节,θi为关节变量,其他三个参数固定不变;对于移动关节,di为关节变量,其他三个参数固定不变;这种用连杆参数描述机构运动关系的方法称为Denavit-Hartenberg参数法,对于一个6关节机器人,需要用18个参数完全描述这些固定的运动学参数,可用6组(ai-1,αi-1,di)表示，用6个关节变量θi描述运动学中的变化部分。3
5、.1.3连杆附加坐标系的规定为了描述每个连杆和相邻连杆之间的相对位置关系,需要在每个连杆上定义一个固连坐标系.（1）连杆中的中间连杆规定:坐标系{i-1}的Z轴称为Zi-1,与关节轴i-1重合;坐标系{i-1}的原点位于公垂线ai-1与关节轴i-1的交点处.Xi-1轴沿ai-1方向由关节i-1指向关节i(若:ai-1=0,则Xi-1垂直于Zi-1和Zi所在的平面;Yi-1轴由右手定则确定Yi-1=Zi-1×Xi-13.1.3连杆附加坐标系的规定坐标系{0}通常规定:Z0轴沿着关节轴1的方向,当坐标系1
6、的关节变量为0时,设定参考坐标系{0}与{1}重合.且a0=0,α0=0,当关节1为转动关节,d1=0;当关节1为移动关节,θ1=0.坐标系{n}通常规定:对于转动关节n,设定θn=0.0,此时Xn和Xn-1轴的方向相同,选取坐标系{n}的原点位置,使之满足dn=0;对于移动关节n,{n}的设定使之满足θn=0.0，且当dn=0时,Xn与Xn-1重合.(2)连杆中的首尾连杆3.1.3连杆附加坐标系的规定（3）在连杆坐标系中对连杆参数的归纳αi-1通常规定,其余可正可负.按照上述规定的坐标系不是唯一的；
7、Zi的指向有两种选择;如果关节轴相交,Xi轴的指向也有两种选择.当相邻两轴平行时,坐标系原点可以任意选择.当关节为移动关节时,坐标系的选取具有一定任意性.3.1.3连杆附加坐标系的规定确定关节轴，并画出轴的延长线。找出关节轴i-1和i的公垂线或交点，作为坐标系i-1的原点。规定Zi-1的指向是沿着第i-1个关节轴。规定Xi-1轴得指向是沿着轴i-1和i的公垂线的方向，如果关节轴i-1和i相交，则Xi-1轴垂直于关节轴i-1和i所在的平面。Yi-1轴的方向由右手定则确定Yi-1=Zi-1×Xi-1。当第
8、一个关节变量为0时，规定坐标系{0}和{1}重合，对于坐标系{N}，尽量选择坐标系使得连杆参数为0.（4）建立连杆坐标系的步骤αi-13.1.3连杆附加坐标系的规定【例题1】iai-1αi-1diθi1000θ12L100θ23L200θ33.1.4操作臂运动学方程目的：求出相邻连杆间的坐标变换的形式，进一步求出连杆n相对于连杆0的位置和姿态。（1）推导过程：1.坐标系{i-1}相对于坐标系{i}的变换是由连杆四个参数构成的函数，其中只有一个变量。2.为
