工业机器人优秀教案

1 5 教案 章 节备课 学时 8 章 节 第二章第二章 操作臂运动学操作臂运动学 第一节 齐次坐标与动系位姿矩阵 第二节 齐次变换 第三节 机器人的位姿分析 第四节 机器人的运动学 教学目的 和要求 机器人运动学研究机器人运动的几何关系 而不考虑引起运动的力 掌握 机器人运动学的基础知识 包括齐次坐标 齐次变换 连杆参数及机器人正向 和逆向运动学 掌握齐次坐标及齐次变换 掌握工业机器人杆件坐标系建立的方法及其齐 次变换矩阵 掌握工业机器人运动学方程 教学 重点 难点 重点 齐次坐标和齐次变换 机器人运动学方程 难点 杆件坐标系建立的方法 坐标系间的齐次变换矩阵 教学进程 含章节 教学内容 学时分配 教学方法 教学手段 辅助手段 第一节 位姿描述 2 学时 讲授 1 齐次坐标 2 动系的位姿表示 第二节 齐次变换 2 学时 讲授 1 旋转齐次变换 2 平移齐次变换 3 复合变换 第三节 操作臂的位姿分析 2 学时 讲授 1 杆件坐标系的建立 2 连杆坐标系间的变换矩阵 第四节 操作臂的运动学 2 学时 讲授 1 机器人的运动学 2 机器人逆运动学的解 作业 主要 参考资料 教材 熊有伦 机器人技术基础 华中科技大学出版社 1996 教学参考书 1 刘极峰 机器人技术基础 高等教育出版社 2006 2 陈恳 机器人技术与应用 清华大学出版社 2006 3 蔡自兴 机器人学 清华大学出版社 2005 备注 2 5 图 2 1 空间任一点的坐标表示 教案 课时备课 第 3 次课 2 学时 课目 课 题 第一节 位姿描述 1 齐次坐标 2 动系的位姿表示 教学目的 和要求 掌握齐次坐标及动系位姿表示 重点 难点 重点 齐次坐标和动系位姿表示 难点 动系位姿表示 教学进程 含课堂 教学内容 教学方法 辅助手段 师生互动 时间分配 板书设计 一 复习一 复习 二 讲授新课二 讲授新课 2 12 1 位姿描述位姿描述 2 1 1 齐次坐标 一 空间任意点的坐标表示 在选定的直角坐标系 A 中 空间任一 点 P 的位置可以用 3 1 的位置矢量 AP 表示 其左上标表示选定的坐标系 A 此时 AP P PX PY PZ T 式中 PX PY PZ是点 P 在坐标系 A 中的 三个位置坐标分量 如图 2 1 所示 二 齐次坐标表示 将一个 n 维空间的点用 n 1维坐标表示 则该 n 1 维坐标即为 n 维坐 标的齐次坐标 一般情况下 w 称为该齐次坐标中的比例因子 当取 w 1时 其表示方法称为齐次坐标的规格化形式 即 P PX PY PZ 1 T 三 坐标轴的方向表示 i j k 分别表示直角坐标系中 X Y Z 坐标轴的单位矢量 用齐次坐标 表示之 则有 X 1 0 0 0 T Y 0 1 0 0 T Z 0 0 1 0 T 由上述可知 若规定 4 1 列阵 a b c w T中第四个元素为零 且满足 a2 b2 c 2 1 则 a b c 0 T中 a b c 的表示某轴的方向 4 1 列阵 a b c w T中第四个元素不为零 则 a b c w T表示空间某点的位置 3 5 图 2 2 坐标轴及矢量的方向表示 图 2 4 连杆的位姿表示 四 矢量的方向表示 图 2 2 中所示的矢量 u 的方向用 4 1 列 阵可表达为 u a b c 0 T a cos b cos c cos 图 2 2 中所示的矢量 u 的起点 O 为坐标 原点 用 4 1 列阵可表达为 O 0 0 0 1 T 例 2 1 用齐次坐标表示图 2 3 中所示的 矢量 u v w 的坐标方向 图 2 3 用不同方向角表示方向矢量 u v w 2 1 2 位姿描述 在机器人坐标系中 运动时相对于连杆不动的坐标系称为静坐标系 简 称静系 跟随连杆运动的坐标系称为动坐标系 简称为动系 动系位置与姿 态的描述称为动系的位姿表示 是对动系原点位置及各坐标轴方向的描述 一 连杆的位姿描述 设有一个机器人的连杆 若给定了连杆 PQ 上某点的位置和该连杆在空 间的姿态 则称该连杆在空间是完全确定的 如图 2 4 所示 O 为连杆上任一点 O X Y Z 为与连杆固接的一个动坐标 系 即为动系 连杆 PQ 在固定坐标系 OXYZ 中的位置可用一齐次坐标表示为 连杆的姿态可由动系的坐标轴方向来 表示 令 n o a 分别为 X Y Z 坐标 轴的单位矢量 各单位方向矢量在静系上 的分量为动系各坐标轴的方向余弦 以齐 次坐标形式分别表示为 由此可知 连杆的位姿可用下述齐次矩阵表示 4 5 显然 连杆的位姿表示就是对固连于连杆上的动系位姿表示 例 2 2 图 2 5 表示固连于连杆的坐标系 B 位于 OB点 XB 2 YB 1 ZB 0 在XOY 平面内 坐标系 B 相对固定坐标系 A 有一个 30 的偏 转 试写出表示连杆位姿的坐标系 B 的 4 4 矩阵表达式 图 2 5 动坐标系 B 的位姿表示 二 手部的位姿描述 机器人手部的位置和姿态也可以用固连于手部的坐标系 B 的位姿来表 示 如图 2 6 所示 坐标系 B 可以这样来确定 取手部的中心点为原点 OB 关节轴为 ZB轴 ZB轴的单位方向矢量 a 称为接近矢量 指向朝外 两 手指的连线为 YB轴 YB轴的单位方向矢量 o 称为姿态矢量 指向可任意选定 XB轴与 YB轴及 ZB轴垂直 XB轴的单位方向矢量 n 称为法向矢量 且 n o a 指向符合右手法则 图 2 6 手部的位姿表示 手部的位置矢量为固定参考系原点指向手部坐标系 B 原点的矢量 P 手 部的方向矢量为 n o a 于是手部的位姿可用 4 4 矩阵表示为 5 5 图 2 7 抓握物体 Q 的手部 例 2 3 图 2 7 表示手部抓握物体 Q 物 体是边长为 2 个单位的正立方体 写出表达 该手部位姿的矩阵表达式 三 目标物齐次矩阵表示 如图 2 8 所示 楔块 Q 在图 2 8 a 所示位 置 其位置和姿态可用 8 个点描述 矩阵表 达式为 若让楔块绕