CN113799114B - 机器手臂的原点校正方法 - Google Patents
机器手臂的原点校正方法 Download PDFInfo
- Publication number
- CN113799114B CN113799114B CN202010528372.7A CN202010528372A CN113799114B CN 113799114 B CN113799114 B CN 113799114B CN 202010528372 A CN202010528372 A CN 202010528372A CN 113799114 B CN113799114 B CN 113799114B
- Authority
- CN
- China
- Prior art keywords
- robot arm
- origin
- dimensional
- measuring device
- positioning points
- 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/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
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/0095—Means or methods for testing manipulators
-
- 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
-
- 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/39021—With probe, touch reference positions
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本公开提供一种机器手臂的原点校正方法,包含步骤:(a)依据移动命令控制机器手臂进行移动,并利用三维测量装置取得机器手臂所到达的多个参考定位点的三维坐标;(b)在机器手臂的原点产生偏移时,依据移动命令控制机器手臂进行移动,并利用三维测量装置取得机器手臂所到达的多个实际定位点的三维坐标,并依据实际定位点取得雅可比矩阵;(c)依据雅可比矩阵和参考定位点及实际定位点的三维坐标取得机器手臂的转动角度的偏差量,并依据偏差量取得补正角度值;以及(d)依据补正角度值更新机器手臂的转动角度,以更新机器手臂的原点。
Description
技术领域
本公开涉及一种原点校正方法,特别涉及一种机器手臂的原点校正方法。
背景技术
如今,机器人在各个产业上的应用愈加广泛。当机器人运行于工作站的过程中,机器人可能因故导致原点移位(例如断电或受外力撞击)。为此,现有应对方式是将机器人撤出工作站,并将机器人移动至原厂或特定环境下进行校正。于机器人完成校正后,再将机器人移动至工作站继续运行。
然而,由于需将机器人移动至原厂或特定环境下方能进行校正,并于校正后再将机器人移回工作站,故移动过程将额外耗费时间及成本,亦导致工作效率降低。再者,当校正后的机器人回到工作站时,需重新对机器人进行教点,同样将导致工作效率降低。
因此,如何发展一种可改善上述现有技术的机器手臂的原点校正方法,实为目前迫切的需求。
发明内容
本公开的目的在于提供一种机器手臂的原点校正方法,其是于机器手臂的工作环境中设置测量装置,并利用测量装置实现对机器手臂的原点校正。因此,于机器手臂的运行过程中,若机器手臂的原点偏移,则可在机器手臂的工作环境中实时对机器手臂进行校正,且在校正完成后无需重新教点。借此,可节省校正所需的时间及成本,并大幅提升机器手臂的工作效率。
为达上述目的,本公开提供一种机器手臂的原点校正方法,其中机器手臂运行于工作空间中,工作空间中设置有三维测量装置,三维测量装置是架构于测量机器手臂的位置。原点校正方法包含步骤:(a)依据移动命令控制机器手臂进行移动,并利用三维测量装置取得机器手臂所到达的多个参考定位点的三维坐标;(b)在机器手臂的原点产生偏移时,依据移动命令控制机器手臂进行移动,并利用三维测量装置取得机器手臂所到达的多个实际定位点的三维坐标,并依据多个实际定位点取得雅可比矩阵;(c)依据雅可比矩阵、多个参考定位点的三维坐标及多个实际定位点的三维坐标取得机器手臂的转动角度的偏差量,并依据偏差量取得补正角度值;以及(d)依据补正角度值更新机器手臂的转动角度,以更新机器手臂的原点。
附图说明
图1为本公开优选实施例的机器手臂、工作空间及三维测量装置的立体结构示意图。
图2为图1的三维测量装置的立体结构示意图。
图3为本公开优选实施例的机器手臂的原点校正方法的流程示意图。
附图标记说明:
1:机器手臂
2:工作平台
3:三维测量装置
31:球形体
32:基座
33:测量模块
34:测量结构
4:工具
S1、S2、S3、S4:原点校正方法的步骤
具体实施方式
体现本公开特征与优点的一些典型实施例将在后段的说明中详细叙述。应理解的是本公开能够在不同的实施方式上具有各种的变化,其皆不脱离本公开的范围,且其中的说明及图示在本质上是当作说明之用,而非架构于限制本公开。
图1为本公开优选实施例的机器手臂、工作空间及三维测量装置的立体结构示意图,图2为图1的三维测量装置的立体结构示意图。如图1及图2所示,其中是以工作平台2代表机器手臂1运行过程中所在的工作空间,但工作空间的实际实施方式并不以此为限。三维测量装置3设置于工作平台2上并架构于测量机器手臂1的位置。当然,于实际应用中,工作平台2上亦将设置机器手臂1在运行过程中相互动的元件或装置,此处为便于说明校正过程而仅于图中示出工作平台2上的三维测量装置3。机器手臂1可为例如但不限于六轴型机器手臂或SCARA机器手臂。三维测量装置3包含球形体31、基座32及三个测量模块33。球形体31可拆卸地组接于机器手臂1,且受机器手臂1带动而同步移动或转动。三个测量模块33均设置于基座32上,其中每一测量模块33包含测量结构34及位置感测器。三个测量模块33的三个测量结构34分别于X轴、Y轴及Z轴方向上移动,且均与球形体31接触。位置感测器是架构于在对应的测量结构34被球形体31推动时感测测量结构34的移动距离,其中位置感测器可为例如但不限于由光学尺所构成。
在机器手臂1的运行过程中,可能因种种意外状况导致机器手臂1的原点产生偏移(例如但不限于断电或受外力撞击),在此情况下,是执行图3所示的原点校正方法来对机器手臂1进行校正。
如图3所示,图3为本公开优选实施例的机器手臂的原点校正方法的流程示意图。首先,依据移动命令控制机器手臂1进行移动,并利用三维测量装置3取得机器手臂1所到达的多个参考定位点(步骤S1),其中,移动命令可例如但不限于包含控制机器手臂1以不同的操作动作进行多次移动。接着,在机器手臂1的原点产生偏移时,依据移动命令控制机器手臂1进行移动,并利用三维测量装置3取得机器手臂1所到达的多个实际定位点(步骤S2),其中实际定位点的数量与参考定位点的数量相同。而后,依据多个参考定位点及多个实际定位点计算取得补正信息(步骤S3)。最后,依据补正信息对机器手臂1的原点进行更新(步骤S4)。借此,在机器手臂1运行于工作空间的过程中,若机器手臂1的原点偏移,则可在工作空间中实时对机器手臂1进行校正,且在校正完成后无需重新教点。借此,可节省校正所需的时间及成本,并大幅提升机器手臂1的工作效率。
请再参阅图1至图3所示,上述三个测量结构34是分别沿对应各个轴向(X轴、Y轴及Z轴)的可移动距离以共同定义测量空间,于原点校正方法的步骤S1及步骤S2中,球形体31受机器手臂1带动而于测量空间中移动,三个位置感测器的感测结果反映球形体31的三维坐标。于一些实施例中,原点校正方法的步骤S1及步骤S2中的参考定位点及实际定位点为三维测量装置3所测量的球形体31的球心的三维坐标。
上述球形体31可拆卸地组接于机器手臂1,因此机器手臂1可仅在有校正需求时组接于球形体31,以执行图3所示的原点校正方法。更甚者,机器手臂1可仅在需测量定位点时组接于球形体31,具体而言,机器手臂1可仅于原点校正方法的步骤S1及步骤S2中组接于球形体31。
于一些实施例中,机器手臂1组接于工具4,工具4是受机器手臂1带动而运行于工作平台2上,其中,当机器手臂1组接于工具4的情况下,机器手臂1亦可同时组接于三维测量装置3的球形体31。借此,当机器手臂1进行校正时,无需在校正前拆除工具4,故在校正完成后,无需重新安装工具4并进行相应调校,从而可节省校正工序及耗费时间,间接提升机器手臂1的工作效率。
以下将示例说明如何依据多个参考定位点及多个实际定位点取得补正信息。
在步骤S1中,是利用三维测量装置3测量取得参考定位点的三维坐标。在步骤S2中,是利用三维测量装置3取得实际定位点的三维坐标,并依据该多个实际定位点取得雅可比(Jacobian)矩阵。由于机器手臂1的原点产生偏移,对应导致机器手臂1的转动角度产生偏差,因此当机器手臂1受相同的移动命令控制而进行移动时,所到达的实际定位点会与原先的参考定位点不同,其中,参考定位点、实际定位点及机器手臂1的转动角度的偏差量之间的关系如等式(1)所示。
其中,P代表实际定位点的三维坐标,代表参考定位点的三维坐标,i代表机器手臂1依据移动命令所执行的操作动作的次序,代表雅可比矩阵,△θ代表机器手臂1的转动角度θ的偏差量。根据等式(1)变化可取得等式(2)。
因此,在步骤S3中,根据参考定位点的三维坐标、实际定位点的三维坐标及雅可比矩阵,可计算取得机器手臂1的转动角度的偏差量,并进一步通过该偏差量取得补正信息的补正角度值。借此,在步骤S4中,即可依据补正角度值更新机器手臂1的转动角度,从而更新机器手臂1的原点,使机器手臂1的参考定位点与实际定位点一致,实现对机器手臂1的校正。
综上所述,本公开提供一种机器手臂的原点校正方法,其是于机器手臂的工作环境中设置测量装置,并利用测量装置实现对机器手臂的原点校正。因此,于机器手臂的运行过程中,若机器手臂的原点偏移,则可在机器手臂的工作环境中实时对机器手臂进行校正,且在校正完成后无需重新教点。借此,可节省校正所需的时间及成本,并大幅提升机器手臂的工作效率。另外,在机器手臂组接于工具的情况下,机器手臂亦可同时组接于三维测量装置的球形体。借此,当机器手臂进行校正时,无需在校正前拆除工具,故在校正完成后,无需重新安装工具对进行相应调校,从而可节省校正工序及耗费时间,间接提升机器手臂的工作效率。
须注意,上述仅是为说明本公开而提出的优选实施例,本公开不限于所述的实施例,本公开的范围由权利要求决定。且本公开得由本领域技术人员任施匠思而为诸般修饰,然皆不脱权利要求所欲保护者。
Claims (8)
1.一种机器手臂的原点校正方法,其中该机器手臂运行于一工作空间中,该工作空间中设置有一三维测量装置,该三维测量装置是架构于测量该机器手臂的位置,该原点校正方法包含步骤:
(a)依据一移动命令控制该机器手臂进行移动,并利用该三维测量装置取得该机器手臂所到达的多个参考定位点的三维坐标;
(b)在该机器手臂的该原点产生偏移时,依据该移动命令控制该机器手臂进行移动,并利用该三维测量装置取得该机器手臂所到达的多个实际定位点的三维坐标,并依据该多个实际定位点取得一雅可比矩阵;
(c)依据该雅可比矩阵、该多个参考定位点的该三维坐标及该多个实际定位点的该三维坐标取得该机器手臂的一转动角度的一偏差量,并依据该偏差量取得一补正角度值;以及
(d)依据该补正角度值更新该机器手臂的该转动角度,以更新该机器手臂的该原点,
其中该三维测量装置包含:
一球形体,可拆卸地组接于该机器手臂,且受该机器手臂带动而同步移动或转动;
一基座;以及
三个测量模块,设置于该基座上,其中每一该测量模块包含一测量结构及一位置感测器,该三个测量模块的三个该测量结构分别于X轴、Y轴及Z轴方向上移动,且均与该球形体接触,该位置感测器架构于在对应的该测量结构被该球形体推动时,测量该测量结构的移动距离。
2.如权利要求1所述的原点校正方法,其中该移动命令包含控制该机器手臂以不同的操作动作进行多次移动。
4.如权利要求1所述的原点校正方法,
其中三个该测量结构分别沿对应各个轴向的可移动距离共同定义一测量空间,于该步骤(a)及该步骤(b)中,该球形体受该机器手臂带动而于该测量空间中移动,三个该位置感测器的感测结果反映该球形体的该三维坐标。
5.如权利要求4所述的原点校正方法,其中该机器手臂组接于一工具,该工具受该机器手臂带动而运行于该工作空间中,且该机器手臂在组接于该工具时可拆卸地组接于该三维测量装置的该球形体。
6.如权利要求4所述的原点校正方法,其中该机器手臂仅于该步骤(a)及该步骤(b)中组接于该三维测量装置的该球形体。
7.如权利要求4所述的原点校正方法,其中于该步骤(a)及该步骤(b)中,该多个参考定位点及该多个实际定位点为该三维测量装置所测量的该球形体的球心的该三维坐标。
8.如权利要求1所述的原点校正方法,其中该机器手臂为六轴型机器手臂或SCARA型机器手臂。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010528372.7A CN113799114B (zh) | 2020-06-11 | 2020-06-11 | 机器手臂的原点校正方法 |
US17/318,884 US11745349B2 (en) | 2020-06-11 | 2021-05-12 | Origin calibration method of manipulator |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010528372.7A CN113799114B (zh) | 2020-06-11 | 2020-06-11 | 机器手臂的原点校正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113799114A CN113799114A (zh) | 2021-12-17 |
CN113799114B true CN113799114B (zh) | 2023-03-14 |
Family
ID=78824348
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010528372.7A Active CN113799114B (zh) | 2020-06-11 | 2020-06-11 | 机器手臂的原点校正方法 |
Country Status (2)
Country | Link |
---|---|
US (1) | US11745349B2 (zh) |
CN (1) | CN113799114B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR3097457B1 (fr) * | 2019-06-19 | 2021-07-09 | Safran Aircraft Engines | Procédé d’ébavurage amélioré de pièce aéronautique |
CN115139338B (zh) * | 2022-06-30 | 2023-09-22 | 上海睿触科技有限公司 | 一种机器人tcp快速高精度标定方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS649504A (en) * | 1987-07-02 | 1989-01-12 | Fanuc Ltd | Position correcting system for articulated robot |
CN103101060A (zh) * | 2011-11-11 | 2013-05-15 | 鸿富锦精密工业(深圳)有限公司 | 机器人工具中心点的传感校正方法 |
CN104802168A (zh) * | 2015-04-20 | 2015-07-29 | 深圳市文鼎创数据科技有限公司 | 一种边界检测方法及系统 |
CN110722558A (zh) * | 2019-10-24 | 2020-01-24 | 广东拓斯达科技股份有限公司 | 机器人的原点校正方法、装置、控制器和存储介质 |
CN110815201A (zh) * | 2018-08-07 | 2020-02-21 | 广明光电股份有限公司 | 机器手臂校正坐标的方法 |
Family Cites Families (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
ATE401170T1 (de) | 2004-10-25 | 2008-08-15 | Univ Dayton | Verfahren und system zum ermöglichen von erhöhter genauigkeit bei mehrfachverbundenen robotern durch berechnung der kinematischen robotermodellparameter |
JP4298757B2 (ja) | 2007-02-05 | 2009-07-22 | ファナック株式会社 | ロボット機構のキャリブレーション装置及び方法 |
WO2010060459A1 (en) | 2008-11-25 | 2010-06-03 | Abb Technology Ab | A method and an apparatus for calibration of an industrial robot system |
JP5938954B2 (ja) * | 2012-03-06 | 2016-06-22 | 株式会社ジェイテクト | ロボットのキャリブレーション方法及びキャリブレーション装置 |
EP2722136A1 (en) * | 2012-10-19 | 2014-04-23 | inos Automationssoftware GmbH | Method for in-line calibration of an industrial robot, calibration system for performing such a method and industrial robot comprising such a calibration system |
US10065319B2 (en) | 2015-11-30 | 2018-09-04 | Delta Electronics, Inc. | Tool calibration apparatus of robot manipulator |
JP6487385B2 (ja) | 2016-07-20 | 2019-03-20 | ファナック株式会社 | ロボットの原点位置較正装置および方法 |
TWI668541B (zh) | 2017-09-29 | 2019-08-11 | 財團法人工業技術研究院 | 機器人工具中心點校正系統及其方法 |
CN110614630B (zh) | 2018-06-19 | 2022-10-18 | 台达电子工业股份有限公司 | 机械手臂的工具校正装置 |
JP7048535B2 (ja) * | 2019-04-01 | 2022-04-05 | ファナック株式会社 | ロボットを制御するための機構誤差パラメータを較正するロボットの制御装置 |
CN110487233B (zh) | 2019-07-30 | 2021-06-15 | 东莞长盈精密技术有限公司 | 校正机器人用户坐标系的方法及系统 |
-
2020
- 2020-06-11 CN CN202010528372.7A patent/CN113799114B/zh active Active
-
2021
- 2021-05-12 US US17/318,884 patent/US11745349B2/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS649504A (en) * | 1987-07-02 | 1989-01-12 | Fanuc Ltd | Position correcting system for articulated robot |
CN103101060A (zh) * | 2011-11-11 | 2013-05-15 | 鸿富锦精密工业(深圳)有限公司 | 机器人工具中心点的传感校正方法 |
CN104802168A (zh) * | 2015-04-20 | 2015-07-29 | 深圳市文鼎创数据科技有限公司 | 一种边界检测方法及系统 |
CN110815201A (zh) * | 2018-08-07 | 2020-02-21 | 广明光电股份有限公司 | 机器手臂校正坐标的方法 |
CN110722558A (zh) * | 2019-10-24 | 2020-01-24 | 广东拓斯达科技股份有限公司 | 机器人的原点校正方法、装置、控制器和存储介质 |
Also Published As
Publication number | Publication date |
---|---|
US20210387344A1 (en) | 2021-12-16 |
US11745349B2 (en) | 2023-09-05 |
CN113799114A (zh) | 2021-12-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10525598B2 (en) | Positioning system using robot | |
US8918210B2 (en) | Method of detecting an inter-axis offset of 6-axis robot | |
JP5670416B2 (ja) | ロボットシステム表示装置 | |
US9563601B2 (en) | Force sensor correcting method | |
JP4267005B2 (ja) | 計測装置及びキャリブレーション方法 | |
US7904202B2 (en) | Method and system to provide improved accuracies in multi-jointed robots through kinematic robot model parameters determination | |
JP5321532B2 (ja) | ロボットキャリブレーション装置及びキャリブレーション方法 | |
US10189161B2 (en) | Calibration system and calibration method calibrating mechanical parameters of wrist part of robot | |
CN108724181B (zh) | 校准系统 | |
CN113799114B (zh) | 机器手臂的原点校正方法 | |
US11273554B2 (en) | Method and device for evaluating calibration precision | |
US11289303B2 (en) | Calibrating method and calibrating system | |
KR20080088165A (ko) | 로봇 캘리브레이션 방법 | |
EP1886771B1 (en) | Rotation center point calculating method, rotation axis calculating method, program creating method, operation method, and robot apparatus | |
CN111267108B (zh) | 一种工业机器人关节零点标定结构及标定方法 | |
CN113799115B (zh) | 机器手臂的坐标校正方法 | |
JP2002096232A (ja) | 工作機械の制御方法 | |
TWI710441B (zh) | 機器手臂的座標校正方法 | |
US20230191611A1 (en) | Robot system | |
KR100499090B1 (ko) | 로봇의 캘리브레이션 장치 및 그 방법 | |
TWI746004B (zh) | 機器手臂的原點校正方法 | |
Kong et al. | An experimental comparison for the accuracy improvement of a 6-PSS parallel manipulator by choosing different sets of measurement data | |
KR100637378B1 (ko) | 퍼셉트론 센서를 이용한 산업용 로봇 캘리브레이션 시스템 | |
English et al. | Kinematic calibration of six-axis robots | |
KR20230116502A (ko) | 로봇 캘리브레이션 방법 및 장치 |
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 |