一种六轴关节机器人分布式控制系统及方法技术方案

本发明专利技术公开了一种六轴关节机器人分布式控制方法，该控制方法包括：主站将用户程序中的六轴关节机器人定位指令发送到机器人反解计算模块，机器人反解计算模块对目标点的位置进行反解计算，解析成对应的参数，将参数通过总线发送到从站的电机驱动器中，电机驱动器接收到有效的数据后将其中的定位运行参数解析出来，发送到电子凸轮模块，电子凸轮模块在虚拟主轴的驱动下进行周期性的计算，每个周期计算出周期脉冲量，电机控制模块根据周期脉冲量驱动电机运行。本发明专利技术能够降低对主站计算能力的要求、降低对总线的带宽需求、降低布线和排查难度、提高抗干扰能力。

【技术实现步骤摘要】

本专利技术涉及机器人控制
，尤其涉及一种六轴关节机器人分布式控制系统及方法。
技术介绍
六轴关节机器人是一种典型的串联型工业机器人，是当今工业领域中最常见的工业机器人的形态之一，适合用于诸多工业领域的自动化作业，例如，自动装配、自动喷涂、搬运、码垛、焊接等作业。六轴关节机器人的反解，指根据给定的目标位姿及机械参数，计算出各关节轴的角度，从而可以控制各关节电机运动到达目标位姿。反解的计算比较复杂，因此控制机器人动作需要专用的控制器，目前主流的技术有以下两种：1、基于PC+运动控制卡的方案：逻辑控制和机器人相关的数学计算在PC平台上进行，运动控制卡在每个控制周期将计算的结果通过脉冲或者通讯总线发送给伺服电机驱动器；2、基于专用运动控制器的方案：在运动控制器中采用比较高端的处理器，完成逻辑控制和机器人相关的数学计算，在每个控制周期将计算的结果通过脉冲或者通讯总线发送给伺服电机驱动器。然而，在上述现有技术中，存在以下问题：首先，上述技术属于集中控制，控制器需要进行周期性的反解计算，对处理器的计算能力要求很高；其次，使用脉冲周期性通讯，控制器和每一台电机驱动器都要连接脉冲线，在现场很容易受到干扰，出现干扰时排查和解决都比较困难，接线数量也较多；此外，使
用高速现场总线周期性通讯，对总线的传输带宽要求比较高，需要选择高性能高成本的总线，实现方案复杂。近年来，随着半导体技术的飞速发展，嵌入式CPU处理能力越来越强，存储空间越来越大，这使得电机驱动器在完成电机控制相关计算的前提下有富余的资源。但是目前电机驱动器富余的资源多用于增强电机的驱动性能，从系统的角度来看，驱动器CPU性能的提升并没有降低控制器CPU的压力。
技术实现思路
本专利技术要解决的技术问题在于，针对现有技术的不足，提供一种六轴关节机器人分布式控制系统及方法，用以降低对主站计算能力的要求、降低对总线的带宽需求、降低布线和排查难度、提高抗干扰能力。为解决上述技术问题，本专利技术采用如下技术方案。一种六轴关节机器人分布式控制系统，其包括有六轴关节机器人、一个主站及五个从站，所述主站和从站分别对应驱动六轴关节机器人的六个关节，其中：所述主站内预置有用户程序模块、PTP命令执行模块、机器人反解计算模块、通讯控制模块、虚拟主轴模块、电子凸轮模块及电机控制模块，所述用户程序模块用于执行用户编写的逻辑程序，该逻辑程序包含定位指令，在执行定位指令时，PTP命令执行模块获取指令中的目标点坐标，发送到机器人反解计算模块，机器人反解计算模块对目标点的位姿进行反解计算，得出目标点对应的各个轴的位置，本轴位置直接发送给本轴的电子凸轮模块，其他轴的位置通过通讯控制模块发送给各个从站，之后虚拟主轴模块持续发出虚拟主轴，驱动各轴的电子凸轮运行；所述从站内预置有电机控制模块、电子凸轮模块和通讯控制模块，通讯控制模块接收到本轴目标位置后，将参数传递给电子凸轮模块，
电子凸轮模块根据这些参数，计算对应的电子凸轮曲线并保存到凸轮表，当接收到虚拟主轴时，根据凸轮表周期性的计算本周期应该发出的周期脉冲量，所述电机控制模块接收电子凸轮模块每个周期的输出信号，并根据该信号控制电机运行。优选地，所述主站中：所述用户程序模块由用户编程，在程序控制下调用六轴关节机器人定位指令，所述定位指令包括坐标系下末端执行器的X、Y、Z坐标以及末端执行器的旋转角度等参数，用户程序模块在定位指令生效后将这些参数传递给PTP命令执行模块；所述通讯控制模块用于将参数打包发送到对应的电机驱动器；所述虚拟主轴模块用于在插补运行中周期性的发出数量和速度可控的虚拟主轴。优选地，所述从站中：通讯控制模块用于接收主站发送给本机的参数，对通讯数据进行校验，校验通过后将参数发送到电子凸轮模块；电子凸轮模块根据设定的曲线类型、目标点位姿、当前位姿等参数自动计算生成凸轮曲线，运行时根据虚拟主轴周期计算得到每个周期的周期脉冲量，发送到电机控制模块；电机控制模块用于根据周期脉冲量驱动电机运行，同时反馈电机的运行状态。优选地，所述电子凸轮模块包括：参数缓冲区，用于保存通讯控制模块发来的定位控制参数；电子凸轮曲线计算模块，用于根据参数计算对应的电子凸轮曲线保存到凸轮表；凸轮表，用于保存电子凸轮曲线；虚拟主轴接收模块，用于在每个计算周期内接收控制器传递过来的虚拟主轴，并计算主轴增量；电子凸轮运行控制模块，用于在每个计算周期内根据虚拟主轴和凸轮表计算本周期应该发出的周期脉冲量，并发送给电机控制模块。一种六轴关节机器人分布式控制方法，该控制方法包括：主站将用户程序中的六轴关节机器人定位指令发送到机器人反解计算模块，机器人反解计算模
块对目标点的位置进行反解计算，解析成对应的参数，将参数通过总线发送到从站的电机驱动器中，电机驱动器接收到有效的数据后将其中的定位运行参数解析出来，发送到电子凸轮模块，电子凸轮模块在虚拟主轴的驱动下进行周期性的计算，每个周期计算出周期脉冲量，电机控制模块根据周期脉冲量驱动电机运行。本专利技术公开的六轴关节机器人分布式控制系统及方法，其相比现有技术而言的有益效果在于，首先，本专利技术在六轴关节机器人的各轴电机驱动器内进行周期计算，充分利用电机驱动器富余的计算资源，对主站计算能力要求不高；其次，本专利技术在六轴关节机器人进行定位控制时只需要在启动时通过总线传输一组参数，在插补过程中只需要发出虚拟主轴，不需要周期性的传递数据，降低了对总线的带宽需求；此外，本专利技术只需要在主站和从站之间连接通讯线路及虚拟主轴线路，降低了布线和排查的难度，不易受到干扰。附图说明图1为本专利技术六轴关节机器人分布式控制方法中反解过程的流程图。图2为本专利技术六轴关节机器人分布式控制系统的组成框图。图3为电子凸轮模块的内部框图。图4为六轴关节机器人的关节分布示意图；图5为图4中六轴关节机器人各关节的坐标示意图。具体实施方式下面结合附图和实施例对本专利技术作更加详细的描述。本专利技术公开了一种六轴关节机器人分布式控制系统，结合图1至图5所示，
其包括有六轴关节机器人、一个主站及五个从站，所述主站和从站分别对应驱动六轴关节机器人的六个关节，其中：所述主站内预置有用户程序模块、PTP命令执行模块、机器人反解计算模块、通讯控制模块、虚拟主轴模块、电子凸轮模块及电机控制模块，所述用户程序模块用于执行用户编写的逻辑程序，该逻辑程序包含定位指令，在执行定位指令时，PTP命令执行模块获取指令中的目标点坐标，发送到机器人反解计算模块，机器人反解计算模块对目标点的位姿进行反解计算，得出目标点对应的各个轴的位置，本轴位置直接发送给本轴的电子凸轮模块，其他轴的位置通过通讯控制模块发送给各个从站，之后虚拟主轴模块持续发出虚拟主轴，驱动各轴的电子凸轮运行；所述从站内预置有与所述主站功能相同的电机控制模块、电子凸轮模块和通讯控制模块，通讯控制模块接收到本轴目标位置后，将参数传递给电子凸轮模块，电子凸轮模块根据这些参数，计算对应的电子凸轮曲线并保存到凸轮表，当接收到虚拟主轴时，根据凸轮表周期性的计算本周期应该发出的周期脉冲量，所述电机控制模块接收电子凸轮模块每个周期的输出信号，并根据该信号控制电机运行。作为一种优选方式，所述主站中：所述用户程序模块由用户编程，在程序控制下调用六本文档来自技高网...

