机械臂模型及旋转矩阵探究ppt课件.ppt

1 机械臂模型及旋转矩阵探究 2 机械臂模型及应用 机械臂的应用 机械臂研究现状 机械臂的模型 3 机械臂的应用 机械手臂是目前在机械人技术领域中得到最广泛实际应用的自动化机械装置 在工业制造 医学治疗 娱乐服务 军事以及太空探索等领域都能见到它的身影 尽管它们的形态各有不同 但它们都有一个共同的特点 就是能够接受指令 精确地定位到三维 或二维 空间上的某一点进行作业 机械臂 机器加载 取放操作 焊接 机器加载 喷漆 检测 抽样 装配操作 机械制造 医疗应用 危险环境 水下太空及远程 4 机械臂研究近状 1 工业机器人性能不断提高 高精度 高速度 高可靠性 便于操作和维修 2 机械结构向模块化 可重构化发展 3 工业机器人控制系统向基于PC机的开放型控制器方向发展 便于标准化 网络化 4 虚拟显示在机器人中的作用己从仿真 预演 发展到用于过程控制 如使遥控机器人操作者产生置身于远端作业环境中的感觉来操纵机器人 5 当代遥控机器人系统的发展特点不是追求全自治系统 而是致力于操作者与机器人的人机交互控制 几个发展方向 5 机械臂研究近状 1 网络远程控制网络远程控制是控制方法与网络结合成果 是控制领域崭新而非常有前景的发展方向和研究热点 系统结构图 6 机械臂研究近状 2 车载机械臂我国二期月球探测的科学目标之一是近距离 大比例尺形貌和地质构造研究 要完成这个科学目标 要求月球车携带一些能完成就位探测的有效载荷仪器 当月球车对目标月岩或月壤进行就位分析时 机械臂能够完成就位有效载荷仪器的放置 定位 操作及撤离等操作 控制系统结构图 控制器硬件原理图 7 机械臂研究近状 3 空间柔性机械臂太空作业机械臂的研究工作最早丌始于前苏联的hnakod Luna空I 日J计划 此后 美国 同本 欧洲等各国相继丌展了空间机器人研究与丌发工作 当自订 舱外空间机械臂多安装于航天飞机 国际空间站 太空实验舱和实验卫星上 具有有代表性的空间机械臂如下 1 航天飞机上机械臂目前投入使用比较典型的是加拿大1号臂 如图卜1所示 加拿大臂山加拿大斯巴公司生产 安装于美国航天飞机上 目前仍有3套航天飞机机械臂在使用 加拿大1号臂由强度极高的碳纤维材料制造 长15 2m 直径38cm 总质量为410Kg 在无载荷条件下移动速度可达600m吣 有载荷时移动速度为60mm s 无载荷时能移动到距目标点的精度范围为 152mm 操作载荷质量可达300looKg 8 机械臂研究近状 2 国际空间站上机械臂在空间站舱外机械臂系统中 最具代表性的是国际空问站美国舱段上的加拿大和美国航天局 NASA 联合研制的移动服务系统Mss Mobileservicin2svstem 航天飞机上的机械臂 空间站上的机械臂 9 机械臂研究近状 柔性机械臂1 随着宇航业及机器人业的飞速发展 出现了越来越多地采用由若干个柔性构件组成的多柔体系统 柔性机械臂与刚性机械臂相比较 柔性机械臂具有结构轻 载重与自重比高等特性 因而具有较低的能耗 较大的操作空间和很高的效率 其响应快速而准确 有着很多潜在的优点 在工业 国防等应用领域中有十分重要的地位 2 由于柔性机械臂中包含有一些柔性单元 如柔性关节 柔性连杆等 其在运行过程中会产生扭曲 弹性 剪切等变形 从而给这类柔性机械臂的分析和控制带来了许多困难 柔性臂建模方法介绍A Newton Euler法B agrange方程或Hamilton原理C Kane方法和虚位移原理D 模型辨识的方法 10 机械臂的模型 1 自由度 X Y Z 如图只沿X Y Z轴运动的机械臂是三自由度的 如果还能绕X Y Z轴旋转那么就是六自由度的 11 机械臂的模型 2 旋转矩阵的一种理解已知向量op 有矩阵 有 x y p o 设op的长度为r 辐角为 12 机械臂的模型 p P点在 B 系中为BP B 系原点在 A 系中可表示为 13 机械臂的模型 p x y 0 xA yA zA xB yB zB 绕z轴旋转的旋转矩阵如下 P点在 A 坐标系中的可表示为 14 机械臂的模型 机械臂的工作是由控制器指挥的 关节在每个位置的参数是预先记录好的 当机械臂执行工作任务的时候 控制嚣给出记录好的位置数据 使机械臂按照预定的位置序列运动 机械臂的平动或转动是由关节电机控制关节的位移或转角 其间并不涉及到控制力或控制力矩的大小 这是机械臂控制的一种传统方法 我们也称之为运动学控制 在这里建立机械臂的运动学模型的目的是为动力学建模提供各臂之间的几何关系和运动关系 15 机械臂的模型 机器人运动学就是建立各运动构件与末端执行器空间的位置 姿态之间的关系 为运动控制提供分析的手段和方法 机器人运动学包括两类问题 1 运动学正问题 给定机器人手臂 腕部等构件的几何参数及连接各构件运动的关节变量求机器人末端执行器对于参考坐标系的位姿 2 运动学逆问题 已知机器人各构件的几何参数和机器人末端执行器相对于参考坐标系的位置和姿态 求解是否存在实现这个位姿的关节变量 运动学正解问题 运动学逆解问题 末端执行器位姿 关节角 关节角 16 机械臂的模型 DH坐标法 连杆的DH参数如表 对于转动关节有连杆变换矩阵如下所示 17 机械臂的模型 DH坐标法 建立坐标系时应使连杆变换矩阵的形式简单 一般将 0 系与 1 系重合 Z轴沿关节轴方向 X轴沿连杆方向 将各参数带入到一般式 可以得到以下的连杆变换矩阵 18 机械臂的模型 DH坐标法 将各个连杆的矩阵连乘得到 如下式示 即得到末端相对于基坐标系的位姿 19 机械臂的模型 求解各个关节角 如果对于一个给定的末端位姿 即要求机械臂的末端到达某一个位置时 要求各个关节的关节角的变量值 即运动学求反解 由已知的连杆变换矩阵先计算中间果 然后可以得到 其中n a p代表的是多项式 即是矩阵相乘后的结果 20 机械臂的模型 求解各个关节角 对于 即 因为作为中间结果可求出 令矩阵两端元素对应相等 可以求出表达式 对于到都可以用矩阵运算的方法得到其表达式 21 机械臂的模型 求解及控制机械臂 对于求得的各关节角变量的表达式用MATLAB语言编写对应的程序 在已知末端要到达的位置时可以求出具体的数值 同常六自由度会有8组反解 在考虑机械结构的限制 关节奇异点