位置姿势推定方法和位置姿势推定系统

摘要

提供位置姿势推定方法和位置姿势推定系统。即使在对象物的一部分被其他物体遮挡时，也能够简易且高精度地推定该对象物在三维坐标系中的位置和姿势。可以根据通过具有与实空间的Z轴平行的光轴的拍摄装置而获取的工件W的各指标区域Ai的尺寸φi，推定各指标点Pi的Z坐标值。基于各指标点Pi的Z坐标值Zi，推定穿过构成一对的指标点Pi和Pj的指标直线Qij的第1实空间姿势θ1(i,j)。通过使用照射装置对多个指标点Pi当中的第1指标点Pi1照射光线，形成并定义包括该第1指标点Pi1在内的第1指标区域Ai1。在拍摄装置的拍摄范围中，即使在工件W的一部分被其他物体遮挡时，通过以避开该其他物体的方式或者利用间隙的方式对该工件W的第1指标点Pi1照射光线，从而能够简单且切实地形成第1指标区域Ai1。

说明书

技术领域

本发明涉及测定工件等对象物在三维空间中的位置以及姿势的方法和系统。

背景技术

已被提出有在照相机中组合测距传感器从而测定物体的位置的方法。比如被提出有以下的方法：在相对于照相机的光轴是垂直的基准面上，对利用该照相机得到的物体上的已知3点的各自的位置的检测结果，基于利用测距传感器得到的该3点的各自的测距结果进行视差补正，从而测定该3点的三维位置，进而测定该物体的三维位置(参照专利文献1)。还被提出有下述方法：基于平面上的3个标记各自利用照相机得到的X-Y位置的测定结果以及利用测距传感器得到的Z位置的测定结果，推定该平面的位置以及姿势(参照专利文献2)。

然而，由于采用测距传感器而导致测定系统的成本变高，为了避免这一点，还被提出了不使用测距传感器而使用拍摄装置来测定物体的三维位置的方法。另外，还被提出有下述方法：通过照相机拍摄存在几何学关系已知的4个以上的多个标记的平面，基于该多个标记在该平面中的位置以及在二维图像坐标系中的位置，推定该多个标记的三维位置(参照专利文献3)。此外，被提出有下述方法：在通过照相机拍摄的二维图像中提取出对象物体的3个特征点，基于该提取结果、和预先测定的该3个特征点之间的距离，测定该对象物体的三维位置(参照专利文献4)。还被提出有下述方法：基于通过照相机拍摄以格子状进行二维排列的多个标记而得到的多个标记的二维位置，按照规定的关系式推定该多个标记的三维位置(参照专利文献5)。还被提出有下述方法：通过照相机拍摄带有预先测量了相互间距离的4个记号的对象物从而得到图像，除了基于所得到的图像中的二维位置之外，还基于该相互间距离，推定该4个记号的三维位置(参照专利文献6)。

现有技术文献

专利文献

专利文献1：日本特开平3-92712号公报

专利文献2：日本特开平9-304013号公报

专利文献3：日本特开昭62-175603号公报

专利文献4：日本专利第2534517号公报

专利文献5：日本特开平6-259536号公报

专利文献6：日本专利第4602704号公报

发明内容

发明要解决的课题

然而，为了确认部件彼此的组装状态，使用拍摄装置来拍摄一个部件时，有时在该部件上附带的标记至少一部分被其他部件或部件组遮挡，该确认作业变得困难。

因此，本发明的目的在于，提供即使在对象物的一部分被其他物体遮挡的情况下，也能够简易且高精度地推定该对象物在三维坐标系中的位置以及姿势的技术。

用于解决问题的手段