【技术保护点】
一种六轴关节机器人分布式控制系统，其特征在于，包括有六轴关节机器人、一个主站及五个从站，所述主站和从站分别对应驱动六轴关节机器人的六个关节，其中：所述主站内预置有用户程序模块、PTP命令执行模块、机器人反解计算模块、通讯控制模块、虚拟主轴模块、电子凸轮模块及电机控制模块，所述用户程序模块用于执行用户编写的逻辑程序，该逻辑程序包含定位指令，在执行定位指令时，PTP命令执行模块获取指令中的目标点坐标，发送到机器人反解计算模块，机器人反解计算模块对目标点的位姿进行反解计算，得出目标点对应的各个轴的位置，本轴位置直接发送给本轴的电子凸轮模块，其他轴的位置通过通讯控制模块发送给各个从站，之后虚拟主轴模块持续发出虚拟主轴，驱动各轴的电子凸轮运行；所述从站内预置有电机控制模块、电子凸轮模块和通讯控制模块，通讯控制模块接收到本轴目标位置后，将参数传递给电子凸轮模块，电子凸轮模块根据这些参数，计算对应的电子凸轮曲线并保存到凸轮表，当接收到虚拟主轴时，根据凸轮表周期性的计算本周期应该发出的周期脉冲量，所述电机控制模块接收电子凸轮模块每个周期的输出信号，并根据该信号控制电机运行。

【技术特征摘要】
1.一种六轴关节机器人分布式控制系统，其特征在于，包括有六轴关节机器人、一个主站及五个从站，所述主站和从站分别对应驱动六轴关节机器人的六个关节，其中：所述主站内预置有用户程序模块、PTP命令执行模块、机器人反解计算模块、通讯控制模块、虚拟主轴模块、电子凸轮模块及电机控制模块，所述用户程序模块用于执行用户编写的逻辑程序，该逻辑程序包含定位指令，在执行定位指令时，PTP命令执行模块获取指令中的目标点坐标，发送到机器人反解计算模块，机器人反解计算模块对目标点的位姿进行反解计算，得出目标点对应的各个轴的位置，本轴位置直接发送给本轴的电子凸轮模块，其他轴的位置通过通讯控制模块发送给各个从站，之后虚拟主轴模块持续发出虚拟主轴，驱动各轴的电子凸轮运行；所述从站内预置有电机控制模块、电子凸轮模块和通讯控制模块，通讯控制模块接收到本轴目标位置后，将参数传递给电子凸轮模块，电子凸轮模块根据这些参数，计算对应的电子凸轮曲线并保存到凸轮表，当接收到虚拟主轴时，根据凸轮表周期性的计算本周期应该发出的周期脉冲量，所述电机控制模块接收电子凸轮模块每个周期的输出信号，并根据该信号控制电机运行。2.如权利要求1所述的六轴关节机器人分布式控制系统，其特征在于，所述主站中：所述用户程序模块由用户编程，并在程序控制下调用六轴关节机器人定位指令，所述定位指令包括坐标系下末端执行器的X、Y、Z坐标以及末端执行器的旋转角度参数，用户程序模块在定位指令生效后将这些参数传递给PTP命令执行模块；所述通讯控制模块用于将参数打包发送到对应的电机驱动器；所述虚拟主轴模块用于在插补运行中周期性的发出数量和速度可控的虚拟主轴。3.如权利要求1所述的六轴关节机器人分布式控制系统，其特征在于，所述从站中：通讯控制模块用于接收主站发送给本机的参数，以及对通讯数据进行校验，校验通过后将参数发送到电子凸轮模块；电子凸轮模块根据设定的曲线类型、目标点位姿、当前位姿等参数自动计算生成凸轮曲线，运行时根据虚拟主轴周期计算得出每个周期的周期脉冲量，发送到电机控制模块；电机控制模块用于根据周期脉冲量驱动电机运行，同时反馈电机的运行状态。4.如权利要求1所述的六轴关节机器人分布式控制系统，其特征在于，所述电子凸轮模块包括：参数缓冲区，用于保存通讯控制模块发来的定位控制参数；电子凸轮曲线计算模块，用于根据参数计算对应的电子凸轮曲线保存到凸轮表；凸轮表，用于保存电子凸轮曲线；虚拟主轴接收模块，用于在每个计算周期内接收控制器传递过来的虚拟主轴，并计算主轴增量；电子凸轮运行控制模块，用于在每个计算周期内根据虚拟主轴和凸轮表计算本周期应该发出的周期脉冲量，并发送给电机控制模块。5.一种六轴关节机器人分布式控制方法，其特征在于，该控制方法包括：主站将用户程序中的六轴关节机器人定位指令发送到机器人反解计算模块，机
\t器人反解计算模块对目标点的位置进行反解计算，解析成对应的参数，将参数通过总线发送到从站的电机驱动器中，电机驱动器接收到有效的数据后将其中的定位运行参数解析出来，发送到电子凸轮模块，电子凸轮模块在虚拟主轴的驱动下进行周期性的计算，每个周期计算出周期脉冲量，电机控制模块根据周期脉冲量驱动电机运行。6.如权利要求5所述的六轴关节机器人分布式控制方法，其特征在于，所述机器人反解计算模块执行的反解算法如下：给定期望位姿： n x o x a x p x n y o y a y p y n z o z a z p z 0 0 0 1 ]]>反解计算各关节角度：θ1＝atan(py/px)θ234＝atan(az/(C1ax+S1ay)) C 3 = ( ( p x C 1 ...

【专利技术属性】
技术研发人员：陈阳，高大林，
申请(专利权)人：深圳市微秒控制技术有限公司，
类型：发明
国别省市：广东;44