机器人技术 Robotics Technology 第四章:操作臂运动学 授课人:张毅
CHONGQING UNIVERSITY OF POSTS AND TELECOMMUNICATIONS 机器人技术 Robotics Technology 第四章：操作臂运动学 授课人：张毅
连杆-1 连杆描述与运 云 相邻两连杆之间有一个共同的关节轴线。因此,每 关节轴线,有两条公法线与它垂直,每条公法线 相应于一条连杆。这两条公法线(连杆)的距离称为 连杆的偏置,记为d,它代表连相对于连杆i-1的偏 置。两公法线(连杆)之间的夹角成为关节角,记为 0;它表示连杆相对连杆绕该轴线旋转角度 2△彥撑
2 连杆描述与运动学 相邻两连杆之间有一个共同的关节轴线。因此，每 一关节轴线，有两条公法线与它垂直，每条公法线 相应于一条连杆。这两条公法线 (连杆 )的距离称为 连杆的偏置，记为 di，它代表连i相对于连杆i-1的偏 置。两公法线 (连杆 )之间的夹角成为关节角，记为 θi，它表示连杆i相对连杆i-l绕该轴线i的旋转角度
连杆坐标系规定连杆参数 利用连杆坐标系,则连杆参数可以明确地定义为 a=从Z到z沿X测量的距离 aF从乙到2绕X测量的角度; d1=从X到X沿z测量的距离; 0产从X1到X绕z旋转的角度。 3庄大
3 连杆坐标系规定连杆参数 利用连杆坐标系，则连杆参数可以明确地定义为 ： ai = 从 Zi 到 Zi+1 沿 Xi测量的距离； α i = 从 Zi 到 Zi+1 绕 Xi测量的角度； di = 从 Xi-1 到 Xi 沿 Zi测量的距离； θi = 从 Xi-1 到 Xi 绕 Zi旋转的角度
坐标系{相对于坐标系{-1}的变换可以看成是以下 的四个子变换的乘积 1)绕X1轴转&1角; 2)沿X1轴移动a1; 3)绕Z轴转角; 4)沿Z轴移动d。 按照“从左到右”的原则,我们得到 i-T=Rot(X, aTrans(X, a,_Rot(Z, 0)Trans(Z, d,) ce -se 0 seca, ceca. sa, -d sa s61s1-1c61sa1-1ca1 d: cai-1 0 0 0 產尤控
4 坐标系{i}相对于坐标系{i-1}的变换 可以看成是以下 的四个子变换的乘积 1)绕Xi-1轴转αi-1角； 2)沿Xi-1轴移动ai-1； 3)绕Zi轴转θi角； 4)沿Zi轴移动di。 按照“从左到右”的原则，我们得到 1 1 1 ( , ) ( , ) (, ) (, ) i i i ii i T Rot X Trans X a Rot Z Trans Z d i i-1 1 i-1 i 1 i-1 i 1 1 i 1 1i 1 -s 0 a c c s -d c d 0 0 0 1 i i ii i i ii i i i c sc s T ss s c c
运动学方程的建立 连杆变换矩阵是最重要的结果之一,将各连杆变换矩阵 ,2,n-1,顺序相乘,便得到末端连杆坐标系{n叫相对于基坐标 系{0}的变换矩阵。 =2T…"nT=1(41)27(q2)…"7(qn) 根据关节变量q,i=1,2,…,6,的值,利用运动学 方程,便可计算出手臂变换矩阵 的各个元素。 得到手爪相对基座(或工作站)的位姿。 通常把关节矢量构成的空间为关节空间,而把手 爪位姿构成的空间为操作空间。由关节空间向操作空 间的映射为正运动学,其逆映射为反向运动学。 5庄大
5 运动学方程的建立 连杆变换矩阵是最重要的结果之一，将各连杆变换矩阵 ，i=1 ，2，n-1，顺序相乘，便得到末端连杆坐标系{n}叫相对于基坐标 系{0}的变换矩阵。 0 01 1 0 1 1 1 2 1 12 2 () () () n n n n nn T TT T Tq Tq Tq 根据关节变量qi，i=1，2，…，6，的值，利用运动学 方程，便可计算出手臂变换矩阵 的各个元素。 得到手爪相对基座 (或工作站)的位姿。 通常把关节矢量构成的空间为关节空间，而把手 爪位姿构成的空间为操作空间。由关节空间向操作空 间的映射为正运动学，其逆映射为反向运动学。 T i i 1 T i i 1