本发明的位置姿势推定方法的特征在于，其包括：第1尺寸测定处理，通过拍摄装置获取对象物的拍摄图像，测定对象物中定义的多个指标区域各自在所述拍摄图像中的尺寸，所述拍摄装置在由XYZ坐标系定义的实空间中的位置以及姿势被固定、且具有相对于Z轴平行的光轴；纵实空间位置推定处理，基于所述第1尺寸测定处理中的测定结果，推定所述多个指标区域各自所包含的多个指标点各自的Z坐标值；第1实空间姿势推定处理，基于所述多个指标点各自的X坐标值和Y坐标值中的至少一者、以及所述多个指标点各自的Z坐标值的推定结果，将穿过所述多个指标点当中构成一对的指标点的指标直线在实空间中的姿势推定为第1实空间姿势；和，实空间姿势推定处理，基于所述第1实空间姿势的推定结果，推定所述对象物的实空间姿势；所述第1尺寸测定处理中，使用在所述实空间中的位置以及姿势被固定的照射装置，对所述多个指标点当中的第1指标点照射光线，由此形成第1指标区域作为所述多个指标区域当中的至少1个指标区域。

根据本发明的位置姿势推定方法，可以根据通过具有与实空间的Z轴平行的光轴的拍摄装置而获取的对象物的各指标区域的尺寸，推定各指标点的Z坐标值。其依据的定性关系在于，指标点越靠近拍摄装置(或其拍摄元件)则其测定尺寸越大，指标点越远离拍摄装置则其测定尺寸越小。基于各指标点的Z坐标值，推定穿过构成一对的指标点的指标直线的第1实空间姿势(根据方向矢量来确定)。通过使用照射装置对多个指标点当中的第1指标点照射光线，形成并定义包括该第1指标点在内的第1指标区域。

在拍摄装置的拍摄范围中，即使在对象物的一部分被其他物体遮挡的情况下，通过以避开该其他物体的方式或者利用间隙的方式对该对象物的第1指标点进行照射光线来形成第1指标区域。可以简单地使拍摄图像中包括多个指标区域，所述多个指标区域的各个指标区域包括存在于同一指标直线上的多个指标点中的某个指标点。因此，即使在这样的情况下，也能够简易且高精度地推定对象物的由至少Z坐标值定义的实空间位置以及由至少指标直线的第1实空间姿势定义的对象物的实空间姿势。

本发明的位置姿势推定方法中，优选的是，还包括：

第2尺寸测定处理，针对所述拍摄图像中的所述指标直线的延伸方向，测定所述多个指标区域当中的至少1个指标区域的尺寸；

第2实空间姿势推定处理，基于所述第2尺寸测定处理中的测定结果，将所述至少1个指标区域的实空间姿势推定为第2实空间姿势；

所述实空间姿势推定处理中，通过综合所述第1实空间姿势的推定结果以及所述第2实空间姿势的推定结果，推定所述对象物的实空间姿势。

根据该位置姿势推定方法，可以根据拍摄图像中的至少1个指标区域的针对指标直线的延伸方向的尺寸，推定该指标区域的第2实空间姿势(根据指标区域的垂线矢量来确定)。通过整合第1实空间姿势的推定结果以及第2实空间姿势的推定结果，可以实现对象物的实空间姿势的推定精度的提高。

本发明的位置姿势推定方法中，优选的是，所述实空间姿势推定处理中，通过综合穿过构成各不同对的指标点、且为同一指标直线或彼此平行的多个所述指标直线的各自的所述第1实空间姿势的推定结果，推定所述对象物的实空间姿势。

根据该位置姿势推定方法，可以实现穿过构成不同对的指标点的多个指标直线的各自的实空间姿势、进而是对象物的实空间姿势的推定精度的提高。

本发明的位置姿势推定方法中，优选的是，设定所述多个指标点，从而定义所述实空间中正交的2个所述指定方向。

根据该位置姿势推定方法，可以推定实空间中正交的2个指标直线的各自的由第1实空间姿势(或者第1实空间姿势的多个推定结果的整合结果，或者第1实空间姿势以及第2实空间姿势的整合结果)定义的对象物的实空间姿势。

