JP2023041201A - ワーク保持装置、ワーク保持方法、プログラム、及び制御装置 - Google Patents
ワーク保持装置、ワーク保持方法、プログラム、及び制御装置 Download PDFInfo
- Publication number
- JP2023041201A JP2023041201A JP2021148424A JP2021148424A JP2023041201A JP 2023041201 A JP2023041201 A JP 2023041201A JP 2021148424 A JP2021148424 A JP 2021148424A JP 2021148424 A JP2021148424 A JP 2021148424A JP 2023041201 A JP2023041201 A JP 2023041201A
- Authority
- JP
- Japan
- Prior art keywords
- holding
- work
- workpiece
- candidate
- candidate point
- 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.)
- Pending
Links
Images
Landscapes
- Manipulator (AREA)
Abstract
【課題】ワークの保持に失敗した場合、短時間でワークの再保持を行うこと。
【解決手段】ワーク保持装置は、3次元空間の複数のワークの中から1つずつワークを保持する保持手段と、複数のワークの3次元情報を取得する情報取得手段と、ワークの3次元情報に基づいて、保持手段がワークを保持する際の保持候補点を複数算出する候補算出手段と、算出された複数の保持候補点の中から1つの保持候補点を選択し、選択した保持候補点で、ワークを保持するように保持手段を制御する制御手段と、制御手段による保持手段の制御によって、ワークの保持が成功したか否かを判定する判定手段と、を備える。制御手段は、ワークの保持が成功しなかったと判定された場合に、選択された保持候補点に基づいて所定範囲を設定し、所定範囲外にある他の保持候補点で、ワークを再度保持するように保持手段を制御する。
【選択図】図2
【解決手段】ワーク保持装置は、3次元空間の複数のワークの中から1つずつワークを保持する保持手段と、複数のワークの3次元情報を取得する情報取得手段と、ワークの3次元情報に基づいて、保持手段がワークを保持する際の保持候補点を複数算出する候補算出手段と、算出された複数の保持候補点の中から1つの保持候補点を選択し、選択した保持候補点で、ワークを保持するように保持手段を制御する制御手段と、制御手段による保持手段の制御によって、ワークの保持が成功したか否かを判定する判定手段と、を備える。制御手段は、ワークの保持が成功しなかったと判定された場合に、選択された保持候補点に基づいて所定範囲を設定し、所定範囲外にある他の保持候補点で、ワークを再度保持するように保持手段を制御する。
【選択図】図2
Description
本発明は、ワークを保持するワーク保持装置、ワーク保持方法、プログラム、及び制御装置に関する。
バラ積みなどされた複数のワークの3次元情報に基づいて、ワークを保持手段により保持するワーク保持装置が知られている(例えば、特許文献1参照)。
しかしながら、例えば、ワークの積載位置やワークを保持する際の磁力による吸引力などによっては、ワークの保持に失敗する可能性がある。その場合、再度ワークを保持する必要があるが、保持失敗の際にワークが荷崩れするなどのワークの配置が変化していることが考え得る。このため、ワークの3次元情報を再度取得する必要が生じ、ワークの再保持により多くの時間を要する。
本発明は、このような問題点を解決するためになされたものであり、ワークの保持に失敗した場合、短時間でワークの再保持を行うことができるワーク保持装置、ワーク保持方法、プログラム、及び制御装置を提供することを主たる目的とする。
上記目的を達成するための本発明の一態様は、
3次元空間に置かれた複数のワークの中から1つずつワークを保持する保持手段と、
前記複数のワークの3次元情報を取得する情報取得手段と、
前記情報取得手段により取得されたワークの3次元情報に基づいて、前記保持手段がワークを保持する際の該ワークの保持点の候補である保持候補点を複数算出する候補算出手段と、
前記候補算出手段により算出された複数の保持候補点の中から1つの保持候補点を選択し、該選択した保持候補点で、前記ワークを保持するように前記保持手段を制御する制御手段と、
前記制御手段による前記保持手段の制御によって、前記ワークの保持が成功したか否かを判定する判定手段と、
を備え、
前記制御手段は、前記判定手段によりワークの保持が成功しなかったと判定された場合に、前記選択された保持候補点に基づいて所定範囲を設定し、該所定範囲外にある他の保持候補点を選択し、該選択した他の保持候補点で、前記ワークを再度保持するように前記保持手段を制御する、
ワーク保持装置
である。
この一態様において、前記判定手段は、前記保持手段が複数のワークを同時に保持した場合に、前記ワークの保持が成功しなかったと判定し、
前記制御手段は、前記判定手段によりワークの保持が成功しなかったと判定された場合に、前記ワークを解放するように前記保持手段を制御した後、前記他の保持候補点で、前記ワークを再度保持するように前記保持手段を制御してもよい。
この一態様において、前記保持手段がワークを保持した時の該ワークの重量を検出する重量検出手段を更に備え、
前記判定手段は、前記重量検出手段により検出されたワークの重量に基づいて、前記ワークの保持が成功したか否かを判定してもよい。
この一態様において、前記保持手段は、前記ワークを非接触状態で吸引し保持してもよい。
この一態様において、前記制御手段は、前記判定手段によりワークの保持が成功しなかったと判定された場合に、前記選択された保持候補点から所定距離以内の範囲を前記所定範囲に設定し、
前記解放するワークの数、重量、又は、大きさに応じて、前記所定距離を変化させてもよい。
上記目的を達成するための本発明の一態様は、
3次元空間に置かれた複数のワークの3次元情報を取得するステップと、
前記取得されたワークの3次元情報に基づいて、保持手段がワークを保持する際の該ワークの保持点の候補である保持候補点を複数算出するステップと、
前記算出された複数の保持候補点の中から1つの保持候補点を選択し、該選択した保持候補点で、前記ワークを保持するように前記保持手段を制御するステップと、
前記保持手段の制御によって、前記ワークの保持が成功したか否かを判定するステップと、
前記ワークの保持が成功しなかったと判定された場合に、前記選択された保持候補点に基づいて所定範囲を設定し、該所定範囲外にある他の保持候補点を選択し、該選択した他の保持候補点で、前記ワークを再度保持するように前記保持手段を制御するステップと、
を含む、ワーク保持方法
であってもよい。
上記目的を達成するための本発明の一態様は、
3次元空間に置かれた複数のワークの3次元情報を取得する処理と、
前記取得されたワークの3次元情報に基づいて、保持手段がワークを保持する際の該ワークの保持点の候補である保持候補点を複数算出する処理と、
前記算出された複数の保持候補点の中から1つの保持候補点を選択し、該選択した保持候補点で、前記ワークを保持するように前記保持手段を制御する処理と、
前記保持手段の制御によって、前記ワークの保持が成功したか否かを判定する処理と、
前記ワークの保持が成功しなかったと判定された場合に、前記選択された保持候補点に基づいて所定範囲を設定し、該所定範囲外にある他の保持候補点を選択し、該選択した他の保持候補点で、前記ワークを再度保持するように前記保持手段を制御する処理と、
をコンピュータに実行させる、プログラム
であってもよい。
上記目的を達成するための本発明の一態様は、
3次元空間に置かれた複数のワークの3次元情報に基づいて、保持手段がワークを保持する際の該ワークの保持点の候補である保持候補点を複数算出する候補算出手段と、
前記候補算出手段により算出された複数の保持候補点の中から1つの保持候補点を選択し、該選択した保持候補点で、前記ワークを保持するように前記保持手段を制御する制御手段と、
前記制御手段による前記保持手段の制御によって、前記ワークの保持が成功したか否かを判定する判定手段と、
を備え、
前記制御手段は、前記判定手段によりワークの保持が成功しなかったと判定された場合に、前記選択された保持候補点に基づいて所定範囲を設定し、該所定範囲外にある他の保持候補点を選択し、該選択した他の保持候補点で、前記ワークを再度保持するように前記保持手段を制御する、
制御装置
であってもよい。
3次元空間に置かれた複数のワークの中から1つずつワークを保持する保持手段と、
前記複数のワークの3次元情報を取得する情報取得手段と、
前記情報取得手段により取得されたワークの3次元情報に基づいて、前記保持手段がワークを保持する際の該ワークの保持点の候補である保持候補点を複数算出する候補算出手段と、
前記候補算出手段により算出された複数の保持候補点の中から1つの保持候補点を選択し、該選択した保持候補点で、前記ワークを保持するように前記保持手段を制御する制御手段と、
前記制御手段による前記保持手段の制御によって、前記ワークの保持が成功したか否かを判定する判定手段と、
を備え、
前記制御手段は、前記判定手段によりワークの保持が成功しなかったと判定された場合に、前記選択された保持候補点に基づいて所定範囲を設定し、該所定範囲外にある他の保持候補点を選択し、該選択した他の保持候補点で、前記ワークを再度保持するように前記保持手段を制御する、
ワーク保持装置
である。
この一態様において、前記判定手段は、前記保持手段が複数のワークを同時に保持した場合に、前記ワークの保持が成功しなかったと判定し、
前記制御手段は、前記判定手段によりワークの保持が成功しなかったと判定された場合に、前記ワークを解放するように前記保持手段を制御した後、前記他の保持候補点で、前記ワークを再度保持するように前記保持手段を制御してもよい。
この一態様において、前記保持手段がワークを保持した時の該ワークの重量を検出する重量検出手段を更に備え、
前記判定手段は、前記重量検出手段により検出されたワークの重量に基づいて、前記ワークの保持が成功したか否かを判定してもよい。
この一態様において、前記保持手段は、前記ワークを非接触状態で吸引し保持してもよい。
この一態様において、前記制御手段は、前記判定手段によりワークの保持が成功しなかったと判定された場合に、前記選択された保持候補点から所定距離以内の範囲を前記所定範囲に設定し、
前記解放するワークの数、重量、又は、大きさに応じて、前記所定距離を変化させてもよい。
上記目的を達成するための本発明の一態様は、
3次元空間に置かれた複数のワークの3次元情報を取得するステップと、
前記取得されたワークの3次元情報に基づいて、保持手段がワークを保持する際の該ワークの保持点の候補である保持候補点を複数算出するステップと、
前記算出された複数の保持候補点の中から1つの保持候補点を選択し、該選択した保持候補点で、前記ワークを保持するように前記保持手段を制御するステップと、
前記保持手段の制御によって、前記ワークの保持が成功したか否かを判定するステップと、
前記ワークの保持が成功しなかったと判定された場合に、前記選択された保持候補点に基づいて所定範囲を設定し、該所定範囲外にある他の保持候補点を選択し、該選択した他の保持候補点で、前記ワークを再度保持するように前記保持手段を制御するステップと、
を含む、ワーク保持方法
であってもよい。
上記目的を達成するための本発明の一態様は、
3次元空間に置かれた複数のワークの3次元情報を取得する処理と、
前記取得されたワークの3次元情報に基づいて、保持手段がワークを保持する際の該ワークの保持点の候補である保持候補点を複数算出する処理と、
前記算出された複数の保持候補点の中から1つの保持候補点を選択し、該選択した保持候補点で、前記ワークを保持するように前記保持手段を制御する処理と、
前記保持手段の制御によって、前記ワークの保持が成功したか否かを判定する処理と、
前記ワークの保持が成功しなかったと判定された場合に、前記選択された保持候補点に基づいて所定範囲を設定し、該所定範囲外にある他の保持候補点を選択し、該選択した他の保持候補点で、前記ワークを再度保持するように前記保持手段を制御する処理と、
をコンピュータに実行させる、プログラム
であってもよい。
上記目的を達成するための本発明の一態様は、
3次元空間に置かれた複数のワークの3次元情報に基づいて、保持手段がワークを保持する際の該ワークの保持点の候補である保持候補点を複数算出する候補算出手段と、
前記候補算出手段により算出された複数の保持候補点の中から1つの保持候補点を選択し、該選択した保持候補点で、前記ワークを保持するように前記保持手段を制御する制御手段と、
前記制御手段による前記保持手段の制御によって、前記ワークの保持が成功したか否かを判定する判定手段と、
を備え、
前記制御手段は、前記判定手段によりワークの保持が成功しなかったと判定された場合に、前記選択された保持候補点に基づいて所定範囲を設定し、該所定範囲外にある他の保持候補点を選択し、該選択した他の保持候補点で、前記ワークを再度保持するように前記保持手段を制御する、
制御装置
であってもよい。
本発明によれば、ワークの保持に失敗した場合、短時間でワークの再保持を行うことができるワーク保持装置、ワーク保持方法、プログラム、及び制御装置を提供することができる。
以下、図面を参照して本発明の実施形態について説明する。図1は、本実施形態に係るワーク保持装置の概略的なシステム構成を示す構成図である。本実施形態に係るワーク保持装置1は、3次元空間に配置された複数のワークの中から1つずつワークを保持し、移動させることができる。複数のワークは、箱内や平面板などにバラ積みされている部品などである。なお、複数のワークは、平面形状や立体形状などの任意の形状の部品を含む。
本実施形態に係るワーク保持装置1は、ロボットアーム2と、制御装置3と、3次元ビジョンセンサ4と、を備えている。
ロボットアーム2は、保持手段の一具体例である。ロボットアーム2は、例えば、複数のリンク21と、各リンク21を回動可能に連結する関節部(手首関節、肘関節、肩関節など)23と、その先端に設けられワークを保持するエンドエフェクタ24と、を有する多関節型アームとして構成されている。
各関節部23には、各関節部23の回転情報を検出するエンコーダなどの回転センサ、各関節部23を駆動するサーボモータなどのアクチュエータ、各関節部23の操作力を検出する力センサ、などが設けられている。力センサは、例えば、各関節部23のトルクを検出するトルクセンサなどである。各関節部23には、減速機構などが設けられている。
エンドエフェクタ24は、磁力や空気圧力などの吸引力により、ワークを非接触状態で吸引し保持する。エンドエフェクタ24は、例えば、磁力を発生させることによってワークを電磁吸着し、磁力の発生を停止することによって電磁吸着しているワークを解放するように構成されている。
エンドエフェクタ24は、指部などでワークを把持するように構成されていてもよい。なお、エンドエフェクタ24は、ワークを磁力などにより吸引するように構成されている場合、複数のワークを同時に保持し易いため、後述の保持失敗が起き易くなるため、後述の本実施形態に係る効果はより大きい。
ロボットアーム2のリンク先端側とエンドエフェクタ24との間には、力覚センサ5が設けられている。力覚センサ5は、重量検出手段の一具体例である。エンドエフェクタ24がワークを吸引し保持した時にエンドエフェクタ24にはワークの重量が掛かる。力覚センサ5は、そのワークの重量を検出する。
制御装置3は、ロボットアーム2に対する各種の演算処理及び制御処理を行う。制御装置3は、例えば、CPU(Central Processing Unit)やGPU(Graphics Processing Unit)などのプロセッサ3aと、RAM(Random Access Memory)やROM(Read Only Memory)などの内部メモリ3bと、HDD(Hard Disk Drive)やSDD(Solid State Drive)などのストレージデバイス3cと、ディスプレイなどの周辺機器を接続するための入出力I/F3dと、装置外部の機器と通信を行う通信I/F3eと、を備えた通常のコンピュータのハードウェア構成を有する。
3次元ビジョンセンサ4は、情報取得手段の一具体例である。3次元ビジョンセンサ4は、複数のワークの3次元情報を取得する。ワークの3次元情報は、各ワークの形状、位置、姿勢などの情報を含む。
3次元ビジョンセンサ4は、例えば、ロボットアーム2のエンドエフェクタ24やリンク21などに設けられている。3次元ビジョンセンサ4は、カメラやレーザセンサなどで構成されている。3次元ビジョンセンサ4は、取得したワークの3次元情報を制御装置3に対して出力する。
図2は、本実施形態に係る制御装置の概略的なシステム構成を示すブロック図である。本実施形態に係る制御装置3は、候補算出部31と、ロボット制御部32と、保持判定部33と、を有している。
候補算出部31は、候補算出手段の一具体例である。候補算出部31は、3次元ビジョンセンサ4により取得されたワークの3次元情報に基づいて、ロボットアーム2のエンドエフェクタ24がワークを保持する際のワークの保持点(吸着点)の候補である保持候補点を複数算出する。
例えば、候補算出部31は、3次元ビジョンセンサ4により取得されたワークの3次元情報に基づいて、各ワークの高さ位置を示す深度情報を算出する。候補算出部31は、算出した各ワークの深度情報に基づいて、各ワークの凸部を検出する。候補算出部は、所定高さ以上の点を1とし、所定高さ未満の点を0として2値化し、1となる点を、凸部として検出してもよい。候補算出部31は、検出した凸部の中から、エンドエフェクタ24が吸着を行うための端面の面積が閾値以上の凸部を保持候補点として検出する。
候補算出部31は、上述のように算出した複数の保持候補点をロボット制御部32に対して出力する。
ロボット制御部32は、制御手段の一具体例である。ロボット制御部32は、ロボットアーム2の動作を制御する。ロボット制御部32は、例えば、各関節部23の回転センサからの回転情報(回転角など)と、力センサからの操作力と、に基づいて、各関節部23のアクチュエータを制御することで、ロボットアーム2をフィードバック制御する。また、ロボット制御部32は、エンドエフェクタ24によるワークの吸着及び解放を制御する。これにより、ロボット制御部32は、ロボットアーム2を制御することで、ワークを保持し、移動させることができる。
ロボット制御部32は、候補算出部31により算出された複数の保持候補点の中から1つの保持候補点を選択する。ロボット制御部32は、例えば、候補算出部31により算出された複数の保持候補点の中から最も高い位置の保持候補点を選択する。ロボット制御部32は、候補算出部31により算出された複数の保持候補点の中から凸部の端面の面積が最大の保持候補点を選択してもよい。なお、上記保持候補点の選択方法は一例であり、これに限定されず、任意の選択方法が適用されてもよい。
ロボット制御部32は、3次元ビジョンセンサ4により取得されたワークの3次元情報に基づいて、ロボットアーム2のエンドエフェクタ24が上記選択された保持候補点(以下、選択保持候補点と称す)でワークを保持するように、ロボットアーム2を制御する。
保持判定部33は、判定手段の一具体例である。保持判定部33は、上述のロボット制御部32によるロボットアーム2の制御によって、ワークの保持が成功したか否かを判定する。
保持判定部33は、ロボットアーム2のエンドエフェクタ24がワークに接近し(図3(a))、エンドエフェクタ24が複数(例えば、2つ)のワークを同時に吸引し保持した場合(図3(b))、ワークの保持が失敗したと判定する。あるいは、保持判定部33は、ロボットアーム2のエンドエフェクタ24が0個のワークを保持した場合、すなわち、ワークを保持できなった場合にワークの保持が失敗したと判定する。特に、上述の如く、磁石などによりワークを吸引し保持する場合、複数のワークを同時に保持する失敗が生じ易く、この失敗を確実に判定する必要がある。
保持判定部33は、力覚センサ5により検出されたワークの重量に基づいて、ワークの保持が成功したか否かを判定してもよい。保持判定部33には、予めワークの重量が設定されていてもよい。保持判定部33は、力覚センサ5により検出されたワークの重量に基づいて、ロボットアーム2のエンドエフェクタ24が複数のワークを同時に吸引し保持した場合(図3(b))、あるいは、0個のワークを保持したと判定した場合に、ワークの保持が失敗したと判定する。
保持判定部33は、カメラにより撮影されたワークの画像に基づいて、ワークの保持が成功したか否かを判定してもよい。なお、保持判定部33は、上述の如く、力覚センサ5により検出されたワークの重量に基づいて、ワークの保持が成功したか否かを判定するのがより好ましい。これにより、簡易な処理でワーク保持の成功を高精度に判定できる。
保持判定部33は、上述のように判定したワーク保持の判定結果をロボット制御部32に出力する。
ところで、例えば、ワークの積載位置やワークを保持する際の吸引力などによっては、ワークの保持に失敗する可能性がある。その場合、再度ワークを保持する必要があるが、保持失敗の際にバラ積みされたワークが荷崩れするなどのワークの配置が変化していることが考え得る。このため、ワークの3次元情報を再度取得する必要が生じ、ワークの再保持により多くの時間を要する。
これに対し、本実施形態において、ロボット制御部32は、保持判定部33によりワークの保持が成功しなかったと判定された場合に、選択保持候補点に基づいて所定範囲を設定し、その所定範囲外にある他の保持候補点を選択し、その選択した他の保持候補点で、ワークを再度保持するようにロボットアーム2を制御する。
保持失敗した保持候補点から離れた位置にある所定範囲外の他の保持候補点のワークは、保持失敗によるワーク荷崩れで配置変化していないと考えられる。したがって、ロボット制御部32は、3次元ビジョンセンサ4により既に取得されたワークの3次元情報に基づいて、ロボットアーム2のエンドエフェクタ24が所定範囲外の他の保持候補点でワークを保持するように、ロボットアーム2を制御することができる。これにより、ワークの3次元情報を再度取得する必要が生じないため、短時間でワークの再保持を行うことができる。
ロボット制御部32は、保持判定部33によりワークの保持が成功しなかったと判定された場合に、選択保持候補点に基づいて所定範囲を設定する。例えば、ロボット制御部32は、図4に示す如く、選択保持候補点Xから所定距離以内の範囲を所定範囲(斜線部)Sとして設定する。ここで、所定距離は、エンドエフェクタ24の吸引力などに基づいて、実験的に求めた最適値が設定される。所定距離は、ロボット制御部32に予め設定されていてもよい。
ワークが斜めの傾斜面上に配置されている場合、保持失敗によるワーク荷崩れは斜面の傾斜方向に生じ易い。したがって、ロボット制御部32は、この斜面の傾斜方向を考慮して、選択保持候補点Xに基づいて所定範囲Sを設定してもよい。例えば、ロボット制御部32は、図5に示す如く、選択保持候補点Xから斜面の傾斜方向へ広がる領域を、所定範囲Sに設定してもよい。
また、後述の如く、ロボットアーム2のエンドエフェクタ24が複数のワークを同時に保持し、ワーク保持が成功しなかった場合に、エンドエフェクタ24はその保持した複数のワークを解放することとなる。
このとき、ロボット制御部32は、解放するワークの数に応じて、上記所定距離を変化させてもよい。解放するワークの数が増加するほど、そのワークによって荷崩れの範囲が拡大すると考えられる。したがって、ロボット制御部32は、解放するワークの数が増加するに従って、上記所定距離を増加させてもよい。これにより、より高精度に所定範囲Sを設定し、より確実に荷崩れの影響のない所定範囲外の他の保持候補点を選択できる。
同様に、ロボット制御部32は、解放するワークの重量又は大きさに応じて、上記所定距離を変化させてもよい。解放するワークの重量又は大きさが増加すると、そのワークによって荷崩れの範囲が拡大すると考えられる。したがって、ロボット制御部32は、解放するワークの重量又は大きさが増加するに従って、上記所定距離を増加させてもよい。これにより、より高精度に所定範囲Sを設定し、より確実に荷崩れの影響のない所定範囲外の他の保持候補点を選択できる。
保持判定部33は、上述の如く、ロボットアーム2のエンドエフェクタ24が複数のワークを同時に吸引し保持した場合に、ワークの保持が成功しなかったと判定する。ロボット制御部32は、この保持判定部33の判定に応じて、エンドエフェクタ24が複数のワークを解放するようにロボットアーム2を制御する。
このとき、ワークが斜めの傾斜面上に配置されている場合、ロボット制御部32は、この傾斜面を考慮して、エンドエフェクタ24の位置をオフセットさせた後、エンドエフェクタ24がワークを解放するようにロボットアーム2を制御してもよい。
傾斜面上にワークを置いた場合、ワークはこの傾斜面に沿ってずれることが想定される。したがって、ロボット制御部32は、この傾斜面によるワークのずれ量だけ、エンドエフェクタ24の位置をオフセットさせた後、エンドエフェクタ24がワークを解放するようにロボットアーム2を制御してもよい。
ロボット制御部32は、エンドエフェクタ24の位置をオフセットさせ、そのオフセット位置が所定範囲S以内にあると判定すると、エンドエフェクタ24がワークを解放するようにロボットアーム2を制御する。一方、ロボット制御部32は、オフセット位置が所定範囲以外にあると判定した場合、オフセット位置を所定範囲S以内に入れる調整をした後、そのオフセット位置でエンドエフェクタ24がワークを解放するようにロボットアーム2を制御する。
このような制御を行うことで、ワーク解放による荷崩れの影響を所定範囲S内に収めることができ、所定範囲外でのワーク解放による荷崩れの影響を抑制できる。したがって、より確実に荷崩れの影響のない所定範囲外の他の保持候補点でワークを再保持できる。
ロボット制御部32は、上述の如く、エンドエフェクタ24がワークを解放した後、所定範囲外の他の保持候補点で、ワークを再度保持するようにロボットアーム2を制御する。
ここで、例えば、図4に示す如く、所定範囲外S1の他の保持候補点X1が複数存在する場合、ロボット制御部32は、所定範囲外S1の複数の他の保持候補点X1の中から、選択保持候補点Xから最も離れた他の保持候補点X1を選択し、その他の保持候補点X1でワークを再度保持するようにロボットアーム2を制御する。これにより、より荷崩れの影響のない所定範囲外の他の保持候補点でワークを再保持できる。
続いて、本実施形態に係るワーク保持方法について説明する。図6は、本実施形態に係るワーク保持方法のフローを示すフローチャートである。なお、図6に示す制御処理を所定時間毎に繰り返し実行される。
3次元ビジョンセンサ4は、ワークの3次元情報を取得し、制御装置3に対して出力する(ステップS101)。
制御装置3の候補算出部31は、3次元ビジョンセンサ4により取得されたワークの3次元情報に基づいて、ロボットハンドのエンドエフェクタ24の保持候補点を複数算出する(ステップS102)。
ロボット制御部32は、候補算出部31により算出された複数の保持候補点の中から1つの保持候補点を選択する(ステップS103)。ロボット制御部32は、3次元ビジョンセンサ4により取得されたワークの3次元情報に基づいて、ロボットアーム2のエンドエフェクタ24が選択保持候補点でワークを保持するように、ロボットアーム2を制御する(ステップS104)。
保持判定部33は、上述のロボット制御部32によるロボットアーム2の制御によって、ワークの保持が成功したか否かを判定する(ステップS105)。
ロボット制御部32は、保持判定部33によりワークの保持が成功しなかったと判定された場合に(ステップS105のNO)、選択保持候補点に基づいて所定範囲を設定する(ステップS106)。ロボット制御部32は、所定範囲の外側にある他の保持候補点を選択する(ステップS107)。ロボット制御部32は、その選択した他の保持候補点で、ワークを再度保持するようにロボットアーム2を制御する(ステップS108)。
一方で、ロボット制御部32は、保持判定部33によりワークの保持が成功したと判定された場合に(ステップS105のYES)、本処理を終了する。
以上、本実施形態に係るワーク保持装置1は、ワークの保持が成功しなかったと判定した場合に、選択保持候補点に基づいて所定範囲を設定し、その所定範囲外にある他の保持候補点を選択し、その選択した他の保持候補点で、ワークを再度保持するようにロボットアーム2を制御する。
ワーク保持装置1は、ワークの保持に失敗した場合、3次元ビジョンセンサ4により既に取得されたワークの3次元情報に基づいて、ロボットアーム2のエンドエフェクタ24が所定範囲外の他の保持候補点でワークを保持するように、ロボットアーム2を制御することができる。これにより、ワークの3次元情報を再度取得する必要が生じないため、短時間でワークの再保持を行うことができる。
本発明は、例えば、図6に示す処理を、プロセッサにコンピュータプログラムを実行させることにより実現することも可能である。
プログラムは、様々なタイプの非一時的なコンピュータ可読媒体(non-transitory computer readable medium)を用いて格納され、コンピュータに供給することができる。非一時的なコンピュータ可読媒体は、様々なタイプの実体のある記録媒体(tangible storage medium)を含む。非一時的なコンピュータ可読媒体の例は、磁気記録媒体(例えばフレキシブルディスク、磁気テープ、ハードディスクドライブ)、光磁気記録媒体(例えば光磁気ディスク)、CD-ROM(Read Only Memory)、CD-R、CD-R/W、半導体メモリ(例えば、マスクROM、PROM(Programmable ROM)、EPROM(Erasable PROM)、フラッシュROM、RAM(random access memory))を含む。
プログラムは、様々なタイプの一時的なコンピュータ可読媒体(transitory computer readable medium)によってコンピュータに供給されてもよい。一時的なコンピュータ可読媒体の例は、電気信号、光信号、及び電磁波を含む。一時的なコンピュータ可読媒体は、電線及び光ファイバ等の有線通信路、又は無線通信路を介して、プログラムをコンピュータに供給できる。
上述した各実施形態に係る制御部を構成する各部は、プログラムにより実現するだけでなく、その一部または全部を、ASIC(Application Specific Integrated Circuit)やFPGA(Field-Programmable Gate Array)などの専用のハードウェアにより実現することもできる。
1 ワーク保持装置、2 ロボットアーム、3 制御装置、3a プロセッサ、3b 内部メモリ、3c ストレージデバイス、4 3次元ビジョンセンサ、5 力覚センサ、
21 リンク、23 関節部、24 エンドエフェクタ、31 候補算出部、32 ロボット制御部、33 保持判定部
21 リンク、23 関節部、24 エンドエフェクタ、31 候補算出部、32 ロボット制御部、33 保持判定部
Claims (8)
- 3次元空間に置かれた複数のワークの中から1つずつワークを保持する保持手段と、
前記複数のワークの3次元情報を取得する情報取得手段と、
前記情報取得手段により取得されたワークの3次元情報に基づいて、前記保持手段がワークを保持する際の該ワークの保持点の候補である保持候補点を複数算出する候補算出手段と、
前記候補算出手段により算出された複数の保持候補点の中から1つの保持候補点を選択し、該選択した保持候補点で、前記ワークを保持するように前記保持手段を制御する制御手段と、
前記制御手段による前記保持手段の制御によって、前記ワークの保持が成功したか否かを判定する判定手段と、
を備え、
前記制御手段は、前記判定手段によりワークの保持が成功しなかったと判定された場合に、前記選択された保持候補点に基づいて所定範囲を設定し、該所定範囲外にある他の保持候補点を選択し、該選択した他の保持候補点で、前記ワークを再度保持するように前記保持手段を制御する、
ワーク保持装置。 - 請求項1記載のワーク保持装置であって、
前記判定手段は、前記保持手段が複数のワークを同時に保持した場合に、前記ワークの保持が成功しなかったと判定し、
前記制御手段は、前記判定手段によりワークの保持が成功しなかったと判定された場合に、前記ワークを解放するように前記保持手段を制御した後、前記他の保持候補点で、前記ワークを再度保持するように前記保持手段を制御する、
ワーク保持装置。 - 請求項1又は2記載のワーク保持装置であって、
前記保持手段がワークを保持した時の該ワークの重量を検出する重量検出手段を更に備え、
前記判定手段は、前記重量検出手段により検出されたワークの重量に基づいて、前記ワークの保持が成功したか否かを判定する、
ワーク保持装置。 - 請求項1乃至3のうちいずれか1項記載のワーク保持装置であって、
前記保持手段は、前記ワークを非接触状態で吸引し保持する、
ワーク保持装置。 - 請求項2記載のワーク保持装置であって、
前記制御手段は、
前記判定手段によりワークの保持が成功しなかったと判定された場合に、前記選択された保持候補点から所定距離以内の範囲を前記所定範囲に設定し、
前記解放するワークの数、重量、又は、大きさに応じて、前記所定距離を変化させる、
ワーク保持装置。 - 3次元空間に置かれた複数のワークの3次元情報を取得するステップと、
前記取得されたワークの3次元情報に基づいて、保持手段がワークを保持する際の該ワークの保持点の候補である保持候補点を複数算出するステップと、
前記算出された複数の保持候補点の中から1つの保持候補点を選択し、該選択した保持候補点で、前記ワークを保持するように前記保持手段を制御するステップと、
前記保持手段の制御によって、前記ワークの保持が成功したか否かを判定するステップと、
前記ワークの保持が成功しなかったと判定された場合に、前記選択された保持候補点に基づいて所定範囲を設定し、該所定範囲外にある他の保持候補点を選択し、該選択した他の保持候補点で、前記ワークを再度保持するように前記保持手段を制御するステップと、
を含む、ワーク保持方法。 - 3次元空間に置かれた複数のワークの3次元情報を取得する処理と、
前記取得されたワークの3次元情報に基づいて、保持手段がワークを保持する際の該ワークの保持点の候補である保持候補点を複数算出する処理と、
前記算出された複数の保持候補点の中から1つの保持候補点を選択し、該選択した保持候補点で、前記ワークを保持するように前記保持手段を制御する処理と、
前記保持手段の制御によって、前記ワークの保持が成功したか否かを判定する処理と、
前記ワークの保持が成功しなかったと判定された場合に、前記選択された保持候補点に基づいて所定範囲を設定し、該所定範囲外にある他の保持候補点を選択し、該選択した他の保持候補点で、前記ワークを再度保持するように前記保持手段を制御する処理と、
をコンピュータに実行させる、プログラム。 - 3次元空間に置かれた複数のワークの3次元情報に基づいて、保持手段がワークを保持する際の該ワークの保持点の候補である保持候補点を複数算出する候補算出手段と、
前記候補算出手段により算出された複数の保持候補点の中から1つの保持候補点を選択し、該選択した保持候補点で、前記ワークを保持するように前記保持手段を制御する制御手段と、
前記制御手段による前記保持手段の制御によって、前記ワークの保持が成功したか否かを判定する判定手段と、
を備え、
前記制御手段は、前記判定手段によりワークの保持が成功しなかったと判定された場合に、前記選択された保持候補点に基づいて所定範囲を設定し、該所定範囲外にある他の保持候補点を選択し、該選択した他の保持候補点で、前記ワークを再度保持するように前記保持手段を制御する、
制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021148424A JP2023041201A (ja) | 2021-09-13 | 2021-09-13 | ワーク保持装置、ワーク保持方法、プログラム、及び制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021148424A JP2023041201A (ja) | 2021-09-13 | 2021-09-13 | ワーク保持装置、ワーク保持方法、プログラム、及び制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2023041201A true JP2023041201A (ja) | 2023-03-24 |
Family
ID=85641500
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2021148424A Pending JP2023041201A (ja) | 2021-09-13 | 2021-09-13 | ワーク保持装置、ワーク保持方法、プログラム、及び制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2023041201A (ja) |
-
2021
- 2021-09-13 JP JP2021148424A patent/JP2023041201A/ja active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10839261B2 (en) | Information processing apparatus, information processing method, and storage medium | |
EP3869464B1 (en) | Learning apparatus and learning method | |
JP5927259B2 (ja) | 力制御を実行するロボットシステム | |
US9102063B2 (en) | Robot apparatus | |
JP6140204B2 (ja) | 3次元センサを備えた搬送ロボットシステム | |
JP5582126B2 (ja) | ワーク取出システム、ロボット装置および被加工物の製造方法 | |
KR102269710B1 (ko) | 파지력 설정 시스템, 파지력 설정 방법, 및 파지력 추정 시스템 | |
JP2016132521A (ja) | 荷役装置 | |
US20220088795A1 (en) | Manipulator controller, manipulator control method, and non-transitory computer-readable storage medium storing manipulator control program | |
JP2016055389A (ja) | 物品搬送システム | |
KR20210024445A (ko) | 미끄러짐 검출 장치 | |
CN113386122A (zh) | 测量参数的优化方法和装置以及计算机可读存储介质 | |
US10434649B2 (en) | Workpiece pick up system | |
CN113966265A (zh) | 用于运行机器人的方法和系统 | |
JP6845671B2 (ja) | 部品実装装置及びその制御方法 | |
JP2023041201A (ja) | ワーク保持装置、ワーク保持方法、プログラム、及び制御装置 | |
JP2023041200A (ja) | ワーク保持装置、ワーク保持方法、プログラム、及び制御装置 | |
JP2023112730A (ja) | ワーク保持システム、ワーク保持方法、プログラム、及び制御装置 | |
US20210094136A1 (en) | Detection system for detecting workpiece | |
US20230111819A1 (en) | Workpiece holding apparatus, workpiece holding method, program, and control apparatus | |
KR20210021953A (ko) | 제어 장치, 제어 방법 및 프로그램 | |
TWI833477B (zh) | 基板運送機器人的控制裝置以及關節馬達的控制方法 | |
JP7303454B2 (ja) | コントローラ | |
JP2023073828A (ja) | ワーク取出し装置、ワーク取出し方法、プログラム及び制御装置 | |
JP2022164308A (ja) | システム、製造方法、制御方法、プログラム、媒体 |