一种真空双臂机器人的双臂独立控制方法技术

本发明专利技术属于双臂真空机器人控制领域，具体说是一种真空双臂机器人的双臂独立控制方法，包括以下步骤：上位机发送运动指令至机器人控制器；机器人控制器对运动指令进行解析，解析出上手臂指令和下手臂指令；将上手臂指令发送至规划库，获取上手臂控制参数，并根据控制参数进行规划，获取上手臂规划结果；将下手臂指令写入共享内存中，规划库获取下手臂控制参数，并根据控制参数进行规划，获取下手臂规划结果；将上述双臂规划结果分别发送至对应的机器人驱动器执行上手臂规划结果和下手臂规划结果。本发明专利技术采用双进程的双臂独立控制方法可以实现在上臂运动的过程中，然后再开始下臂的运动，双臂的开始运动时间和结束运动时间可以不同。不同。不同。

【技术实现步骤摘要】
一种真空双臂机器人的双臂独立控制方法


[0001]本专利技术属于双臂真空机器人控制领域，具体说是一种真空双臂机器人的双臂独立控制方法。

技术介绍

[0002]国内机器人在传输晶圆的过程中只能实现双臂的同步规划控制，即双臂同时开始运动并且同时结束运动，在真空平台中同一时刻只能针对一个工位进行晶圆传输。没办法实现双臂独立规划控制，为保证双臂机器人在传输晶圆的过程中更加灵活，迅速，双臂机器人需要开发一种双臂独立规划技术。

技术实现思路