本发明的位置姿势推定方法中，优选的是，还包括：

横实空间位置推定处理，基于所述多个指标点当中在对象物坐标系中被固定的第2指标点在所述拍摄图像中的位置，推定所述第2指标点的X坐标值和Y坐标值。

根据该位置姿势推定方法，可以根据在对象物坐标系中被固定的第2指标点在拍摄图像中的位置，推定该指标点的X坐标值和Y坐标值。由此，可以高精度地推定由除第2指标点的Z坐标值的推定结果之外、还由X坐标值和Y坐标值的推定结果定义的对象物的实空间位置。

本发明的位置姿势推定方法中，优选的是，由所述对象物中通过所述拍摄装置能够识别的轮廓界定的第2指标区域中包含的点定义为所述第2指标点。

根据该位置姿势推定方法，通过实现拍摄图像中的第2指标点的位置的测定精度的提高，可以实现对象物的实空间位置以及实空间姿势的推定精度的提高。

本发明的位置姿势推定方法中，优选的是，还包括：

第1准备处理，在改变所述多个指标点当中的至少1个指标点的Z坐标值的同时，测定所述对象物的拍摄图像中的所述至少1个指标区域的尺寸的变化，由此将所述至少1个指标点的Z坐标值与所述拍摄图像中的所述至少1个指标区域的尺寸的相关关系定义为第1相关关系，

所述纵实空间位置推定处理中，按照所述第1相关关系，推定所述多个指标点的各自的Z坐标值。

根据该位置姿势推定方法，由于按照事先定义的第1相关关系来推定各指标点的Z坐标值，因此可以实现对象物的实空间位置以及实空间姿势的推定精度的提高。

本发明的位置姿势推定方法中，优选的是，还包括：

第2准备处理，在改变所述至少1个指标区域的实空间姿势的同时，测定所述拍摄图像中所述至少1个指标区域的针对所述指标直线的延伸方向的尺寸的变化，由此将所述至少1个指标区域的实空间姿势与所述拍摄图像中针对所述指标直线的延伸方向的尺寸的相关关系定义为第2相关关系，

所述第2实空间姿势推定处理中，按照所述第2相关关系，推定所述第2实空间姿势。

根据该位置姿势推定方法，由于按照事先定义的第2相关关系来推定第2实空间姿势，因此能够事先对象物的实空间位置以及实空间姿势的推定精度的提高。

附图说明

图1是与作为本发明的第1实施方式的位置姿势推定方法相关的说明图。

图2A是与基准状态下的对象物的拍摄图像、光线的照射以及拍摄方式(第1实施方式)相关的说明图。

图2B是与任意状态下的对象物的拍摄图像、光线的照射以及拍摄方式(第1实施方式)相关的说明图。

图3A是与第1相关关系相关的说明图。

图3B是与第1相关关系相关的说明图。

图3C是与第1相关关系相关的说明图。

图4A是与第2相关关系相关的说明图。

图4B是与第2相关关系相关的说明图。

图4C是与第2相关关系相关的说明图。

图5A是与基准状态下的对象物的拍摄图像、光线的照射以及拍摄方式(第2实施方式)相关的说明图。

图5B是与任意状态下的对象物的拍摄图像、光线的照射以及拍摄方式(第2实施方式)相关的说明图。

具体实施方式

(第1实施方式)

作为本发明的第1实施方式的位置姿势推定方法中，将实空间坐标系(X,Y,Z)中的对象物坐标系(x,y,z)的位置以及姿势推定为工件W(对象物)的实空间位置以及实空间姿势(参照图2A下侧、图2B下侧、图5A下侧以及图5B下侧)。进行该推定时，使用照射装置2以及拍摄装置4来推定工件W在实空间中的位置以及姿势。照射装置2以其光线20(激光束)的光轴平行于Z轴的方式通过基台1对照射装置2在实空间中的位置以及姿势进行保持。拍摄装置4以其光轴平行于Z轴的方式通过基台1对拍摄装置4在实空间中的位置以及姿势进行保持。

工件W例如是要被装配到其他工件上的部件。其中，该其他工件以实空间中的位置以及姿势维持为恒定的方式被配置的工件。在将工件W分别装配于该各个其他工件上时，为了评价其各个实空间位置以及姿势相对于各个目标位置以及目标姿势的偏差而执行本发明的位置姿势推定方法。

通过将照射装置2的实空间位置以及实空间姿势维持为恒定，预先确定了多个指标点P_i(i＝0,1,2,‥N)当中的第1指标点的X坐标值X_i和Y坐标值Y_i。第2指标点在对象物坐标系中的位置被固定。第1实施方式中，穿过构成一对的指标点P_i和P_j的多个指标直线彼此为非平行。例如，如图2A上侧以及图2B上侧所示那样，穿过指标点P₀和P₁的第1指标直线(此处与x轴相一致)以及穿过指标点P₀和P₂的第2指标直线(此处与y轴相一致)在指标点P₀处正交。

本发明的位置姿势推定方法通过下述方式执行：通过构成计算机的处理器(单核处理器或多核处理器等)，从该处理器的内部或外部的存储器中读取必要的数据以及软件，按照该软件对该数据进行演算处理。例如，作为执行图1所示的各步骤的处理的功能要素的各处理要素由处理器构成。

“第1尺寸测定处理要素”可以具有除了控制用于调节由XYZ坐标系定义的实空间中的拍摄装置4的位置以及姿势的驱动机构(由电机以及传动机构等构成)的动作之外，还控制拍摄装置4的动作的功能。“第1尺寸测定处理要素”具有除了控制用于调节照射装置2(或基台1)的位置以及姿势的驱动机构的动作之外，还控制照射装置2的动作的功能。

为了改变多个指标点当中的至少1个指标点P的Z坐标值，“第1准备处理要素”还可以具有控制用于调节拍摄装置4以及工件W(对象物)的相对位置或者位置以及姿势的驱动机构的动作的功能。

为了改变至少1个指标区域的实空间姿势，“第2准备处理要素”还可以具有控制用于调节拍摄装置4以及工件W(对象物)的相对姿势或者位置以及姿势的驱动机构的动作的功能。

使用照射装置2对工件W的多个指标点P_i当中的第1指标点P_i1照射光线20(图1/步骤02)。由此，同时或者在不同时刻对例如图2A上侧以及图2B上侧所示的第1指标点P₁以及P₂(i₁＝1,2)分别照射光线。其结果是，在工件W的表面上形成近似圆形的照射区域并将其定义为第1指标区域A₁和A₂。光线20的照射区域的形状除近似圆形形状之外，还可以为近似椭圆形等其他形状，也可以为近似圆环状等环状。照射区域的形状为环状时，可以将以该环作为轮廓的区域定义为第1指标区域A_i1。

将通过拍摄装置4获取的拍摄图像中源自可识别的工件W的外观或结构的区域定义为第2指标区域A_i2，将第2指标区域A_i2的中心点或其边界线上的点等包含在其中的点定义为第2指标点P_i2。第2指标点P_i2从其性质来讲，其位置在对象物坐标系中被固定。在图2A以及图2B所示的例子中，将通过工件W中形成的开口部的周缘定义的第2指标区域A₀(i₂＝0)中心点定义为第2指标点P₀。在第1实施方式中，以穿过构成一对的第1指标点P_i1和第2指标点P_i2的方式定义指标直线Q_i1i2。需要说明的是，多个指标点P_i中可以包括多个第2指标点P_i2。也可以将多个指标点P_i全部定义为第1指标点P_i1，对所有指标点P_i照射光线20。

接着，通过拍摄装置4获取工件W的拍摄图像(图1/步骤04)。由此，以例如如图2A上侧以及图2B上侧各自所示那样的方式，获取包括指标区域A₀～A₂在内的工件W的拍摄图像。

