CN115107023B - 一种真空双臂机器人的双臂独立控制方法 - Google Patents
一种真空双臂机器人的双臂独立控制方法 Download PDFInfo
- Publication number
- CN115107023B CN115107023B CN202210703306.8A CN202210703306A CN115107023B CN 115107023 B CN115107023 B CN 115107023B CN 202210703306 A CN202210703306 A CN 202210703306A CN 115107023 B CN115107023 B CN 115107023B
- Authority
- CN
- China
- Prior art keywords
- arm
- planning
- lower arm
- upper arm
- robot
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 47
- 230000033001 locomotion Effects 0.000 claims abstract description 51
- 230000008569 process Effects 0.000 claims description 24
- 230000006870 function Effects 0.000 description 10
- 238000004891 communication Methods 0.000 description 7
- 238000005516 engineering process Methods 0.000 description 7
- 235000012431 wafers Nutrition 0.000 description 7
- 230000001133 acceleration Effects 0.000 description 6
- 230000036461 convulsion Effects 0.000 description 6
- 230000005540 biological transmission Effects 0.000 description 3
- 230000001360 synchronised effect Effects 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J18/00—Arms
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1661—Programme controls characterised by programming, planning systems for manipulators characterised by task planning, object-oriented languages
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
本发明属于双臂真空机器人控制领域,具体说是一种真空双臂机器人的双臂独立控制方法,包括以下步骤:上位机发送运动指令至机器人控制器;机器人控制器对运动指令进行解析,解析出上手臂指令和下手臂指令;将上手臂指令发送至规划库,获取上手臂控制参数,并根据控制参数进行规划,获取上手臂规划结果;将下手臂指令写入共享内存中,规划库获取下手臂控制参数,并根据控制参数进行规划,获取下手臂规划结果;将上述双臂规划结果分别发送至对应的机器人驱动器执行上手臂规划结果和下手臂规划结果。本发明采用双进程的双臂独立控制方法可以实现在上臂运动的过程中,然后再开始下臂的运动,双臂的开始运动时间和结束运动时间可以不同。
Description
技术领域
本发明属于双臂真空机器人控制领域,具体说是一种真空双臂机器人的双臂独立控制方法。
背景技术
国内机器人在传输晶圆的过程中只能实现双臂的同步规划控制,即双臂同时开始运动并且同时结束运动,在真空平台中同一时刻只能针对一个工位进行晶圆传输。没办法实现双臂独立规划控制,为保证双臂机器人在传输晶圆的过程中更加灵活,迅速,双臂机器人需要开发一种双臂独立规划技术。
发明内容
本发明目的是提供一种真空双臂机器人的双臂独立控制方法,以实现在传输晶圆的过程中实现双臂的独立规划控制,以克服上述现有国内机器人只能实现双臂的同步规划控制的弊端。
本发明为实现上述目的所采用的技术方案是:一种真空双臂机器人的双臂独立控制方法,包括以下步骤:
1)上位机发送运动指令至机器人控制器;
2)机器人控制器对运动指令进行解析,解析出上手臂指令和下手臂指令;
3)机器人控制器将上手臂指令发送至规划库,规划库在第一进程中获取上手臂控制参数,并根据控制参数进行规划,获取上手臂规划结果;
机器人控制器将下手臂指令写入共享内存中,并通过规划库进行规划,规划库在第二进程中获取下手臂控制参数,并根据控制参数进行规划,获取下手臂规划结果;
4)将上手臂规划结果和下手臂规划结果分别通过CAN总线发送至对应的上手臂机器人驱动器和下手臂机器人驱动器;
5)上手臂的机器人驱动器和下手臂的机器人驱动器分别执行上手臂规划结果和下手臂规划结果,实现真空双臂机器人的双臂独立控制。
所述步骤2)具体为:解析指令时,通过设定的指令标识分别将上手臂指令解析为上手臂对应的指令码,下手臂指令解析为下手臂对应的指令码。
所述控制参数,包括:工位信息、目标位置和速度。
步骤3)中所述规划库在第一进程中获取上手臂控制参数,具体为:
根据上手臂对应的指令码在第一进程中获取相应的工位信息、目标位置和速度并进行运动规划。
步骤3)中所述规划库在第二进程中获取下手臂控制参数,具体为:
通过共享内存获取下手臂对应的指令码,在第二进程中获取共享内存中的工位信息、目标位置、速度进行运动规划。
步骤3)中根据控制参数进行规划,获取上手臂和下手臂的规划结果,具体为:
规划开始时,分别根据上手臂和下手臂的工位信息、目标位置确定上手臂的关节值,根据速度得到周期数,进而分别获取在每个周期中上手臂的关节值和下手臂的关节值;进而根据上手臂和下手臂的关节值,得到用于控制上手臂关节的电机码盘值和用于控制下手臂关节的电机码盘值。
所述步骤5),具体为:
所述上手臂和下手臂均由两个电机控制;
将获取到的上手臂关节的电机码盘通过CAN总线写入到作为CAN从站节点ID1的第一电机和CAN从站节点ID2的第二电机所对应的对象字典中,上手臂机器人驱动器根据上手臂关节的电机码盘分别对两个电机驱动,从而实现上手臂的运动控制;
将获取到的下手臂关节的电机码盘值通过CAN总线写入到共享内存中,在将共享内存中的下手臂关节的电机码盘值通过CAN总线写入到作为CAN从站节点ID3的第三电机和CAN从站节点ID4的第四电机所对应的对象字典中,下手臂机器人驱动器根据下手臂关节的电机码盘分别对两个电机驱动,从而实现下手臂的运动控制。
本发明具有以下有益效果及优点:
1.本发明采用双进程的双臂独立控制方法可以实现在上臂运动的过程中,然后再开始下臂的运动,双臂的开始运动时间和结束运动时间可以不同。
2.本发明在真空平台中可以随时对两个不同的工位进行晶圆传输,这样传输效率可以比原有双臂同步控制方法提高一倍。
3.本发明实现了双臂机器人在传输晶圆过程中的双臂独立规划控制技术,使双臂机器人在传输晶圆时更加灵活、迅速。
附图说明
图1本发明的控制原理图;
图2本发明的方法流程图。
具体实施方式
下面结合附图及实施例对本发明做进一步的详细说明。
本发明的技术关键点在于:1、通过使用进程间通讯技术传输双臂的运动信息。2、使用双进程分别规划双臂的运动轨迹。3、使用进程间通讯技术传输规划完的运动轨迹并实现运动。其中,双臂独立规划技术总体方案包括:通讯指令的接收、双臂独立规划、双臂运动实现。
本发明基于的装置为双臂机器人实现,如公布日为2020年7月3日的申请号201811586648.6,发明名称为:一种升降式独立直驱真空机械手;其中,本发明中的上手臂对应该申请中机械手组件2的一轴手臂5和二轴手臂6;本申请下手臂对应该申请中机械手组件2的三轴手臂7和四轴手臂8;
其中,控制本发明的上手臂和下手臂均由两个电机控制,对于控制上手臂的第一电机和第二电机,分别对应了一种升降式独立直驱真空机械手的一轴直驱电机20和二轴直驱电机19;对于控制下手臂的第三电机和第四电机,分别对应了一种升降式独立直驱真空机械手的三轴直驱电机18和四轴直驱电机17;
如图1所示,为本发明的控制原理图:
1)通讯指令的接收:通过指令区分接收到的运动指令是控制哪个手臂的指令。解析并将目标位置点的关节值、速度、加速度和加加速度传给对应的手臂。
2)通过双进程实现双臂独立规划:通过两个进程分别规划各自的手臂运动轨迹。
3)通过进程间通讯技术实现双臂的独立运动:通过进程间通讯技术将两个手臂的运动轨迹点传输给控制器,控制器通过CAN总线将各个轴的码盘值发送给驱动器实现双臂的独立运动。
如图2所示,为本发明的方法流程图,具体包括以下步骤:
首先,1)上位机发送运动指令至机器人控制器;
2)机器人控制器对运动指令进行解析,解析出上手臂指令和下手臂指令;
3)机器人控制器将上手臂指令发送至规划库,规划库在第一进程中获取上手臂控制参数,并根据控制参数进行规划,获取上手臂规划结果;
机器人控制器将下手臂指令写入共享内存中,并通过规划库进行规划,规划库在第二进程中获取下手臂控制参数,并根据控制参数进行规划,获取下手臂规划结果;
4)将上手臂规划结果和下手臂规划结果分别通过CAN总线发送至对应的上手臂机器人驱动器和下手臂机器人驱动器;
5)上手臂的机器人驱动器和下手臂的机器人驱动器分别执行上手臂规划结果和下手臂规划结果,实现真空双臂机器人的双臂独立控制。
其中,机器人控制器对运动指令进行解析,解析出上手臂指令和下手臂指令;其通讯指令接收详细步骤如下:
通过TCP或者串口接收上位机发送给机器人的运动指令,解析指令时通过设定的指令标识(ARM A、ARM B)分别将上手臂指令解析为上手臂对应的指令码,下手臂指令解析为下手臂对应的指令码(上臂指令码0xa1-0xcf、下臂指令码0xd1~0xff)。通过指令标识,机器人控制器可自动分辨出具体哪一条指令码对应了哪一个手臂;
双臂独立规划详细步骤:
上手臂运动规划可直接将上手臂对应的指令码通过上手臂接口函数传递给上手臂运动函数,上手臂运动函数可直接在主进程中获取相应的工位信息、目标位置、速度、加速度、加加速度并进行运动规划。
下手臂运动规划由于在进程二中无法直接获取主进程中的指令码、工位信息、目标位置、速度、加速度、加加速度、信号量同步等信息。需要先将上述信息写入共享内存中,下手臂运动规划通过共享内存获取下手臂对应的指令码,再将指令码通过下手臂接口函数传递给下手臂运动函数,下手臂运动函数通过获取共享内存中的工位信息、目标位置、速度、加速度、加加速度进行运动规划。
双臂运动实现详细步骤:
上手臂运动规划开始时,会将工位信息、目标位置、速度、加速度、加加速度5个参数传给规划函数,计算得出每个周期输出的关节值,关节值在通过模型函数计算出每个周期输出的码盘值,直到规划全部执行完成。
下手臂运动规划开始时,会将工位信息、目标位置、速度、加速度、加加速度5个参数传给规划函数,计算得出每个周期输出的关节值,关节值在通过模型函数计算出每个周期输出的码盘值,直到规划全部执行完成。下手臂规划由于在进程二中进行,需要先获取信号量同步信息再将每个周期规划后计算出的码盘值写入到共享内存中。
双臂运动控制详细步骤:
上手臂和下手臂均由两个电机控制;
将获取到的上手臂关节的电机码盘写入到CAN总线,再通过CAN总线通过对象字典为0x6063的PDO写入到作为CAN从站节点ID1的第一电机和CAN从站节点ID2的第二电机所对应的对象字典中,上手臂机器人驱动器根据上手臂关节的电机码盘分别对两个电机驱动,从而实现上手臂的运动控制;
将获取到的下手臂关节的电机码盘值通过CAN总线写入到共享内存中,在将共享内存中的下手臂关节的电机码盘值写入到CAN总线中,CAN总线再通过对象字典为0x6063的PDO写入到作为CAN从站节点ID3的第三电机和CAN从站节点ID4的第四电机所对应的对象字典中,下手臂机器人驱动器根据下手臂关节的电机码盘分别对两个电机驱动,从而实现下手臂的运动控制。
以上所述仅为本发明的实施方式,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内所作的任何修改、等同替换、改进、扩展等,均包含在本发明的保护范围内。
Claims (6)
1.一种真空双臂机器人的双臂独立控制方法,其特征在于,包括以下步骤:
1)上位机发送运动指令至机器人控制器;
2)机器人控制器对运动指令进行解析,解析出上手臂指令和下手臂指令;
解析指令时,通过设定的指令标识分别将上手臂指令解析为上手臂对应的指令码,下手臂指令解析为下手臂对应的指令码;
3)机器人控制器将上手臂指令发送至规划库,规划库在第一进程中获取上手臂控制参数,并根据控制参数进行规划,获取上手臂规划结果;
机器人控制器将下手臂指令写入共享内存中,并通过规划库进行规划,规划库在第二进程中获取下手臂控制参数,并根据控制参数进行规划,获取下手臂规划结果;
4)将上手臂规划结果和下手臂规划结果分别通过CAN总线发送至对应的上手臂机器人驱动器和下手臂机器人驱动器;
5)上手臂的机器人驱动器和下手臂的机器人驱动器分别执行上手臂规划结果和下手臂规划结果,实现真空双臂机器人的双臂独立控制。
2.根据权利要求1所述的一种真空双臂机器人的双臂独立控制方法,其特征在于,所述控制参数,包括:工位信息、目标位置和速度。
3.根据权利要求1所述的一种真空双臂机器人的双臂独立控制方法,其特征在于,步骤3)中所述规划库在第一进程中获取上手臂控制参数,具体为:
根据上手臂对应的指令码在第一进程中获取相应的工位信息、目标位置和速度并进行运动规划。
4.根据权利要求1所述的一种真空双臂机器人的双臂独立控制方法,其特征在于,步骤3)中所述规划库在第二进程中获取下手臂控制参数,具体为:
通过共享内存获取下手臂对应的指令码,在第二进程中获取共享内存中的工位信息、目标位置、速度进行运动规划。
5.根据权利要求1所述的一种真空双臂机器人的双臂独立控制方法,其特征在于,步骤3)中根据控制参数进行规划,获取上手臂和下手臂的规划结果,具体为:
规划开始时,分别根据上手臂和下手臂的工位信息、目标位置确定上手臂的关节值,根据速度得到周期数,进而分别获取在每个周期中上手臂的关节值和下手臂的关节值;进而根据上手臂和下手臂的关节值,得到用于控制上手臂关节的电机码盘值和用于控制下手臂关节的电机码盘值。
6.根据权利要求1所述的一种真空双臂机器人的双臂独立控制方法,其特征在于,所述步骤5),具体为:
所述上手臂和下手臂均由两个电机控制;
将获取到的上手臂关节的电机码盘通过CAN总线写入到作为CAN从站节点ID1的第一电机和CAN从站节点ID2的第二电机所对应的对象字典中,上手臂机器人驱动器根据上手臂关节的电机码盘分别对两个电机驱动,从而实现上手臂的运动控制;
将获取到的下手臂关节的电机码盘值通过CAN总线写入到共享内存中,在将共享内存中的下手臂关节的电机码盘值通过CAN总线写入到作为CAN从站节点ID3的第三电机和CAN从站节点ID4的第四电机所对应的对象字典中,下手臂机器人驱动器根据下手臂关节的电机码盘分别对两个电机驱动,从而实现下手臂的运动控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210703306.8A CN115107023B (zh) | 2022-06-21 | 2022-06-21 | 一种真空双臂机器人的双臂独立控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210703306.8A CN115107023B (zh) | 2022-06-21 | 2022-06-21 | 一种真空双臂机器人的双臂独立控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115107023A CN115107023A (zh) | 2022-09-27 |
CN115107023B true CN115107023B (zh) | 2023-01-24 |
Family
ID=83327569
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210703306.8A Active CN115107023B (zh) | 2022-06-21 | 2022-06-21 | 一种真空双臂机器人的双臂独立控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115107023B (zh) |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7946800B2 (en) * | 2007-04-06 | 2011-05-24 | Brooks Automation, Inc. | Substrate transport apparatus with multiple independently movable articulated arms |
CN102554910A (zh) * | 2010-12-21 | 2012-07-11 | 沈阳新松机器人自动化股份有限公司 | 一种机器人手臂机构 |
US10518405B2 (en) * | 2016-06-29 | 2019-12-31 | Abb Schweiz Ag | Industrial robot system comprising a dual arm robot |
CN108942874A (zh) * | 2018-10-11 | 2018-12-07 | 泉州市联控自动化科技有限公司 | 一种超市寻货机器人 |
CN111360805A (zh) * | 2018-12-25 | 2020-07-03 | 沈阳新松机器人自动化股份有限公司 | 一种升降式独立直驱真空机械手 |
CN111300408B (zh) * | 2020-02-06 | 2023-05-12 | 北京凡川智能机器人科技有限公司 | 一种结合形似与神似的仿人双臂机器人运动规划控制方法 |
-
2022
- 2022-06-21 CN CN202210703306.8A patent/CN115107023B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN115107023A (zh) | 2022-09-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109483556B (zh) | 一种基于示教学习的机器人打磨***及方法 | |
CN106475999B (zh) | 刚性条件下基于阻抗模型的双臂协调的加速度控制方法 | |
CN104552300B (zh) | 一种基于示教机器人的离线编程示教装置及方法 | |
CN101739865B (zh) | 一种基于plc的教学用二维运动示教平台及其实现方法 | |
CN106777475B (zh) | 一种有限空间约束的注塑机械臂动力学协同仿真方法 | |
CN106003023A (zh) | 机器人运动控制***和方法 | |
CN105965512B (zh) | 一种工业多轴机械臂的运动再现方法 | |
CN109978272B (zh) | 一种基于多个全向移动机器人的路径规划***及方法 | |
CN110842920B (zh) | 一种单处理芯片的控驱一体***架构 | |
CN108189034B (zh) | 一种机器人连续轨迹实现方法 | |
CN108279630B (zh) | 一种基于总线的分布式运动控制***及方法 | |
CN111002306B (zh) | 一种基于电子凸轮的机器人运动控制方法及控制*** | |
CN108762112A (zh) | 一种基于虚拟现实的工业机器人仿真与实时控制*** | |
CN113433894B (zh) | 基于工业pc的多通道多轴联动的数控***及方法 | |
CN109834714B (zh) | 一种用于多机器人的轨迹控制***与方法 | |
CN108638015B (zh) | 基于量化通信的主从机械臂同步跟踪控制方法 | |
CN106346480A (zh) | 一种基于ug和matlab的多自由度注塑机械臂建模方法 | |
CN107443379A (zh) | 一种基于仿真数据的机械臂运动控制方法 | |
CN107671838B (zh) | 机器人示教记录***、示教的工艺步骤及其算法流程 | |
CN110515358B (zh) | 基于一体化控制器的自动化产线并行控制***的控制方法 | |
CN114102590A (zh) | 一种工业机器人仿真方法、***及应用 | |
CN115107023B (zh) | 一种真空双臂机器人的双臂独立控制方法 | |
CN112965397B (zh) | 一种基于模型的本地有线/远程无线硬件在环实时控制装置及方法 | |
CN113601516A (zh) | 一种无传感器的机器人拖动示教方法及*** | |
CN205343150U (zh) | 机器人*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right |
Effective date of registration: 20231103 Address after: No.15-1 Feiyun Road, Hunnan District, Shenyang City, Liaoning Province, 110169 Patentee after: Shenyang Xinsong Semiconductor Equipment Co.,Ltd. Address before: Hunnan New District Jinhui street in Shenyang of Liaoning province 110168 City No. 16 Patentee before: SHENYANG SIASUN ROBOT & AUTOMATION Co.,Ltd. |
|
TR01 | Transfer of patent right |