CN106956258B - 使用机械手臂进行阵列取放的路径规划方法和补偿器 - Google Patents
使用机械手臂进行阵列取放的路径规划方法和补偿器 Download PDFInfo
- Publication number
- CN106956258B CN106956258B CN201610012058.7A CN201610012058A CN106956258B CN 106956258 B CN106956258 B CN 106956258B CN 201610012058 A CN201610012058 A CN 201610012058A CN 106956258 B CN106956258 B CN 106956258B
- Authority
- CN
- China
- Prior art keywords
- axis
- pick
- mechanical arm
- place
- component
- 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
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
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
- B25J9/1692—Calibration of manipulator
-
- 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
- B25J9/1687—Assembly, peg and hole, palletising, straight line, weaving pattern movement
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39024—Calibration of manipulator
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39191—Compensation for errors in mechanical components
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
一种使用机械手臂进行阵列取放的路径规划方法,主要是在机械手臂每一次进行取放作业的过程中,利用一X轴位置传感器与一Y轴传感器感测取放点的坐标误差,接着由一控制器根据两者的坐标误差向量和计算出一位置补偿量,并以位置补偿量修正机械手臂的取放位置,在取得位置补偿量之后再产生下一个取放点的坐标,如此不断地反复操作即可完成大量阵列的取放任务。
Description
技术领域
本发明与机械手臂有关,特别是指一种使用机械手臂进行阵列取放的路径规划方法及配合该路径规划方法使用的补偿器。
背景技术
在操作机械手臂执行阵列取放作业时,由于累积误差的关系,使得机械手臂仅能在有限的工作范围内进行操作。就相关的先前技术来说,例如欧洲公告第2190634号专利案是利用一组线性滑轨与一组平行四连杆来实现X-Y平面补偿的功能,同时再使用磁簧传感器反馈过行程的警示信号,让机械手臂停止动作。但是在此专利案中,磁簧传感器无法得知机械手臂在X-Y方向所移动的距离,此外,磁簧传感器所发送的警示信号会让机械手臂停止动作而无法继续完成剩下的阵列取放作业。
另外如美国公告第4745681号专利案是利用夹爪周围的力传感器来感测从插销孔吸入或排出的气体压力,若感测到气体压力有分布不均等的状况时,反复移动夹爪而使插销能够尽量对准插销孔,直到力传感器感测到气体压力呈现均等时,操作夹爪将插销插入插销孔内。然而在此专利案中,等待气体压力值呈现平衡的过程太过耗时,再加上一组夹爪要搭配四个力传感器,对于成本来说过于昂贵,而且也不太适合应用在高精度的产品。
发明内容
本发明的主要目的在于提供一种使用机械手臂进行阵列取放的路径规划方法,其利用信号反馈与位置补偿来实现大量阵列取放的任务,并能达到消除累积误差的效果。
为了实现上述目的,本发明的路径规划方法包含有下列几个步骤。首先操作一机械手臂进行原点校正,接着由一控制器产生下一个取放点的坐标位置,然后由该控制器根据下一个取放点的坐标位置控制该机械手臂执行取放作业,在执行过程中使用一X轴位置传感器与一Y轴位置传感器感测该机械手臂的一X轴位移量与一Y轴位移量,并将感测结果反馈至该控制器,接着该控制器根据该机械手臂的X、Y轴位移量计算出该取放点的坐标误差,再由所得到的坐标误差计算出一位置补偿量,在取得该位置补偿量之后返回步骤b)。
更佳地,在完成一次取放作业之后,该控制器会判断是否为最后一个取放点,若是最后一个取放点,该控制器控制该机械手臂停止动作,若不是最后一个取放点,则是继续执行步骤d),经过如此不断地反复反馈与补偿即可解决误差放大的问题,同时可以完成大量阵列的取放任务。
附图说明
图1为本发明的流程图。
图2为本发明所提供的补偿器的立体图。
图3为本发明所提供的补偿器的局部立体分解图。
图4为本发明的路径规划示意图。
具体实施方式
请先参阅图1,本发明的路径规划方法包含有下列步骤:
步骤a)S1:操作一机械手臂进行原点校正。
步骤b)S2:由一控制器产生下一个取放点的坐标位置。
步骤c)S3:控制器根据下一个取放点的坐标位置控制机械手臂执行取放作业。
步骤d)S4:如图2所示,在执行取放作业的过程中使用一X轴位置传感器12与一Y轴位置传感器14感测机械手臂的一X轴位移量与一Y轴位移量,并将感测结果反馈至控制器。
在本实施例中,X轴位置传感器12与Y轴位置传感器14共同设置于机械手臂的一补偿器10内。请再参阅图3,本发明所提供的补偿器10除了包含有X轴位置传感器12与Y轴位置传感器14之外,还包含有一第一部件16、一第二部件18、一X轴线性滑轨20、一Y轴线性滑轨22,以及二相对的复位弹性件24,其中:
第一部件16的顶面用来连接于机械手臂。
第二部件18的顶面连接于第一部件16的底面,第二部件18的底面用来连接于一末端工具(图中未示)。
X轴线性滑轨20设于第二部件18的顶面,使第二部件18能藉由X轴线性滑轨20沿着一X轴方向相对第一部件16移动。
Y轴线性滑轨22设于第二部件18的顶面,使第二部件18能藉由Y轴线性滑轨22沿着一Y轴方向相对第一部件16移动。
X轴复位弹性件24以沿着X轴方向的方式水平设置于第一部件16与第二部件18之间,用以对第二部件18提供复位力,使第二部件18在不受侧向力时能够回复到初始位置。
Y轴复位弹性件26以沿着Y轴方向的方式水平设置于第一部件16与第二部件18之间,用以对第二部件18提供复位力,使第二部件18在不受侧向力时能够回复到初始位置。
X轴位置传感器12设于X轴线性滑轨20的一端,用以感测X轴线性滑轨20的移动距离。
Y轴位置传感器14设于Y轴线性滑轨22的一端,用以感测Y轴线性滑轨22的移动距离。
步骤e)S5:控制器根据机械手臂的X、Y轴位移量计算出步骤b)的取放点的坐标误差。
步骤f)S6:控制器根据步骤e)的坐标误差计算出机械手臂的一位置补偿量,在取得位置补偿量之后再返回步骤b)。
接下来用六个阵列取放点结合图4及表一来帮助说明前述步骤。首先设定原点的坐标为P0,控制器所产生的第一个取放点的坐标假设为P1,在执行P1的取放作业之后会同时取得P1的坐标误差为ε1xy,接着控制器会产生第二个取放点,假设第二个取放点的坐标为P2,在执行P2的取放作业之后会同时取得P2的坐标误差ε2xy。之后控制器会产生第三个取放点,假设第三个取放点的坐标为P3,在执行P3的取放过程中会根据先前所取得的两个坐标误差ε1xy、ε2xy来计算位置补偿量,并以所计算出来的位置补偿量将机械手臂的取放位置修正至P3’,同时也取得P3的坐标误差ε3xy。假设第四个取放点的坐标为P4,在执行P4的取放过程中会根据先前所取得的坐标误差ε1xy计算位置补偿量,并以所计算出来的位置补偿量将机械手臂的取放位置修正至P4’,同时取得P4的坐标误差ε4xy。假设第五个取放点的坐标为P5,在执行P5的取放过程中会根据先前所取得的两个坐标误差ε3xy、ε4xy计算位置补偿量,并以所计算出来的位置补偿量将机械手臂的取放位置修正至P5’,同时取得P5的坐标误差ε5xy,后续过程以此类推。
表一
原始位置 | 坐标误差 | 修正后位置 |
P1 | ε<sub>1xy</sub> | P1 |
P2 | ε<sub>2xy</sub> | P2 |
P3 | ε<sub>3xy</sub> | P3’=P3+ε<sub>1xy</sub>+ε<sub>2xy</sub> |
P4 | ε<sub>4xy</sub> | P4’=P4+ε<sub>1xy</sub> |
P5 | ε<sub>5xy</sub> | P5’=P5+ε<sub>3xy</sub>+ε<sub>4xy</sub> |
另一方面,在完成一次取放作业之后,控制器会判断是否为最后一个取放点,若是最后一个取放点,控制器控制机械手臂停止动作,若不是最后一个取放点,则执行步骤d)。
由上述可知,本发明主要是在机械手臂每一次进行取放作业的过程中,利用X、Y轴位置传感器12、14感测取放点的坐标误差,接着由控制器根据两者之间的坐标误差计算出位置补偿量,并以位置补偿量修正机械手臂的取放位置,在如此不断地反复操作之下,一方面可以消除误差放大的问题,另一方面可以完成大量阵列的取放任务,进而达到本发明的目的。
【符号说明】
10 补偿器 12 X轴位移传感器
14 Y轴位移传感器 16 第一部件
18 第二部件 20 X轴线性滑轨
22 Y轴线性滑轨 24 X轴复位弹性件
26 Y轴复位弹性件 S1~S6 步骤
Claims (2)
1.一种使用机械手臂进行阵列取放的路径规划方法,包含有下列步骤:
a)操作一机械手臂进行原点校正;
b)由一控制器产生下一个取放点的坐标位置;
c)由该控制器根据下一个取放点的坐标位置控制该机械手臂执行取放作业;
d)使用一X轴位置传感器与一Y轴位置传感器感测该机械手臂的一X轴位移量与一Y轴位移量,并将感测结果反馈至该控制器;
e)该控制器根据该机械手臂的X、Y轴位移量计算出步骤b)的取放点的坐标误差;以及
f)该控制器根据步骤e)的坐标误差计算出该机械手臂的一位置补偿量,在取得该位置补偿量之后返回步骤b);
其中,该X轴位置传感器与该Y轴位置传感器共同设置于该机械手臂的一补偿器内;
其中,该补偿器包含有:
一第一部件;
一第二部件,连接于该第一部件的底面;
一X轴线性滑轨,设于该第二部件,使该第二部件能藉由该X轴线性滑轨沿着一X轴方向相对该第一部件移动;
一Y轴线性滑轨,设于该第二部件,使该第二部件能藉由该Y轴线性滑轨沿着一Y轴方向相对该第一部件移动;
二相对的X轴复位弹性件,沿着该X轴方向设于该第一部件与该第二部件之间,用以对该第二部件提供复位力;
二相对的Y轴复位弹性件,沿着该Y轴方向设于该第一部件与该第二部件之间,用以对该第二部件提供复位力;
一X轴位置传感器,设于该X轴线性滑轨的一端,用以感测该X轴线性滑轨的移动距离;以及
一Y轴位置传感器,设于该Y轴线性滑轨的一端,用以感测该Y轴线性滑轨的移动距离。
2.如权利要求1所述的路径规划方法,其中在步骤c)完成一次取放作业之后,该控制器会判断是否为最后一个取放点,若为是,该控制器控制该机械手臂停止动作,若为否,执行步骤d)。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610012058.7A CN106956258B (zh) | 2016-01-08 | 2016-01-08 | 使用机械手臂进行阵列取放的路径规划方法和补偿器 |
JP2016017231A JP6194376B2 (ja) | 2016-01-08 | 2016-02-01 | ロボットアームによって配列にピックアンドプレース作業を行う径路計画方法 |
US15/062,478 US9833906B2 (en) | 2016-01-08 | 2016-03-07 | Method of path planning for array-based pick-and-place performed with robotic arm and compensator for use with the method |
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610012058.7A CN106956258B (zh) | 2016-01-08 | 2016-01-08 | 使用机械手臂进行阵列取放的路径规划方法和补偿器 |
JP2016017231A JP6194376B2 (ja) | 2016-01-08 | 2016-02-01 | ロボットアームによって配列にピックアンドプレース作業を行う径路計画方法 |
US15/062,478 US9833906B2 (en) | 2016-01-08 | 2016-03-07 | Method of path planning for array-based pick-and-place performed with robotic arm and compensator for use with the method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106956258A CN106956258A (zh) | 2017-07-18 |
CN106956258B true CN106956258B (zh) | 2020-06-30 |
Family
ID=69063570
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610012058.7A Active CN106956258B (zh) | 2016-01-08 | 2016-01-08 | 使用机械手臂进行阵列取放的路径规划方法和补偿器 |
Country Status (3)
Country | Link |
---|---|
US (1) | US9833906B2 (zh) |
JP (1) | JP6194376B2 (zh) |
CN (1) | CN106956258B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108107439A (zh) * | 2017-11-30 | 2018-06-01 | 上海华力微电子有限公司 | 蚀刻设备真空传输腔内机械手臂位置量测方法及装置 |
CN109129486B (zh) * | 2018-09-26 | 2021-04-30 | 华南理工大学 | 一种抑制周期噪声的冗余度机械臂重复运动规划方法 |
CN112902898B (zh) * | 2019-12-03 | 2022-11-29 | 台达电子工业股份有限公司 | 三维测量装置及所适用的机械手臂的校正方法 |
WO2024193630A1 (zh) * | 2023-03-23 | 2024-09-26 | 武汉联影智融医疗科技有限公司 | 机械臂的路径规划方法、装置、存储介质和计算机设备 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS629862A (ja) * | 1985-07-04 | 1987-01-17 | Mitsubishi Electric Corp | 力覚工具支持機構 |
CN1033590A (zh) * | 1987-07-28 | 1989-07-05 | 布莱阿姆青年大学 | 机器人误差矫正装置和方法 |
CN101574586A (zh) * | 2009-06-09 | 2009-11-11 | 东北大学 | 毽球机器人及控制方法 |
CN102794662A (zh) * | 2012-08-10 | 2012-11-28 | 安徽工程大学 | 一种六自由度位置姿态全解耦可调夹具 |
CN103203618A (zh) * | 2013-04-02 | 2013-07-17 | 嘉兴华嶺机电设备有限公司 | 一种直驱节能在线检测及高效装配设备 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4745681A (en) | 1987-04-22 | 1988-05-24 | International Business Machines Corporation | Controlled pin insertion using airflow sensing and active feedback |
US5325468A (en) * | 1990-10-31 | 1994-06-28 | Sanyo Electric Co., Ltd. | Operation planning system for robot |
US5908283A (en) * | 1996-11-26 | 1999-06-01 | United Parcel Service Of Americia, Inc. | Method and apparatus for palletizing packages of random size and weight |
ITTO20070512A1 (it) | 2007-07-11 | 2009-01-12 | Tekno Alfa Srl | Dispositivo di compensazione su due assi e anticollisione as-sociato all'attrezzo operatore di un robot industriale |
JP5774361B2 (ja) * | 2011-04-28 | 2015-09-09 | 本田技研工業株式会社 | 軌道計画方法、軌道計画システム及び軌道計画・制御システム |
US9308649B2 (en) * | 2013-02-25 | 2016-04-12 | LuxVue Techonology Corporation | Mass transfer tool manipulator assembly |
JP2015000455A (ja) * | 2013-06-17 | 2015-01-05 | キヤノン株式会社 | ロボット装置及びロボット装置の制御方法 |
-
2016
- 2016-01-08 CN CN201610012058.7A patent/CN106956258B/zh active Active
- 2016-02-01 JP JP2016017231A patent/JP6194376B2/ja active Active
- 2016-03-07 US US15/062,478 patent/US9833906B2/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS629862A (ja) * | 1985-07-04 | 1987-01-17 | Mitsubishi Electric Corp | 力覚工具支持機構 |
CN1033590A (zh) * | 1987-07-28 | 1989-07-05 | 布莱阿姆青年大学 | 机器人误差矫正装置和方法 |
CN101574586A (zh) * | 2009-06-09 | 2009-11-11 | 东北大学 | 毽球机器人及控制方法 |
CN102794662A (zh) * | 2012-08-10 | 2012-11-28 | 安徽工程大学 | 一种六自由度位置姿态全解耦可调夹具 |
CN103203618A (zh) * | 2013-04-02 | 2013-07-17 | 嘉兴华嶺机电设备有限公司 | 一种直驱节能在线检测及高效装配设备 |
Also Published As
Publication number | Publication date |
---|---|
JP2017136649A (ja) | 2017-08-10 |
JP6194376B2 (ja) | 2017-09-06 |
CN106956258A (zh) | 2017-07-18 |
US20170252927A1 (en) | 2017-09-07 |
US9833906B2 (en) | 2017-12-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106956258B (zh) | 使用机械手臂进行阵列取放的路径规划方法和补偿器 | |
US9043023B2 (en) | Robot system, and control apparatus and method thereof | |
US11285609B2 (en) | Working position correcting method and working robot | |
EP2613912B1 (en) | System and method for tool testing and alignment | |
US20100281705A1 (en) | Method of aligning arm reference system of a multiple-arm measurement machine | |
US20110040514A1 (en) | Method for calibrating a coordinate measuring machine | |
CN111890348B (zh) | 一种双机器人协同搬运的控制方法及装置 | |
CN105312632A (zh) | 将工具按压至工件来进行作业的机器人的控制装置 | |
CN109129482B (zh) | 一种动态补偿机器人直线导轨运动误差的方法 | |
CN105573248B (zh) | 基于多工位装配夹具补偿的柔性件装配尺寸偏差控制方法 | |
JP6563271B2 (ja) | 組立体製造装置及び組立体製造方法 | |
CN115493635A (zh) | 一种面向孔位补偿与姿态检测的实验平台和调整方法 | |
US9983563B2 (en) | Method and apparatus for controlling a machine tool | |
US20110118876A1 (en) | Teaching line correcting apparatus, teaching line correcting method, and program thereof | |
JP5526375B2 (ja) | 三次元計測システム及び三次元計測方法 | |
CN110686655B (zh) | 三维曲面工件的定位方法、装置及系统 | |
TWI564131B (zh) | Method and method of path planning for array pick - up using robotic arm The compensator used by the path planning method | |
CN109789548B (zh) | 用于工件校准的方法和使用该方法的机器人系统 | |
CN110154043B (zh) | 基于加工结果进行学习控制的机器人系统及其控制方法 | |
JP2022120550A (ja) | ロボットシステム、ロボットシステムの制御方法、ロボットシステムを用いた物品の製造方法、制御プログラムおよび記録媒体 | |
JP5895376B2 (ja) | ロボットセルの位置合わせ方法及び位置合わせ制御装置 | |
CN108748150A (zh) | 面向机器人加工的低成本实时补偿装置及方法 | |
JP5361334B2 (ja) | 産業機械 | |
KR102006829B1 (ko) | 로봇의 교정 시스템 및 이를 이용한 교정 방법 | |
Freeman | A novel means of software compensation for robots and machine tools |
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 |