基于拍摄图像执行“第1尺寸测定处理”，测定图像坐标系中的指标区域A_i的尺寸φ_i(或者直径)(图1/步骤10)。需要说明的是，作为第1尺寸测定处理，与后述第2尺寸测定处理(参照图1/步骤20)同样地，可以针对拍摄图像中的指标直线的延伸方向，测定指标区域A_i的尺寸φ_i。

进一步，执行“纵实空间位置推定处理”，基于图像坐标系(u,v)中的指标区域A_i的尺寸φ_i的测定结果，推定指标点P_i的Z坐标值Z_i(Z坐标值)(图1/步骤12)。例如，如图3A～图3C中概念性地示出的那样，如拍摄装置4(或其拍摄元件)与指标点P_i的间隔D_i越小则拍摄图像中的指标区域A_i的尺寸φ_i越大(拍摄装置4与指标点P_i的间隔D越大则拍摄图像中的指标区域A_i的尺寸φ_i越小)那样，在该间隔D_i与该尺寸φ_i之间存在相关关系(第1相关关系)。因此，基于图像坐标系(u,v)中的指标区域A_i的尺寸φ_i，按照该第1相关关系，能够推定相当于间隔D_i的指标点P_i的Z坐标值Z_i。

基于拍摄图像执行“横实空间位置推定处理”，基于图像坐标系(u,v)中的第2指标点P_i2的位置(u_i2,v_i2)，测定实空间中的该第2指标点P_i2的X坐标值X_i2和Y坐标值Y_i2(图1/步骤14)。由此，基于例如第2指标点P₀(i₂＝0)在图像坐标系中的位置(u₀,v₀)，测定X坐标值X₀和Y坐标值Y₀(参照图2A上侧以及图2B上侧)。

基于与第2指标点P_i2相关的纵实空间位置推定处理的结果(参照图1/步骤12)以及横实空间位置推定处理的结果(参照图1/步骤14)，执行“实空间位置推定处理”，由此将该第2指标点P_i2的实空间位置(X_i2,Y_i2,Z_i2)推定为工件W的实空间位置(参照图1/步骤16)。由此，推定例如作为工件W的代表点的第2指标点P₀(i₂＝0)的实空间位置(X₀,Y₀,Z₀)(参照图2A以及图2B)。

基于纵实空间位置推定处理的结果(参照图1/步骤10)，执行“第1实空间姿势推定处理”(图1/步骤18)。具体，基于各指标点P_i的X坐标值X_i和Y坐标值Y_i(针对第1指标点为已知值，针对第2指标点为推定值)以及Z坐标值Z_i的推定结果，将穿过多个指标点P_i当中构成一对的指标点P_i和P_j的指标直线Q_ij的实空间姿势推定为第1实空间姿势。例如，基于指标直线Q_ij的方向矢量(a_i1,b_i1,c_i1)，将指标直线Q_ij相对于实空间的X轴的角度θ_1X(i,j)＝arctan(c_i1/a_i1)以及指标直线Q_ij相对于实空间的Y轴的角度θ_1Y(i,j)＝arctan(c_i1/b_i1)分别推定为第1实空间姿势θ_1(i,j)。

可以基于任意状态下的指标点P_i的Z坐标值Z_i(k)相对于基准状态下的指标点P_i的Z坐标值Z_i(0)的偏差ΔZ_j(k)，按照关系式(01)来推定第1实空间姿势θ_1(i,j)。其中，在所述基准状态下，对象物坐标系的xy平面相对于实空间的XY平面的姿势为基准姿势(例如平行)，在所述任意状态下，对象物坐标系的xy平面相对于实空间的XY平面的姿势为未知。在将对象物坐标系的xy平面相对于实空间的XY平面的姿势调节为基准姿势后，可以预先测定指标点P_i的Z坐标值Z_i(0)。

