(57)【要約】【課題】安全性を高める機械制御装置を提供する。【解決手段】機械制御装置１０は、制御指令に基づいて、異なる２つ以上の撮像位置において２つ以上の画像を撮像するように撮像装置２を制御する撮像制御部１１と、２つ以上の撮像位置の位置情報を取得する撮像位置情報取得部１３と、ステレオカメラの手法を利用して２つの画像と２つの撮像位置間の距離情報と撮像装置２のパラメータとに基づいて、対象物Ｗの位置情報として対象物Ｗの測定距離を復元する測定距離復元部１４と、対象物Ｗの一部領域を指定領域として指定する領域指定部１２と、指定領域において２つの画像と対象物Ｗの測定距離と撮像装置２のパラメータとに基づいて、対象物Ｗの測定精度が所定の精度を満たす２つの撮像位置間の距離情報を算出する所定精度位置演算部１７とを備え、算出された２つの撮像位置間の距離情報に基づいて撮像装置２の位置及び姿勢を制御し２つの撮像位置を変更する。【選択図】図１
2020126461.tif 000002
【特許請求の範囲】
【請求項１】
対象物に所定の作業を行う機械を制御する機械制御装置であって、撮像装置によって撮像された対象物を含む画像に基づいて前記機械と前記対象物との相対的な位置を制御する機械制御装置において、
制御指令に基づいて、前記撮像装置の位置及び姿勢を制御し、異なる２つ以上の撮像位置において前記対象物を含む２つ以上の画像を撮像するように前記撮像装置を制御する撮像制御部と、
前記２つ以上の撮像位置の位置情報を取得する撮像位置情報取得部と、
ステレオカメラの手法を利用して、前記２つ以上の画像のうちの少なくとも２つの画像と、前記２つ以上の撮像位置のうちの前記少なくとも２つの画像に対応する少なくとも２つの撮像位置間の距離情報と、前記撮像装置のパラメータとに基づいて、前記対象物の位置情報として前記対象物の測定距離を復元する測定距離復元部と、
前記対象物の一部領域を指定領域として指定する領域指定部と、
前記指定領域において、前記少なくとも２つの画像と、前記対象物の測定距離と、前記撮像装置のパラメータとに基づいて、前記対象物の測定精度が所定の精度を満たす前記少なくとも２つの撮像位置間の距離情報を算出する、或いは、前記少なくとも２つの画像と、前記少なくとも２つの撮像位置間の距離情報と、前記撮像装置のパラメータとに基づいて、前記対象物の測定精度が所定の精度を満たす前記対象物の測定距離を算出する所定精度位置演算部と、
を備え、
所定精度位置演算部によって算出された前記少なくとも２つの撮像位置間の距離情報又は前記対象物の測定距離に基づいて、前記撮像装置の位置及び姿勢を制御し、前記少なくとも２つの撮像位置の少なくとも一方を変更する、
機械制御装置。
【請求項２】
前記測定距離復元部は、前記少なくとも２つの画像に領域マッチングを行うことにより画素毎に視差情報Ｚを求め、前記画素毎の視差情報Ｚと、前記少なくとも２つの撮像位置間の距離情報Ｄと、前記撮像装置のパラメータである焦点距離ｆとに基づいて、下記（１）式により前記対象物の測定距離Ｈを算出し、
前記所定精度位置演算部は、前記対象物の測定距離Ｈと、前記撮像装置のパラメータである焦点距離ｆとに基づいて、下記（３）式により前記対象物の測定精度が所定の精度Ｐ’を満たす前記少なくとも２つの撮像位置間の距離Ｄ’を算出する、或いは、前記少なくとも２つの撮像位置間の距離Ｄと、前記撮像装置のパラメータである焦点距離ｆとに基づいて、下記（４）式により前記対象物の測定精度が所定の精度Ｐ’を満たす前記対象物の測定距離Ｈ’を算出する、
請求項１に記載の機械制御装置。
Ｈ＝Ｄ×ｆ／Ｚ・・・（１）
Ｐ’＝Ｈ２／（Ｄ’×ｆ）・・・（３）
Ｐ’＝Ｈ’２／（Ｄ×ｆ）・・・（４）
【請求項３】
前記少なくとも２つの撮像位置の間の距離を広げる方向か、或いは前記２つの前記撮像位置を前記対象物に近づける方向に前記撮像装置の位置を制御することにより、前記対象物の測定精度を高める、
請求項１又は２に記載の機械制御装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、工作機械又は産業用ロボット等の機械を制御する機械制御装置に関する。
【背景技術】
【０００２】
例えば、工具を用いてワーク（対象物）に切削等の加工（所定の処理）を施す工作機械の数値制御装置がある。このような数値制御装置において、工具とワークとの相対的な位置を制御する際に、ビジョンセンサ（撮像装置）で撮像されたワークの画像に基づくワークの位置及び姿勢の情報を利用することが期待されている（例えば、特許文献１参照）。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特許第２８８９０１１号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
工作機械の数値制御装置の加工精度と比較して、ビジョンセンサの測定精度は低い。そのため、ビジョンセンサの測定精度を考慮せずに、ビジョンセンサで撮像されたワークの画像に基づくワークの位置及び姿勢の情報を、ワークの位置決め等に利用すると、工具とワークとの衝突が生じ、工具又はワークの破損が生じる恐れがある。
【０００５】
本発明は、撮像装置で撮像された対象物の画像に基づいて機械の制御を行う機械制御装置において、安全性を高める機械制御装置を提供することを目的とする。
【課題を解決するための手段】
【０００６】
（１）  本発明に係る機械制御装置（例えば、後述の機械制御装置１０）は、対象物（例えば、後述のワークＷ）に所定の作業を行う機械を制御する機械制御装置であって、撮像装置（例えば、後述のビジョンセンサ２）によって撮像された対象物を含む画像に基づいて前記機械と前記対象物との相対的な位置を制御する機械制御装置において、制御指令に基づいて、前記撮像装置の位置及び姿勢を制御し、異なる２つ以上の撮像位置において前記対象物を含む２つ以上の画像を撮像するように前記撮像装置を制御する撮像制御部（例えば、後述の撮像制御部１１）と、前記２つ以上の撮像位置の位置情報を取得する撮像位置情報取得部（例えば、後述の撮像位置情報取得部１３）と、ステレオカメラの手法を利用して、前記２つ以上の画像のうちの少なくとも２つの画像と、前記２つ以上の撮像位置のうちの前記少なくとも２つの画像に対応する少なくとも２つの撮像位置間の距離情報と、前記撮像装置のパラメータとに基づいて、前記対象物の位置情報として前記対象物の測定距離を復元する測定距離復元部（例えば、後述の測定距離復元部１４）と、前記対象物の一部領域を指定領域として指定する領域指定部（例えば、後述の領域指定部１２）と、前記指定領域において、前記少なくとも２つの画像と、前記対象物の測定距離と、前記撮像装置のパラメータとに基づいて、前記対象物の測定精度が所定の精度を満たす前記少なくとも２つの撮像位置間の距離情報を算出する、或いは、前記少なくとも２つの画像と、前記少なくとも２つの撮像位置間の距離情報と、前記撮像装置のパラメータとに基づいて、前記対象物の測定精度が所定の精度を満たす前記対象物の測定距離を算出する所定精度位置演算部（例えば、後述の所定精度位置演算部１７）とを備え、所定精度位置演算部によって算出された前記少なくとも２つの撮像位置間の距離情報又は前記対象物の測定距離に基づいて、前記撮像装置の位置及び姿勢を制御し、前記少なくとも２つの撮像位置の少なくとも一方を変更する。
【０００７】
（２）  （１）に記載の機械制御装置において、前記測定距離復元部は、前記少なくとも２つの画像に領域マッチングを行うことにより画素毎に視差情報Ｚを求め、前記画素毎の視差情報Ｚと、前記少なくとも２つの撮像位置間の距離情報Ｄと、前記撮像装置のパラメータである焦点距離ｆとに基づいて、下記（１）式により前記対象物の測定距離Ｈを算出してもよく、前記所定精度位置演算部は、前記対象物の測定距離Ｈと、前記撮像装置のパラメータである焦点距離ｆとに基づいて、下記（３）式により前記対象物の測定精度が所定の精度Ｐ’を満たす前記少なくとも２つの撮像位置間の距離Ｄ’を算出する、或いは、前記少なくとも２つの撮像位置間の距離Ｄと、前記撮像装置のパラメータである焦点距離ｆとに基づいて、下記（４）式により前記対象物の測定精度が所定の精度Ｐ’を満たす前記対象物の測定距離Ｈ’を算出してもよい。
Ｈ＝Ｄ×ｆ／Ｚ・・・（１）
Ｐ’＝Ｈ２／（Ｄ’×ｆ）・・・（３）
Ｐ’＝Ｈ’２／（Ｄ×ｆ）・・・（４）
【０００８】
（３）  （１）又は（２）に記載の機械制御装置は、前記少なくとも２つの撮像位置の間の距離を広げる方向か、或いは前記２つの前記撮像位置を前記対象物に近づける方向に前記撮像装置の位置を制御することにより、前記対象物の測定精度を高めてもよい。
【発明の効果】
【０００９】
本発明によれば、撮像装置で撮像された対象物の画像に基づいて機械の制御を行う機械制御装置において、安全性を高める機械制御装置を提供することができる。
【図面の簡単な説明】
【００１０】
【図１】第１実施形態に係る工作機械の機械制御装置の主要部を示す図である。
【図２】機械制御装置によるビジョンセンサの制御について説明するための図である。
【図３】ステレオカメラの手法を利用したワークの測定距離の復元について説明するための図である。
【図４】機械制御装置による目標精度を満たす２つの撮像位置（移動量）の演算について説明するための図である。
【図５】機械制御装置によるビジョンセンサの制御のプログラムの一例（左部分）とその説明（右部分）を示す図である。
【図６】変形例に係る機械制御装置による目標精度を満たす２つの撮像位置（移動量）の演算について説明するための図である。
【図７】変形例に係る機械制御装置によるビジョンセンサの制御のプログラムの一例（左部分）とその説明（右部分）を示す図である。
【発明を実施するための形態】
【００１１】
以下、添付の図面を参照して本発明の実施形態の一例について説明する。なお、各図面において同一又は相当の部分に対しては同一の符号を附すこととする。
【００１２】
（第１実施形態）
図１は、第１実施形態に係る工作機械の機械制御装置の主要部を示す図である。図１に示す機械制御装置１０は、ワーク（対象物）Ｗに所定の作業（例えば、切削加工等の加工）を行う工作機械を制御する数値制御装置である。その際、機械制御装置１０は、ビジョンセンサ（Vision Sensor、視覚センサ：撮像装置）２によって撮像されたワークＷを含む画像に基づいて、ワークＷの位置を認識し、工作機械の工具ＴとワークＷとの相対的な位置を制御する。例えば、機械制御装置１０は、工作機械の工具Ｔの位置を制御してもよいし、ワークＷの位置を制御してもよい。
工作機械の工具Ｔの近傍にビジョンセンサ２が取り付けられると、工作機械の工具Ｔの移動指令とビジョンセンサ２の移動指令とを同一にすることができる。
以下、機械制御装置１０によるビジョンセンサ２の制御について詳細に説明する。
【００１３】
機械制御装置１０は、例えば、ＣＰＵ（Central Processing Unit）、ＤＳＰ（Digital Signal Processor）等の演算プロセッサで構成される。機械制御装置１０の各種機能は、例えば記憶部に格納された所定のソフトウェア（プログラム、アプリケーション）を実行することで実現される。機械制御装置１０の各種機能は、ハードウェアとソフトウェアとの協働で実現されてもよいし、ＦＰＧＡ（Field Programmable Gate Array）やハードウェア（電子回路）のみで実現されてもよい。
【００１４】
機械制御装置１０は、撮像制御部１１と、領域指定部１２と、撮像位置情報取得部１３と、測定距離復元部１４と、測定精度演算部１５と、測定精度判定部１６と、所定精度位置演算部１７とを備える。
【００１５】
図２は、機械制御装置１０によるビジョンセンサ２の制御について説明するための図である。
図２に示すように、撮像制御部１１は、例えば記憶部（図示せず）に記憶された制御指令に基づいて、ビジョンセンサ２の位置及び姿勢を制御し、異なる２つの撮像位置においてワークＷを含む２つの画像を撮像するようにビジョンセンサ２を制御する。例えば、撮像制御部１１は、ビジョンセンサ２を所定方向に移動させ、撮像位置間距離（以下、視点間距離ともいう）Ｄの２つの撮像位置においてビジョンセンサ２によってワークＷの撮像を行う。
【００１６】
領域指定部１２は、２つの画像において、ワークＷの一部領域を指定領域（以下、指定画素、注目画素ともいう）として指定する。指定領域は、表示部等に表示された撮像画像に基づいてユーザによって手動で指定されたワークの領域であってもよいし、撮像画像の画像処理（例えば、特徴点抽出アルゴリズム等）によって自動で指定されたワークの領域であってもよい。
【００１７】
撮像位置情報取得部１３は、上述した制御指令から、２つの撮像位置の位置情報（例えば、カメラ座標系又は機械座標系上の座標ＸＹＺ）を取得する。なお、撮像位置情報取得部１３は、機械制御装置１０から移動前後の座標を取得してもよい。
【００１８】
測定距離復元部１４は、ステレオカメラの手法を利用して、２つの画像と、２つの撮像位置間の距離情報と、ビジョンセンサ２のパラメータとに基づいて、ワークＷの位置情報としてワークＷの測定距離を復元する。
図３は、ステレオカメラの手法を利用したワークの測定距離の復元について説明するための図である。図３に示すように、測定距離復元部１４は、２つの画像に領域マッチングを行うことにより画素毎に視差Ｚを求め、画素毎の視差Ｚと、２つの撮像位置間の距離Ｄと、ビジョンセンサ２のパラメータである焦点距離ｆとに基づいて、下記（１）式によりワークＷの測定距離Ｈを算出する。
Ｈ＝Ｄ×ｆ／Ｚ・・・（１）
【００１９】
ここで、機械制御装置１０は、ビジョンセンサ２によって撮像されたワークＷを含む画像に基づいて、ワークＷの位置を認識し、工作機械の工具ＴとワークＷとの相対的な位置を制御する。
【００２０】
工作機械の数値制御装置の加工精度と比較して、ビジョンセンサ２の測定精度は低い。そのため、ビジョンセンサ２の測定精度を考慮せずに、ビジョンセンサ２で撮像されたワークＷの画像に基づくワークＷの位置及び姿勢の情報を、ワークＷの位置決め等に利用すると、工具ＴとワークＷとの衝突が生じ、工具Ｔ又はワークＷの破損が生じる恐れがある。
そこで、本実施形態の機械制御装置１０は、測定距離復元部１４に加え、測定精度演算部１５、測定精度判定部１６及び所定精度位置演算部１７を備える。
【００２１】
測定精度演算部１５は、ステレオカメラの手法を利用して、２つの画像と、２つの撮像位置間の距離情報と、ビジョンセンサ２のパラメータとに基づいて、ワークＷの測定距離の測定精度Ｐを演算する。
測定精度Ｐは、撮影面に映るワークＷが誤って隣接画素に映ったと想定した際に（このときの視差をＺ’とする）、どれだけ差が出るかで定義する（下記（２）式参照）。換言すれば、測定精度Ｐは、測定距離ＨをＺで微分した値である。
Ｐ＝｜Ｈ（Ｚ’）−Ｈ（Ｚ）｜＝｜ｄＨ／ｄＺ｜＝Ｄ×ｆ／Ｚ２
これに上記（１）式を代入し、測定精度Ｐは下記（２）式のように表される。
Ｐ＝Ｈ２／（Ｄ×ｆ）・・・（２）
これより、２つの撮像位置間の距離Ｄが大きいほど測定精度Ｐは小さく、精度が高いことがわかる。
【００２２】
測定精度判定部１６は、指定領域において、ワークＷの測定精度Ｐが目標精度（所定の精度：以下、指定精度ともいう）Ｐ’を満たすか否かを判定する。目標精度Ｐ’は、予め定められた値であって、記憶部等に記憶されていればよい。
【００２３】
所定精度位置演算部１７は、ワークＷの測定精度Ｐが目標精度Ｐ’を満たす２つの撮像位置を演算する。例えば、所定精度位置演算部１７は、２つの画像と、ビジョンセンサ２のパラメータとに基づいて、ワークＷの測定精度Ｐが目標精度Ｐ’を満たす２つの撮像位置を演算する。より具体的には、所定精度位置演算部１７は、指定領域において、２つの画像と、ワークＷの測定距離と、ビジョンセンサ２のパラメータとに基づいて、ワークＷの測定精度が所定の精度を満たす２つの撮像位置間の距離情報を算出する。
【００２４】
図４は、機械制御装置１０による目標精度Ｐ’を満たす２つの撮像位置（移動量）の演算について説明するための図である。
例えば、所定精度位置演算部１７は、ワークＷの測定距離Ｈと、撮像装置のパラメータである焦点距離ｆとに基づいて、下記（３）式によりワークＷの測定精度が所定の精度Ｐ’を満たす２つの撮像位置間の距離Ｄ’を算出する。
Ｐ’＝Ｈ２／（Ｄ’×ｆ）・・・（３）
これにより、視点間距離Ｄの状態からの移動距離Ｅは、次式により求まる。
Ｅ＝Ｄ’−Ｄ
【００２５】
或いは、所定精度位置演算部１７は、指定領域において、２つの画像と、２つの撮像位置間の距離情報と、ビジョンセンサ２のパラメータとに基づいて、ワークＷの測定精度が所定の精度を満たすワークＷの測定距離を算出してもよい。
例えば、所定精度位置演算部１７は、２つの撮像位置間の距離Ｄと、ビジョンセンサ２のパラメータである焦点距離ｆとに基づいて、下記（４）式によりワークＷの測定精度が所定の精度Ｐ’を満たすワークＷの測定距離Ｈ’を算出してもよい。
Ｐ’＝Ｈ’２／（Ｄ×ｆ）・・・（４）
【００２６】
このように、視点間距離Ｄを広げることにより、測定精度が向上する。或いは、視点間距離Ｄを一定とし、ビジョンセンサ２をワークＷに近づけることにより、測定精度が向上する。
【００２７】
ワークＷの測定精度が目標精度を満たす場合、機械制御装置１０は、位置演算部１４によって演算されたワークＷの位置情報に基づいて、工作機械の工具ＴとワークＷとの相対的な位置を制御し、工具Ｔを用いてワークＷに所定の作業を行う。
【００２８】
一方、ワークＷの測定精度が目標精度を満たさない場合、機械制御装置１０は、所定精度位置演算部１７によって演算された目標精度Ｐ’を満たす２つの撮像位置に基づいて、
・撮像制御部１１によるビジョンセンサ２の移動及び撮影、
・指定領域決定部１２、撮像位置情報取得部１３及び位置演算部１４によるワークＷの位置の演算、
・精度演算部１５及び精度判定部１６によるワークＷの測定精度の演算及び判定、
を行う。
【００２９】
なお、それでもワークＷの測定精度が目標精度を満たさない場合、機械制御装置１０は、
・所定精度位置演算部１７による目標精度Ｐ’を満たす２つの撮像位置の演算、
・撮像制御部１１によるビジョンセンサ２の移動及び撮影、
・指定領域決定部１２、撮像位置情報取得部１３及び位置演算部１４によるワークＷの位置の演算、
・精度演算部１５及び精度判定部１６によるワークＷの測定精度の演算及び判定、
を、目標精度が得られるまで繰り返してもよい。
【００３０】
上述した処理を既定の回数繰り返しても目標精度が得られない場合、もしくはビジョンセンサ２の移動が困難である場合、機械制御装置１０は、位置演算部１４によって演算されたワークＷの位置情報に基づく、工作機械の工具ＴとワークＷとの相対的な位置の制御、及び工具Ｔを用いたワークＷの所定の作業を停止する。
【００３１】
図５は、機械制御装置１０によるビジョンセンサ２の制御のプログラムの一例（左部分）とその説明（右部分）を示す図である。
「Ｇ８００」は、ビジョンセンサの移動指令である。
「Ｇ８１０」は、撮像、画像処理（位置情報、精度情報の計測）を起動する指令である。
これにより、撮像制御部１１は、ビジョンセンサ２を所定方向に移動させ、撮像位置間距離（視点間距離）Ｄの２つの撮像位置においてビジョンセンサ２によってワークＷの撮像を行う。
撮像位置情報取得部１３は、制御指令から、２つの撮像位置を取得する。
【００３２】
「Ｇ８２０」は、注目画素（指定領域）を指定する指令である。
これにより、領域指定部１２は、２つの画像において、ワークＷの一部領域を指定領域として指定する。指定された画素の列と行が♯１００、♯１０１に入る。
測定距離復元部１４は、ステレオカメラの手法を利用して、２つの画像と、２つの撮像位置間の距離情報と、ビジョンセンサ２のパラメータとに基づいて、ワークＷの位置情報としてワークＷの測定距離を復元する。
測定精度演算部１５は、２つの画像と、２つの撮像位置間の距離情報と、ビジョンセンサ２のパラメータとに基づいて、ワークＷの測定距離の測定精度を演算する。
【００３３】
「Ｇ８３０」は、画素（♯１００,♯１０１）に対応するワークＷの位置情報が（０．１,０．１,０．１）ｍｍ精度を満たすか否かを判定する指令である。
これにより、測定精度判定部１６は、指定領域において、ワークＷの測定精度Ｐが目標精度Ｐ’を満たすか否かを判定する。例えば、測定精度判定部１６は、画像の列♯１００、行♯１０１番目の画素の測定データが、測定精度（０．１, ０．１, ０．１）ｍｍを満たすか否かを判定する。例えば満たしていない場合、♯８９９８に０以外の数字が入る。
【００３４】
「Ｇ８４０」は、対象画素（指定領域）が指定精度（目標精度）を満たすのに必要な撮像位置を計算する指令である。
これにより、所定精度位置演算部１７は、ワークＷの測定精度Ｐが目標精度Ｐ’を満たす２つの撮像位置（２つの撮像位置間の距離Ｄ’又はワークＷの測定距離Ｈ’）を演算する。例えば、所定精度位置演算部１７は、列♯１００，行♯１０１で指定した画素の測定データが、指定の精度を満たすのに必要な撮像位置を計算し、次に移動する距離を、Ｘ方向♯３００，Ｙ方向♯３０１，Ｚ方向♯３０３にセットする。
【００３５】
「ＧＯＴＯ １０」指令により２行目へ処理を戻し、もう一回ビジョンセンサを移動して撮像する。
【００３６】
以上説明したように、本実施形態の機械制御装置１０によれば、ワークＷの測定精度を向上し、ビジョンセンサ２で撮像されたワークＷの画像に基づいて工作機械の制御を行う機械制御装置において、安全性を高めることができる。
また、本実施形態の機械制御装置１０によれば、ハレーション又はオクルージョン（陰面）に起因する誤測定や測定不能が発生する場合も、有効に機能する。
【００３７】
本願発明者らによれば、以下の知見を得ている。
・既存のビジョンセンサは、測定精度を制御できない。
ビジョンセンサを対象物に近づけることにより測定精度を改善できるが、危険と限界がある。
高解像素子、高精度レンズを有するセンサは高価である。
・現在、数値制御装置がビジョンセンサの測定精度を判断する方法がない。
数値制御装置がビジョンセンサの測定精度を知る方法がない。
加工に必要な精度を満たすか否かを判定する方法がない。
・現在、ビジョンセンサが精度不足の場合、数値制御装置が安全に動作できる仕組みがない。
ビジョンセンサから数値制御装置を停止する仕組みがない。
数値制御装置からビジョンセンサの精度向上を指令する仕組みがない。
【００３８】
これらの点に関し、本実施形態の機械制御装置１０によれば以下の利点を得ることができる。
・数値制御装置が、ビジョンセンサの測定精度を知ることができるようになる。
・数値制御装置が、ビジョンセンサ出力値が指定精度を満たすか否かを判定できるようになる。
・数値制御装置が、ビジョンセンサの測定精度を制御（向上）できるようになる。
・測定精度不足の場合、数値制御装置を停止することができるようになる。
・信頼性の向上
加工に必要なビジョンセンサの測定精度を保証できる。
数値制御装置で安全にビジョンセンサを利用できる。
・検出精度の向上
ビジョンセンサの測定精度が向上でき、検出精度が向上する。
・設備費の低減
数値制御装置＋単眼カメラ＋制御ソフトウェア（プログラム）で、ステレオカメラ同等の機能を実現できる。
【００３９】
（変形例）
図１において、機械制御装置１０は、所定精度位置演算部１７を必ずしも備えていなくともよい。すなわち、機械制御装置１０は、所定精度位置演算部１７による目標精度Ｐ’を満たす２つの撮像位置の演算を必ずしも行わなくてよい。
変形例では、ワークＷの測定精度が目標精度を満たさない場合、機械制御装置１０は、目標精度が得られるまで２つの撮像位置（例えば、２つの撮像位置間の距離Ｄ）を少しずつ広げていく。
【００４０】
図６は、変形例に係る機械制御装置１０による目標精度を満たす２つの撮像位置（移動量）の演算について説明するための図である。
図６に示すように、変形例の機械制御装置１０は、ワークＷの測定精度が目標精度を満たさない場合、目標精度が得られるまで２つの撮像位置（例えば、２つの撮像位置間の距離Ｄ）を所定量（微小量）だけ広げていく。所定量（微小量）は、予め決められた値であって、例えば記憶部等に記憶されていればよい。
或いは、上述同様に、変形例の機械制御装置１０は、２つの撮像位置（例えば、ワークＷの測定距離Ｈ）をワークＷに所定量（微小量）だけ近づけていってもよい。
【００４１】
すなわち、変形例の機械制御装置１０は、ワークＷの測定精度が目標精度を満たさない場合、
・撮像位置を所定量（微小量）だけ変更
・撮像制御部１１によるビジョンセンサ２の移動及び撮影、
・指定領域決定部１２、撮像位置情報取得部１３及び位置演算部１４によるワークＷの位置の演算、
・精度演算部１５及び精度判定部１６によるワークＷの測定精度の演算及び判定、
を、目標精度が得られるまで繰り返す。
【００４２】
図７は、変形例に係る機械制御装置１０によるビジョンセンサ２の制御のプログラムの一例（左部分）とその説明（右部分）を示す図である。図７に示すプログラムは、図５に示すプログラムにおいて「Ｇ８００」の位置が異なる。
【００４３】
「Ｇ８００」は、ビジョンセンサの移動指令である。
例えば、♯２００に入っている所定の移動距離（例えば、初期値、又はユーザ指定）だけビジョンセンサをＸ方向に移動する。
【００４４】
以上、本発明の実施形態について説明したが、本発明は上述した実施形態に限定されることなく、種々の変更及び変形が可能である。例えば、上述した実施形態では、ビジョンセンサによって撮像された対象物を含む画像に基づいて対象物の位置を測定する機械制御装置を例示したが、本発明はこれに限定されず、種々の撮像装置によって撮像された対象物を含む画像に基づいて対象物の位置を測定する機械制御装置に適用可能である。例えば、種々の撮像装置としては、単眼カメラ、３次元計測が可能なステレオカメラ、３次元カメラ等が挙げられる。
ステレオカメラ、３次元カメラでも、対象物に近づけることにより測定精度を上げることができる。
【００４５】
また、上述した実施形態では、２つの撮像位置において撮像された対象物を含む２つの画像に基づいて対象物との位置を制御する機械制御装置を例示したが、本発明はこれに限定されず、３つ以上の撮像位置において撮像された対象物を含む３つ以上の画像に基づいて対象物との位置を制御する機械制御装置に適用可能である。この場合、基準となる撮像位置を決め、基準に対する各撮像位置について、上述したように対象物の位置情報として対象物の測定距離を復元し（測定距離復元部）、対象物の測定距離の測定精度を演算し（測定精度演算部）、対象物の測定精度が所定の精度を満たすか否かを判定し（測定精度判定部）、対象物の測定精度が所定の精度を満たす２つの撮像位置間の距離情報又は対象物の測定距離を算出し（所定精度位置演算部）、所定精度位置演算部によって算出された２つの撮像位置間の距離情報又は対象物の測定距離に基づいて、撮像装置の位置及び姿勢を制御し、基準に対する撮像位置（２つの撮像位置間の距離又は対象物の測定距離）を変更してもよい。
【００４６】
また、上述した実施形態では、工作機械に取り付けられた工具とワークとの相対的な位置を制御してワークに所定の作業を行う工作機械の数値制御装置を例示した。しかし、本発明はこれに限定されず、産業用ロボットに取り付けされた工具又はハンドとワークとの相対的な位置を制御してワークに所定の作業を行うロボット制御装置等の、種々の機械制御装置に適用可能である。この場合、ロボットのアームに撮像装置が取り付けられると、ロボットのアームの移動指令と撮像装置の移動指令とを同一にすることができる。
【符号の説明】
【００４７】
２  ビジョンセンサ（撮像装置）
１０  機械制御装置
１１  撮像制御部
１２  領域指定部
１３  撮像位置情報取得部
１４  測定距離復元部
１５  測定精度演算部
１６  測定精度判定部
１７  所定精度位置演算部
【図１】
2020126461.tif 000003
【図２】
2020126461.tif 000004
【図３】
2020126461.tif 000005
【図４】
2020126461.tif 000006
【図５】
2020126461.tif 000007
【図６】
2020126461.tif 000008
【図７】
2020126461.tif 000009