5.2.4 连杆变换矩阵及其乘积
1.机器人运动方程的表示
由于任何串联机器人的机械手臂看作是一系列由关节连接起来的连杆构成的。我们为机械手臂的每一连杆建立一个坐标系,并用齐次变换来描述这些坐标系间的相对位置和姿态。通常把描述一个连杆与下一个连杆间相对关系的齐次变换叫做A变换。一个A矩阵就是一个描述连杆坐标系间相对平移和旋转的齐次变换。本文的基坐标系就是坐标系{0},直接与大地相连。如果A1表示第一个连杆坐标系相对于基坐标系的位置和姿态,即A1=0T1;A2表示第二个连杆坐标系相对于第一个连杆坐标系的位置和姿态,即A2=0T1那么第二个连杆坐标系相对于基坐标系的位置和姿态变换0T1可由A1、A2乘积给出:即0T2=0T11T2=A1A2,同理,若A3表示第三个连杆坐标系相对于第二个连杆坐标系的位置和姿态,则第三个连杆坐标系相对于基坐标系的位置和姿态变换0T3为:0T3=A1A2A3。
同理,一个优连杆机械手可具有优个自由度,每个连杆含有一个自由度,并能在其运动范围内任意定位与定向。其中,三个自由度用于规定位置,而另外三个自由度用来规定姿态。本文的机器人具有6个自由度,用于规定其姿态与位置。毕业论文http://www.youerw.com/
2.构件坐标系的确定
为了描述连杆之间的数学关系,Denavit和Hertenberg提出了为关节链中的杆件建立主附体坐标系的矩阵方法,即D-H法。
连杆串联型机器人是由一系列连接在一起的连杆构成的。需要用两个参数来描述一个连杆,即公共法线距离an和垂直于a n所在平面内两轴的夹角 n;需要另外两个参数来表示相邻两连杆的关系,即两连杆的相对位置dn和两连杆法线的夹角 n,如图5-7所示。
除第一个和最后一个连杆外,每个连杆两端的轴线各有一条法线,分别为前、后相邻连杆的公共法线。这两条法线之间的距离为d n。我们称a n为连杆长度, 为连杆扭角,d n为两连杆距离, n为两连杆夹角。
机器人关节上坐标系的配置取决于机械手连杆连接的类型。其连接方式有两种:转动关节和棱柱联轴节。对于转动关节, n为关节变量。连杆n的坐标系原点位于关节n和关节n+1的公共法线与关节n+1轴线的交点上。如果两相邻连杆的轴线相交于一点,那么原点就在这一交点上。如果两轴线相互平行,那么就选择原点使对下一连杆的距离dn+1为零。连杆n的z轴与关节n+1的轴线在一直线上,而x轴则在连杆n和n+1的公共法线上,其方向从n指向n+1,见图5-7。当两关节轴线相交时,x轴的方向与两矢量的交积z n z n+1平行或反向平行。
<< 上一页 [11] [12] [13] [14] [15] [16] [17]