θ_1(i,j)＝arctan{(ΔZ_j(k)-ΔZ_i(k))/L_ij}‥(01)。

例如，在图2A下侧所示的状态下，x轴相对于X轴为平行，且y轴相对于Y轴为平行。在该状态下，对象物坐标系的xy平面相对于实空间的XY平面为平行，相对于XY平面的第1指标直线(x轴线)的第1实空间姿势θ_1(0,1)以及第2指标直线(y轴线)的第1实空间姿势θ_1(0,2)均被推定为0。

与此相对，在图2B下侧所示的状态下，对象物坐标系的xy平面相对于实空间的XY平面倾斜。在该状态下，基于指标点P_i的Z坐标值Z_i(k)(纵实空间位置推定处理的结果)，按照关系式(01)，推定第1指标直线的第1实空间姿势θ_1(0,1)以及第2指标直线的第1实空间姿势θ_1(0,2)。

基于拍摄图像执行“第2尺寸测定处理”，针对图像坐标系中的指标直线的延伸方向，测定多个指标区域A_i当中的至少1个指标区域的尺寸(图1/步骤20)。由此，针对例如第1指标直线Q₀₁(相当于对象物坐标系的x轴)以及第2指标直线Q₀₂(相当于对象物坐标系的y轴)的延伸方向，分别测定拍摄图像中的第2指标区域A₂的尺寸φ₀₁和φ₀₂(参照图2A上侧以及图2B上侧)。

接着，基于第2尺寸测定处理中的测定结果执行“第2实空间姿势推定处理”，将至少1个指标区域A_i的实空间姿势推定为第2实空间姿势(图1/步骤22)。基于指标区域A_i的垂线矢量(a_i2,b_i2,c_i2)，将各个指标直线Q_ij相对于实空间的X轴的角度θ_2X(i,j)＝arctan(c_i2/a_i2)、以及指标直线Q_ij相对于实空间的Y轴的角度θ_2Y(i,j)＝arctan(c_i2/b_i2)推定为第2实空间姿势θ_2(i,j)。

例如，如图4A～图4C上侧所示那样，指标直线Q₀₁(在该例子中相当于对象物坐标系的x轴)相对于实空间的XY平面的倾斜角度ξ越大，则如图4A～图4C下侧所示那样，图像坐标系中的指标区域A_i针对该指标直线的延伸方向(在该例子中为x方向)的尺寸φ₀₁(ξ)越小。在该倾斜角度ξ与该尺寸φ_ij(ξ)之间存在如上所述的相关关系(第2相关关系)。因此，基于图像坐标系(u,v)中的指标区域A_i针对指标直线Q_ij的延伸方向的尺寸φ_ij，按照该第2相关关系，能够推定第2实空间姿势θ_2(i,j)。

基于任意状态下的指标区域A_i的尺寸φ_ij(ξ(k))相对于基准状态下的指标区域A_i的尺寸φ_ij(ξ(0))的偏差Δφ_ij(k)，按照关系式(02)来推定第2实空间姿势θ_2(i,j)。其中，在所述基准状态下，对象物坐标系的xy平面相对于实空间的XY平面的姿势为基准姿势(例如平行)，所述任意状态下，对象物坐标系的xy平面相对于实空间的XY平面的姿势未知。可以在将对象物坐标系的xy平面相对于实空间的XY平面的姿势调节为基准姿势后，预先测定指标区域A_i的尺寸φ_ij(ξ(0))。

θ_2(i,j)＝arccos{Δφ_ij(k)/φ_ij(k)}‥(02)。

基于第1实空间姿势推定处理的结果(参照图1/步骤10)以及第2实空间姿势推定处理的结果(参照图1/步骤22)，执行“实空间姿势推定处理”(图1/步骤24)。具体，基于以所述方式推定的第1实空间姿势θ_1(i,j)以及第2实空间姿势θ_2(i,j)，按照关系式(04)来推定工件W的实空间姿势θ_(i,j)。

