CN102485441B - 机械手臂的定位方法及校正方法 - Google Patents
机械手臂的定位方法及校正方法 Download PDFInfo
- Publication number
- CN102485441B CN102485441B CN201010602964.5A CN201010602964A CN102485441B CN 102485441 B CN102485441 B CN 102485441B CN 201010602964 A CN201010602964 A CN 201010602964A CN 102485441 B CN102485441 B CN 102485441B
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- coordinate system
- coordinate
- control unit
- 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
- 238000012937 correction Methods 0.000 title claims abstract description 89
- 238000000034 method Methods 0.000 title claims abstract description 84
- 239000011159 matrix material Substances 0.000 claims abstract description 65
- 238000013519 translation Methods 0.000 claims abstract description 40
- 239000013598 vector Substances 0.000 claims description 20
- 230000009466 transformation Effects 0.000 claims description 17
- 238000006243 chemical reaction Methods 0.000 claims description 9
- 238000004364 calculation method Methods 0.000 claims description 8
- 238000012795 verification Methods 0.000 claims 4
- 238000006073 displacement reaction Methods 0.000 claims 2
- 238000012806 monitoring device Methods 0.000 description 9
- 238000004519 manufacturing process Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 238000009434 installation Methods 0.000 description 2
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003252 repetitive effect Effects 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/1679—Programme controls characterised by the tasks executed
- B25J9/1692—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/39045—Camera on end effector detects reference pattern
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
一种机械手臂的定位方法及校正方法,其先提供一机械手臂、一感光装置、一校正板及一控制单元,并且感光装置配置于机械手臂的前端。之后,通过感光装置撷取一校正板图像,并且依据光束交会法计算出感光装置相对于校正板的相对位置。此外,本发明更提出一种机械手臂的校正方法,其通过驱使感光装置绕校正板的一基准轴进行旋转,以计算校正板与机械手臂之间的平移矩阵,并且驱使感光装置沿校正板的三相互正交的基准轴平移,以计算校正板与机械手臂之间的旋转矩阵。
Description
技术领域
本发明涉及一种机械手臂,且特别涉及一种机械手臂的定位方法及校正方法。
背景技术
近十几年来,工业上常利用机械手臂来达成自动化的生产过程,然而,大部分机械手臂的应用仍局限于处理具有重复流程的案件,而处理这些案件必须由一位有经验的操作员事先操作机械手臂,以教导机械手臂沿着固定的轨迹移动。但在小型化、多样少量生产类型的电子产业中,这种利用操作员教导机械手臂的做法在自动化生产过程中将需要耗费很多的时间,进而增加生产制造上的成本。因此,已知技术发展出一种利用摄影装置来引导机械手臂的方法以取代需操作员教导机械手臂的旧有的方法。但这种利用摄影装置来引导机械手臂的方法还需另外结合立体视觉模组,以缩短校正机械手臂的时间。
在视觉导引的机械手臂(Vision Guided Robot,VGR)***中,摄影装置的校正与手眼(Hand-Eye)校正将显得格外重要。因此如何建立一套机械手臂的定位方法和校正方法,藉此方法取得机械手臂与物件的转换矩阵及摄影装置的扭曲误差值将是未来所面临重要的问题之一。
以美国专利第7161321号专利案(以下简称’321案)为例,在机械手臂校正时,是将一针状物架设于机械手臂的前端。机械手臂另具有一驱动单元,并搭配一套位于机械手臂外部的一监控装置以进行机械手臂的校正。监控装置包括一摄影装置、一显示装置及一控制单元,其中,摄影装置设置于一固定处。’321案所公开的校正方法是导引位于机械手臂上的针状物移至摄影装置的画面中,并通过摄影装置撷取针状物的尖点的画面。之后,将尖点的画面回传至显示装置,并经由控制单元计算出机械手臂与显示装置间的转换矩阵,再经由控制单元驱使机械手臂移动至显示装置的位置。
然而,’321案的监控装置是配置于机械手臂外部的设备,在购买机械手臂时还需要额外添购监控装置。因此,’321案所公开的技术存在着高设备成本的问题。另外,’321案于每次校正机械手臂前,需将配置于机械手臂外部的监控装置电性连接于机械手臂上,故在校正前需额外花费前置时间去电性连接监控装置于机械手臂上,进而增加校正机械手臂的程序,并降低机械手臂的校正效率。此外,在校正机械手臂的过程中,摄影装置撷取尖状物的画面后,需回传至配置于机械手臂外部的监控装置,并利用此监控装置计算出机械手臂与物件间的转换矩阵,再依据其转换矩阵导引机械手臂移动至显示装置的位置,并无法及时将转换矩阵回传至机械手臂,故于’321案中的校正方法将面临校正时间过长的问题。因此于’321案中将面临校正前的前置时间过久、高设备成本及校正时间过长的问题。
发明内容
鉴于以上的问题,本发明提供一种机械手臂的定位方法及校正方法,经由将感光装置配置于机械手臂前端,且依据感光装置与校正板之间的空间关系,找出校正板与机械手臂的空间关系,藉以改善已知技术所面临的高设备成本及校正时间过长的问题。
依据本发明一实施例的机械手臂的定位方法,其包括提供一机械手臂以及一校正板。机械手臂具有一控制单元,且机械手臂的前端具有一感光装置,另外,感光装置具有固定于其上的一感光装置坐标系。校正板的一板面上具有多个定位标记,并且校正板具有固定于其上的一校正板坐标系。接下来执行一定位步骤,其定位步骤包括经由感光装置利用光束交会演算法撷取一校正板图像,再将校正板图像回传至控制单元,并且经由控制单元计算出感光装置坐标与校正板坐标系的一转换矩阵以及一感光装置校正板坐标值。
依据本发明一实施例的机械手臂的定位方法,感光装置具有一透镜及一电荷耦合装置(Charge Coupled Device,CCD),其中透镜具有多个镜头扭曲值,求得感光装置坐标与校正板坐标系的一转换矩阵以及一感光装置校正板坐标值的方法包括经由控制单元撷取每一定位标记的校正板坐标系的一定位标记校正板坐标值,经由这些控制单元撷取这些校正板图像中每一定位标记的这些感光面坐标系的一定位标记感光面坐标值。另外,以这些定位标记感光面坐标值其中之一作为一基准点,经由这些控制单元计算其余的定位标记感光面坐标值与这些基准点之间的距离值。
并且,经由这些控制单元将这些定位标记校正板坐标值、这些定位标记感光面坐标值、这些距离值以及这些透镜的一焦距值代入一光束交会演算公式以计算这些转换矩阵的多个矩阵元素及这些感光装置校正板坐标值。
依据本发明一实施利的机械手臂的校正方法,其包括提供一机械手臂,具有一控制单元及一基座,基座具有固定于其上的一基座坐标系,其中,机械手臂的前端具有一感光装置,感光装置具有固定于其上的一感光装置坐标系。并提供一校正板,校正板的一板面上具有多个定位标记,并校正板具有固定于其上的一校正板坐标系。
接着经由控制单元驱使机械手臂以校正板坐标系的一坐标轴的一点为圆心旋转,并且记录感光装置的多个旋转位置。再依据这些旋转位置,进行前述机械手臂的定位方法中的定位步骤,并且经由控制单元计算这些旋转位置在校正板坐标系的多个旋转坐标值,将这些旋转坐标值回传至控制单元,并经由控制单元计算出圆心于校正板坐标系的一圆心校正板坐标值。另外,经由控制单元计算出圆心在基座坐标系的一圆心基座坐标值。之后,经由控制单元计算出校正板坐标与基座坐标系之间的一平移矩阵。
接下来计算校正板坐标与基座坐标系的旋转矩阵,其包括经由控制单元驱使机械手臂依序沿校正板坐标系的三正交轴各平移一次,并且记录感光装置于校正板坐标系的多个平移位置。之后,依据这些平移位置,进行机械手臂的定位方法中的定位步骤,以经由控制单元计算这些平移位置于校正板坐标系的一平移坐标值。依据这些平移坐标值,经由控制单元计算出与校正板坐标系三正交轴平行的三平移方向向量。之后,依据平移方向向量与基座坐标轴的方向向量,经由控制单元计算出校正板坐标与基座坐标系之间的一旋转矩阵。
依据本发明一实施利的机械手臂的定位方法及校正方法,其是将感光装置直接配置在机械手臂的前端,搭配校正板求得感光装置在校正板坐标系中的位置,即本发明是利用于机械手臂上的感光装置搭配校正板,藉以取代已知技术中将感光装置、控制单元和显示装置电性连接于机械手臂,搭配设置于机械手臂前端的一针状物的校正方式。
在校正的过程中,由于感光装置直接架设于机械手臂上,感光装置撷取图像后直接回传至机械手臂的显示装置,故不需要额外架设显示装置,是以相较于已知技术而言,这种将感光装置架设于机械手臂的方法能够节省设置设备的成本。
依据本发明的一实施例的机械手臂的定位方法及校正方法,当机械手臂需校正时,可任意摆放校正板于一定位处,而不需如已知技术所公开的针状物需架设于机械手臂上,是以相较于已知技术而言,用校正板取代针状物的方法能够节省前置安装的时间。
另外,当考虑镜面修正变形误差值时,本发明是将扭曲误差值一并带入光束交会演算法,藉以利用感光装置撷取图像,并经由控制单元同时计算出转换矩阵和扭曲误差值,是以相较于已知技术而言,考量镜面修正变形误差值能够增加其校正的精确度。
以上关于本发明内容的说明及以下实施方式的说明用以示范与解释本发明的原理,并且提供本发明的专利申请范围更进一步的解释。
附图说明
图1为本发明一实施例的机械手臂的定位方法及校正方法的定位步骤流程图。
图2为本发明一实施例的机械手臂的定位方法及校正方法的定位方法流程图。
图3为本发明一实施例的机械手臂的定位方法及校正方法的具镜头扭曲修正的定位方法流程图。
图4、图5及图6为本发明一实施例的机械手臂的定位方法及校正方法的感光装置旋转及平移的操作流程图。
图7为本发明一实施例的机械手臂的定位方法及校正方法的检验方法流程图。
图8为本发明一实施例的机械手臂的定位方法及校正方法的机械手臂校正装置的平面示意图。
图9A为本发明一实施例的机械手臂的定位方法及校正方法的感光装置200的分解示意图。
图9B为本发明一实施例的机械手臂的定位方法及校正方法的感光面221的示意图。
图10A为本发明一实施例的机械手臂的定位方法及校正方法的校正板坐标系320的示意图。
图10B为本发明一实施例的机械手臂的定位方法及校正方法的感光面坐标系222的示意图。
图11A为本发明一实施例的机械手臂的定位方法及校正方法的感光装置200的旋转示意图。
图11B为本发明一实施例的机械手臂的定位方法及校正方法的感光装置200的平移示意图。
【主要元件符号说明】
100 机械手臂
110 基座
111 基座坐标系
120 控制单元
200 感光装置
210 透镜
220 电荷耦合装置
221 感光面
222 感光面坐标系
222a 定位标记感光面坐标值
222c 投影中心
230 感光装置坐标系
300 校正板
310 定位标记
320 校正板坐标系
330 校正板图像
330a 感光装置校正板坐标值
330b 定位标记校正板坐标值
340 定位标记A
410 圆心
420 第一旋转位置
430 第二旋转位置
440 第三旋转位置
450 第一平移位置
460 第二平移位置
470 第三平移位置
480 第四平移位置
具体实施方式
依据本发明一实施例所公开的机械手臂校正***,其先提供一机械手臂校正***。请参阅「图8」至「图9B」,机械手臂校正***包括有一机械手臂100、一感光装置200、一校正板300。其中,机械手臂100具有一基座110及一控制单元120。感光装置200例如具有一透镜210及一电荷耦合装置220(Charge Coupled Device,CCD)且电荷耦合装置220具有一感光面221,校正板300的板面上具有多个定位标记310。此外,基座110具有一基座坐标系111,感光装置200具有一感光装置坐标系230,感光面221具有一感光面坐标系222,校正板300具有一校正板坐标系320。
基于上述的机械手臂100、感光装置200、校正板300,本发明便能够进行一定位步骤,以求得感光装置200与校正板300之间的相对位置。以下将对此定位步骤进行描述,请参阅「图1」及「图8」至「图10A」。首先,在步骤S101中,本发明经由控制单元120移动机械手臂100,使得校正板300位于感光装置200的光感应范围内。之后,由于校正板300的图像会经由透镜210而映射于电荷耦合装置220,是以感光装置200能够撷取一校正板图像330。之后,在步骤S102中,本发明依据校正板图像330,经由控制单元120计算感光装置坐标系230与校正板坐标系320的一转换矩阵以及一感光装置校正板坐标值330a。
以下将针对定位步骤S102进行举例说明,请参阅「图2」及「图8」至「图9B」。首先,在步骤S201中,本发明经由控制单元120撷取校正板300上的每一定位标记310的校正板坐标系320的一定位标记校正板坐标值330b。之后,在步骤S202中,本发明经由控制单元120撷取校正板图像330中每一定位标记310的感光面坐标系222的一定位标记感光面坐标值222a。然后,在步骤S203中,本发明经由控制单元120将这些定位标记校正板坐标值330b、这些定位标记感光面坐标值222a以及透镜210的一焦距值代入一光束交会演算公式以计算感光装置坐标系230与校正板坐标系320的转换矩阵的多个矩阵元素及感光装置校正板坐标值330a。
其中,在步骤S203所提及的光束交会演算公式为
其中,如果选取校正板300上的任一定位标记310作为一定位标记A时,则上述演算公式中的xa与ya为定位标记A的感光面坐标系222的定位标记感光面坐标值222a,x0与y0为感光面坐标系222的一投影中心222c,mij为感光装置坐标系230与校正板坐标系320间的转换矩阵的矩阵元素,其中,i:1~3、j:1~3、XA、YA与ZA为定位标记A的校正板坐标系320的三个彼此正交的坐标轴的定位标记校正板坐标值330b,XL、YL与ZL为坐标中心于校正板坐标系320的彼此正交的坐标轴的感光装置校正板坐标值330a。
以下将对求得转换矩阵及感光装置校正板坐标值330a的详细步骤进行举例说明。首先,经由感光装置200撷取一校正板图像330,再将感光装置200撷取的校正板图像330回传至控制单元120,并且以感光面坐标系222描述校正板图像330上的每个定位标记310的位置。之后,在校正板300上选定一定位标记340,并且经由控制单元120撷取此定位标记340在校正板坐标系320中的定位标记校正板坐标值,即(XA,YA,ZA)。之后,在校正板图像330上选取定位标记340的图像于感光面坐标系222中的感光面坐标值,即(xa,ya)。
接下来,经由控制单元120将(XA,YA,ZA)、(xa,ya)以及透镜210的一焦距值f代入光束交会演算公式,以获得一方程式。
接下来,逐一选取其余的定位标记310,并将其余定位标校正板坐标值330b、其余定位标记感光面坐标值222a及透镜210的焦距值代入光束交会公式,以获得多个方程式。接着,经由控制单元120利用最小平方法迭代出感光装置坐标系230与校正板坐标系320间的转换矩阵的所有矩阵元素及感光装置200的感光装置校正板坐标值。
以本实施例来说,校正板300上的定位标记310的数量为49个,是以经由这些定位标记310则会产生98个方程式。因此,本实施例便可以将此98个方程式利用控制单元120以最小平方法迭代出感光装置坐标系230与校正板坐标系320间的转换矩阵的多个矩阵元素及感光装置200的感光装置校正板坐标值330a。
此外,在依据本发明的其他实施例中,本发明还可以依据透镜210的多个镜头扭曲值来修正上述的光束交会演算公式,以更准确地求得感光装置200与校正板300之间的相对位置。
以下将对此镜头扭曲值修正步骤进行描述。请参阅「图3」与「图8」至「图9B」。首先,在S301步骤中,本发明经由控制单元120撷取每一定位标记310的校正板坐标系320的一定位标记校正板坐标值330b。之后,在S302步骤中,本发明经由控制单元120撷取校正板图像330中每一定位标记310的感光面坐标系222的一定位标记感光面坐标值222a。然后,在S303步骤中,本发明以定位标记感光面坐标值222a其中之一作为一基准点,经由控制单元120计算其余的每一定位标记感光面坐标值222a与基准点之间的距离值。之后,在S304步骤中,本发明经由控制单元120将这些定位标记校正板坐标值330b、这些定位标记感光面坐标值222a、这些距离值以及透镜210的一焦距值代入一光束交会演算公式以计算转换矩阵的多个矩阵元素及感光装置校正板坐标值330a。
以下针对镜头扭曲值修正步骤进行详细步骤的举例说明。首先,经由感光装置200撷取一校正板图像330,再将感光装置200撷取的校正板图像330回传至控制单元120,并以感光面坐标系222描述校正板图像330上的每个定位标记310的位置。之后,在校正板300上选定一定位标记340,并且经由控制单元120撷取此定位标记340在校正板坐标系320中的定位标记校正板坐标值,即(XA,YA,ZA)。之后,在校正板图像330上选取定位标记340的图像于感光面坐标系222中的感光面坐标值,即(xa,ya)。
再来,经由一镜头扭曲值修正方法,以将原本的定位标记感光面坐标值222a加上桶状失真误差修正值及切线失真误差修正值,得到镜头扭曲值修正公式,镜头扭曲值修正公式为
其中,δx与δy为感光装置200的一桶状失真误差修正值,Δx与Δy为感光装置200的一切线失真误差修正值。
接着将加入镜头扭曲值修正方法后的定位标记感光面坐标值222a代入光束交会演算公式,产生一具有镜头扭曲值修正方法的光束交会演算公式,具有镜头扭曲值修正方法的光束交会演算公式为
其中,
其中,如果选取校正板300上的任一定位标记310作为一定位标记A时,则上述演算公式中的xa与ya为定位标记A的感光面坐标系222的定位标记感光面坐标值222a,x0与y0为感光面坐标系222的一投影中心222c,r为定位标记A感光面坐标值与基准点之间的距离值,mij为感光装置坐标系230与校正板坐标系320间的转换矩阵的矩阵元素,其中,i:1~3、j:1~3、XA、YA与ZA为定位标记A的校正板坐标系320的三个彼此正交的坐标轴的定位标记校正板坐标值330b,XL、YL与ZL为坐标中心于校正板坐标系320的彼此正交的坐标轴的感光装置校正板坐标值330a,K1、K2、K3、P1、P2与P3为镜头扭曲参数值,δx与δy为感光装置200的一桶状失真误差修正值,Δx与Δy为感光装置200的一切线失真误差修正值。
再者,依据本发明的一实施例,本发明还可以利用上述的机械手臂的定位步骤,以进行一机械手臂的校正步骤。请参阅「图4」至「图6」,在本实施例中,机械手臂的校正步骤区分为两部分,其分别为一求取平移矩阵的校正步骤以及一求取旋转矩阵的校正步骤,其中平移矩阵的校正步骤包括S401~S405,旋转矩阵的校正步骤包括S406~S409。
以下先针对平移矩阵的校正步骤进行详细说明,请继续参阅「图8」至「图11B」,首先,在步骤S401中,本发明经由控制单元120驱使机械手臂100以校正板坐标系320的一坐标轴的一点为圆心410旋转,并且记录感光装置200的多个旋转位置。之后,在步骤S402中,本发明依据这些旋转位置,进行上述的机械手臂的定位步骤,以经由控制单元120计算每一旋转位置在校正板坐标系320的旋转坐标值。然后,在步骤S403中,本发明依据这些旋转坐标值,经由控制单元120计算出圆心410于校正板坐标系320的一圆心校正板坐标值。接着,在步骤S404中,本发明经控制单元120计算出圆心410在基座坐标系111的一圆心基座坐标值。之后,在步骤S405中,本发明依据圆心基座坐标值及圆心校正板坐标值,经由控制单元120计算出校正板坐标系320与基座坐标系111之间的一平移矩阵。
举例来说,经控制单元120驱使机械手臂100以校正板坐标系320的一坐标轴的一点为圆心410旋转,得到感光装置200三个旋转位置,分别为第一旋转位置420、第二旋转位置430与第三旋转位置440。再通过上述的机械手臂的定位方法求得这三个旋转位置420~430于校正板坐标系320的旋转坐标值(x1,y1,z1)、(x2,y2,z2)以及(x3,y3,z3)。接着利用三个旋转坐标值(x1,y1,z1)、(x2,y2,z2)以及(x3,y3,z3)求得圆心410于校正板坐标系320的圆心校正板坐标值(xp,yp,zp)。再来通过控制单元120计算出圆心410位置于基座坐标系111的圆心基座坐标值(xq,yq,zq),则[(xp-xq)(yp-yq)(zp-zq)]为基座坐标系111与校正板坐标系320的平移矩阵。
接下来将对旋转矩阵的校正步骤进行详细说明,首先,在步骤S406中,本发明经由控制单元120驱使机械手臂100依序沿校正板坐标系320的三正交轴各平移一次,并且记录感光装置200于校正板坐标系320的多个平移位置。之后,在步骤S407中,本发明依据这些平移位置,进行上述机械手臂100的定位步骤,以经由控制单元120计算每一平移位置于校正板坐标系320的一平移坐标值。再来,在步骤S408中,本发明依据这些平移坐标值,经由控制单元计算出与校正板坐标系三正交轴平行的三平移方向向量。然后,在步骤S409中,本发明依据三平移方向向量与基座坐标轴之方向向量,经由控制单元120计算出校正板坐标系320与该基座坐标系111之间的一旋转矩阵。
举例来说,首先,经由控制单元120驱使机械手臂100依序沿校正板坐标系320的三正交轴,u轴、v轴与w轴各平移一次,得到四个平移位置,分别为第一平移位置450,第二平移位置460,第三平移位置470,第四平移位置480,并且记录感光装置200于校正板坐标系320的4个平移位置,再依据上述的机械手臂的定位步骤,通过控制单元120计算出这些平移位置450~470于校正板坐标系320的平移坐标值(u1,v1,w1)、(u2,v1,w1)、(u1,v3,w1)以及(u1,v1,w4)。之后,再经由控制单元120依据这些平移坐标值计算出与校正板坐标系320三正交轴平行的三个平移方向向量,其中,平移方向向量1为[(u2-u1),0,0],平移方向向量2为[0,(v3-v1),0],平移方向向量3为[0,0,w4-w1],并且,3个平移方向向量分别代表校正板坐标系320的三正交轴的方向向量。最后,通过控制单元120依据三个平移方向向量与基座三坐标轴的方向向量间的关系计算出校正板坐标系320与基座坐标系111之间的一旋转矩阵。
请参阅「图7」,依据本发明一实施例所公开的机械手臂的校正方法,还包括一检验步骤。在步骤S501中,本发明依据校正板坐标系320与基座坐标系111的一关系式、平移矩阵与旋转矩阵,经由控制单元120计算校正板坐标系320与基座坐标系111的一相对位置。
其中,在步骤S501中所提及的关系式为
PG=PR×R+T
其中,PG为一校正座原点坐标值,PR为基座原点坐标值,R为旋转矩阵,T为平移矩阵。
依据本发明一实施利的机械手臂的定位方法及校正方法,其是将感光装置200直接配置在机械手臂100的前端,搭配校正板300求得感光装置200在校正板坐标系320中的位置,即本发明系利用于机械手臂100上的感光装置200搭配校正板300,藉以取代已知技术中将感光装置、控制单元120和显示装置电性连接于机械手臂,搭配设置于机械手臂前端的一针状物的校正方式。
在校正的过程中,由于感光装置200直接架设于机械手臂100上,感光装置200撷取图像后直接回传至机械手臂100的控制单元120,故不需要额外架设监控装置,是以相较于已知技术而言,这种将感光装置200架设于机械手臂的方法能够节省设置设备的成本。
依据本发明的一实施例的机械手臂的定位方法及校正方法,当机械手臂100需校正时,可任意摆放校正板300于一定位处,而不需如已知技术所公开的针状物需架设于机械手臂上,是以相较于已知技术而言,用校正板300取代针状物的方法能够节省前置安装的时间。
另外,当考虑镜面修正变形误差值时,本发明是将扭曲误差值一并带入光束交会演算法,藉以利用感光装置200撷取图像,并经由控制单元120同时计算出转换矩阵和扭曲误差值,是以相较于已知技术而言,考虑镜面修正变形误差值能够增加其校正的精确度。
Claims (6)
1.一种机械手臂的定位方法,其包括:
提供一机械手臂,具有一控制单元,该机械手臂的前端具有一感光装置,该感光装置具有固定于其上的一感光装置坐标系;
提供一校正板,其一板面上具有多个定位标记,并该校正板具有固定于其上的一校正板坐标系;及
执行一定位步骤,其包括:
经由该感光装置撷取一校正板图像;及
依据该校正板图像,经由该控制单元计算该感光装置坐标与该校正板坐标系的一转换矩阵以及一感光装置校正板坐标值,
其中,该感光装置包括一透镜以及一电荷耦合装置CCD,该电荷耦合装置具有一感光面,并具有固定于该感光面的一感光面坐标系,
计算该转换矩阵的步骤包括:
经由该控制单元撷取每一该定位标记的该校正板坐标系的一定位标记校正板坐标值;
经由该控制单元撷取该校正板图像中每一该定位标记的该感光面坐标系的一定位标记感光面坐标值;及
经由该控制单元将这些定位标记校正板坐标值、这些定位标记感光面坐标值以及该透镜的一焦距值代入一光束交会演算公式以计算该转换矩阵的多个矩阵元素及该感光装置校正板坐标值,该光束交会演算公式为
其中,xa与ya为该定位标记的该感光面坐标系的该定位标记感光面坐标值,x0与y0为该感光面坐标系的一投影中心,mij为该感光装置坐标与该校正板坐标系间的该转换矩阵的矩阵元素,其中,i:1~3、j:1~3、XA、YA与ZA为该定位标记的该校正板坐标系的该定位标记校正板坐标值,XL、YL与ZL为该感光装置于该校正板坐标系的该感光装置校正板坐标值。
2.一种机械手臂的定位方法,其包括:
提供一机械手臂,具有一控制单元,该机械手臂的前端具有一感光装置,该感光装置具有固定于其上的一感光装置坐标系;
提供一校正板,其一板面上具有多个定位标记,并该校正板具有固定于其上的一校正板坐标系;及
执行一定位步骤,其包括:
经由该感光装置撷取一校正板图像;及
依据该校正板图像,经由该控制单元计算该感光装置坐标与该校正板坐标系的一转换矩阵以及一感光装置校正板坐标值,
其中,该感光装置包括一透镜以及一电荷耦合装置CCD,该透镜具有多个镜头扭曲值,该电荷耦合装置具有一感光面,并具有固定于该感光面的一感光面坐标系,
计算该转换矩阵以及该感光装置校正板坐标值的步骤包括:
经由该控制单元撷取每一该定位标记的该校正板坐标系的一定位标记校正板坐标值;
经由该控制单元撷取该校正板图像中每一该定位标记的该感光面坐标系的一定位标记感光面坐标值;
以这些定位标记感光面坐标值其中之一作为一基准点,经由该控制单元计算其余的该定位标记感光面坐标值与该基准点之间的一距离值;及
经由该控制单元将这些定位标记校正板坐标值、这些定位标记感光面坐标值、这些距离值以及该透镜的一焦距值代入一光束交会演算公式以计算该转换矩阵的多个矩阵元素及该感光装置校正板坐标值,该光束交会演算公式则变为
其中,
其中,xa、ya为该定位标记的该感光面坐标系的该定位标记感光面坐标值,x0、y0为该感光面坐标系的一投影中心,r为每一该定位标记感光面坐标值与该基准点之间的该距离值,mij为该感光装置坐标与该校正板坐标系间的该转换矩阵的矩阵元素,其中,i:1~3、j:1~3、XA、YA与ZA为该定位标记的该校正板坐标系的三个彼此正交的坐标轴的该定位标记校正板坐标值,XL、YL与ZL为一坐标中心于该校正板坐标系的彼此正交的坐标轴的该感光装置校正板坐标值,K1、K2、K3、P1、P2与P3为镜头扭曲参数值,δx与δy为该感光装置的一桶状失真误差修正值,△x与△y为该感光装置的一切线失真误差修正值。
3.一种机械手臂的校正方法,其包括:
提供一机械手臂,具有一控制单元及一基座,该基座具有固定于其上的一基座坐标系,该机械手臂的前端具有一感光装置,该感光装置具有固定于其上的一感光装置坐标系;
提供一校正板,其一板面上具有多个定位标记,并该校正板具有固定于其上的一校正板坐标系;
经由该控制单元驱使该机械手臂以该校正板坐标系的一坐标轴上的一点为一圆心旋转,并且记录该感光装置的多个旋转位置;
依据这些旋转位置,进行如权利要求1所述的该定位步骤,以经由该控制单元计算这些旋转位置在该校正板坐标系的多个旋转坐标值;
依据这些旋转坐标值,经由该控制单元计算出该圆心于该校正板坐标系的一圆心校正板坐标值;
经该控制单元计算出该圆心在该基座坐标系的一圆心基座坐标值;
依据该圆心基座坐标值及该圆心校正板坐标值,经由控制单元计算出该校正板坐标与该基座坐标系之间的一平移矩阵;
经由该控制单元驱使该机械手臂依序沿该校正板坐标系的三正交轴各平移一次,并且记录该感光装置于该校正板坐标系的多个平移位置;
依据这些平移位置,进行如权利要求1所述的该定位步骤,以经由该控制单元计算这些平移位置于该校正板坐标系的一平移坐标值;
依据这些平移坐标值,经由该控制单元计算出与该校正板坐标系三正交轴平行的三平移方向向量;及
依据该三平移方向向量与该基座坐标轴的方向向量,经由该控制单元计算出该校正板坐标与该基座坐标系之间的一旋转矩阵。
4.如权利要求3所述的机械手臂的校正方法,其还包括一检验步骤,该检验步骤包括:
依据该校正板坐标与该基座坐标系的一关系式、该平移矩阵、该旋转矩阵,经由该控制单元计算该校正板坐标与该基座坐标系的一相对位置,该关系式为
PG=PR×R+T
其中,PG为一校正座原点坐标值,PR为一基座原点坐标值,R为该旋转矩阵,T为该平移矩阵。
5.一种机械手臂的校正方法,其包括:
提供一机械手臂,具有一控制单元及一基座,该基座具有固定于其上的一基座坐标系,该机械手臂的前端具有一感光装置,该感光装置具有固定于其上的一感光装置坐标系;
提供一校正板,其一板面上具有多个定位标记,并该校正板具有固定于其上的一校正板坐标系;
经由该控制单元驱使该机械手臂以该校正板坐标系的一坐标轴上的一点为一圆心旋转,并且记录该感光装置的多个旋转位置;
依据这些旋转位置,进行如权利要求2所述的该定位步骤,以经由该控制单元计算这些旋转位置在该校正板坐标系的多个旋转坐标值;
依据这些旋转坐标值,经由该控制单元计算出该圆心于该校正板坐标系的一圆心校正板坐标值;
经该控制单元计算出该圆心在该基座坐标系的一圆心基座坐标值;
依据该圆心基座坐标值及该圆心校正板坐标值,经由控制单元计算出该校正板坐标与该基座坐标系之间的一平移矩阵;
经由该控制单元驱使该机械手臂依序沿该校正板坐标系的三正交轴各平移一次,并且记录该感光装置于该校正板坐标系的多个平移位置;
依据这些平移位置,进行如权利要求2所述的该定位步骤,以经由该控制单元计算这些平移位置于该校正板坐标系的一平移坐标值;
依据这些平移坐标值,经由该控制单元计算出与该校正板坐标系三正交轴平行的三平移方向向量;及
依据该三平移方向向量与该基座坐标轴的方向向量,经由该控制单元计算出该校正板坐标与该基座坐标系之间的一旋转矩阵。
6.如权利要求5所述的机械手臂的校正方法,其还包括一检验步骤,该检验步骤包括:
依据该校正板坐标与该基座坐标系的一关系式、该平移矩阵、该旋转矩阵,经由该控制单元计算该校正板坐标与该基座坐标系的一相对位置,该关系式为
PG=PR×R+T
其中,PG为一校正座原点坐标值,PR为一基座原点坐标值,R为该旋转矩阵,T为该平移矩阵。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW099142245 | 2010-12-03 | ||
TW099142245A TWI408037B (zh) | 2010-12-03 | 2010-12-03 | 機械手臂的定位方法及校正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102485441A CN102485441A (zh) | 2012-06-06 |
CN102485441B true CN102485441B (zh) | 2014-07-02 |
Family
ID=46151033
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201010602964.5A Active CN102485441B (zh) | 2010-12-03 | 2010-12-23 | 机械手臂的定位方法及校正方法 |
Country Status (3)
Country | Link |
---|---|
US (1) | US8688274B2 (zh) |
CN (1) | CN102485441B (zh) |
TW (1) | TWI408037B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI617995B (zh) * | 2016-11-04 | 2018-03-11 | 廣明光電股份有限公司 | 機器人視覺定位的驗證方法 |
Families Citing this family (39)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6108860B2 (ja) * | 2013-02-14 | 2017-04-05 | キヤノン株式会社 | ロボットシステム及びロボットシステムの制御方法 |
JP2014180720A (ja) * | 2013-03-19 | 2014-09-29 | Yaskawa Electric Corp | ロボットシステム及びキャリブレーション方法 |
US9457470B2 (en) * | 2013-04-05 | 2016-10-04 | Abb Technology Ltd | Robot system and method for calibration |
JP6468741B2 (ja) * | 2013-07-22 | 2019-02-13 | キヤノン株式会社 | ロボットシステム及びロボットシステムの校正方法 |
CN103519902B (zh) * | 2013-10-28 | 2015-09-09 | 杭州三坛医疗科技有限公司 | 无创式实时手术定位导航设备 |
CN104827480A (zh) * | 2014-02-11 | 2015-08-12 | 泰科电子(上海)有限公司 | 机器人***的自动标定方法 |
CN104482856A (zh) * | 2014-12-17 | 2015-04-01 | 顾莹 | 一种医用诊断仪器上耗材的定位方法和*** |
JP6267157B2 (ja) * | 2015-05-29 | 2018-01-24 | ファナック株式会社 | 位置補正機能を有するロボットを備えた生産システム |
GB201509341D0 (en) * | 2015-05-29 | 2015-07-15 | Cambridge Medical Robotics Ltd | Characterising robot environments |
US10547796B2 (en) | 2015-07-14 | 2020-01-28 | Industrial Technology Research Institute | Calibration equipment and calibration method of a mechanical system |
JP6812095B2 (ja) * | 2015-10-22 | 2021-01-13 | キヤノン株式会社 | 制御方法、プログラム、記録媒体、ロボット装置、及び物品の製造方法 |
TWI557522B (zh) * | 2015-11-05 | 2016-11-11 | 財團法人工業技術研究院 | 校正方法與校正設備 |
CN106144582A (zh) * | 2016-08-30 | 2016-11-23 | 苏州康贝尔电子设备有限公司 | 一种用于led自动收料机的机械手固定座装配体 |
TWI614103B (zh) * | 2016-10-21 | 2018-02-11 | 和碩聯合科技股份有限公司 | 機械手臂定位方法及應用其的系統 |
JP6661028B2 (ja) * | 2016-11-17 | 2020-03-11 | 株式会社Fuji | 作業位置補正方法 |
WO2018120210A1 (zh) * | 2016-12-30 | 2018-07-05 | 深圳配天智能技术研究院有限公司 | 确定码垛点位置信息的方法、装置及机器人 |
JP6680720B2 (ja) * | 2017-04-10 | 2020-04-15 | ファナック株式会社 | ロボットの動作軌跡を自動で生成する装置、システム、および方法 |
JP6815924B2 (ja) * | 2017-04-19 | 2021-01-20 | トヨタ自動車株式会社 | キャリブレーション装置 |
EP3680070A4 (en) * | 2017-09-07 | 2021-06-23 | Kawasaki Jukogyo Kabushiki Kaisha | ROBOTIC SYSTEM AND ITS OPERATING PROCESS |
TWI649659B (zh) | 2017-10-27 | 2019-02-01 | 財團法人工業技術研究院 | 自動光學檢測影像分類方法、系統及含有該方法之電腦可讀取媒體 |
CN113059559B (zh) * | 2020-01-02 | 2022-07-12 | 台达电子工业股份有限公司 | 机器人工具的校正方法与校正*** |
CN108775882B (zh) * | 2018-06-01 | 2019-06-14 | 山东科技大学 | 爬行机器人在圆柱类物体表面运动位置的描述方法 |
US11315231B2 (en) | 2018-06-08 | 2022-04-26 | Industrial Technology Research Institute | Industrial image inspection method and system and computer readable recording medium |
TWI706841B (zh) * | 2019-03-22 | 2020-10-11 | 達明機器人股份有限公司 | 3d相機與機械手臂座標系統的校正裝置及方法 |
TWI699264B (zh) * | 2019-07-05 | 2020-07-21 | 上銀科技股份有限公司 | 視覺導引機器手臂校正方法 |
TWI758626B (zh) * | 2019-08-01 | 2022-03-21 | 達明機器人股份有限公司 | 機器手臂的視覺系統定位方法 |
JP2021037587A (ja) * | 2019-09-03 | 2021-03-11 | 株式会社デンソー | 部品挿入装置および部品の挿入方法 |
TWI708667B (zh) * | 2019-09-27 | 2020-11-01 | 國立臺灣大學 | 運動裝置之位置與姿態校正裝置及系統與方法 |
CN113246116B (zh) * | 2020-02-07 | 2022-08-23 | 复盛应用科技股份有限公司 | 机械臂校正方法 |
CN111591474B (zh) * | 2020-02-28 | 2021-12-07 | 上海航天控制技术研究所 | 一种航天器在轨操作***对准式手眼标定方法 |
TWI710441B (zh) * | 2020-06-11 | 2020-11-21 | 台達電子工業股份有限公司 | 機器手臂的座標校正方法 |
CN113799115B (zh) | 2020-06-11 | 2023-03-24 | 台达电子工业股份有限公司 | 机器手臂的坐标校正方法 |
TWI748626B (zh) * | 2020-08-31 | 2021-12-01 | 財團法人工業技術研究院 | 工具中心點的校正方法、機械手臂的教導方法及應用其之機械手臂系統 |
CN112192370B (zh) * | 2020-09-10 | 2021-12-21 | 天津津航技术物理研究所 | 一种用于光学元件空间曲面抛光的机械手定位方法 |
TW202224872A (zh) | 2020-12-28 | 2022-07-01 | 財團法人工業技術研究院 | 機械手臂校正系統及機械手臂校正系統方法 |
US11508089B2 (en) * | 2021-03-05 | 2022-11-22 | Black Sesame Technologies Inc. | LiDAR assisted wheel encoder to camera calibration |
CN114136563B (zh) * | 2021-12-15 | 2024-04-23 | 神龙汽车有限公司 | 指压刚度自动测试装置及测试方法 |
CN114252012B (zh) * | 2021-12-22 | 2024-01-16 | 上海原能细胞生物低温设备有限公司 | 一种冻存盒孔位的获取方法 |
CN114147728B (zh) * | 2022-02-07 | 2022-05-06 | 杭州灵西机器人智能科技有限公司 | 通用的机器人眼在手上标定方法和*** |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1033590A (zh) * | 1987-07-28 | 1989-07-05 | 布莱阿姆青年大学 | 机器人误差矫正装置和方法 |
US5297238A (en) * | 1991-08-30 | 1994-03-22 | Cimetrix Incorporated | Robot end-effector terminal control frame (TCF) calibration method and device |
US5570190A (en) * | 1992-12-03 | 1996-10-29 | Fanuc Ltd. | Visual sensor coordinate system setting jig and setting method |
US6236896B1 (en) * | 1994-05-19 | 2001-05-22 | Fanuc Ltd. | Coordinate system setting method using visual sensor |
CN1727839A (zh) * | 2004-07-28 | 2006-02-01 | 发那科株式会社 | 机器人***中再校准三维视觉传感器的方法和设备 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2686351B2 (ja) | 1990-07-19 | 1997-12-08 | ファナック株式会社 | 視覚センサのキャリブレーション方法 |
US5083073A (en) * | 1990-09-20 | 1992-01-21 | Mazada Motor Manufacturing U.S.A. Corp. | Method and apparatus for calibrating a vision guided robot |
US6615112B1 (en) | 1999-06-26 | 2003-09-02 | Kuka Schweissanlagen Gmbh | Method and device for calibrating robot measuring stations, manipulators and associated optical measuring devices |
JP4167940B2 (ja) * | 2003-05-29 | 2008-10-22 | ファナック株式会社 | ロボットシステム |
JP2005138223A (ja) * | 2003-11-06 | 2005-06-02 | Fanuc Ltd | ロボット用位置データ修正装置 |
JP4191080B2 (ja) | 2004-04-07 | 2008-12-03 | ファナック株式会社 | 計測装置 |
CN101524842A (zh) * | 2009-01-09 | 2009-09-09 | 成都广泰实业有限公司 | 工业机器人校准方法 |
-
2010
- 2010-12-03 TW TW099142245A patent/TWI408037B/zh active
- 2010-12-23 CN CN201010602964.5A patent/CN102485441B/zh active Active
-
2011
- 2011-01-25 US US13/013,690 patent/US8688274B2/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1033590A (zh) * | 1987-07-28 | 1989-07-05 | 布莱阿姆青年大学 | 机器人误差矫正装置和方法 |
US5297238A (en) * | 1991-08-30 | 1994-03-22 | Cimetrix Incorporated | Robot end-effector terminal control frame (TCF) calibration method and device |
US5570190A (en) * | 1992-12-03 | 1996-10-29 | Fanuc Ltd. | Visual sensor coordinate system setting jig and setting method |
US6236896B1 (en) * | 1994-05-19 | 2001-05-22 | Fanuc Ltd. | Coordinate system setting method using visual sensor |
CN1727839A (zh) * | 2004-07-28 | 2006-02-01 | 发那科株式会社 | 机器人***中再校准三维视觉传感器的方法和设备 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI617995B (zh) * | 2016-11-04 | 2018-03-11 | 廣明光電股份有限公司 | 機器人視覺定位的驗證方法 |
Also Published As
Publication number | Publication date |
---|---|
US20120143370A1 (en) | 2012-06-07 |
TW201223724A (en) | 2012-06-16 |
CN102485441A (zh) | 2012-06-06 |
US8688274B2 (en) | 2014-04-01 |
TWI408037B (zh) | 2013-09-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102485441B (zh) | 机械手臂的定位方法及校正方法 | |
CN109767476B (zh) | 一种自动对焦双目摄像头标定及深度计算方法 | |
EP3220099B1 (en) | Calibration device, calibration method, optical device, imaging device, projection device, measurement system, and measurement method | |
JP6701101B2 (ja) | 複数の光チャネルを備えるマルチアパーチャ光学系を画像センサに対して相対的に位置決めするためのデバイス及び方法 | |
US8934721B2 (en) | Microscopic vision measurement method based on adaptive positioning of camera coordinate frame | |
US9445080B2 (en) | Stereo camera apparatus, self-calibration apparatus and calibration method | |
CN109859272B (zh) | 一种自动对焦双目摄像头标定方法及装置 | |
CN102294695A (zh) | 机器人标定方法及标定*** | |
US20140100694A1 (en) | System and method for camera-based auto-alignment | |
CN105376564A (zh) | 摄像头校准设备及其控制方法与装置 | |
JP7189988B2 (ja) | ビジョンシステムの3次元校正のためのシステム及び方法 | |
CN105190234A (zh) | 三维表面测量的装置和方法 | |
CN105359640A (zh) | 安放设备和安放方法 | |
CN111986267B (zh) | 一种多相机视觉***的坐标***标定方法 | |
CN105374067A (zh) | 一种基于pal相机的三维重建方法及其重建*** | |
CN105323455A (zh) | 一种基于机器视觉的定位补偿方法 | |
CN114643578A (zh) | 一种提高机器人视觉引导精度的标定装置及方法 | |
RU2479828C2 (ru) | Стереоскопическая измерительная система и способ | |
CN115741720A (zh) | 基于双目视觉技术及lm算法的机器人的零点标定***及其方法 | |
CN110779933A (zh) | 基于3d视觉传感阵列的表面点云数据获取方法和*** | |
CN106813595A (zh) | 三相机组特征点匹配方法、测量方法及三维检测装置 | |
CN111591474A (zh) | 一种航天器在轨操作***对准式手眼标定方法 | |
KR20190099122A (ko) | 로봇의 위치 정보 복원 방법 | |
KR20160129652A (ko) | 카메라 모듈 조립장치 및 조립방법 | |
US10760895B2 (en) | Length measurement device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |