个机器人机械臂与封闭的运动链的基于PLC的控制.docVIP

基于 PLC控制的机械臂控制系统 摘要：本文介绍了基于可编程逻辑控制器（ PLC）的机器人控制系统的设计和实施。该控制 机器人是用一个拥有 4 自由度（ DOF）的机械手实现运动，被广泛使用在包装、负载工作当 中。控制软件是的一款商用 PLC系统， 它具有标准编程工具和多任务处理的功能。 而且还能 详细分析相关的缺点和优点。在这种使用标准下选择 PLC，和专门的硬件选择有许多相似的 地方，特别强调的是要考虑控制的准确性。 一、引言 机械臂被大量使用在包装厂， 尤其是需要取放操作和箱灌装的工业场合。 比如包装小食品过 程中（如饼干或糖果） ，他们的工作区相对较小，需要高性能的机器人并具有短周期和高精 度的运动控制。 这样的情况常用到轻型并联驱动器或三角运动方式， 它的优势在降低移动质 量和惯性。一个典型的例子机械手是 ABB 制造的 FlexPicker IRB 340 ，这是一个具有 4 度中 自由度（ DOF）机器人 。 IRB 340 或典型工作单元类似的机器人都拥有视觉系统，用以识别 产品的运输情况。在机械人内部控制系统中，整个解决方案里的硬件和软件提议由 ABB 提 供。因此， 机器人控制装置实际上是一个相当封闭的系统， 客户不能也没必要在机械人内部 作具体的扩展。 机器人使用程序是特定的， 但是整个生产过程的控制， 还要在机器人外部作 相应的扩展， 所以基本的机器人运动控制系统通常需要软件或硬件的密切配合， 为了更方便 利用， 客户往往寻求开放式的机器人控制器。 事实上， 一些开放体系结构的机器人控制可以 在学术项目中， 或在商业机器人制造商那找到。 在大多数情况下， 这些架构利用都是基于计 算机（ PC ）。一方面，利用 PC的机器人控制降低软件开发成本，这要归功于高级语言和精 心设计的集成开发环境（ IDE ） 。在另一方面，标准的 PC 不具有恶劣的工业环境所需的 可靠性，为此使用的保护套和更强大的电子元件实际上增加了 PC机的最终成本。 而可编程逻辑控制器（ PLC）由于其耐用性，低成本和易用性，已经在工业控制装置领域发 挥主导作用。 PLC常被认为是低级别的系统，是因为其控制简单的布尔信号（即离散控制和 测序）和监督的安全性、完整性。然而，现代 PLC具有足够的计算带宽，能够执行复杂的数 学计算和编程语言（如 IEC 61131-3 ），允许轻松实现任何种类的算法，可以在机器人的控 制中使用。此外，即使大多数的 PLC只支持其专有 IDE，在该特定的 IDE 上它能够上传来自 控制器的用户软件并修改它， 这是基于 PC的系统，其软件是一个已编译可执行文件。 因此， 用户即使没有原始的延伸源代码终端， PLC程序也可以被更新，这使得 PLC是“开放式”系 统。尽管有这些特点，基于 PLC的控制系统的机器人是相当罕见的，并且在一般情况下，仅 限于简单的笛卡儿或门架状结构。 在本文中， 我们的目标是证明商业 PLC和其多任务操作系 统是足够强大来实现机器人系统控制的，包括逆运动学，上线轨迹规划及视觉系统的整合。 事实上， 在本论文中的描述是专为取放小食品产品的机器人系统，需要的使用程序如前所 述。本文的其余部分安排如下：二、 描述了机器人，二段的运动。 三、提 供有关轨迹生成解决方案的一些细 节。第四和第五描述硬件架构和软件 实现的控制系统。 该实验结果列于第 六点。 二、机器人运动学 在这项研究中所考虑的机器人拥有 4 自由度和封闭的运动链。 闭链解决方 案是 采用高速 和高刚度运动， 因为 它可以减小上部链接的惯性 。机器 人具有类似运动的实例 结构是浅田 的半直驱机械臂 ABB IRB660（如右图 1 所示）。其中仅 三个主要的自由度被突出显示。完 整的机械设计 机器人包括一个三连杆机构， 该夹持器要总是平行于 XY 平面，并围绕该工具 的接近轴旋转。 在下文中， 我们分析了机器人的逆运动学， 考虑到仅三个自由度有关的笛卡尔空间定位。 因 此，我们定义： p = [ px py pz ]T ; q = [ θ1 θ2 θ3 ]T (1) 分别为工作区位置矢量和关节间隙位置矢量。为了定义的逆运动学函数 Q= F （ P），我们首 先标示机器人的环节如下： L1 是从底座上的第一连杆，在图中所示 . 1 在弯头向上配置， L2 串联连接到 L1 ，而 L3 和 L4 构成了第二个串行链，如图 . 1 在肘下配置。然后，我们分别定 义为 L1， L2，L3 和 L4 链路的长度。自 L1 = L4 ，在下文中，我们将仅使用第一个的两项措 施。所要分析的其他位移的措施是从夹持器到基座并从夹持器到 Z 轴的距离。 给定 p 和在 平行于 XY 平面的投影 P，这