θ_(i,j)＝αθ_1(i,j)+(1-α)θ_2(i,j)(0＜α＜1)‥(04)。

加权系数α例如设定为“0.5”，可以根据第1实空间姿势θ_1(i,j)以及第2实空间姿势θ_2(i,j)各自的推定精度的高低差而适当变更该加权系数。例如，源自拍摄图像中的光线的第1指标区域的识别精度高于源自工件W的结构或外观的第2指标区域的识别精度时，可以将α设定为大于0.5的值。

(第2实施方式)

在作为本发明的第2实施方式的位置姿势推定方法中，与第1实施方式不同之处在于，省略第2尺寸测定处理(参照图1/步骤20)以及第2实空间姿势推定处理(参照图1/步骤22)。

第2实施方式中，多个指标直线Q_ij和Q_i’j’彼此平行地配置，或者为同一直线。例如，如图5A上侧以及图5B上侧所示那样，穿过指标点P₀和P₁的第1指标直线Q₀₁(i＝0,j＝1)以及穿过指标点P₀和P₃的第3指标直线Q₀₃(i’＝0,j’＝1)为同一直线(相当于对象物坐标系的x轴)。同样地，穿过指标点P₀和P₂的第2指标直线Q₀₂(i＝0,j＝2)以及穿过指标点P₀和P₄的第4指标直线Q₀₄(i’＝0,j’＝4)为同一直线(相当于对象物坐标系的y轴)。分别对被定义为第1指标点的4个指标点P₁～P₄的照射光线从而形成并定义第1指标区域A₁～A₄(参照图1/步骤02)。

经过第1尺寸测定处理、纵实空间位置推定处理以及第1实空间姿势推定处理(参照图1/步骤10→步骤12→步骤18)，将彼此平行的(或者属于同一直线的)多个指标直线Q_i1j1～Q_iMjM(M＝2,3,‥)分别相对于XY平面的角度推定为第1实空间姿势θ_1(i1,j1)～θ_1(iM,jM)。并且，基于多个第1实空间姿势θ_1(i1,j1)～θ_1(iM,jM)，按照关系式(06)来执行“实空间姿势推定处理”(参照图1/步骤24)。

θ＝Σ_m＝1-Mβ_mθ_1(im,jm))(0＜β_m＜1、Σβ_m＝1)‥(06)。

例如，在图5A下侧所示的基准状态下，推定第1～第4指标直线相对于XY平面的第1实空间姿势θ_1(0,1)～θ_1(0,4)分别为0(参照图2A下侧)。与此相对的是，在如图5B下侧所示的任意状态下，推定对象物坐标系的x轴线相对于实空间的XY平面的角度θ_x为(θ_1(0,1)+θ_1(0,3))/2(β₀₁＝1/2、β₀₃＝1/2)，推定对象物坐标系的y轴线相对于实空间的XY平面的角度θ_y为(θ_1(0,2)+θ_1(0,4))/2(β₀₂＝1/2、β₀₄＝1/2)。

(本发明的作用效果)

根据本发明的位置姿势推定方法，可以根据通过具有与实空间的Z轴平行的光轴的拍摄装置4而获取的工件W的各指标区域A_i的尺寸φ_i，推定各指标点P_i的Z坐标值(参照图1/步骤04→步骤10→步骤12、图2A、图2B)。其依据的定性关系在于，指标点P_i越靠近拍摄装置4(或其拍摄元件)则其测定尺寸越大，指标点P_i越远离拍摄装置4则其测定尺寸越小(参照图3A～图3C)。基于各指标点P_i的Z坐标值Z_i，推定穿过构成一对的指标点P_i和P_j的指标直线Q_ij的第1实空间姿势θ_1(i,j)(根据方向矢量来确定)(参照图1/步骤18→步骤24、关系式(04))。通过使用照射装置2对多个指标点P_i当中的第1指标点P_i1照射光线20，形成并定义包括该第1指标点P_i1在内的第1指标区域A_i1(参照图1/步骤02、图2A上侧、图2B上侧、图5A上侧以及图5B上侧)。

