机器人技术复习资料.ppt

第三章 机器人运动学 机器人关节运动副基本类型 机器人位姿变换矩阵T “右乘联体左乘基” 可理解为： 从基（静）坐标系变换到联体坐标系→右乘 基（静）坐标系变换到基坐标系→左乘 例2、下图在机器人及工作环境中，建立了基座坐标系{B}，腕（末端）坐标系{W}，工具坐标系{T}，工作台坐标系{S}，工件坐标系{G}。 求齐次变换矩阵 （10分）。 解： 机器人的雅可比矩阵 雅可比矩阵：机械手的笛卡儿空间运动速度与关节空间运动速度之间的变换称之为雅可比矩阵。关节空间向笛卡儿空间速度的传动比。 设x为表示机械手末端位姿的广义位置矢量， q为机械手的关节坐标矢量, n个关节则为n维矢量 例4.一个三自由度机械手，其末端夹持一质量m =10 kg的重物，l1=l2=0.8 m，θ1=60°，θ2=?–60°，θ3=?–90°。不计机械手的质量，求平衡时机械手的各关节力矩。 解： * * 机器人的位置与姿态 为描述机器人及其组成系统的各个元器件 (杆件、手部等)的位置与姿态即（位姿pose），确定它们之间的运动关系，需要建立机器人坐标系统。 采用笛卡尔（Cartesian）正交坐标系——直角坐标系。 机器人在空间的位姿由位置矢量（3×1）和旋转矩阵（3×3）共同表示。 位置(location)自由度和姿态 (orientation)自由度称为物体的位姿。 动系X轴相对于静系的位置 动系Y轴相对于静系的位置 动系Z轴相对于静系的位置 动系原点相对于静系的位置 动系即是联体坐标系， 静系即是基准参考坐标系。 例1.下图正方体边长为1，已知 P2（1，0，0）点和三套坐标系，求P0和0A1 ，0A2. x0 y0 z0 x1 y1 z1 x2 z2 y2 1 1 1 P {B} {S} {G} {T} {W} ??雅可比矩阵 两空间之间速度的线性映射关系—雅可比矩阵（简称雅可比）。它可以看成是从关节空间到操作空间运动速度的传动比，同时也可用来表示两空间之间力的传递关系。 vx vy 存在怎样的关系 看一个两自由度平面关节机器人的末端点位置（x，y） 图4- 1 两自由度平面关节机器人 容易求得 将其微分得 写成矩阵形式 令末端位姿 则 ??雅可比矩阵 若J是关节空间向操作空间的映射（微分运动矢量），则 把操作空间的广义力矢量映射到关节空间的关节力矢量。 关节空间 操作空间 雅可比J 力雅可比JT 解：由前面的推导知 例3如图3-18所示的平面2R机械手，手爪端点与外界接触，手爪作用于外界环境的力为 ，若关节无摩擦力存在，求力 的等效关节力矩 。 所以得： 图3-18 关节力和操作力关系 y0 x0 *