实验指导书(机器人.doc

实验一机器人运动学实验一、基本理论本实验以 SCARA 四自由度机械臂为例研究机器人的运动学问题. 机器人运动学问题包括运动学方程的表示,运动学方程的正解、反解等,这些是研究机器人动力学和机器人控制的重要基础,也是开放式机器人系统轨迹规划的重要基础。机械臂杆件链的最末端是机器人工作的末端执行器(或者机械手),末端执行器的位姿是机器人运动学研究的目标,对于位姿的描述常有两种方法:关节坐标空间法和直角坐标空间法。关节坐标空间: 末端执行器的位姿直接由各个关节的坐标来确定,所有关节变量构成一个关节矢量,关节矢量构成的空间称为关节坐标空间。图 1-1 是GRB400 机械臂的关节坐标空间的定义。因为关节坐标是机器人运动控制直接可以操纵的,因此这种描述对于运动控制是非常直接的。图 1-1 机器人的关节坐标空间图 1-2 机器人的直角坐标空间法直角坐标空间: 机器人末端的位置和方位也可用所在的直角坐标空间的坐标及方位角来描述,当描述机器人的操作任务时,对于使用者来讲采用直角坐标更为直观和方便(如图 1-2 )。当机器人末端执行器的关节坐标给定时,求解其在直角坐标系中的坐标就是正向运动学求解(运动学正解)问题;反之,当末端执行器在直角坐标系中的坐标给定时求出对应的关节坐标就是机器人运动学逆解(运动学反解)问题。运动学反解问题相对难度较大,但在机器人控制中占有重要的地位。机器人逆运动学求解问题包括解的存在性、唯一性及解法三个问题。存在性: 至少存在一组关节变量来产生期望的末端执行器位姿,如果给定末端执行器位置在工作空间外,则解不存在。唯一性: 对于给定的位姿,仅有一组关节变量来产生希望的机器人位姿。机器人运动学逆解的数目决定于关节数目、连杆参数和关节变量的活动范围。通常按照最短行程的准则来选择最优解,尽量使每个关节的移动量最小。解法: 逆运动学的解法有封闭解法和数值解法两种。在末端位姿已知的情况下,封闭解法可以给出每个关节变量的数学函数表达式;数值解法则使用递推算法给出关节变量的具体数值,速度快、效率高,便于实时控制。下面介绍 D-H 变化方法求解运动学问题。建立坐标系如下图所示连杆坐标系{i} 相对于{i ?1} 的变换矩阵可以按照下式计算出,其中连杆坐标系 D-H 参数为由表 1-1 给出。齐坐标变换矩阵为: 其中描述连杆 i本身的特征; 和描述连杆 i?1与i之间的联系。对于旋转关节,仅是关节变量,其它三个参数固定不变;对于移动关节,仅是关节变量,其它三个参数不变。表1-1 连杆参数表其中连杆长 l 1=200mm ,l 2=200mm ,机器人基坐标系为 O-X 0Y 0Z 0 。根据上面的坐标变换公式,各个关节的位姿矩阵如下: 运动学正解: 各连杆变换矩阵相乘, 可得到机器人末端执行器的位姿方程(正运动学模型)为: 其中: z 轴为手指接近物体的方向,称接近矢量 a(approach ); y 轴为两手指的连线方向,称方位矢量 o(orientation );x轴称法向矢量 n(normal ), 由右手法则确定, n=o*a 。p为手爪坐标系原点在基坐标系中的位置矢量。运动学逆解: 通常可用未知的连杆逆变换右乘上式: 令两式对应元素分别相等即可解出。其中将上式回代,可得, 令第二行第四个元素对应相等,可得: 令第四行第三个元素对应相等,可得: 所以, 注