在拍摄装置4的拍摄范围中，即使在工件W的一部分被其他物体遮挡的情况下，通过以避开该其他物体的方式或者利用间隙的方式对该工件W的第1指标点P_i1照射光线20，从而形成第1指标区域A_i1。可以简单地使拍摄图像中包括多个指标区域A_i，所述指标区域分别包括存在于同一指标直线上的多个指标点P_i中的某个指标点。因此，即使在这样的情况下，也能够简易且高精度地推定工件W的至少由Z坐标值Z_i定义的实空间位置和至少由指标直线Q_ij的第1实空间姿势θ_1(i,j)定义的工件W的实空间姿势。

根据第1实施方式，可以根据拍摄图像中的至少1个指标区域A_i的针对指标直线Q_ij的延伸方向的的尺寸φ_ij，推定该指标区域A_i的第2实空间姿势θ_2(i,j)(根据指标区域A_i的垂线矢量来确定)(参照图1/步骤20→步骤22、关系式(02))。通过整合第1实空间姿势θ_1(i,j)的推定结果以及第2实空间姿势θ_2(i,j)的推定结果，可以实现工件W的实空间姿势θ_(i,j)的推定精度的提高(参照图1/步骤24、关系式(04))。

根据第2实施方式，在实空间姿势推定处理(参照图1/步骤24)中，通过综合穿过形成各个不同对的指标点、且为同一直线或彼此平行的多个指标直线Q_i1j1～Q_iMjM的各自的第1实空间姿势θ_1(im,jm)的推定结果，推定工件W的实空间姿势θ_(i,j)(参照关系式(06))。由此，与仅基于单一的指标直线的第1实空间姿势θ_1(im,jm)推定工件W的实空间姿势θ_(i,j)相比，可以实现该推定精度的提高。

(其他实施方式)

所述实施方式中，也可以省略横实空间位置推定处理(参照图1/步骤14)。此时，将至少1个指标点P_i的Z坐标值Z_i的推定结果或其整合结果视为工件W的实空间位置的推定结果。

可以以与第2实施方式相同的方式定义多个指标点P_i，并将穿过构成第1对的第2指标点P₁和P₃的指标直线Q₁₃(相当于对象物坐标系的x轴)以及穿过构成第2对的第2指标点P₂和P₄的指标直线Q₂₄(相当于对象物坐标系的y轴)的各自相对于X轴和Y轴的角度推定为第1实空间姿势θ_1(1,3)和θ_1(2,4)，然后按照与本发明的第1实施方式相同的流程，推定工件W的姿势。

可以在所述实施方式中预先执行“第1准备处理”。具体，在改变多个指标点P_i当中的至少1个指标点P_k的Z坐标值Z_k的同时，测定工件W的拍摄图像中的至少1个指标区域A_k的尺寸φ_k的变化，由此将该Z坐标值Z_k与该尺寸φ_k的相关关系定义为第1相关关系。由此，在纵实空间位置推定处理(图1/步骤12)中，按照第1相关关系来推定各指标点P_i的Z坐标值Z_i。

可以在所述实施方式中预先执行“第2准备处理”。具体，在改变至少1个指标区域A_i的实空间姿势θ_(i,j)的同时，测量拍摄图像中的该指标区域A_i的针对指标直线Q_ij的延伸方向的尺寸φ_ij的变化，由此将该实空间姿势θ_(i,j)与拍摄图像中针对指标直线Q_ij的延伸方向的尺寸φ_ij的相关关系定义为第2相关关系。由此，在第2实空间姿势推定处理(参照图1/步骤22)中，按照第2相关关系来推定第2实空间姿势θ_2(i,j)。