第三章操作臂运动学201111



《第三章操作臂运动学201111》由会员分享,可在线阅读,更多相关《第三章操作臂运动学201111(57页珍藏版)》请在文档大全上搜索。
1、操作臂运动学 操作臂运动学研究的是手臂各连杆间的位移关系、速度关操作臂运动学研究的是手臂各连杆间的位移关系、速度关系和加速度关系。系和加速度关系。 机器人的操作机可用个开环关节链来建模,此链由数个刚体(杆件)用以驱动器驱动的转动或移动关节串连而成。开链的一端固接在基座上,另一端是自由的,安装着工具(末端执行器),用以操纵物体,或完成装配作业。关节的相对运动导致杆件的运动,使手定位于所需的方位上。在很多机器人应用问题中,人们感兴趣的是操作机末端执行器相对于固定参考坐标系的空间描述。操作臂运动学操作臂运动学 为了研究操作贸各连杆之间的位移关系、可在每个连秆上固接一个坐标系,然后描述这些坐标系之涧的
2、关系。Denavit和Hartenbergu提出一种通用的方法,用一“44的齐次变换矩阵描述相邻两连杆的空间关系,从而推导出“手爪坐标系”相对于“参考系”的等价齐次变换矩阵,建立操作臂的运动方程。-D-H坐标系坐标系连杆描述连杆描述连杆的功能在于保持其两端的关节轴线具有固定的几何关系,连杆的特征也是由这两条轴线规定的。如图32所示,连杆il是由关节轴线i一1和i的公法线长度a i-1和夹角 i-1 所规定的。 a i-1和 分别称为连扦i一1的长度和扭角长度和扭角。1i1ii公垂线绕1一i向规规定为从轴1 - i转至轴线正连杆描述逆时针为正011455431arccos22lopaACB连杆连
3、接的描述测量。到由i之间间角,绕轴表示测量;i,的交点间交点间的距离i与轴轴“的交点到i轴线表示d节角。称为为两条连杆之间的之间间的的夹 ;称为为条连杆之间间的距离d之所示。两示。两条公43,图i代表连表1;一i代表连表. 表一条连一条每条公法线代有两两公法线与它垂直i相连连,因此关节轴i由关1一i和i连杆相邻 杆中间11i1ii1i11iiiiiiiiiiiiaaaaaaaaaaaa与沿轴线与与偏置与连杆节两连首末连杆连接的描述0 0aa,0的零位。10为为量变是可变可变的,称为动关节,则是1若关,0d的零位。10为为量变是可变可变的,称为是转转动关节,1若关6060111111习惯约定杆,
4、规定节变移节习惯约定杆,规定节变节d连杆参数连杆本身的参数连杆长度ai-1连杆两个轴的公垂线距离(x方向)连杆扭转角i-1连杆两个轴的夹角(x轴的扭转角)连杆之间的参数连杆之间的距离di相连两连杆公垂线距离(z方向平移距)连杆之间的夹角i相连两连杆公垂线的夹角(z轴旋转角)为了描述连杆之间的关系,我们对每个连杆赋一个坐标系,D-H坐标系D-H 坐标系的建立D-H 坐标系的建立转动关节转动关节:关节变量为i。连杆i-1的坐标原点设在关节i-1和关节i轴之间的公共垂线与关节i-1轴的交点上。在关节轴相交的情况下(无公垂线),这个原点就在两个关节轴的相交点上(ai-10)。如果两个关节轴平行(有无数
5、条公垂线),则原点的选择要使下一个连杆的关节距离为0(di0),连杆i-1的z轴与i-1关节轴在一条直线上。x轴与任何存在的公共垂线成一条直线,并且沿着这条垂线从i-1关节指向i关节。在相交关节的情况下,x轴的方向平行或者逆平行zi-1zi的向量叉积,应该注意,这个条件对于沿着关节i-1和i之间垂线的x轴同样满足。当xi-1和xi平行,且有相同的指向时,则对于第i个转动关节i0。 棱形关节棱形关节:关节变量为di。关节轴的方向就是关节的运动方向。与转动关节不同,轴的运动方向被确定了,但在空间的位置并没有确定(见图2.10)。对于棱形关节,连杆长度ai-1没有意义,所以被设置为0。棱形关节坐标的
6、z轴(zi-1)与连杆i-1的轴在一条直线上,x轴(xi-1)平行或逆平行棱形关节轴的方向(zi-1)与zi的叉积。对于棱形关节,当di=0时,定义为0位置(即坐标原点)。因此棱形关节坐标原点与上一个关节(n-2)坐标原点重合,an-1D-H 坐标系的建立D-H坐标系 同一直线移到与,把d移一距离轴z沿(4) .同一平面内x转到与角,使轴旋转z(3)绕 重合。z的i与连连的坐标坐标系1一i,把连a移一距离轴(2)沿 z轴z轴(1) i1 - iiii1 - iii1 - i1 - ii1 - i1 - i1 - ixxxxx平轴轴原点杆平同一直线上。转到与角,使旋转绕称为连杆变换Ti1 - i
7、D-H坐标系1ixD-H坐标系D-H变换用A矩阵表示T矩阵D-H变换D-H坐标系举例100001111111111iiiiiiiiiiiiiiiiiiicdcscsssdscccsascTD-H坐标系举例D-H坐标系举例D-H坐标系建立求解步骤n1)建立D-H坐标系,确定关节变量n2)写出D-H参数n3)求解连杆变换n4)求解运动方程举例:换刀机械手举例:换刀机械手举例:换刀机械手举例:换刀机械手举例:Stanford机器人A1A2A3A4A5A6d1Y1Z1X1O1d2Y2x2Z2O2z4y4x4O4y5z5x5O5z6y6x6O634545,0o o odd重重合合d3zTxTyTOTdT