第三章操作臂运动学1009

操作臂运动学

操作臂运动学研究的是手臂各连杆间的位移关系、速度关系和加速度关系。

机器人的操作机可用—个开环关节链来建模，此链由数个刚体(杆件)用以驱动器驱动的转动或移动关节串连而成。开链的一端固接在基座上，另一端是自由的，安装着工具(末端执行器)，用以操纵物体，或完成装配作业。关节的相对运动导致杆件的运动，使手定位于所需的方位上。在很多机器人应用问题中，人们感兴趣的是操作机末端执行器相对于固定参考坐标系的空间描述。操作臂运动学操作臂运动学为了研究操作贸各连杆之间的位移关系、可在每个连秆上固接一个坐标系，然后描述这些坐标系之涧的关系。Denavit和Hartenbergu提出一种通用的方法，用一“4×4的齐次变换矩阵描述相邻两连杆的空间关系，从而推导出“手爪坐标系”相对于“参考系”的等价齐次变换矩阵，建立操作臂的运动方程。----D-H坐标系连杆描述连杆描述连杆的功能在于保持其两端的关节轴线具有固定的几何关系，连杆的特征也是由这两条轴线规定的。如图3—2所示，连杆i—l是由关节轴线i一1和i的公法线长度ai-1和夹角αi-1所规定的。

ai-1和分别称为连扦i一1的长度和扭角。连杆描述逆时针为正ACB连杆连接的描述首末连杆连接的描述连杆参数连杆本身的参数连杆长度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-1＝0）。如果两个关节轴平行（有无数条公垂线），则原点的选择要使下一个连杆的关节距离为0（di＝0），连杆i-1的z轴与i-1关节轴在一条直线上。x轴与任何存在的公共垂线成一条直线，并且沿着这条垂线从i-1关节指向i关节。在相交关节的情况下，x轴的方向平行或者逆平行zi-1×zi的向量叉积，应该注意，这个条件对于沿着关节i-1和i之间垂线的x轴同样满足。当xi-1和xi平行，且有相同的指向时，则对于第i个转动关节θi＝0。棱形关节：关节变量为di。关节轴的方向就是关节的运动方向。与转动关节不同，轴的运动方向被确定了，但在空间的位置并没有确定（见图2.10）。对于棱形关节，连杆长度ai-1没有意义，所以被设置为0。棱形关节坐标的z轴（zi-1）与连杆i-1的轴在一条直线上，x轴（xi-1）平行或逆平行棱形关节轴的方向（zi-1）与zi的叉积。对于棱形关节，当di=0时，定义为0位置（即坐标原点）。因此棱形关节坐标原点与上一个关节（n-2）坐标原点重合，an-1D-H坐标系的建立D-H坐标系称为连杆变换D-H坐标系D-H坐标系D-H变换用A矩阵表示T矩阵D-H变换D-H坐标系举例D-H坐标系举例D-H坐标系举例D-H坐标系建立求解步骤1)建立D-H坐标系,确定关节变量2）写出D-H参数3)求解连杆变换4)求解运动方程举例：换刀机械手举例：换刀机械手举例：换刀机械手举例：换刀机械手举例：Stanford机器人A1A2A3A4A5A6d1Y1Z1X1O1d2Y2x2Z2O2z4y4x4O4y5z5x5O5z6y6x6O6d3zTxTyTOTdT为右手坐标系原点Oi：i与i+1关节轴线的交点Zi轴：与i关节轴重合，指向任意Xi轴：Zi和Zi+1构成的面的法线(

i与i+1关节轴线的公法线）Yi轴：按右手定则ai-1—沿xi

-1轴，zi与xi

-1轴交点到0i-1的距离αi-1—绕xi-1轴，由zi-1转向zidi—沿zi轴，zi轴和xi-1交点至∑0i坐标系原点的距离θi—绕zi轴，由x