[0003]本专利技术目的是提供一种真空双臂机器人的双臂独立控制方法，以实现在传输晶圆的过程中实现双臂的独立规划控制，以克服上述现有国内机器人只能实现双臂的同步规划控制的弊端。
[0004]本专利技术为实现上述目的所采用的技术方案是：一种真空双臂机器人的双臂独立控制方法，包括以下步骤：
[0005]1)上位机发送运动指令至机器人控制器；
[0006]2)机器人控制器对运动指令进行解析，解析出上手臂指令和下手臂指令；
[0007]3)机器人控制器将上手臂指令发送至规划库，规划库在第一进程中获取上手臂控制参数，并根据控制参数进行规划，获取上手臂规划结果；
[0008]机器人控制器将下手臂指令写入共享内存中，并通过规划库进行规划，规划库在第二进程中获取下手臂控制参数，并根据控制参数进行规划，获取下手臂规划结果；
[0009]4)将上手臂规划结果和下手臂规划结果分别通过CAN总线发送至对应的上手臂机器人驱动器和下手臂机器人驱动器；/>[0010]5)上手臂的机器人驱动器和下手臂的机器人驱动器分别执行上手臂规划结果和下手臂规划结果，实现真空双臂机器人的双臂独立控制。
[0011]所述步骤2)具体为：解析指令时，通过设定的指令标识分别将上手臂指令解析为上手臂对应的指令码，下手臂指令解析为下手臂对应的指令码。
[0012]所述控制参数，包括：工位信息、目标位置和速度。
[0013]步骤3)中所述规划库在第一进程中获取上手臂控制参数，具体为：
[0014]根据上手臂对应的指令码在第一进程中获取相应的工位信息、目标位置和速度并进行运动规划。
[0015]步骤3)中所述规划库在第二进程中获取下手臂控制参数，具体为：
[0016]通过共享内存获取下手臂对应的指令码，在第二进程中获取共享内存中的工位信息、目标位置、速度进行运动规划。
[0017]步骤3)中根据控制参数进行规划，获取上手臂和下手臂的规划结果，具体为：
[0018]规划开始时，分别根据上手臂和下手臂的工位信息、目标位置确定上手臂的关节值，根据速度得到周期数，进而分别获取在每个周期中上手臂的关节值和下手臂的关节值；进而根据上手臂和下手臂的关节值，得到用于控制上手臂关节的电机码盘值和用于控制下手臂关节的电机码盘值。
[0019]所述步骤5)，具体为：
[0020]所述上手臂和下手臂均由两个电机控制；
[0021]将获取到的上手臂关节的电机码盘通过CAN总线写入到作为CAN从站节点ID1的第一电机和CAN从站节点ID2的第二电机所对应的对象字典中，上手臂机器人驱动器根据上手臂关节的电机码盘分别对两个电机驱动，从而实现上手臂的运动控制；
[0022]将获取到的下手臂关节的电机码盘值通过CAN总线写入到共享内存中，在将共享内存中的下手臂关节的电机码盘值通过CAN总线写入到作为CAN从站节点ID3的第三电机和CAN从站节点ID4的第四电机所对应的对象字典中，下手臂机器人驱动器根据下手臂关节的电机码盘分别对两个电机驱动，从而实现下手臂的运动控制。
[0023]本专利技术具有以下有益效果及优点：
[0024]1.本专利技术采用双进程的双臂独立控制方法可以实现在上臂运动的过程中，然后再开始下臂的运动，双臂的开始运动时间和结束运动时间可以不同。
[0025]2.本专利技术在真空平台中可以随时对两个不同的工位进行晶圆传输，这样传输效率可以比原有双臂同步控制方法提高一倍。
[0026]3.本专利技术实现了双臂机器人在传输晶圆过程中的双臂独立规划控制技术，使双臂机器人在传输晶圆时更加灵活、迅速。
附图说明
[0027]图1本专利技术的控制原理图；
[0028]图2本专利技术的方法流程图。
具体实施方式
[0029]下面结合附图及实施例对本专利技术做进一步的详细说明。
[0030]本专利技术的技术关键点在于：1、通过使用进程间通讯技术传输双臂的运动信息。2、使用双进程分别规划双臂的运动轨迹。3、使用进程间通讯技术传输规划完的运动轨迹并实现运动。其中，双臂独立规划技术总体方案包括：通讯指令的接收、双臂独立规划、双臂运动实现。
[0031]本专利技术基于的装置为双臂机器人实现，如公布日为2020年7月3日的申请号201811586648.6，专利技术名称为：一种升降式独立直驱真空机械手；其中，本专利技术中的上手臂对应该申请中机械手组件2的一轴手臂5和二轴手臂6；本申请下手臂对应该申请中机械手组件2的三轴手臂7和四轴手臂8；
[0032]其中，控制本专利技术的上手臂和下手臂均由两个电机控制，对于控制上手臂的第一电机和第二电机，分别对应了一种升降式独立直驱真空机械手的一轴直驱电机20和二轴直驱电机19；对于控制下手臂的第三电机和第四电机，分别对应了一种升降式独立直驱真空机械手的三轴直驱电机18和四轴直驱电机17；
[0033]如图1所示，为本专利技术的控制原理图：
[0034]1)通讯指令的接收：通过指令区分接收到的运动指令是控制哪个手臂的指令。解析并将目标位置点的关节值、速度、加速度和加加速度传给对应的手臂。
[0035]2)通过双进程实现双臂独立规划：通过两个进程分别规划各自的手臂运动轨迹。
[0036]3)通过进程间通讯技术实现双臂的独立运动：通过进程间通讯技术将两个手臂的运动轨迹点传输给控制器，控制器通过CAN总线将各个轴的码盘值发送给驱动器实现双臂的独立运动。
[0037]如图2所示，为本专利技术的方法流程图，具体包括以下步骤：
[0038]首先，1)上位机发送运动指令至机器人控制器；
[0039]2)机器人控制器对运动指令进行解析，解析出上手臂指令和下手臂指令；
[0040]3)机器人控制器将上手臂指令发送至规划库，规划库在第一进程中获取上手臂控制参数，并根据控制参数进行规划，获取上手臂规划结果；
[0041]机器人控制器将下手臂指令写入共享内存中，并通过规划库进行规划，规划库在第二进程中获取下手臂控制参数，并根据控制参数进行规划，获取下手臂规划结果；
[0042]4)将上手臂规划结果和下手臂规划结果分别通过CAN总线发送至对应的上手臂机器人驱动器和下手臂机器人驱动器；
[0043]5)上手臂的机器人驱动器和下手臂的机器人驱动器分别执行上手臂规划结果和下手臂规划结果，实现真空双臂机器人的双臂独立控制。
[0044]其中，机本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种真空双臂机器人的双臂独立控制方法，其特征在于，包括以下步骤：1)上位机发送运动指令至机器人控制器；2)机器人控制器对运动指令进行解析，解析出上手臂指令和下手臂指令；3)机器人控制器将上手臂指令发送至规划库，规划库在第一进程中获取上手臂控制参数，并根据控制参数进行规划，获取上手臂规划结果；机器人控制器将下手臂指令写入共享内存中，并通过规划库进行规划，规划库在第二进程中获取下手臂控制参数，并根据控制参数进行规划，获取下手臂规划结果；4)将上手臂规划结果和下手臂规划结果分别通过CAN总线发送至对应的上手臂机器人驱动器和下手臂机器人驱动器；5)上手臂的机器人驱动器和下手臂的机器人驱动器分别执行上手臂规划结果和下手臂规划结果，实现真空双臂机器人的双臂独立控制。2.根据权利要求1所述的一种真空双臂机器人的双臂独立控制方法，其特征在于，所述步骤2)具体为：解析指令时，通过设定的指令标识分别将上手臂指令解析为上手臂对应的指令码，下手臂指令解析为下手臂对应的指令码。3.根据权利要求1所述的一种真空双臂机器人的双臂独立控制方法，其特征在于，所述控制参数，包括：工位信息、目标位置和速度。4.根据权利要求1所述的一种真空双臂机器人的双臂独立控制方法，其特征在于，步骤3)中所述规划库在第一进程中获取上手臂控制参数，具体为：根据上手臂对应的指令码在第一进程中获取相应的工位信息、目标位置和速度并进行运动规划。5.根据权利要求1所述的一种真空双臂机器人的双臂独立...

【专利技术属性】
技术研发人员：徐方，凌霄，赵彬，杨奇峰，谭学科，赵云鹏，孙若怀，
申请(专利权)人：沈阳新松机器人自动化股份有限公司，
类型：发明
国别省市：