JP7493425B2 - Gripping system and gripping device control method - Google Patents
Gripping system and gripping device control method Download PDFInfo
- Publication number
- JP7493425B2 JP7493425B2 JP2020170922A JP2020170922A JP7493425B2 JP 7493425 B2 JP7493425 B2 JP 7493425B2 JP 2020170922 A JP2020170922 A JP 2020170922A JP 2020170922 A JP2020170922 A JP 2020170922A JP 7493425 B2 JP7493425 B2 JP 7493425B2
- Authority
- JP
- Japan
- Prior art keywords
- gripping
- objects
- hand
- control
- contact
- 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
- 238000000034 method Methods 0.000 title claims description 32
- 238000010586 diagram Methods 0.000 description 32
- 230000036544 posture Effects 0.000 description 22
- 230000006870 function Effects 0.000 description 8
- 238000005516 engineering process Methods 0.000 description 4
- 239000007787 solid Substances 0.000 description 3
- 238000010276 construction Methods 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000001174 ascending effect Effects 0.000 description 1
- 239000012636 effector Substances 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
Images
Landscapes
- Manipulator (AREA)
Description
本発明は、物体を把持する把持装置を制御するシステム及び制御方法に関する。 The present invention relates to a system and a control method for controlling a gripping device that grips an object.
物流倉庫のピッキング作業、工場の製造作業、工事現場の建設作業、及び、災害現場の瓦礫撤去作業等、様々な作業においてロボットが活用されている。災害現場での瓦礫撤去作業では、ロボットアームを搭載したロボットが使用されている。ロボットアームは物体(ワーク)を把持するためのハンドを有する。 Robots are used in a variety of tasks, such as picking work in logistics warehouses, manufacturing work in factories, construction work at construction sites, and rubble removal work at disaster sites. Robots equipped with robotic arms are used for rubble removal work at disaster sites. Robotic arms have hands for grasping objects (workpieces).
ロボットアームが安定した状態で物体を把持するための技術として特許文献1に記載の技術が知られている。特許文献1には「ロボットハンド11は、第1指部21と第2指部41とを有し、前記第1指部は、互いに平行な軸の回りに回転する第1関節23および第2関節25と、先端部に第1把持面33とを備え、前記第2指部は先端部に第2把持面53を備える。そして、前記第1把持面および前記第2把持面は、前記第1関節および前記第2関節の回転運動によって正対可能に配置される。そして、前記第1把持面と前記第2把持面によって対象物を把持した状態で、前記第1把持面と前記第2把持面とを相対的に、少なくとも2方向にスライド運動可能とする第3関節27および第4関節43が、それぞれ前記第1指部または前記第2指部に設けられている。」ことが記載されている。
The technology described in
また、ロボットアームの作業スピードを向上させるための技術として特許文献2に記載の技術が知られている。特許文献2には「複数の指体20により把持対象物Xを把持するようにしたエンドエフェクタ1において、複数の指体20のうち、少なくとも一つの指体20には、把持対象物Xに接触する把持面aを移動させる搬送部20cを備えている。そして、搬送部20cは、把持面aに略直交する軸を中心にして駆動回転するように構成する。」ことが記載されている。
Furthermore, the technology described in Patent Document 2 is known as a technology for improving the working speed of a robot arm. Patent Document 2 describes that "In an
従来のロボットアームが把持する物体は一つであるため、瓦礫撤去作業等、物体が大量にある作業では作業効率が低い。 Conventional robot arms can only grasp one object, making them inefficient when working on tasks involving large amounts of objects, such as removing rubble.
本発明は、同時に複数の物体を把持するようにロボットアームを搭載するロボット(把持装置)を制御するシステム及びその制御方法を提供する。 The present invention provides a system and a control method for controlling a robot (gripping device) equipped with a robot arm so as to grasp multiple objects simultaneously.
本願において開示される発明の代表的な一例を示せば以下の通りである。すなわち、把持システムであって、物体を把持するハンド、及び物体の状態を示す物体情報を取得する物体情報取得装置を有する把持装置と、前記把持装置を制御する制御装置と、を備え、前記ハンドは、独立に動く複数の指部を有し、少なくとも一つの前記指部は、前記指部の伸長方向に略平行な方向にモーメントを与えることによって接する物体を回転させる移動機構を有し、前記制御装置は、作業空間に存在する複数の物体の前記物体情報に基づいて、同時に把持する物体群を決定し、前記物体群を把持するための第1制御情報を生成し、前記把持装置に前記第1制御情報を送信し、前記ハンドによって把持された前記物体群の前記物体情報に基づいて、前記物体群に含まれ、かつ、前記移動機構に接する物体の中から、回転させる対象物体を決定し、前記物体群を把持する二つの前記指部を結び、かつ、前記モーメントの向きと平行な制御面における前記対象物体の長手方向が前記ハンドが与える把持力の方向と略平行となるように前記対象物体を回転させるための第2制御情報を生成し、前記把持装置に前記第2制御情報を送信する。 A representative example of the invention disclosed in this application is as follows: That is, the gripping system includes a gripping device having a hand that grips an object and an object information acquisition device that acquires object information indicating the state of the object, and a control device that controls the gripping device, the hand has multiple fingers that move independently, and at least one of the fingers has a movement mechanism that rotates an object in contact by applying a moment in a direction approximately parallel to the extension direction of the fingers, the control device determines a group of objects to be simultaneously gripped based on the object information of multiple objects present in a working space, generates first control information for gripping the group of objects, transmits the first control information to the gripping device, determines a target object to be rotated from among objects included in the group of objects and in contact with the movement mechanism based on the object information of the group of objects gripped by the hand, generates second control information for connecting the two fingers that grip the group of objects, and rotates the target object so that the longitudinal direction of the target object on a control plane parallel to the direction of the moment is approximately parallel to the direction of the gripping force applied by the hand, and transmits the second control information to the gripping device.
本発明によれば、把持装置は、同時に複数の物体を安定した状態で把持することができる。上記した以外の課題、構成及び効果は、以下の実施例の説明により明らかにされる。 According to the present invention, the gripping device can simultaneously grip multiple objects in a stable manner. Problems, configurations, and effects other than those described above will become clear from the description of the embodiments below.
以下、本発明の実施例を、図面を用いて説明する。ただし、本発明は以下に示す実施例の記載内容に限定して解釈されるものではない。本発明の思想ないし趣旨から逸脱しない範囲で、その具体的構成を変更し得ることは当業者であれば容易に理解される。 The following describes an embodiment of the present invention with reference to the drawings. However, the present invention should not be interpreted as being limited to the description of the embodiment shown below. It will be easily understood by those skilled in the art that the specific configuration can be changed without departing from the concept or spirit of the present invention.
以下に説明する発明の構成において、同一又は類似する構成又は機能には同一の符号を付し、重複する説明は省略する。 In the configuration of the invention described below, the same or similar configurations or functions are given the same reference symbols, and duplicate explanations are omitted.
本明細書等における「第1」、「第2」、「第3」等の表記は、構成要素を識別するために付するものであり、必ずしも、数又は順序を限定するものではない。 The terms "first," "second," "third," and the like used in this specification are used to identify components and do not necessarily limit the number or order.
図面等において示す各構成の位置、大きさ、形状、及び範囲等は、発明の理解を容易にするため、実際の位置、大きさ、形状、及び範囲等を表していない場合がある。したがって、本発明では、図面等に開示された位置、大きさ、形状、及び範囲等に限定されない。 The position, size, shape, range, etc. of each component shown in the drawings, etc. may not represent the actual position, size, shape, range, etc., in order to facilitate understanding of the invention. Therefore, the present invention is not limited to the position, size, shape, range, etc. disclosed in the drawings, etc.
図1は、実施例1の把持システムの構成の一例を示す図である。図2は、実施例1の計算機の構成の一例を示す図である。図3は、実施例1の把持装置が有するハンドの構造の一例を示す図である。 Figure 1 is a diagram showing an example of the configuration of a gripping system according to the first embodiment. Figure 2 is a diagram showing an example of the configuration of a computer according to the first embodiment. Figure 3 is a diagram showing an example of the structure of a hand of a gripping device according to the first embodiment.
把持システム100は、把持装置101及び計算機102から構成される。把持装置101及び計算機102は、ネットワークを介して互いに通信する。ネットワークは、例えば、WAN(Wide Area Network)及びLAN(Local Area Network)等である。
The gripping system 100 is composed of a
計算機102は、把持装置101から各種情報を取得し、把持装置101を制御するための制御情報を生成し、把持装置101に制御情報を送信する。
The
図2に示すように、計算機102は、プロセッサ200、主記憶装置201、副記憶装置202、ネットワークインタフェース203、及びIOインタフェース204を有する。各要素は内部バスを介して互いに接続される。
As shown in FIG. 2, the
なお、計算機102のハードウェア構成は一例であってこれに限定されない。例えば、計算機102は、図示しないハードウェアを有してもよいし、副記憶装置202及びIOインタフェース204等の一部のハードウェアを有していなくてもよい。
Note that the hardware configuration of the
プロセッサ200は、主記憶装置201に格納されるプログラムを実行する。プロセッサ200がプログラムにしたがって処理を実行することによって、特定の機能を実現する機能部(モジュール)として動作する。
The
主記憶装置201は、DRAM(Dynamic Random Access Memory)等の記憶装置であり、プロセッサ200が実行するプログラム及びプログラムが使用する情報を格納する。また、主記憶装置201は、プログラムが使用するワークエリアとしても用いられる。
The
なお、プログラム及び情報は副記憶装置202等、主記憶装置201以外のデバイス又は装置に格納されてもよい。この場合、プロセッサ200が、デバイス又は装置からプログラム及び情報を読み出し、主記憶装置201にロードする。
The programs and information may be stored in a device or apparatus other than the
副記憶装置202は、HDD(Hard Disk Drive)及びSSD(Solid State Drive)等の記憶装置であり、データを永続的に格納する。
The
ネットワークインタフェース203は、ネットワークを介して把持装置101等の外部装置と通信するためのインタフェースである。
The
IOインタフェース204は、入力装置及び出力装置等に接続するためのインタフェースである。なお、入力装置は、キーボード、マウス、及びタッチパネル等であり、出力装置は、ディスプレイ及びプリンタ等である。
The
把持装置101は、物流倉庫、災害現場、及び工場等の作業空間において物体150の把持作業を行う。実施例1の把持装置101は、地面の上にある二つの物体150-1、150-2を同時に把持する。作業空間は3次元座標系で表される。図1では、横方向をx軸、奥行き方向をy軸、縦方向をz軸と定義する。
The
把持装置101は、コントローラ111、マニピュレータ112、物体情報取得装置113、及びハンド114から構成される。なお、把持装置101は、タイヤ及びモータ等の移動装置を有しているが、図からは省略している。
The
コントローラ111は、計算機102から受信した制御情報に基づいて、把持装置101全体を制御する。
The
物体情報取得装置113は、作業空間の全体及び一部の領域の少なくともいずれかから、物体150の状態を示す物体情報を取得する。物体情報取得装置113は、例えば、画像を取得するカメラである。物体情報には、物体150の大きさ、形状、姿勢、及び、配置等に関するデータが含まれる。
The object
なお、把持装置101は、同一種類の物体情報を取得する物体情報取得装置113を複数有してもよいし、また、異なる種類の物体情報を取得する物体情報取得装置113を複数有してもよい。
The
マニピュレータ112は、リンク及びジョイントから構成される。マニピュレータ112は、ジョイントを支点にリンクを所定の方向に移動させるための駆動装置(図示省略)を有する。
The
ハンド114は、物体150を把持するための複数の指部300を有する。また、ハンド114は、指部300を開閉する駆動装置(図示省略)を有する。なお、ハンド114は力覚センサ及び触覚センサ等を有してもよい。
The
ここで、図3を用いてハンド114の詳細な構造について説明する。なお、図3は、ハンド114をxz平面から見た図である。
Here, the detailed structure of the
ハンド114は、指部300と物体150とが接する面に対して略垂直な方向に指部300を開閉することによって、物体150に力(把持力)を加える。図3の実線の矢印は指部300の開閉方向、すなわち、把持力の向きを示す。
The
少なくとも一つの指部300は移動機構301を有する。移動機構301は、指部300の伸長方向と略平行な方向に移動する。移動機構301が移動することによって、移動機構301に接する物体150に対して移動方向にモーメントが加わり、物体150が回転する。図3の破線の矢印は移動機構301の移動方向を示す。
At least one
なお、本発明はハンド114の形態に限定されない。物体150を把持できる形態であればよい。また、移動機構301は前述した方向にモーメントを与えることができるベルトコンベアでもよい。
The present invention is not limited to the shape of the
図4は、実施例1の計算機102が実行する処理の一例を説明するフローチャートである。図5A及び図5Bは、実施例1の把持装置101が実行する把持作業の流れの一例を示す図である。
Figure 4 is a flowchart illustrating an example of processing executed by the
計算機102は、イベントを検知した場合、又は周期的に以下で説明する処理を実行する。イベントは、ユーザからの実行指示の受信及び把持装置101による物体150の検知等である。
The
計算機102は、把持装置101から、作業空間に存在する物体150の物体情報を取得する(ステップS101)。物体情報を取得する範囲は、計算機102を操作するユーザが決定してもよいし、また、把持装置101のコントローラ111が決定してもよい。
The
次に、計算機102は、物体情報に基づいて、把持する複数の物体150(物体群)を決定し、物体群を把持し、所定の高さに持ち上げるための制御情報を生成する(ステップS102)。
Next, the
例えば、計算機102は、物体群を同時に把持するための把持位置を算出し、また、把持位置への軌道計画を生成する。さらに、計算機102は、把持位置への軌道計画を含む制御情報を生成する。ここで、把持位置への軌道計画は、ハンド114を把持位置まで移動させるためのマニピュレータ112及び把持装置101の移動軌道に関する情報である。
For example, the
次に、計算機102は、把持装置101に制御情報を送信することによって、物体群の把持を指示する(ステップS103)。
Next, the
把持装置101のコントローラ111は、受信した制御情報に基づいて、把持装置101を物体群の近くまで移動させ、マニピュレータ112及びハンド114を制御して、ハンド114に物体群を把持させる。なお、コントローラ111は、物体群に含まれる各物体150が接した状態を維持するように物体群に把持力を加えている。
Based on the received control information, the
次に、計算機102は、把持装置101から、ハンド114内の物体群の物体情報を取得する(ステップS104)。ここでは、ハンド114をxz平面から見た物体群の物体情報が取得されるものとする。
Next, the
次に、計算機102は、取得した物体情報に基づいて、物体群に含まれる物体150の中から回転させる物体150(対象物体150)を決定し、対象物体150を回転させるための制御情報を生成する(ステップS105)。実施例1では、対象物体150は一つであるものとする。ここで、ステップS105の処理の詳細について説明する。
Next, the
(S105-1)計算機102は、物体情報に基づいて、移動機構301に接している物体150を特定し、特定された物体150のリストを生成する。
(S105-1) The
(S105-2)計算機102は、物体情報に基づいて、物体群を把持する二つの指部300を結び、かつ、モーメントの向きと平行な面(xz平面)における、移動機構301に接している物体150の長手方向を特定する。本明細書では、物体群を把持する二つの指部300を結び、かつ、モーメントの向きと平行な面における物体150の長手方向を、単に物体150の長手方向と記載する。また、前述の面における物体150の短手方向を、単に物体150の短手方向と記載する。
(S105-2) Based on the object information, the
(S105-3)計算機102は、移動機構301に接している物体150の中から、長手方向が把持力の向き(指部300の開閉方向)と略平行である物体150を特定する。例えば、計算機102は、長手方向と把持力の向きとの角度差が閾値より小さい物体150を特定する。計算機102は、前述の条件を満たす物体150をリストから削除する。計算機102は、リストに残った物体150を対象物体150に決定する。
(S105-3) The
(S105-4)計算機102は、対象物体150の長手方向が把持力の向きに略平行となるように対象物体150を回転させるための制御情報を生成する。制御情報には、少なくとも、対象物体150の識別情報(例えば、指部300の識別情報等)、回転方向、及び回転角度が含まれる。このとき、計算機102は、対象物体150と対象物体150に接する他の物体150(接触物体150)とが接触した状態が保たれるように、回転方向及び回転角度を算出する。
(S105-4) The
なお、対象物体150の長手方向が把持力の向きに略平行になるように回転させると、対象物体150及び接触物体150が接触した状態を保てない場合、計算機102は、対象物体150を回転させなくてもよいし、対象物体150の短手方向と把持力の向きが略平行となるように、回転方向呼び回転角度を算出してもよい。
Note that if the target object 150 and the contacting object 150 cannot maintain contact when the target object 150 is rotated so that the longitudinal direction of the target object 150 is approximately parallel to the direction of the gripping force, the
以上が、ステップS105の処理の説明である。 This concludes the explanation of the processing in step S105.
次に、計算機102は、把持装置101に制御情報を送信することによって、対象物体150の姿勢制御を指示する(ステップS106)。その後、計算機102は処理を終了する。
Next, the
把持装置101のコントローラ111は、受信した制御情報に基づいて、対象物体150と接する移動機構301を操作する。なお、コントローラ111は、力覚センサの値が一定以上になるようにハンド114を制御する。すなわち、対象物体150及び接触物体150が接触した状態が保たれるようにハンド114が制御される。
The
なお、計算機102は、ステップS106の処理の後、物体群を所定の位置に移動させるための制御情報を生成し、把持装置101に送信してもよい。
After processing in step S106, the
ステップS104において、ハンド114内の物体群が図5Aに状態である場合、計算機102は、物体150-2を対象物体150に決定する。ステップS105では、計算機102は、物体150-2の長手方向が把持力の向きと平行となるように物体150-2を反時計回りに回転させるための制御情報を生成する。把持装置101のコントローラ111は、制御情報に基づいて、物体150-2と接する移動機構301を上方向に移動させることによって物体150-2を回転させる。これによって、ハンド114内の物体群は図5Bに示すような状態になる。
In step S104, if the group of objects in the
図6A、図6B、及び図6Cは、実施例1の把持装置101が行う物体150の姿勢制御の原理を説明する図である。
Figures 6A, 6B, and 6C are diagrams explaining the principle of the attitude control of the object 150 performed by the
ここでは、ハンド114が二つの物体150-1、150-2を把持する場合を一例として物体150の姿勢制御の原理を説明する。
Here, the principle of controlling the attitude of object 150 will be explained using an example in which
面600-1は、姿勢制御の実行前における、物体150-1と接する移動機構301が形成する平面を表す。面600-2は、姿勢制御の実行後における、物体150-1と接する移動機構301が形成する平面を表す。面610-1は、姿勢制御の実行前における、物体150-2と接する移動機構301が形成する平面を表す。面610-2は、姿勢制御の実行後における、物体150-2と接する移動機構301が形成する平面を表す。
Surface 600-1 represents the plane formed by the moving
図6Aは、対象物体150の断面の形状が長方形である場合の物体150の姿勢制御を示す。物体150-2(A)は姿勢制御の実行前の物体150-2の状態を表し、物体150-2(B)は姿勢制御の実行後の物体150-2の状態を表す。 Figure 6A shows the attitude control of object 150 when the cross-sectional shape of target object 150 is rectangular. Object 150-2 (A) represents the state of object 150-2 before attitude control is performed, and object 150-2 (B) represents the state of object 150-2 after attitude control is performed.
姿勢制御の実行前では、物体150-1は長手方向が把持力の向きと平行であるが、物体150-2(A)は長手方向が把持力の向きと平行ではない。この場合、物体150-2(A)が対象物体150に決定される。 Before posture control is performed, the longitudinal direction of object 150-1 is parallel to the direction of the gripping force, but the longitudinal direction of object 150-2(A) is not parallel to the direction of the gripping force. In this case, object 150-2(A) is determined to be the target object 150.
物体150-2(A)は、物体150-1及び物体150-2(A)の接点を中心に時計回り又は反時計回りに回転できる。物体150-2(A)を時計回りに回転させた場合、物体150-2の長手方向は把持力の向きと垂直になり、物体150-2(A)を反時計回りに回転させた場合、物体150-2の長手方向は把持力の向きと平行になる。 Object 150-2(A) can be rotated clockwise or counterclockwise around the contact point between object 150-1 and object 150-2(A). When object 150-2(A) is rotated clockwise, the longitudinal direction of object 150-2 becomes perpendicular to the direction of the gripping force, and when object 150-2(A) is rotated counterclockwise, the longitudinal direction of object 150-2 becomes parallel to the direction of the gripping force.
ハンド114内の物体群(物体150-1、150-2)は、把持力により生じる、物体150及び移動機構301の間の摩擦力と、物体150間の摩擦力とによって固定されている。
The group of objects (objects 150-1, 150-2) in the
ここで、物体150-2に接する移動機構301が形成する平面について、姿勢制御前後の把持力の向きの移動量を考える。物体150-2の回転軌道は、物体150-1及び物体150-2の接点を中心とし、物体150-2の対角線を半径Pとする円弧を描く。接点をx軸の原点とした場合、物体150-2に接する移動機構301が形成する平面のx軸の位置はPcos(α)と表せる。αはx軸に対する角度を表す。
Now, consider the amount of movement in the direction of the gripping force before and after posture control for the plane formed by the moving
物体150-2の長手方向と把持力の向きとが垂直となる方向に角度θだけ回転された場合、角度変化に対する平面の位置の変化は大きい。このとき、把持力により生じる摩擦力の変化も大きくなるため、物体150-2は不安定な状態となる。一方、物体150-2の長手方向と把持力の向きとが平行となる方向に角度θだけ回転させた場合、角度変化に対する平面の位置の変化は小さい。このとき、把持力により生じる摩擦力の変化は小さいため、物体150-2は安定した状態となる。 When object 150-2 is rotated by angle θ in a direction in which the longitudinal direction of object 150-2 is perpendicular to the direction of the gripping force, the change in the position of the plane relative to the change in angle is large. At this time, the change in the frictional force caused by the gripping force is also large, so object 150-2 becomes unstable. On the other hand, when object 150-2 is rotated by angle θ in a direction in which the longitudinal direction of object 150-2 is parallel to the direction of the gripping force, the change in the position of the plane relative to the change in angle is small. At this time, the change in the frictional force caused by the gripping force is small, so object 150-2 becomes stable.
そこで、実施例1の把持装置101は、移動機構301と接する物体150の長手方向が把持力の向きと略平行となるように回転させる。具体的には、把持装置101は、物体150-2(B)のような状態になるように反時計回りに物体150-2(A)を回転させる。
Therefore, the
図6Bは、対象物体150の断面の形状が多角形である場合の物体150の姿勢制御を示す。姿勢制御の実行前では、物体150-1は長手方向が把持力の向きと平行であるが、物体150-2(A)は長手方向が把持力の向きと平行ではない。この場合、物体150-2(A)が対象物体150として特定される。 Figure 6B shows posture control of object 150 when the cross-sectional shape of target object 150 is polygonal. Before posture control is performed, object 150-1 has a longitudinal direction parallel to the direction of the gripping force, but object 150-2(A) has a longitudinal direction that is not parallel to the direction of the gripping force. In this case, object 150-2(A) is identified as the target object 150.
把持装置101は、前述した原理に基づいて、物体150-2(B)のような状態になるように時計回りに物体150-2(A)を回転させる。
Based on the principle described above, the
多角形は形状が複雑であるため、物体150の長手方向が把持力の向きとは完全に平行となる場合に、物体群が安定状態になるとは限らない。この場合、計算機102は、把持装置101から物体情報及び力覚センサの値に基づいて、ハンド114内の物体群の位置及び力の変化を一定時間監視し、ハンド114内の物体群の位置及び力の変化が小さくなるように対象物体150の回転方向及び回転量を調整する。
Since polygons have complex shapes, the group of objects will not necessarily be in a stable state when the longitudinal direction of the object 150 is completely parallel to the direction of the gripping force. In this case, the
図6Cは、対象物体150の断面の形状が楕円形である場合の物体150の姿勢制御の方式を示す。姿勢制御の実行前では、物体150-1は長手方向が把持力の向きと平行であるが、物体150-2(A)は長手方向が把持力の向きと平行ではない。この場合、物体150-2(A)が対象物体150に決定される。 Figure 6C shows a method of controlling the attitude of object 150 when the cross-sectional shape of target object 150 is elliptical. Before performing attitude control, object 150-1 has a longitudinal direction parallel to the direction of the gripping force, but object 150-2(A) has a longitudinal direction that is not parallel to the direction of the gripping force. In this case, object 150-2(A) is determined to be the target object 150.
把持装置101は、前述した原理に基づいて、物体150-2(B)のような状態になるように反時計回りに物体150-2(A)を回転させる。
Based on the principle described above, the
以上が、把持装置101が行う物体150の姿勢制御の原理の説明である。
The above explains the principle of the attitude control of the object 150 performed by the
実施例1では、把持装置101の制御内容を決定する計算機102と、物体150を把持する把持装置101とを別々に分けていたが、コントローラ111が計算機102の機能を備えるようにしてもよい。これによって、把持装置101は、自立的に物体150の把持作業を行うことができる。
In the first embodiment, the
実施例1によれば、把持装置101は、同時に、二つの物体150を安定した状態で把持することができる。これによって、把持作業の効率が向上し、作業時間も短縮できる。
According to the first embodiment, the
実施例2の把持システム100は、指部300及び物体150の接触面積を考慮して、物体150の姿勢を制御する。以下、実施例1との差異を中心に実施例2について説明する。
The gripping system 100 of the second embodiment controls the posture of the object 150 by taking into account the contact area between the
実施例2の把持システム100の構成は実施例1と同一である。実施例2の計算機102の構成は実施例1と同一である。実施例2のハンド114の構造は実施例1と同一である。
The configuration of the gripping system 100 in Example 2 is the same as that in Example 1. The configuration of the
実施例2では、計算機102が実行する処理の流れは実施例1と同一であるが、ステップS105の処理が異なる。具体的には、以下のような処理が実行される。
In the second embodiment, the flow of the process executed by the
(S105-10)計算機102は、物体情報に基づいて、移動機構301に接している物体150を特定する。計算機102は、物体情報に基づいて、特定された各物体150について、物体150及び移動機構301の接触面積を算出する。計算機102は、接触面積が閾値以下の物体150のリストを生成する。
(S105-10) The
(S105-11)計算機102は、物体情報に基づいて、リストに登録された物体150の長手方向を特定する。
(S105-11) The
(S105-12)計算機102は、リストに登録された物体150の中から、長手方向が把持力の向きと略平行である物体150を特定する。計算機102は、前述の条件を満たす物体150をリストから削除する。計算機102は、リストに残った物体150を対象物体150に決定する。
(S105-12) The
(S105-13)計算機102は、物体情報に基づいて、対象物体150の指部300と接触する面を特定し、特定された面の面積(接触面積)を算出する。対象物体150が複数存在する場合、各対象物体150について前述の処理が実行される。
(S105-13) Based on the object information, the
(S105-14)計算機102は、対象物体150の長手方向が把持力の向きと略平行となり、かつ、対象物体150及び指部300の接触面積が閾値より大きくなるように、回転方向及び回転角度を算出する。接触面積を考慮する理由は、接触面積が大きいと対象物体150が回転しにくくなるためである。
(S105-14) The
実施例2によれば、把持装置101は、二つの物体150をより安定した状態で把持することができる。
According to the second embodiment, the
実施例3の把持システム100は、物体150を把持する場合のハンド114の把持姿勢の角度を調整する。以下、実施例1との差異を中心に実施例3について説明する。
The gripping system 100 of the third embodiment adjusts the angle of the gripping posture of the
実施例3の把持システム100の構成は実施例1と同一である。実施例3の計算機102の構成は実施例1と同一である。実施例3のハンド114の構造は実施例1と同一である。
The configuration of the gripping system 100 in Example 3 is the same as that in Example 1. The configuration of the
実施例3では、計算機102が実行する処理の流れは実施例1と同一であるが、ステップS102の処理が異なる。具体的には、把持位置への軌道計画に、ハンド114の把持姿勢の角度が含まれる。
In the third embodiment, the process flow executed by the
例えば、ハンド114が移動機構301を有さない指部300を含む場合、当該指部300では物体150を回転させることができない。そのため、計算機102は、移動機構301を有さない指部300及び当該指部300に接する物体150の接触面積が閾値より大きくなるハンド114の把持姿勢の角度を算出する。接触面積が閾値より大きくなるハンド114の把持姿勢の角度が複数存在する場合、計算機102は接触面積が最も大きいハンド114の把持姿勢の角度を選択する。
For example, if the
ステップS101の処理及びステップS103以降の処理は実施例1と同一であるため、説明を省略する。 The processing in step S101 and the processing from step S103 onwards are the same as in Example 1, so the explanation will be omitted.
図7A、図7B、図7C、及び図7Dは、実施例3の把持装置101が実行する把持作業の流れの一例を示す図である。
Figures 7A, 7B, 7C, and 7D are diagrams showing an example of the flow of a gripping operation performed by the
図7Aに示すハンド114は、移動機構301を有さない指部300-1を有する。したがって、ステップS102では、計算機102は、指部300-1と物体150-1との接触面積が最も大きくなるようにハンド114の把持姿勢の角度を算出する。
The
図7Bに示すように、把持装置101は、ステップS102において生成された制御情報に基づいて、ハンド114を傾斜させながら物体群(物体150-1、150-2)に近づき、物体群を把持する。
As shown in FIG. 7B, the
ステップS105では、計算機102は、物体150-2を対象物体150に決定し、対象物体150の長手方向が把持力の向きと略平行となるように回転させるための制御情報を生成する。
In step S105, the
図7Cに示すように、把持装置101は、ステップS105において生成された制御情報に基づいて、指部300-2の移動機構301を制御することによって物体150-2を回転させる。これによって、ハンド114内の物体群は、図7Dに示すような状態になる。
As shown in FIG. 7C, the
実施例3によれば、把持装置101は、物体群に含まれる物体150の状態に合わせて、二つの物体150を安定した状態で把持することができる。
According to the third embodiment, the
実施例4では、対象物体150が複数存在する場合のハンド114内の物体群の姿勢制御について説明する。以下、実施例1との差異を中心に実施例4について説明する。
In Example 4, we will explain the posture control of a group of objects in the
実施例4の把持システム100の構成は実施例1と同一である。実施例4の計算機102の構成は実施例1と同一である。実施例4のハンド114の構造は実施例1と同一である。
The configuration of the gripping system 100 in Example 4 is the same as that in Example 1. The configuration of the
実施例4では、計算機102が実行する処理が異なる。図8は、実施例4の計算機102が実行する処理の一例を説明するフローチャートである。
In the fourth embodiment, the processing executed by the
ステップS101からステップS104までの処理は実施例1と同一である。 The processing from step S101 to step S104 is the same as in Example 1.
ステップS104の処理の後、計算機102は、N個の対象物体150を決定する(ステップS151)。Nは2以上の整数である。なお、対象物体150の決定方法は、実施例1と同一の方法であるため説明を省略する。
After the processing of step S104, the
次に、計算機102は、対象物体150の制御順番を決定する(ステップS152)。
Next, the
例えば、計算機102は、対象物体150の長手方向と把持力の向きとの角度差に基づいて、対象物体150の制御順番を決定する。ここでは、前述の角度差が小さい順に制御順番が決定されるものとする。計算機102は、対象物体150を制御順番でソートする。
For example, the
なお、対象物体150の制御順番の決定方法は前述のものに限定されない。物体150の大きさ及び形状、並びに、ハンド114内の物体150の相対位置等に基づいて対象物体150の制御順番が決定されてもよい。
The method of determining the control order of the target object 150 is not limited to the above. The control order of the target object 150 may be determined based on the size and shape of the object 150, the relative position of the object 150 in the
次に、計算機102は、制御順番を表す変数kに初期値「1」を設定する(ステップS153)。
Next, the
次に、計算機102は、変数kに対応する対象物体150の制御情報を生成する(ステップS154)。具体的には、計算機102は、対象物体150の長手方向及び把持力の向きに基づいて、回転方向及び回転角度を算出する。
Next, the
次に、計算機102は、把持装置101に制御情報を送信することによって、対象物体150の姿勢制御を指示する(ステップS106)。
Next, the
次に、計算機102は、変数kがNに一致するか否かを判定する(ステップS155)。すなわち、全ての対象物体150の制御が完了したか否かが判定される。
Next, the
変数kがNに一致しないと判定された場合、計算機102は、変数kの値に1を加算し(ステップS156)。その後、ステップS154に戻る。
If it is determined that the variable k does not match N, the
このとき、計算機102は、把持装置101から、ハンド114内の物体群の物体情報を取得してもよい。これは、対象物体150の制御によって、他の対象物体150の状態が変化する可能性があるためである。
At this time, the
変数kがNに一致する場合、計算機102は処理を終了する。
If the variable k is equal to N, the
図9A、図9B、図9C、図9D、及び図9Eは、実施例4の把持装置101が実行する把持作業の流れの一例を示す図である。
Figures 9A, 9B, 9C, 9D, and 9E are diagrams showing an example of the flow of a gripping operation performed by the
物体150-1、150-2が図9Aに示すような状態で置かれているものとする。把持装置101は、ステップS102において生成された制御情報に基づいて、図9Bに示すように物体群(物体150-1、150-2)を把持する。
Assume that objects 150-1 and 150-2 are placed in the state shown in FIG. 9A. Based on the control information generated in step S102, the
ステップS151では、物体150-1、150-2が対象物体150に決定される。ステップS152では、物体150-1、150-2の順に制御順番が決定されたものとする。 In step S151, objects 150-1 and 150-2 are determined as target objects 150. In step S152, it is assumed that the control order is determined to be objects 150-1, 150-2 in that order.
図9Cに示すように、把持装置101は、ステップS154において生成された制御情報に基づいて、指部300-1の移動機構301を制御することによって物体150-1を回転させる。これによって、ハンド114内の物体群は、図9Dに示すような状態になる。
As shown in FIG. 9C, the
さらに、図9Dに示すように、把持装置101は、ステップS154において生成された制御情報に基づいて、指部300-2の移動機構301を制御することによって物体150-2を回転させる。これによって、ハンド114内の物体群は、図9Eに示すような状態になる。
Furthermore, as shown in FIG. 9D, the
実施例4によれば、把持装置101は、二つの物体150の各々を回転させることによって、二つの物体150を安定した状態で把持することができる。
According to the fourth embodiment, the
実施例5では、把持装置101が三つの物体150を同時に把持する。以下、実施例1との差異を中心に実施例5について説明する。
In Example 5, the
実施例5の把持システム100の構成は実施例1と同一である。実施例5の計算機102の構成は実施例1と同一である。実施例5のハンド114の構造は実施例1と同一である。
The configuration of the gripping system 100 in Example 5 is the same as that in Example 1. The configuration of the
実施例5では、計算機102が実行する処理の流れは実施例4と同一であるが、ステップS102の処理が異なる。具体的には、把持位置への軌道計画に、ハンド114の把持姿勢の角度が含まれる。
In the fifth embodiment, the process flow executed by the
ステップS102では、計算機102は、指部300に接しない物体150と、当該物体150に接する他の物体150との接触面が、指部300の接触面に対して略平行となるようにハンド114の把持姿勢の角度を算出する。
In step S102, the
図10A、図10B、及び図10Cは、実施例5の把持装置101が実行する把持作業の流れの一例を示す図である。
Figures 10A, 10B, and 10C are diagrams showing an example of the flow of a gripping operation performed by the
ステップS102では、物体150-2と他の物体150-1、150-3との接触面が、移動機構301が形成する平面に対して略平行になるようにハンド114の把持姿勢の角度が算出される。把持装置101は、ステップS102において生成された制御情報に基づいて、図10Aに示すように物体群(物体150-1、150-2、150-3)を把持する。
In step S102, the angle of the gripping posture of the
ステップS151では、物体150-1、150-3が対象物体150に決定される。ステップS152では、物体150-1、150-3の順に制御順番が決定されたものとする。 In step S151, objects 150-1 and 150-3 are determined as target objects 150. In step S152, it is assumed that the control order is determined to be objects 150-1, 150-3.
図10Aに示すように、把持装置101は、ステップS154において生成された制御情報に基づいて、指部300-1の移動機構301を制御することによって物体150-1を回転させる。これによって、ハンド114内の物体群は、図10Bに示すような状態になる。
As shown in FIG. 10A, the
さらに、図10Bに示すように、把持装置101は、ステップS154において生成された制御情報に基づいて、指部300-2の移動機構301を制御することによって物体150-3を回転させる。これによって、ハンド114内の物体群は、図10Cに示すような状態になる。
Furthermore, as shown in FIG. 10B, the
物体群に含まれる物体150の数が四つ以上であって、指部300に接しない物体150の姿勢がそろっている場合には、同様の処理によって複数の物体150を同時に把持することができる。
When the number of objects 150 included in the object group is four or more, and the postures of the objects 150 that are not in contact with the
実施例5によれば、把持装置101は、指部300に接する物体150の各々を回転させることによって、三つの物体150を安定した状態で把持することができる。
According to the fifth embodiment, the
実施例6は、物体群の大きさがハンド114の幅より大きい場合の把持装置101の把持作業について説明する。以下、実施例1との差異を中心に実施例6について説明する。
Example 6 describes the gripping operation of the
実施例6の把持システム100の構成は実施例1と同一である。実施例6の計算機102の構成は実施例1と同一である。実施例6のハンド114の構造は実施例1と同一である。
The configuration of the gripping system 100 in Example 6 is the same as that in Example 1. The configuration of the
図11は、実施例6の計算機102が実行する処理の一例を説明するフローチャートである。図12A、図12B、及び図12Cは、実施例6の把持装置101が実行する把持作業の流れの一例を示す図である。
Figure 11 is a flowchart illustrating an example of processing executed by the
計算機102は、把持装置101から、作業空間に存在する物体150の物体情報を取得する(ステップS201)。
The
次に、計算機102は、物体情報に基づいて、把持する複数の物体150(物体群)を決定し、物体群を把持するための制御情報を生成する(ステップS202)。
Next, the
ここで、図12Aに示すような状態の物体150-1、150-2を例に制御情報の生成について説明する。 Here, we will explain how to generate control information using objects 150-1 and 150-2 in the state shown in Figure 12A as an example.
計算機102は、物体150-1、150-2に移動機構301を接触させ、地面に接触させながら、物体150-1、150-2の短手方向と把持力の向きとが略平行となるように、物体150-1、150-2を回転させて、物体150-1、150-2を同時把持するための制御情報を生成する。
The
次に、計算機102は、把持装置101に制御情報を送信することによって、物体群の把持を指示する(ステップS203)。その後、計算機102は処理を終了する。
Next, the
把持装置101のコントローラ111は、受信した制御情報に基づいて、把持装置101を物体150の近くまで移動させる。把持装置101のコントローラ111は、図12Aに示すように、指部300-1の移動機構301が物体150-1に接触し、かつ、指部300-2の移動機構301が物体150-2に接触するようにハンド114を制御する。把持装置101のコントローラ111は、図12Bに示すように、物体150-1、150-2を地面に接触させながら、短手方向が把持力の向きと略平行となるようにハンド114及びマニピュレータ112を制御する。
The
以上の制御によって、ハンド114は、図12Cに示すような状態で、物体150-1、150-2を把持する。
By the above control, the
実施例6によれば、把持装置101は、物体群の大きさがハンド114の幅より大きい場合でも、複数の物体150を安定した状態で把持することができる。
According to the sixth embodiment, the
なお、本発明は上記した実施例に限定されるものではなく、様々な変形例が含まれる。また、例えば、上記した実施例は本発明を分かりやすく説明するために構成を詳細に説明したものであり、必ずしも説明した全ての構成を備えるものに限定されるものではない。また、各実施例の構成の一部について、他の構成に追加、削除、置換することが可能である。 The present invention is not limited to the above-described embodiments, but includes various modified examples. For example, the above-described embodiments are provided to explain the present invention in detail, and are not necessarily limited to those including all of the described configurations. In addition, it is possible to add, delete, or replace part of the configuration of each embodiment with another configuration.
また、上記の各構成、機能、処理部、処理手段等は、それらの一部又は全部を、例えば集積回路で設計する等によりハードウェアで実現してもよい。また、本発明は、実施例の機能を実現するソフトウェアのプログラムコードによっても実現できる。この場合、プログラムコードを記録した記憶媒体をコンピュータに提供し、そのコンピュータが備えるプロセッサが記憶媒体に格納されたプログラムコードを読み出す。この場合、記憶媒体から読み出されたプログラムコード自体が前述した実施例の機能を実現することになり、そのプログラムコード自体、及びそれを記憶した記憶媒体は本発明を構成することになる。このようなプログラムコードを供給するための記憶媒体としては、例えば、フレキシブルディスク、CD-ROM、DVD-ROM、ハードディスク、SSD(Solid State Drive)、光ディスク、光磁気ディスク、CD-R、磁気テープ、不揮発性のメモリカード、ROMなどが用いられる。 The above-mentioned configurations, functions, processing units, processing means, etc. may be realized in part or in whole by hardware, for example by designing them as integrated circuits. The present invention can also be realized by software program code that realizes the functions of the embodiments. In this case, a storage medium on which the program code is recorded is provided to a computer, and a processor included in the computer reads the program code stored in the storage medium. In this case, the program code itself read from the storage medium realizes the functions of the above-mentioned embodiments, and the program code itself and the storage medium on which it is stored constitute the present invention. Examples of storage media for supplying such program code include flexible disks, CD-ROMs, DVD-ROMs, hard disks, SSDs (Solid State Drives), optical disks, magneto-optical disks, CD-Rs, magnetic tapes, non-volatile memory cards, ROMs, etc.
また、本実施例に記載の機能を実現するプログラムコードは、例えば、アセンブラ、C/C++、perl、Shell、PHP、Python、Java(登録商標)等の広範囲のプログラム又はスクリプト言語で実装できる。 In addition, the program code that realizes the functions described in this embodiment can be implemented in a wide range of program or script languages, such as assembler, C/C++, perl, Shell, PHP, Python, Java (registered trademark), etc.
さらに、実施例の機能を実現するソフトウェアのプログラムコードを、ネットワークを介して配信することによって、それをコンピュータのハードディスクやメモリ等の記憶手段又はCD-RW、CD-R等の記憶媒体に格納し、コンピュータが備えるプロセッサが当該記憶手段や当該記憶媒体に格納されたプログラムコードを読み出して実行するようにしてもよい。 Furthermore, the program code of the software that realizes the functions of the embodiment may be distributed over a network and stored in a storage means such as a computer's hard disk or memory, or in a storage medium such as a CD-RW or CD-R, and the processor of the computer may read and execute the program code stored in the storage means or storage medium.
上述の実施例において、制御線や情報線は、説明上必要と考えられるものを示しており、製品上必ずしも全ての制御線や情報線を示しているとは限らない。全ての構成が相互に接続されていてもよい。 In the above examples, the control lines and information lines are those that are considered necessary for the explanation, and not all control lines and information lines in the product are necessarily shown. All components may be interconnected.
100 把持システム
101 把持装置
102 計算機
111 コントローラ
112 マニピュレータ
113 物体情報取得装置
114 ハンド
150 物体
200 プロセッサ
201 主記憶装置
202 副記憶装置
203 ネットワークインタフェース
204 IOインタフェース
300 指部
301 移動機構
100
Claims (13)
物体を把持するハンド、及び物体の状態を示す物体情報を取得する物体情報取得装置を有する把持装置と、
前記把持装置を制御する制御装置と、
を備え、
前記ハンドは、独立に動く複数の指部を有し、
少なくとも一つの前記指部は、前記指部の伸長方向に略平行な方向にモーメントを与えることによって接する物体を回転させる移動機構を有し、
前記制御装置は、
作業空間に存在する複数の物体の前記物体情報に基づいて、同時に把持する物体群を決定し、
前記物体群を把持するための第1制御情報を生成し、前記把持装置に前記第1制御情報を送信し、
前記ハンドによって把持された前記物体群の前記物体情報に基づいて、前記物体群に含まれ、かつ、前記移動機構に接する物体の中から、回転させる対象物体を決定し、
前記物体群を把持する二つの前記指部を結び、かつ、前記モーメントの向きと平行な制御面における前記対象物体の長手方向が前記ハンドが与える把持力の方向と略平行となるように前記対象物体を回転させるための第2制御情報を生成し、前記把持装置に前記第2制御情報を送信することを特徴とする把持システム。 1. A gripping system comprising:
a gripping device having a hand for gripping an object and an object information acquisition device for acquiring object information indicating a state of the object;
A control device that controls the gripping device;
Equipped with
The hand has a plurality of fingers that can move independently,
At least one of the fingers has a movement mechanism that rotates an object in contact with the finger by applying a moment in a direction substantially parallel to an extension direction of the finger,
The control device includes:
determining a group of objects to be simultaneously grasped based on the object information of a plurality of objects present in a working space;
generating first control information for gripping the object group and transmitting the first control information to the gripping device;
determining a target object to be rotated from among objects included in the group of objects and in contact with the moving mechanism based on the object information of the group of objects held by the hand;
A gripping system characterized by generating second control information for connecting the two finger portions that grip the group of objects and rotating the target object so that the longitudinal direction of the target object on a control plane parallel to the direction of the moment is approximately parallel to the direction of the gripping force applied by the hand, and transmitting the second control information to the gripping device.
前記制御装置は、前記制御面における前記対象物体の長手方向が前記把持力の方向と略平行となり、かつ、前記対象物体と当該対象物体に接する他の物体とが接した状態が保たれるように前記対象物体を回転させるための前記第2制御情報を生成することを特徴とする把持システム。 2. The gripping system of claim 1,
A gripping system characterized in that the control device generates the second control information for rotating the target object so that the longitudinal direction of the target object on the control surface is approximately parallel to the direction of the gripping force and so that the target object is maintained in contact with another object in contact with the target object.
前記制御装置は、前記制御面における前記対象物体の長手方向が前記把持力の方向と略平行となり、かつ、前記対象物体及び前記指部の接触面積が所定閾値より大きくなるように前記対象物体を回転させるための前記第2制御情報を生成することを特徴とする把持システム。 3. The gripping system of claim 2,
a control device that generates the second control information for rotating the target object so that the longitudinal direction of the target object on the control surface is approximately parallel to the direction of the gripping force and the contact area between the target object and the finger portions is larger than a predetermined threshold.
前記制御装置は、
前記物体群に含まれ、かつ、前記指部が接する前記物体の中から一つの物体を選択し、
前記選択された物体及び前記指部の接触面積が閾値より大きくなるように前記物体群を把持するための前記ハンドの把持姿勢の角度を算出し、
前記ハンドの把持姿勢の角度を含む前記第1制御情報を生成することを特徴とする把持システム。 3. The gripping system of claim 2,
The control device includes:
selecting one object from among the objects included in the group of objects and in contact with the finger portion;
calculating an angle of a gripping posture of the hand for gripping the group of objects such that a contact area between the selected object and the finger portion is greater than a threshold;
A gripping system, comprising: a gripping information generating unit that generates the first control information including an angle of a gripping posture of the hand.
前記制御装置は、
前記物体群に含まれ、かつ、前記指部と接しない前記物体を選択し、
前記選択された物体と当該物体に接する他の物体との接触面が、前記指部の接触面に対して略平行となるように前記物体群を把持するための前記ハンドの把持姿勢の角度を算出し、
前記ハンドの把持姿勢の角度を含む前記第1制御情報を生成することを特徴とする把持システム。 3. The gripping system of claim 2,
The control device includes:
selecting an object that is included in the group of objects and is not in contact with the finger portion;
calculating an angle of a gripping posture of the hand for gripping the group of objects such that a contact surface between the selected object and another object in contact with the selected object is approximately parallel to a contact surface of the finger portion;
A gripping system, comprising: a gripping information generating unit that generates the first control information including an angle of a gripping posture of the hand.
前記制御装置は、前記対象物体が複数存在する場合、前記制御面における前記対象物体の長手方向と前記把持力の向きとの角度差、前記対象物体の大きさ、前記対象物体の形状、及び、前記ハンド内の前記対象物体の配置関係の少なくともいずれかに基づいて、前記複数の対象物体の各々の制御順番を決定することを特徴とする把持システム。 3. The gripping system of claim 2,
A gripping system characterized in that, when there are multiple target objects, the control device determines the control order of each of the multiple target objects based on at least one of the angular difference between the longitudinal direction of the target object on the control surface and the direction of the gripping force, the size of the target object, the shape of the target object, and the relative positioning of the target objects within the hand.
前記把持システムは、物体を把持するハンド、及び物体の状態を示す物体情報を取得する物体情報取得装置を有する把持装置と、前記把持装置を制御する制御装置と、を含み、
前記ハンドは、独立に動く複数の指部を有し、
少なくとも一つの前記指部は、前記指部の伸長方向に略平行な方向にモーメントを与えることによって接する物体を回転させる移動機構を有し、
前記把持装置の制御方法は、
前記制御装置が、作業空間に存在する複数の物体の前記物体情報に基づいて、同時に把持する物体群を決定する第1のステップと、
前記制御装置が、前記物体群を把持するための第1制御情報を生成し、前記把持装置に前記第1制御情報を送信する第2のステップと、
前記制御装置が、前記ハンドによって把持された前記物体群の前記物体情報に基づいて、前記物体群に含まれ、かつ、前記移動機構に接する物体の中から、回転させる対象物体を決定する第3のステップと、
前記制御装置が、前記物体群を把持する二つの前記指部を結び、かつ、前記モーメントの向きと平行な制御面における前記対象物体の長手方向が前記ハンドが与える把持力の方向と略平行となるように前記対象物体を回転させるための第2制御情報を生成し、前記把持装置に前記第2制御情報を送信する第4のステップと、を含むことを特徴とする把持装置の制御方法。 A method for controlling a gripping device executed by a gripping system, comprising:
The gripping system includes a gripping device having a hand for gripping an object and an object information acquisition device for acquiring object information indicating a state of the object, and a control device for controlling the gripping device,
The hand has a plurality of fingers that can move independently,
At least one of the fingers has a movement mechanism that rotates an object in contact with the finger by applying a moment in a direction substantially parallel to an extension direction of the finger,
The method for controlling the gripping device includes:
A first step in which the control device determines a group of objects to be simultaneously grasped based on the object information of a plurality of objects present in a workspace;
a second step of the control device generating first control information for gripping the group of objects and transmitting the first control information to the gripping device;
a third step in which the control device determines, based on the object information of the group of objects held by the hand, a target object to be rotated from among objects included in the group of objects and in contact with the moving mechanism;
a fourth step of the control device generating second control information for connecting the two finger portions that grasp the group of objects and rotating the target object so that the longitudinal direction of the target object on a control plane parallel to the direction of the moment is approximately parallel to the direction of the grasping force applied by the hand, and transmitting the second control information to the gripping device.
前記第4のステップは、前記制御装置が、前記制御面における前記対象物体の長手方向が前記把持力の方向と略平行となり、かつ、前記対象物体と当該対象物体に接する他の物体とが接した状態が保たれるように前記対象物体を回転させるための前記第2制御情報を生成するステップを含むことを特徴とする把持装置の制御方法。 A method for controlling a gripping device according to claim 7, comprising the steps of:
A method for controlling a gripping device, characterized in that the fourth step includes a step of generating the second control information by the control device for rotating the target object so that the longitudinal direction of the target object on the control surface is approximately parallel to the direction of the gripping force and so that the target object is maintained in contact with another object in contact with the target object.
前記第4のステップは、前記制御装置が、前記制御面における前記対象物体の長手方向が前記把持力の方向と略平行となり、かつ、前記対象物体及び前記指部の接触面積が所定閾値より大きくなるように前記対象物体を回転させるための前記第2制御情報を生成するステップを含むことを特徴とする把持装置の制御方法。 A method for controlling a gripping device according to claim 8, comprising the steps of:
a fourth step of generating the second control information by the control device for rotating the target object so that a longitudinal direction of the target object on the control surface is approximately parallel to a direction of the gripping force and a contact area between the target object and the finger portions is larger than a predetermined threshold.
前記第2のステップは、
前記制御装置が、前記物体群に含まれ、かつ、前記指部が接する前記物体の中から一つの物体を選択するステップと、
前記制御装置が、前記選択された物体及び前記指部の接触面積が閾値より大きくなるように前記物体群を把持するための前記ハンドの把持姿勢の角度を算出するステップと、
前記制御装置が、前記ハンドの把持姿勢の角度を含む前記第1制御情報を生成するステップと、を含むことを特徴とする把持装置の制御方法。 A method for controlling a gripping device according to claim 8, comprising the steps of:
The second step includes:
a step of the control device selecting one object from among the objects included in the group of objects and in contact with the finger portion;
a step of the control device calculating an angle of a gripping posture of the hand for gripping the group of objects such that a contact area between the selected object and the finger portion is larger than a threshold;
and generating the first control information, the first control information including an angle of the gripping posture of the hand, by the control device.
前記第2のステップは、
前記制御装置が、前記物体群に含まれ、かつ、前記指部と接しない前記物体を選択するステップと、
前記制御装置が、前記選択された物体と当該物体に接する他の物体との接触面が、前記指部の接触面に対して略平行となるように前記物体群を把持するための前記ハンドの把持姿勢の角度を算出するステップと、
前記制御装置が、前記ハンドの把持姿勢の角度を含む前記第1制御情報を生成するステップと、を含むことを特徴とする把持装置の制御方法。 A method for controlling a gripping device according to claim 8, comprising the steps of:
The second step includes:
a step of the control device selecting the object that is included in the group of objects and is not in contact with the finger portion;
a step of the control device calculating an angle of a gripping posture of the hand for gripping the group of objects such that a contact surface between the selected object and another object in contact with the selected object is approximately parallel to a contact surface of the finger portion;
and generating the first control information, the first control information including an angle of the gripping posture of the hand, by the control device.
前記第3のステップは、前記制御装置が、前記対象物体が複数存在する場合、前記制御面における前記対象物体の長手方向と前記把持力の向きとの角度差、前記対象物体の大きさ、前記対象物体の形状、及び、前記ハンド内の前記対象物体の配置関係の少なくともいずれかに基づいて、前記複数の対象物体の各々の制御順番を決定することを特徴とする把持装置の制御方法。 A method for controlling a gripping device according to claim 8, comprising the steps of:
The third step is a control method for a gripping device, characterized in that, when there are multiple target objects, the control device determines a control order for each of the multiple target objects based on at least one of the angular difference between the longitudinal direction of the target object on the control surface and the direction of the gripping force, the size of the target object, the shape of the target object, and the positional relationship of the target objects within the hand.
物体を把持するハンド、及び物体の状態を示す物体情報を取得する物体情報取得装置を有する把持装置と、
前記把持装置を制御する制御装置と、
を備え、
前記ハンドは、独立に動く複数の指部を有し、
前記複数の指部は、前記指部の伸長方向に略平行な方向にモーメントを与えることによって接する物体を回転させる移動機構を有し、
前記制御装置は、
作業空間に存在する複数の物体の前記物体情報に基づいて、同時に把持する二つの物体を決定し、
前記二つの物体を把持し、前記二つの物体の各々が地面に接した状態で、前記二つの物体の各々を把持する二つの前記指部を結び、かつ、前記モーメントの向きと平行な制御面における前記二つの物体の各々の短手方向が前記ハンドが与える把持力の方向と略平行となるように、前記二つの物体を回転させるための制御情報を生成し、
前記把持装置に前記制御情報を送信することを特徴とする把持システム。 1. A gripping system comprising:
a gripping device having a hand for gripping an object and an object information acquisition device for acquiring object information indicating a state of the object;
A control device that controls the gripping device;
Equipped with
The hand has a plurality of fingers that can move independently,
the plurality of fingers each have a moving mechanism that rotates an object in contact with the plurality of fingers by applying a moment in a direction substantially parallel to an extension direction of the plurality of fingers;
The control device includes:
determining two objects to be simultaneously grasped based on the object information of a plurality of objects present in a workspace;
gripping the two objects , and connecting the two finger portions gripping each of the two objects while each of the two objects is in contact with the ground, and generating control information for rotating the two objects so that the short-side direction of each of the two objects on a control plane parallel to the direction of the moment is approximately parallel to the direction of the gripping force applied by the hand;
A gripping system that transmits the control information to the gripping device.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020170922A JP7493425B2 (en) | 2020-10-09 | 2020-10-09 | Gripping system and gripping device control method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020170922A JP7493425B2 (en) | 2020-10-09 | 2020-10-09 | Gripping system and gripping device control method |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2022062791A JP2022062791A (en) | 2022-04-21 |
JP7493425B2 true JP7493425B2 (en) | 2024-05-31 |
Family
ID=81255262
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2020170922A Active JP7493425B2 (en) | 2020-10-09 | 2020-10-09 | Gripping system and gripping device control method |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP7493425B2 (en) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012171019A (en) | 2011-02-17 | 2012-09-10 | Seiko Epson Corp | Robot hand, and robot device |
JP2014024143A (en) | 2012-07-26 | 2014-02-06 | Fanuc Ltd | Takeout robot system using roller device |
JP2018043331A (en) | 2016-09-16 | 2018-03-22 | アダマンド並木精密宝石株式会社 | End effector |
US20200070358A1 (en) | 2018-08-07 | 2020-03-05 | Hds Mercury, Inc. | Robotic gripper |
-
2020
- 2020-10-09 JP JP2020170922A patent/JP7493425B2/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012171019A (en) | 2011-02-17 | 2012-09-10 | Seiko Epson Corp | Robot hand, and robot device |
JP2014024143A (en) | 2012-07-26 | 2014-02-06 | Fanuc Ltd | Takeout robot system using roller device |
JP2018043331A (en) | 2016-09-16 | 2018-03-22 | アダマンド並木精密宝石株式会社 | End effector |
US20200070358A1 (en) | 2018-08-07 | 2020-03-05 | Hds Mercury, Inc. | Robotic gripper |
Also Published As
Publication number | Publication date |
---|---|
JP2022062791A (en) | 2022-04-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6640792B2 (en) | Hand control device, hand control method, and hand simulation device | |
US10434646B2 (en) | Robot control apparatus, robot, and robot system | |
Yuan et al. | Design and control of roller grasper v2 for in-hand manipulation | |
US20220305678A1 (en) | Dynamic mass estimation methods for an integrated mobile manipulator robot | |
WO2008001713A1 (en) | Articulated robot and its control program | |
JP7052917B2 (en) | Robot hand, robot hand control method and program | |
WO2022039058A1 (en) | Information processing device, information processing method, and program | |
KR20240093690A (en) | Nonlinear trajectory optimization for robotic devices | |
CN112236272B (en) | Gripping posture evaluation device and gripping posture evaluation program | |
JP6003312B2 (en) | Robot system | |
Platt et al. | Multi-priority cartesian impedance control | |
JP7493425B2 (en) | Gripping system and gripping device control method | |
Hou et al. | Reorienting objects in 3D space using pivoting | |
JP2017154221A (en) | Robot, control device of the robot, and control method of the robot | |
JP2015085499A (en) | Robot, robot system, control device and control method | |
JP2020192614A (en) | Robot device and gripping method | |
WO2021250923A1 (en) | Robot system, control device, and control method | |
Baek et al. | Pre-grasp manipulation planning to secure space for power grasping | |
CN112135718B (en) | Control of robots | |
JP2021146433A (en) | Control device, robot device, simulation device, control method, simulation method, method for manufacturing object, program and recording medium | |
JP6248694B2 (en) | Robot, robot system, and control device | |
US20240149462A1 (en) | Variable payload robot | |
Henning | Approximate inverse kinematics using a database | |
US20230182298A1 (en) | Placement planning | |
JP7263217B2 (en) | CONTROL DEVICE, CONTROL METHOD, AND ROBOT SYSTEM |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20230516 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20240124 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20240227 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20240423 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20240507 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20240521 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7493425 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |