[实用新型]一种串并联机器人的运动控制系统

说明书

发明本实用新型揭示了一种串并联机器人的运动控制系统,系统设有由多个机器人单元组成的串并联机器人，每个所述机器人单元至少设有一个伺服电机，PC机用于串并联机器人运动控制方法的编写、调试，并将运动控制方法输送至控制器，控制器接收每个所述伺服电机的状态信号并输出控制信号至驱动器，驱动器根据控制信号输出驱动信号至每个所述伺服电机。本实用新型的优点在于实现串并联机器人的运动控制，能够控制机器人按照规划的末端轨迹运动，且运动平稳，效果良好；通过虚拟仿真多个机械结构，验证运动控制方法的可移植性强，二次开发简单，效果良好；并且该运动控制方法通用性强，对于不同的机械结构，只需要简单的开发即可。

技术领域

本实用新型涉及工业机器人控制领域，并可扩展用到机床的运动控制领域。

背景技术

机器人运动控制是指对各个伺服轴的运动控制，包括单轴、多轴的控制。串并联机器人又称混联机器人，是指至少包括一个并联机构和一个或多个串联机构按照一定的方式组合在一起的复杂机械系统，它综合了串联结构和并联机构的优良属性。对串并联机器人的伺服轴进行控制，应分别实现串联、并联的运动方式，且能对机器人整体结构的末端轨迹进行规划，实现示教、再现、编程等功能。

现有技术对于不同的机器人机械结构有不同的运动控制系统和方法，市面上的控制器产品多是针对常规的串联或并联机器人的运动控制。因此，对于特殊结构的串并联机器人没有相应的运动控制系统和方法。

实用新型内容

本实用新型所要解决的技术问题是实现一种串并联机器人运动控制系统的通用运动控制方法。

为了实现上述目的，本实用新型采用的技术方案为：一种串并联机器人的运动控制系统,系统设有由多个机器人单元组成的串并联机器人，每个所述机器人单元至少设有一个伺服电机，系统包括PC机、控制器和驱动器，所述PC机用于串并联机器人运动控制方法的编写、调试，并将运动控制方法输送至控制器，所述控制器接收每个所述伺服电机的状态信号并输出控制信号至驱动器，所述驱动器根据控制信号输出驱动信号至每个所述伺服电机。

所述控制器包括：

运动指令的解释规划模块：用于将运动控制方法分解、编号、归类为每个伺服电机的轨迹指令；

迹插补算法的实现模块：用于对每个轨迹指令进行插补，之后将各个轨迹指令组合在一起形成串并联机器人完整的运动轨迹；

运动学的坐标转换模块：根据每个所述伺服电机的状态信号获取各伺服轴的运动位置点，将各伺服轴的位置点转换为机器人末端空间坐标位置；

伺服轴的位置控制模块：用于驱动每个所述伺服电机，控制伺服轴按照规划的位置运动。

所述运动指令的解释规划模块接收PC机的运动控制方法信号，并输出轨迹指令至迹插补算法的实现模块，所述迹插补算法的实现模块输出轨迹函数至运动学的坐标转换模块，所述运动学的坐标转换模块输出信号至伺服轴的位置控制模块，所述伺服轴的位置控制模块与驱动器实时通讯。

所述轨迹指令为驱动伺服电机以直线、圆弧、过渡曲线的方式运动的执行信号。

所述控制器为嵌入式结构，所述控制器和驱动器之间通过EtherCAT通讯。

本实用新型的优点在于实现串并联机器人的运动控制，能够控制机器人按照规划的末端轨迹运动，且运动平稳，效果良好；通过虚拟仿真多个机械结构，验证运动控制方法的可移植性强，二次开发简单，效果良好；并且该运动控制方法通用性强，对于不同的机械结构，只需要简单的开发即可。

附图说明

下面对本实用新型说明书中每幅附图表达的内容作简要说明：

图1为串并联机器人的运动控制系统框图；

图2为串并联机器人的运动控制方法流程图。