已阅读5页,还剩11页未读, 继续免费阅读
版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领
文档简介
工业机器人的轨迹规划和控制工业机器人的轨迹规划和控制 S R Munasinghe and Masatoshi Nakamura 1 简介简介 工业机器人操作臂被用在各种应用中来实现快速 精 确和高质量的生产 在抓取和放置操作 比如对部分的操 作 聚合等 操作臂的末端只执行器必须在工作空间中两 个特定的位置之间移动 而它在两者之间的路径却不被关 心 在路径追踪应用中 比如焊接 切削 喷涂等等 末 端操作器必须在尽可能保持额定的速度下 在三维空间中 遵循特定的轨迹运动 在后面的事例中 在对末端操作器 的速度 节点加速度 轨迹有误等限订的情况下轨迹规划 可能会很复杂 在没有对这些限制进行充分考虑的情况下 进行轨迹规划 通常会得到很差的表现 比如轨迹超调 末 端操作器偏离给定轨迹 过度的速度波动等 机器人在笛 卡尔轨迹中的急弯处的的表现可能会更加恶化 到目前为 止很多轨迹规划算法己经被提出 从笛卡尔轨迹规划到时 间最优轨迹规划 然而 工业系统无法适应大多数的这些 方法 有以下两点原因 1 这些技术经常需要进行在目 前机构中进行硬件的移动 生产过程必须被打断以进行系 统重新配置 而这往往需要很长时间 2 这些方法中很 多通常只考虑到一种约束 而很少关注工业的需求和被请 求的实际的约束 因此 它们很难在工业中实现 在本文的观点中 我们提出了一种新的轨迹规划算法 考虑到了末端操作器的速度限制 节点加速度限制 应用 中的容错度 这些是在工业应用中实际的约束 其他工业 操作臂中的技术问题是他们的动力学延迟 这导致末端操 作臂在轨迹中的拐角处出轨 为了补救这个问题 我们设 计了前向补偿 稍稍改变了拐角处的路径 使得即使在延 迟动力学环节存在的情况下依然确保末端操作臂的实际跟 踪轨迹 结合了前向补偿新的轨迹规划算法在控制系统中 表现为单一的前向阻塞 它可以轻松地适应目前的工业操 作臂系统 不冒风险 不花费时间重新配置硬件 轨迹规划算法可以为所有操作臂的节点产生位置 速 度和加速度的大体规划 在大多数工业操作臂中 系统输 入是节点的位置数据 这在工业中是作为被给定的数据而 广为人知的 为了用笛卡尔轨迹规划来控制操作臂 Paul 描述了同类型的转换是怎样可以被用来代表一系列操作臂 连杆的位置和原点的 Shin et al 的工作和我们的很相似 但是实现在工业控制系统中的应用是很困难的 因为它需 要知道很多操作臂的连杆和节点的参数 在大多数工业操 作比系统中 这些参量并不能被精确的获知 在我们之前的工作中我们解决了在二维空间中加速度 和速度的约束 在目前的工作中 当我们考虑到容差度 我们把他延伸到三维空间 我提出的方法已经在 MK 3s 工 业机器人上测试过了 它的效果已经被实验证实了 2 工业机器人操作臂工业机器人操作臂 2 1 系统体系结构系统体系结构 工业机器人操作臂执行器 MK 3s 如下图 参考输入发生器是专用的 或者是一个通过 DA 转换器 和 AD 转换器连接到伺服控制器的联网计算机 伺服控制器 有功率驱动板来单独的控制操作臂节点 如 Fig1 所示 参 考输入发生器组成了数据序列 j 1 2 3 代表节点 节点 j u 位置从伺服控制器反馈到参考输入发生器 j 参考输入发生器决定了每一个节点的控制命令 发送 这些命令给伺服控制器 使节点原动机有根据的运动 参 考 Fig1 操作臂运动学方程如下 x y z 是末端操作器的位置坐标 是相应的节点 1 2 3 结构位置 是连杆长度 通过对 1 式微分可以得到笛 j L 卡尔速度和节点速度之间的关系如下 雅克比矩阵为 其中 是操作臂的位置 1 2 3 T 2 2 工业机器人操作臂节点动力学工业机器人操作臂节点动力学 工业机器人操作臂被设计来满足需求 比如焊接 切削 部分操纵等 特定的规格一般被限制在确定的准确性 速 度和复杂性上 因此 大多数工业机器人操作臂经常被设 计加入带有限流电源放大器的 PID 控制器 电流的限度决 定了节点加速的限制 此外 不管未知的惯性力矩 科里 奥利力矩 离心力矩 节点是被独立控制的 摩擦力矩和 重力矩被视作控制器的干扰 为了支持这个假设 操作臂 连杆被设计为低惯性 节点被尽可能少的传动装置驱动 这些控制器很简单 也提供很有效的鲁棒性 图 2 举例说 明了一个工业机器人操作臂的三自由度解耦节点动力学模 型 这个模型也包括了节点加速饱和特性功率放大器 和是伺服控制器在位置环和速度环的节点 j 的增益 p j K j v K 这些增益被训练好的操作员定期的调整来保持良好的表现 水平 因为只涉及到两个调整的变量 所以控制调整过程 是很简单的 节点线性加速度 动力学方程如下 当节点加速度饱和时节点动力学方程如下 是节点 j 的最大加速度 在本文中 轨迹规划的 目标最好的利用节点加速度调节能力 这样就要避免饱和 2 3 问题描述问题描述 在本项任务中 我们考虑以下三个在实际工业机器人 应用中适用的主要问题 是末端操作器的速度 额定的速度和最大切向v r v max r v 速度 在弧形拐角处 e 和是轨迹误差和容差度 限制 5 描述了节点加速度的线性区域 在此区域中动力学方 程 3 适用 超出这个限定的话动力学方程 4 适用 限制 6 指定了当末端操作器沿直线运动或通过拐角时的 速度限制 节点的额定速度 是节点的额定转速 转 分钟 是减速装置系数 r RPM G N 然后 额定速度 L 是连杆长度 在轨迹拐角处的 切向速度更难保持恒定的向心加速度 它也可以在理论上 就像在中描述的一样被 决定 3 轨迹规划轨迹规划 3 1 算法算法 我们提出的轨迹规划算法在下图三中说明 目标轨迹被请求所指定 他被划分为 a 转弯处的 s O 环节和 b 直线环节 在笛卡尔空间用指定的切向速度 v 用逆向运动学转换到节点空间 直线环节在节点空间 max t v 中产生 分为三部分 前向 加速 中部 匀速 反 向 减速 前向 反向环节被用这种方式规划 只要末 端操作器的限定没有被违背 至少有一个节点会以最大加 速度或减速度运动 中间环节在笛卡尔空间中规划来保持恒定的末端操作 器速度 v 然后它被转换到节点空间 图四中的 b3 r v 最后 所有节点空间中的拐角和直线环节融合成正确的顺 序 这个在节点空间中的轨迹规划被成为可实行的轨迹 P s 3 2 转角处的轨迹规划转角处的轨迹规划 图四示例了一个带有急转弯的有容差度的目标轨迹 虚线 容差度在工业应用中很普遍 他可以被用来有 效地规划可实行的轨迹 P s 他要求把有效轨迹限制在容差 度中 参照图四 最有可能的圆弧通过点 R 它可能在刚好 在容差范围内 在平面中 为了生成这条曲线 点 A ABC B 和 C 根据下列流程决定于 A B 和 C 在中 ABC A 是由节点坐标 A 和 C 决定的 例如 A 的横坐标 运用相同的方法 B 的位置可以由 F 和 B 决定 C 可以由 A 和 C 决定 F 的位置由 A C 决定 图 4 b 示例的在转弯处的圆弧半径为 D 和 E 是圆弧最后的位置 它们可以由 A B 和 B C DB EB 沿着圆弧 从 D 到 E 的轨迹是在每个处采样得到的 采样角为 是采样区间 采样点数量决定于 N 2 向上取 s t 整 然后 采样角度通过 2N 再调整 M 可以 由 BD 得到 DM r tan n M 可以由 GM 得到 因为 r GM 是已知的 3 3 直线轨迹规划直线轨迹规划 3 3 1 正向和逆向环节正向和逆向环节 图六示例了直线轨迹规划的细节 是目标轨迹的直 1 P 2 P 线环节 它是可实行的轨迹需要规划的 直线的两个末端 点是目标轨迹开始或结束的点 或者圆弧最后的节点 任 何一种方式 在这些点的速度和位置是知道的 前向轨迹 规划从到 而逆向轨迹规划从到 两个环节都在节 1 P 2 P 2 P 1 P 点空间中在两个方面利用相同的算法被规划 正如下面讲 到的一样 每个节点花费的从 k 点到 k 1 点最短的时间为 两个点之间使每个节点都不饱和的最小的可行时间为 最长的 min j t 用来在两个点之间进行轨迹规划保证花费最少的 min kt 时间 结果的节点加速度为 轨迹规划在节点坐标系中方程如下 这个算法当经过点取 k 0 1 2 时一直持续 在同时末 端速度用 2 和 13 14 计算 当末端速度达到额定 速度时终止 就像在图五中说明的一样 末端操作器在前 向达到额定速度 在逆向达到额定速度 F P R P 3 3 2 中间环节中间环节 参考图五 是直线轨迹的中间环节 这个环节在笛 F P R P 卡尔轨迹空间中通过保持额定速度进行规划 r v 和为速度沿轴线方向的组成部分 x y x r v y r v z r v r v F P 和 z是的笛卡尔坐标 中间环节可以用逆向运动学 F P F P F P 转化到节点坐标系 3 4 延迟动力学环节的组成延迟动力学环节的组成 转弯处和直线部分的轨迹规划被融入到形成可实现的 轨迹中去 就像在图三中所展示的那样 给定的数据通过 补偿可实现的延迟动力学环节的轨迹得到 线性反馈极点 的放置被用来建立一个前馈延迟补偿器 其中 1 和 2 为控制器极点 是观测极点 这些极点 可以实验性的调整到更好的表现 极点补偿的理论可以参 考 Munasinghe Nakamura 2003 4 结果讨论结果讨论 4 1 实验条件实验条件 目的轨迹依照下面设定 奇点 0 35 0 1 第一个转弯 0 41 0 1 0 15 m 第二个转弯 0 28 0 1 0 3 m 末端 0 35 0 0 35 m 额定速度和切向速度被设置成 0 15 m 0 02 m 所有节点中最大的节点加 r v 2 s max t v 2 s 速度为 轨迹容差度为 0 001 m 伺 服控制器增益 15 1 s 15 1 s 在延迟补偿中 控 p j K v j K 制极点为 1 2 60 观察极点为 200 为了比较新方法 的效果 我们模拟了惯用的轨迹规划算法 恒定速度为 0 05 m s 的末端操作器被用来在笛卡尔空间通过刚提到的目 的轨迹进行轨迹规划 4 2 结果评估结果评估 图六示例了结果 我们可以得到一个重要的观察结果 那就是我们提出 的方法在仿真和实验结果方面高度的相似性 也就是说实 验产生了末端操作器的速度和节点加速度的模型 与我们 得到的在线性解耦动力学假设下的仿真是很相似的 这说 明了在我们提出的方法中轨迹规划和延迟补偿的有效性 箭头的顺序 N1 N2 N3 N4 N5 N6 证实了在整个运 动过程中三个节点中至少一个以最大加速度或最大减速度 运动 除了在转角 C1 C2 和中间环节 M 处 在整个运动 中末端操作器速度保持在额定速度或低于额定速度 相反 传统方法在它的仿真中表现出在节点加速度框架中的饱和 正像 S1 S2 S3 表现的那样 图七展示了末端操作器在三维空间中的运动和它在 X Y Y Z Z X 平面中的投影 在图 7 b 中 可以观察到 在转角 C1 处有很明显的错误 这是由加速度在节点 2 和节 点 3 饱和导致的 如 S2 和 S3 所示 相似的错误在转角 2 处发生 这是由于加速度在节点 1 处饱和 如 S1 所示 另 一方面 我们提出的方法已经是末端操作器准确的跟踪了 给定的轨迹 4 3 讨论讨论 我们提出的轨迹规划算法考虑了原始的轨迹和速度 加速度 容差度的限制 规划了可实行的轨迹 可实行轨 迹对延迟动力学环节进行了补偿 我们提出的算法实现了 最好的表现 因为它在整个运动中总是保持 5 6 7 中至少一个限制 5 结论结论 这一章节提出了
温馨提示
- 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
- 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
- 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
- 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
- 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
- 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
- 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
最新文档
- 初中九年级语文“雨水描写”写作28法教学设计
- 普通高中数学必修第一册《函数模型在新学期促销决策中的构建与应用》教学设计
- 小学三年级综合实践活动《我和动物交朋友》教学设计
- 初中九年级化学教学设计 基于核心素养的中考情境填空题术语规范与实战训练
- 初中八年级历史中国开始沦为半殖民地半封建社会单元综合复习教学设计
- 高中政治必修三《政治与法治》核心知识体系构建与主体意识养成教学设计
- 高中英语必修第一册 Unit 1 Back to school Extended reading 教学设计
- 高中地理必修第二册交通运输布局促进区域发展教学设计
- 高一语文必修上册《登泰山记》期末复习教学设计
- 初中九年级科学一轮专题复习“物质的构成”教学设计
- 十五五(2026-2030)华东地热能开发可行性研究报告
- 2026年国考金融监管局综合类真题及答案解析
- 《传感器与检测技术》课件 第十章光纤传感器
- 2026年熔化焊接与热切割作业考试题附答案
- 体育课程教学教案16舞龙舞狮
- 浙江省温州市瓯海区2024-2025学年六年级下学期“说题比赛”素养发评估数学试题(含解析)
- 房屋买卖合同2026年电子版下载
- 2026年老旧小区电梯更新改造合同
- 职业病诊断医师资格(化学中毒类)一次通关必刷题库(附答案)
- 华为新员工培养赋能手册
- 医疗纠纷现场谈话记录模板与范例
评论
0/150
提交评论