JP2022072752A - Control device and control method of mobile machine - Google Patents
Control device and control method of mobile machine Download PDFInfo
- Publication number
- JP2022072752A JP2022072752A JP2020182369A JP2020182369A JP2022072752A JP 2022072752 A JP2022072752 A JP 2022072752A JP 2020182369 A JP2020182369 A JP 2020182369A JP 2020182369 A JP2020182369 A JP 2020182369A JP 2022072752 A JP2022072752 A JP 2022072752A
- Authority
- JP
- Japan
- Prior art keywords
- article
- hand
- suction
- motion
- control device
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 37
- 238000011156 evaluation Methods 0.000 claims abstract description 131
- 230000033001 locomotion Effects 0.000 claims description 238
- 238000005452 bending Methods 0.000 claims description 17
- 230000007613 environmental effect Effects 0.000 claims description 6
- 238000013459 approach Methods 0.000 claims description 2
- 230000036544 posture Effects 0.000 description 26
- 238000007726 management method Methods 0.000 description 20
- 238000010586 diagram Methods 0.000 description 19
- 238000001179 sorption measurement Methods 0.000 description 17
- 230000006870 function Effects 0.000 description 10
- 230000008859 change Effects 0.000 description 9
- 238000012545 processing Methods 0.000 description 9
- 239000000123 paper Substances 0.000 description 7
- 238000004891 communication Methods 0.000 description 6
- 230000007246 mechanism Effects 0.000 description 6
- 230000005484 gravity Effects 0.000 description 5
- 230000002093 peripheral effect Effects 0.000 description 5
- 230000005856 abnormality Effects 0.000 description 4
- 210000000078 claw Anatomy 0.000 description 4
- 239000000284 extract Substances 0.000 description 4
- 230000001174 ascending effect Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 3
- 238000003384 imaging method Methods 0.000 description 3
- 239000011159 matrix material Substances 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 238000004422 calculation algorithm Methods 0.000 description 2
- 230000015654 memory Effects 0.000 description 2
- 230000000704 physical effect Effects 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 238000013519 translation Methods 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 238000012790 confirmation Methods 0.000 description 1
- 238000013500 data storage Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000007429 general method Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000004806 packaging method and process Methods 0.000 description 1
- 230000002250 progressing effect Effects 0.000 description 1
- 230000002787 reinforcement Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
Images
Landscapes
- Manipulator (AREA)
Abstract
Description
本発明は、自動移動機械等の制御技術に関する。 The present invention relates to a control technique for an automatic moving machine or the like.
労働人口比率の低下や労働賃金の上昇に伴い、物流業での荷物の運搬および商品のピッキング、ならびに製造ラインへのロボットの導入が進んでいる。従来、ロボットの導入においては、あらかじめロボット動作を決定し、実際にロボットを動かしながらロボットに動作を教示する。このとき、把持物を落下させず、かつロボットを駆動するモータの負荷が大きくならないよう、作業者が実機の動きを見ながら、ロボットの動作を調整する。しかし、これらの調整作業は、経験に基づく熟練作業であり、教示する作業者の能力に左右される。 With the decline in the ratio of the working population and the rise in labor wages, the transportation of luggage and picking of goods in the logistics industry, and the introduction of robots into production lines are progressing. Conventionally, when introducing a robot, the robot operation is determined in advance, and the operation is taught to the robot while actually moving the robot. At this time, the operator adjusts the operation of the robot while observing the movement of the actual machine so that the gripped object is not dropped and the load of the motor for driving the robot does not increase. However, these adjustment work is a skillful work based on experience and depends on the ability of the worker to teach.
そこで、作業者の能力に左右されないロボット動作の調整方法として、特許文献１および特許文献２が開示されている。
Therefore,
特開２０２０－９３３０６（特許文献１）には、物品上面を吸着するだけでなく、下から支える爪を有するハンドが開示されている。 Japanese Patent Application Laid-Open No. 2020-93306 (Patent Document 1) discloses a hand having a claw that not only adsorbs the upper surface of the article but also supports it from below.
特開２００５－１０５５（特許文献２）には、あらかじめ決められた軌道、速度プロファイルに対して、把持物にかかる慣性力を考慮して、把持姿勢を変える方法が開示されている。 Japanese Patent Application Laid-Open No. 2005-1055 (Patent Document 2) discloses a method of changing the gripping posture with respect to a predetermined trajectory and velocity profile in consideration of the inertial force applied to the gripped object.
特許文献１は、物品を下から支える構造の爪を有するハンドであるが、爪を差し込む隙間が必要となるだけでなく、爪を引っ掛ける部分の強度が高い必要があり、用途が限られる。特許文献２は、物品の把持される部分の強度が十分高い場合には、適切な搬送姿勢で移動させることができるが、把持部の強度が低い場合には適用できない。
本発明の目的は、把持される部分の強度が低い物品に対し、把持部にかかる負荷を低減するように動作させることにより、把持している物品の落下および破損を防止する移動方法を提供することである。 An object of the present invention is to provide a moving method for preventing an article having a low strength of a gripped portion from falling and being damaged by operating the article so as to reduce the load applied to the gripped portion. That is.
上記課題の少なくとも一つを解決するために、例えば特許請求の範囲に記載の構成を採用する。本願は上記課題を解決する手段を複数含んでいるが、その一例を以下に挙げる。移動機械の制御装置であって、前記移動機械は、物品を把持するハンドを有し、前記制御装置は、プロセッサと、記憶部と、を有し、前記記憶部は、前記物品を前記ハンドで把持したときの前記物品の把持部分の強度を示す強度情報を保持し、前記プロセッサは、第１の位置に置かれた物品を前記ハンドで把持するピック動作と、把持された前記物品を前記第１の位置とは異なる第２の位置に配置するプレイス動作と、の複数の組合せを生成し、前記強度情報に基づいて、生成された前記ピック動作の評価値及び生成された前記プレイス動作の評価値を計算し、生成された前記ピック動作と前記プレイス動作との組合せの各々について、前記ピック動作の終点から前記プレイス動作の始点まで前記把持された物品を移動するための移動動作を生成し、前記強度情報に基づいて、前記移動動作の評価値を計算し、前記評価値に基づいて、前記ピック動作、前記プレイス動作及び前記移動動作の組合せのいずれかを選択することを特徴とする。 In order to solve at least one of the above problems, for example, the configuration described in the claims is adopted. The present application includes a plurality of means for solving the above problems, and an example thereof is given below. A control device for a mobile machine, wherein the mobile machine has a hand for gripping an article, the control device has a processor and a storage unit, and the storage unit holds the article with the hand. The processor holds strength information indicating the strength of the gripped portion of the article when it is gripped, and the processor picks the article placed in the first position with the hand and holds the gripped article in the first position. A plurality of combinations of a place motion to be placed at a second position different from the position of 1 are generated, and an evaluation value of the pick motion generated and an evaluation value of the generated place motion are evaluated based on the strength information. A value is calculated to generate a moving motion for moving the gripped article from the end point of the pick motion to the start point of the place motion for each of the generated combinations of the pick motion and the place motion. It is characterized in that an evaluation value of the movement operation is calculated based on the intensity information, and one of the combination of the pick operation, the place operation, and the movement operation is selected based on the evaluation value.
本発明の一態様によれば、把持位置・姿勢、ピック動作、プレイス動作および移動動作を把持物の強度に応じて、適切に生成することができ、ロボットの稼働率向上と作業効率向上、把持物ダメージ低減を実現することができる。前述した以外の課題、構成及び効果は、以下の実施例の説明によって明らかにされる。 According to one aspect of the present invention, the gripping position / posture, the picking motion, the placing motion, and the moving motion can be appropriately generated according to the strength of the gripped object, and the robot operating rate is improved, the work efficiency is improved, and the gripping motion is performed. It is possible to reduce object damage. Issues, configurations and effects other than those mentioned above will be clarified by the description of the following examples.
以下、本発明の実施形態について図面を参照して説明する。 Hereinafter, embodiments of the present invention will be described with reference to the drawings.
図１～図１８を用いて、本発明の一実施例を説明する。 An embodiment of the present invention will be described with reference to FIGS. 1 to 18.
図１は、本発明の一実施例のロボットを用いた自動移動機械１００の構成の一例を示すブロック図である。
FIG. 1 is a block diagram showing an example of a configuration of an automatic moving
本実施例では、複数の物品が積層されている物品群６から物品を取り出し、コンベア（図示せず）上に移動させる動作、および、コンベア上から物品を取り、物品群６上に積む動作を例に説明する。しかし、本発明は、例えば箱の中または棚に積まれた物品の取り出し、積み付けなど、種々の動作に適用することができ、上記の動作に限定されるものではない。また、本実施例では３軸制御のロボットを例に説明するが、制御軸数および装置構成はこれに限られるものではなく、直動機構またはリンク機構など、回転機構に限定されるものではない。また、本実施例では１本腕を有するロボットを想定したアルゴリズムを記述しているが、腕の本数は２本以上であってもよい。
In this embodiment, an operation of taking out an article from the
自動移動機械１００は、移動装置１２、制御装置１０および撮影装置１１で構成される。移動装置１２は、ロボット１、ハンド３および力覚センサ４で構成される。ロボット１には、ハンド３および力覚センサ４が取り付けられており、制御装置１０からの動作指令に従って動作する。力覚センサ４は、ロボット１とハンド３を連結する位置に取り付けられており、ハンド３にかかる力を測定する。力覚センサ４は、ハンド３が指機構を有する場合は、指が把持物５に加えている力を測定する位置に取り付けられてもよい。また、ハンド３が吸着機構を有する場合は、その吸着圧力を測定してもよい。
The
撮影装置１１は、複数の物品が積まれている物品群６の積層状況を撮影および認識するものである。撮影装置１１は、ロボット１が物品群６から物品を取り出す場合には、認識した物品群６の積層情報から移動する物品を特定する用途に使用され、ロボット１が積まれている物品群６に対してさらに物品を積む場合には、その積付け位置を特定するために使用される。また、撮影装置１１は、ハンド３で把持する位置を特定する用途にも使用される。力覚センサ４および撮影装置１１は、一般的なセンシングデバイスを用いることができるが、これらに限定されるものではない。
The photographing
制御装置１０は、ロボット１から取得したロボット関節角度、角速度および角加速度などのロボット情報、ならびに、力覚センサ４および撮影データから抽出した物品群６の積層情報から、ロボット１の制御情報を算出し、出力する。
The
＜制御装置の第一の構成例＞ <First configuration example of the control device>
制御装置の第一の構成例について、図２～図７を用いて説明する。 A first configuration example of the control device will be described with reference to FIGS. 2 to 7.
図２は、本発明の一実施例における制御装置１０の構成の一例を示すブロック図である。
FIG. 2 is a block diagram showing an example of the configuration of the
制御装置１０は、移動順序生成部１２１、ピック・プレイス動作生成部１２２、ピック・プレイス動作評価値生成部１２３、移動動作・評価値生成部１２４、動作選択部１２５、異常処理生成部１２６、制御信号出力部１２７、記憶部１０１、入力部１１１、表示部１１２および通信部１１３で構成される。また、記憶部１０１は、ハンド情報記憶領域１０２、物品情報記憶領域１０３、吸着面強度情報記憶領域１０４、動作情報記憶領域１０５および周辺環境情報記憶領域１０６で構成される。
The
移動順序生成部１２１は、物品群６からコンベア上に物品を移動させる場合における、物品を取り出す順序を生成する。生成した移動順序は動作情報記憶領域１０５に格納される。
The movement
ピック・プレイス動作生成部１２２は、把持物５をピッキングするときの動作であるピック動作、および、把持物５を置くときの動作であるプレイス動作を生成する。生成されるピック動作およびプレイス動作は複数生成されてもよく、生成したピック動作とプレイス動作は動作情報記憶領域１０５に格納される。
The pick-place
ピック・プレイス動作評価値生成部１２３は、ピック・プレイス動作生成部１２２で生成されたピック動作とプレイス動作に関し、ハンド情報記憶領域１０２に格納されているハンド情報、物品情報記憶領域１０３に格納されている物品情報、および、吸着面強度情報記憶領域１０４に格納されている吸着面強度情報を用いて、ピック・プレイス動作の評価値を生成し、動作情報記憶領域１０５に格納する。
The pick-place motion evaluation
移動動作・評価値生成部１２４は、ピック動作の終点位置とプレイス動作の始点位置とをつなぎ、移動途中にある障害物およびロボットと把持物との干渉を回避する軌道を生成するとともに、移動時の物品姿勢に関する評価値を生成し、動作情報記憶領域１０５に格納する。
The moving motion / evaluation
動作選択部１２５は、動作情報記憶領域１０５に格納された評価値を用いて、ピック動作、プレイス動作および移動動作の最適な組み合わせを一つ選択する。
The
異常処理生成部１２６は、動作選択部１２５で最適な組み合わせが選定できなかった場合に実行する処理を生成する。
The abnormality
制御信号出力部１２７は、動作選択部１２５で選択したピック動作、プレイス動作および移動動作をロボットの制御信号に変換したのち、通信部１１３を介して、ロボット１に出力する。
The control
入力部１１１は、機構制約情報および移動制約情報の入力、メニューの選択指示、ならびにその他の指示等を入力する入力部であり、入力した情報は記憶部１０１に格納する。表示部１１２は、入力情報の表示、処理結果の表示、および処理途中の経緯の表示等を行う表示部である。通信部１１３は、ロボット１、力覚センサ４、制御装置１０および撮影装置１１の間でデータを送受信する通信部である。
The
この制御装置１０のハードウェア構成は、これに限定されるものではないが、例えば以下の通りである。制御装置１０は、ＣＰＵ（中央処理装置）１２０、ＲＯＭ（リードオンリメモリ）やＲＡＭ（ランダムアクセスメモリ）などの記憶装置を含んで構成される。記憶部１０１は、ハードディスク装置などの外部記憶装置により構成される。入力部１１１は、例えばキーボード、マウスなどを用いる。その他、タッチパネル、専用のスイッチやセンサあるいは音声認識装置を用いてもよい。表示部１１２は、例えばディスプレイ、プロジェクタ、ヘッドマウントディスプレイなど画面やスクリーンに情報を表示する装置を用いる。さらに、表示部１１２に表示された情報を用紙に出力するプリンタ（図示せず）を制御装置１０に接続してもよい。なお、これらのハードウェア構成は、専用装置である必要はなく、パーソナルコンピュータ等の一般的なコンピュータシステムを利用することができる。これらの制御装置１０に含まれる各機能部１２１～１２７は、制御装置１０において、ＣＰＵ１２０が記憶装置に格納されたプログラムを実行することによって実現される。すなわち、これらの各機能部は、ソフトウェアにより構築される機能である。
The hardware configuration of the
図２に示した制御装置１０における制御情報生成の手順について、図３～図７を用いて説明する。
The procedure for generating control information in the
図３は、本発明の一実施例における制御装置１０の動作手順の一例を示すフローチャートである。
FIG. 3 is a flowchart showing an example of the operation procedure of the
移動順序生成（ステップＳ１１）において、制御装置１０は、撮影装置１１で撮影した画像から物品群６の積層状態を抽出するとともに、コンベアへ移動する順序を生成する。移動順序の生成方法としては、物品群６の上側かつロボット側の列にある物品を右から順に取るといったルールを用いて生成する方法などがあるが、これに限定されるものではない。
In the movement order generation (step S11), the
次に、吸着面強度情報取得（ステップＳ１９）において、制御装置１０は、吸着面強度情報を取得する。次に、ピック・プレイス動作生成（ステップＳ１２）において、制御装置１０は、一番目の物品（すなわち、ステップＳ１１で生成された順序に従って最初に移動する物品）に対するピック動作とプレイス動作をそれぞれ少なくとも一つ生成する。次に、制御装置１０は、生成したそれぞれ少なくとも一つのピック動作とプレイス動作について、ピック・プレイス動作評価値生成（ステップＳ１３）において評価値を生成する。
Next, in the suction surface strength information acquisition (step S19), the
次に、移動動作・評価値生成（ステップＳ１４）において、制御装置１０は、ピック・プレイス動作生成（ステップＳ１２）で生成したピック動作の終点とプレイス動作の始点をつなぐ移動動作と、その評価値を生成する。ピック・プレイス動作生成（ステップＳ１２）でピック動作およびプレイス動作の少なくとも一方が複数生成された場合、制御装置１０は、後述するように、生成されたピック動作とプレイス動作とのすべての組み合わせ、または、それらのうち所定の条件を満たすものについて、移動動作とその評価値を生成してもよい。
Next, in the movement operation / evaluation value generation (step S14), the
次に、動作選択（ステップＳ１５）において、制御装置１０は、総合評価値が最小となるピック動作、プレイス動作および移動動作の組合せを選択する。総合評価値として、例えば、ピック動作、プレイス動作および移動動作の評価値の和を用いることができるが、これに限定されるものではない。
Next, in the operation selection (step S15), the
総合評価値判定（ステップＳ１６）で、動作選択が失敗したと判定された場合には、制御装置１０は、アラームを発報し、動作を停止させるなどの異常処理（ステップＳ１８）を実行して、終了する。動作選択が成功した場合には、制御装置１０は、制御信号出力（ステップＳ１７）において、ステップＳ１５で選択したピック動作、プレイス動作および移動動作をロボットの制御信号に変換したのち、通信部１１３を介して、ロボット１に制御信号を出力する。
When it is determined in the comprehensive evaluation value determination (step S16) that the operation selection has failed, the
制御装置１０は、以上のステップＳ１２からステップＳ１６を、ステップＳ１１で生成した移動順序に従って、物品群６の全ての物品に対して繰り返し実行する。あるいは、制御装置１０は、一つの物品を移動したのち、物品群６の積層状態を抽出し、新たな移動順序を生成するよう、ステップＳ１１からステップ１６を繰り返し実行してもよい。以下、各ステップについて、詳細を説明する。
The
図４は、本発明の一実施例におけるピック・プレイス動作生成（ステップＳ１２）の一例を示す説明図である。 FIG. 4 is an explanatory diagram showing an example of pick-place motion generation (step S12) in an embodiment of the present invention.
まず、制御装置１０は、移動順序生成（ステップＳ１１）で抽出した物品群６の積層状態および移動順序と、周辺環境物に関する情報１２２１と、ハンド情報記憶領域１０２に格納されている複数のハンド情報１２２２とを用いて、隣接する物品および周辺環境物とハンドが干渉しない把持姿勢情報１２２６を少なくとも一つ生成する。本実施例では、吸着面が１面であるＩ型ハンド１２２５と、メイン吸着面とサブ吸着面の２面を有し、それらの吸着面がＬ型に（例えばそれらの２面が直方体の箱の隣接する２面を吸着するように）配置されたＬ型ハンド１２２４の２種類を例に説明するが、ハンド形状および把持構造は、これらに限定されるものではない。
First, the
次に、制御装置１０は、物品情報記憶領域１０３に格納されているピック基本動作情報１２２３と、把持姿勢情報１２２６を用いて、ハンドおよび移動物品が隣接する物品や周辺環境物と干渉しない移動方向情報１２２７を少なくとも一つ生成する。Ｉ型ハンド１２２５のように、ハンドが回転対称な形状を持つ場合、把持姿勢情報１２２６は、回転対称の姿勢を含んでもよい。ロボット１の可動範囲によっては、これら複数の回転対称姿勢のうち、実際に取れない姿勢も含まれる場合があるため、可能な回転対称姿勢を含めることは好適である。なお、実際に姿勢を取れるかどうかのチェックは、ピック・プレイス動作生成（ステップＳ１２）で行ってもよいし、移動動作・評価値生成（ステップＳ１４）で移動軌道を生成するときに行ってもよい。
Next, the
ピック基本動作情報１２２３には、例えば、（ａ）上昇、（ｂ）右回転、（ｃ）左回転、（ｄ）手前回転、および（ｅ）奥回転などの、物品をピックするときに実行されうる基本動作があらかじめ格納されている。ここで、平行移動方向が上昇方向のみであるのは、一般的にピック動作では、上昇方向に移動して、物品群６から離れたのち、横方向に移動してプレイス位置上空まで移動することが多いため、一例として取り上げたものである。もちろん、横方向や斜め方向への平行移動、および平行移動と回転移動の複合動作を基本動作に含めてもよい。
The pick
コンベア上に物品を配置するプレイス動作において、例えば、バーコードが印刷されている面を一定の方向に向けるなど、決まった位置・姿勢で物品を置くことが多い。また、ロボットの可動範囲によって実行可能なプレイス動作が制約を受けるため、プレイス動作は、あらかじめ決定しておく方がよい。そのために、物品情報記憶領域１０３に格納されているプレイス動作情報を使用する。
In the place operation of arranging the articles on the conveyor, the articles are often placed in a fixed position and posture, for example, the surface on which the barcode is printed is turned in a certain direction. In addition, since the place movement that can be executed is restricted by the movable range of the robot, it is better to determine the place movement in advance. Therefore, the place operation information stored in the article
図５は、本発明の一実施例におけるピック・プレイス動作評価値生成（ステップＳ１３）の一例を示す説明図である。 FIG. 5 is an explanatory diagram showing an example of pick-place operation evaluation value generation (step S13) in one embodiment of the present invention.
図５では、段ボール箱および紙箱を一例として説明する。図５（ａ）は上面にミシン目５０１がある物品例、図５（ｂ）は上面に蓋５０２がある物品例、図５（ｃ）は側面に穴５０３がある物品例、図５（ｄ）はフィルム５０４で包装された物品例である。
In FIG. 5, a cardboard box and a paper box will be described as an example. 5 (a) is an example of an article having a
例えば、Ｉ型ハンド１２２５でミシン目付き段ボール箱の上面を吸着して持ち上げようとすると、ミシン目が破壊され、持ち上げられない場合がある。また、Ｉ型ハンド１２２５で蓋つき紙箱の上面を吸着して持ち上げる場合、および、フィルム包装された紙箱の上面を吸着して持ち上げる場合には、蓋５０２が開いたり、フィルム５０４がのびたり、破れたりするなどして、持ち上げられない場合がある。
For example, if an I-
また、Ｌ型ハンド１２２４でミシン目付き段ボール箱の上面を吸着する場合、ミシン目の切り口５０５を覆うようにＬ型ハンド１２２４を左向き（すなわちサブ吸着面が箱の左側面を吸着する向き）に配置するとミシン目が破れにくいが、Ｌ型ハンド１２２４を右向き（すなわちサブ吸着面が箱の右側面を吸着する向き）に配置すると、切り口５０５に力が加わるためミシン目が破れやすい。
When the upper surface of the perforated cardboard box is sucked by the L-shaped
また、側面に穴５０３が開いているところに、Ｌ型ハンド１２２４のサブ吸着面を配置しても側面を吸着できないため、持ち上げるのに必要な吸着力を得られない場合がある。一方、フィルム包装された紙箱では、側面のフィルムを吸着し、上に持ち上げた方がフィルムが破れにくいため、Ｌ型ハンド１２２４の使用が有効である。
Further, even if the sub suction surface of the L-shaped
以上のように、物品の状態とハンドの形状、吸着面によって、物品を持ち上げる動作の成否が異なる。そこで、対象物品毎に、ハンド形状と少なくとも一つの吸着面に対応づけられた評価値を生成する。評価値の生成方法として、例えば、吸着面強度情報記憶領域１０４に格納されているピック動作およびプレイス動作の吸着面強度情報を参照する方法、ならびに、強度シミュレーションなどの算出値を使用する方法などがある。例えば、吸着面強度情報として、ハンド形状（ｈ）、吸着面（ｓ１，ｓ２）における最大可搬重量がＭ（ｈ，ｓ１，ｓ２）である場合、移動する物品の重量をｍとすると、ピック動作の評価値Ｅｃとプレイス動作の評価値Ｅｌは、式１を用いて算出することができる。ここで、把持する物品の重量ｍが最大可搬重量Ｍより大きい場合は、物品を破損することなく移動することができないため、評価値を∞とした。
As described above, the success or failure of the operation of lifting the article differs depending on the state of the article, the shape of the hand, and the suction surface. Therefore, an evaluation value associated with the hand shape and at least one suction surface is generated for each target article. As a method of generating the evaluation value, for example, a method of referring to the suction surface strength information of the pick operation and the place operation stored in the suction surface strength
図６は、本発明の一実施例における移動動作・評価値生成（ステップＳ１４）の一例を示す説明図である。 FIG. 6 is an explanatory diagram showing an example of the movement operation / evaluation value generation (step S14) in the embodiment of the present invention.
移動動作・評価値生成では、ピック・プレイス動作生成（ステップＳ１２）で生成したピック動作の終点とプレイス動作との始点をつなぐ移動動作、およびその評価値を生成する。ピック動作およびプレイス動作が複数ある場合は、その組み合わせ数分の移動動作を生成してもよいし、ピック・プレイス動作評価値生成（ステップＳ１３）で生成した評価値が最も高いピック動作とプレイス動作の組合せについて移動動作を生成してもよい。 In the move motion / evaluation value generation, a move motion connecting the end point of the pick motion generated in the pick / place motion generation (step S12) and the start point of the place motion, and the evaluation value thereof are generated. When there are a plurality of pick operations and place operations, movement operations for the number of combinations may be generated, or the pick operation and place operation having the highest evaluation value generated in the pick / place operation evaluation value generation (step S13) may be generated. You may generate a move motion for the combination of.
このとき、ピック動作とプレイス動作の組合せとして、ハンド形状と吸着面が同じとなる組合せを用いることで、持ち替えがない軌道を生成することができる。また、複数ロボットを用いて物品を持ち替えることで、ピック動作とプレイス動作で異なるハンド形状または吸着面を使用することも可能である。 At this time, by using a combination in which the hand shape and the suction surface are the same as the combination of the pick operation and the place operation, it is possible to generate a trajectory without changing hands. It is also possible to use different hand shapes or suction surfaces for the pick operation and the place operation by changing the articles using a plurality of robots.
ピック動作群１２３１とプレイス動作群１２３２の組合せ例として、次に示すように持ち替え不要な移動動作１２３３と持ち替えが必要な移動動作１２３４とが生成される。例えば、ピック動作１２３１（Ｂ）はＩ型ハンド１２２５で物品の上面を吸着しており、おなじくＩ型ハンドが上面を吸着しているプレイス動作１２３２（ａ）、（ｂ）と組み合せることで、持ち替え不要な移動動作１２３３を生成できる。
As an example of the combination of the
しかし、ピック動作１２３１（Ｂ）と、Ｌ型ハンド１２２４を使用するプレイス動作１２３２（ｃ）、（ｄ）または（ｅ）との組合せは、いずれも、ピック動作とプレイス動作でハンド形状が異なり、かつ、Ｉ型ハンドとＬ型ハンドとも上面を吸着していて持ち替えできないことから、これらの組合せでは、移動動作を生成することができない。同様に、ピック動作とプレイス動作の組合せとして、（Ｃ，ｃ）（Ｃ，ｄ）（Ｄ，ｃ）（Ｄ，ｄ）（Ｅ，ｅ）に対し、持ち替えのない移動動作を生成することができる。これによって、作業効率が向上する。
However, in any combination of the pick operation 1231 (B) and the place operation 1232 (c), (d) or (e) using the L-shaped
一方、ピック動作１２３１（Ａ）は、Ｉ型ハンド１２２５で物品の手前側面を吸着しており、Ｉ型ハンドで上面を吸着しているプレイス動作１２３２（ａ）または（ｂ）との組合せでは、持ち替えのある移動動作を生成することができる。ピック動作において吸着している物品の面とプレイス動作において吸着している物品の面とが異なることから、ピック動作とプレイス動作との間で異なるハンドへの持ち替えが可能になるためである。このような持ち替えをすることによって、例えば、ピック動作とプレイス動作で異なる種類のハンドを使用したり、ピック動作をしたハンドを用いたままでは実行不可能なプレイス動作を行ったりする場合にも、作業効率の高い動作を生成することが可能になる。
On the other hand, in the pick operation 1231 (A), in combination with the place operation 1232 (a) or (b) in which the front side surface of the article is adsorbed by the I-
同様に、ピック動作１２３１（Ａ）と、Ｌ型ハンド１２２４で上面と右側面を吸着しているプレイス動作１２３２（ｃ）または（ｄ）との組み合わせに対し、持ち替えのある移動動作を生成することができる。移動動作の生成では、ピック動作の終点からプレイス動作の始点を結ぶ移動動作中において、障害物およびロボットと把持物との干渉を回避する動作を生成する。
Similarly, for the combination of the pick operation 1231 (A) and the place operation 1232 (c) or (d) in which the upper surface and the right side surface are attracted by the L-shaped
次に、移動動作中の物品姿勢に関する評価値を算出する。 Next, the evaluation value regarding the posture of the article during the moving motion is calculated.
図７は、本発明の一実施例における移動動作中の物品姿勢に関する評価関数の一例を示す説明図である。 FIG. 7 is an explanatory diagram showing an example of an evaluation function regarding an article posture during a moving motion in one embodiment of the present invention.
本例では物品が入れられた箱をＬ型ハンド１２２４で移動するときの姿勢について述べるが、移動する物品およびハンド形状はこの限りではない。また、物品姿勢の最適値の算出例として、箱の最大曲げモーメントを用いているが、降伏応力など別の指標を用いることもできる。また、紙箱およびフィルム包装などのように小さな曲げモーメントで曲がるものの、破断に至りにくい材料に対しては、破断応力または塑性変形を開始する降伏応力をシミュレーションまたは実測などで求めて用いてもよい。
In this example, the posture when the box containing the article is moved by the L-shaped
図７に、箱１４１１の中に物品１４１２が入っている物品をＬ型ハンド１２２４で吊り下げるように把持している例を示す。物品１４１２に重力ｇがかかっているとき、その力は、箱１４１１の側壁に作用し、点Ａ、Ｂに、それぞれｆ１、ｆ２の力が作用する。直方体である物品１４１２の中心に重心が位置する場合、重心から点Ａ、点Ｂまでの距離は同じとなるため、ｆ１＝ｆ２＝ｇ／２である。
FIG. 7 shows an example in which an article containing an
点Ａにかかる力ｆ１による点Ｃでの曲げモーメントは、Ｌ１×ｇ・ｃｏｓθ／２であり、点Ｄでの曲げモーメントは、Ｌ２×ｇ・ｓｉｎθ／２である。点Ｃ、Ｄで許容される最大曲げモーメントをそれぞれＭ１、Ｍ２とすると、式２を満たすθの範囲であれば、箱を傷めることなく移動させることができる。
The bending moment at the point C due to the force f1 applied to the point A is L1 × g · cos θ / 2, and the bending moment at the point D is L2 × g · sin θ / 2. Assuming that the maximum bending moments allowed at points C and D are M1 and M2, respectively, the box can be moved without damaging the box as long as it is within the range of θ that satisfies
ここで、例えば、箱壁の強度が同程度でＭ１＝Ｍ２であるとき、点Ｃと点Ｄにかかる曲げモーメントを同じにするには、θ１＝ｔａｎ－１（Ｌ１／Ｌ２）を最適値とすればよい。あるいは、点Ｃ付近にミシン目があり、点Ｃの最大曲げモーメントが点Ｄの最大曲げモーメントの１／１０である場合には、θ２＝ｔａｎ－１（１０Ｌ１／Ｌ２）が最適値となり、θ１より大きい角度で傾けた姿勢で移動させるほうがよい。ここでは、物品１４１２にかかる力として重力を挙げたが、遠心力を含んでもよい。
Here, for example, when the strength of the box wall is about the same and M1 = M2, θ1 = tan-1 (L1 / L2) is set as the optimum value in order to make the bending moments applied to the points C and D the same. do it. Alternatively, when there is a perforation near the point C and the maximum bending moment at the point C is 1/10 of the maximum bending moment at the point D, θ2 = tan-1 (10L1 / L2) becomes the optimum value, and θ1 It is better to move it in a tilted posture at a larger angle. Here, gravity is mentioned as the force applied to the
上記によって求めた最適値（θop）を用いた評価関数例として、式３を用いることができる。生成した移動動作の軌道全体において、各位置における物品の傾きθを求め、式３を評価したのち、それらの最大値を移動動作の評価値Ｅｍとする。ここで、点Ｃ、Ｄにかかる曲げモーメントが、許容される最大曲げモーメントＭ１、Ｍ２より大きい場合は、物品が破損するため、評価値を∞とするとよい。また、物品を傾ける角度θにも制約があってもよい。例えば、天地を逆にすると、内容物が壊れるような場合は、θの範囲を－３０度（θ１）から３０度（θ２）の範囲に限定するなどしてもよい。
なお、上記の曲げモーメントに基づく評価値は、吸着対象の物品の面に生じる変形に伴う評価値の一例であり、その具体的な算出方法は上記のものに限定されない。例えば、移動動作においてθ＝３０度が最適である場合に、θ＝３０度のときの評価値を０、θ＝２０度又は４０度のときの評価値を１０、θ＝１０度又は５０度のときの評価値を３０とするなど、最適な角度との差が大きいほど評価値が大きくなるように（すなわち評価が低くなるように）評価値を決定してもよい。このような評価値の決定は、所定の計算式に基づいてもよいし、予め設定された角度と評価値とを対応付けるテーブルに基づいてもよい。 The evaluation value based on the bending moment is an example of the evaluation value due to the deformation occurring on the surface of the article to be adsorbed, and the specific calculation method thereof is not limited to the above. For example, when θ = 30 degrees is optimal in the movement operation, the evaluation value when θ = 30 degrees is 0, the evaluation value when θ = 20 degrees or 40 degrees is 10, θ = 10 degrees or 50 degrees. The evaluation value may be determined so that the larger the difference from the optimum angle, the larger the evaluation value (that is, the lower the evaluation), such as setting the evaluation value at the time of 30 to 30. The determination of such an evaluation value may be based on a predetermined calculation formula, or may be based on a table for associating a preset angle with the evaluation value.
動作選択（ステップＳ１５）では、制御装置１０は、生成した評価値を用いて、最適な動作を選択する。移動動作生成時に求めたピック動作とプレイス動作の組合せがＮ個ある場合、その組み合わせ毎に総合評価値を式４で算出する。
In the operation selection (step S15), the
ここで、α、β、γは重み係数である。制御装置１０は、求めた総合評価値Ｅｎのうち最小の値をとる動作の組合せを選択する。
Here, α, β, and γ are weighting coefficients. The
総合評価値判定（ステップＳ１６）では、制御装置１０は、総合評価値が∞であった場合には動作選択失敗と判定し、それ以外は、動作選択が成功したと判断する。
In the comprehensive evaluation value determination (step S16), the
なお、上記の例では、ピック動作、プレイス動作及び移動動作のいずれの評価値も、値が小さいほど評価が高いこと、すなわち、物品の損傷（例えば箱の破損又は落下等）が起こりにくいことを示している。しかし、このような評価値は一例であり、例えば値が大きいほど物品の損傷が起こりにくいことを示す評価値を使用してもよい。その場合にも、評価値に基づいて、物品の損傷が起こりにくい動作が選択される。 In the above example, the smaller the evaluation value of the pick operation, the place operation, and the moving operation, the higher the evaluation, that is, the damage of the article (for example, the damage or drop of the box) is less likely to occur. Shows. However, such an evaluation value is an example, and for example, an evaluation value indicating that damage to an article is less likely to occur as the value is larger may be used. Even in that case, an operation in which damage to the article is unlikely to occur is selected based on the evaluation value.
本実施例によれば、箱の強度に応じたハンド形状の選択、およびピック動作とプレイス動作、移動動作を生成することができ、ロボットの稼働率向上、作業効率向上および把持物ダメージ低減を実現することができる。 According to this embodiment, it is possible to select a hand shape according to the strength of the box, and to generate a pick motion, a place motion, and a movement motion, thereby improving the operating rate of the robot, improving the work efficiency, and reducing the damage to the gripped object. can do.
＜制御装置の第二の構成例＞ <Second configuration example of control device>
制御装置の第二の構成例について、図８～図９を用いて説明する。 A second configuration example of the control device will be described with reference to FIGS. 8 to 9.
図８は、本発明の別の実施例における制御装置１０の構成の一例を示すブロック図である。
FIG. 8 is a block diagram showing an example of the configuration of the
図８において、図２に示した第一の構成例と同じ構成には、同じ番号を付与している。図８に示す制御装置１０は、図２に示したものと同様の構成に加えて、順序ツリー生成部１４１および移動順序探索部１４５を有する。順序ツリー生成部１４１は、物品群６から物品を取り出す順序を網羅的に生成した順序ツリーを生成する。移動順序探索部１４５は、評価値を付与した順序ツリーから、最適な移動順序を生成する。
In FIG. 8, the same number is assigned to the same configuration as the first configuration example shown in FIG. The
ピック・プレイス動作生成部１２２～制御信号出力部１２７と同様、順序ツリー生成部１４１および移動順序探索部１４５は、例えば、制御装置１０において、ＣＰＵが記憶装置に格納されたプログラムを実行することによって実現される。すなわち、これらの各機能部は、ソフトウェアにより構築される機能である。
Similar to the pick-place
図９は、本発明の別の実施例における制御装置１０の動作手順の一例を示すフローチャートである。
FIG. 9 is a flowchart showing an example of the operation procedure of the
図３に示した第一の構成例の動作手順と同じ手順には、同じステップ番号を付与している。図９の例では、ステップＳ１１の代わりにステップＳ２１が実行される。ステップＳ１９の次にステップＳ２２が実行され、その次にステップＳ１２が実行される。ステップＳ１５の次にステップＳ２５およびＳ２６が実行され、その次にステップＳ１６が実行される。 The same step number is assigned to the same procedure as the operation procedure of the first configuration example shown in FIG. In the example of FIG. 9, step S21 is executed instead of step S11. Step S22 is executed after step S19, and then step S12 is executed. After step S15, steps S25 and S26 are executed, and then step S16 is executed.
順序ツリー生成（ステップＳ２１）において、制御装置１０は、物品群６の状態を抽出するとともに、物品を移動する順序の全ての組合せとして、順序ツリーを生成する。例えば、制御装置１０は、撮影装置１１が撮影した物品群６の画像から、物品群６を構成する各物品の種類、位置および姿勢等といった状態を抽出し、それらの物品をピックし、移動してプレイスする順序を示す順序ツリーを生成してもよい。あるいは、各物品の状態を示す情報がほかの手段で取得できる場合はその情報を利用してもよい。
In order tree generation (step S21), the
次に、ノード選択（ステップＳ２２）において、制御装置１０は、順序ツリーのうちの一つのノードを選択する。ここで、ノードとは、物品群６の積層状態と次に移動する物品とを一つの状態として表したものである。次に、制御装置１０は、選択したノードについて、ピック・プレイス動作生成（ステップＳ１２）から動作選択（ステップＳ１５）までを、第一の構成例と同様に実行する。この段階で、選択したノードに対するピック動作、プレイス動作、移動動作および総合評価値が決定される。
Next, in the node selection (step S22), the
制御装置１０は、順序ツリーの全てのノードに対して評価値の算出が完了したかを判定し（ステップＳ２５）、完了していなければ残りのノードに対してノード選択（ステップＳ２２）以降の処理を繰り返す。すべてのノードについて総合評価値を算出したのち、制御装置１０は、最小評価値経路探索（ステップＳ２６）で、総合評価値の和が最小となる移動順序を求める。最小評価値経路探索法として、ダイクストラ法などの一般的な手法を用いることができる。
The
次に、総合評価値判定（ステップＳ１６）において、制御装置１０は、動作選択の成功、失敗を判定する。失敗と判定された場合には、制御装置１０は、異常処理（ステップＳ１８）を実行する。成功と判定された場合には、制御装置１０は、制御信号出力（ステップＳ１７）で、移動順序に従って、ピック動作、プレイス動作および移動動作をロボットの制御信号に変換したのち、通信部１１３を介して、ロボット１に出力する。
Next, in the comprehensive evaluation value determination (step S16), the
以上のフローチャートにおいて、制御装置１０は、動作選択（ステップＳ１５）を実行せず、ピック動作、プレイス動作および移動動作の複数の組合せを順序ツリーに反映させたのち、最小評価値経路探索（ステップＳ２６）でそれらのいずれかを選択してもよい。また、ハンドの交換時間を総合評価値に含めてもよい。
In the above flowchart, the
上記の第二の構成例によれば、ハンド交換しながら物品を移動させるための最適な順序を生成することができる。特に、複数種類の物品が混在して積まれている物品群６に対し、物品毎に把持しやすいハンドを用いることができるため、ハンド交換時間を考慮しても、物品にダメージを与えることなく、短時間で移動させることができる。
According to the second configuration example described above, it is possible to generate an optimum order for moving articles while exchanging hands. In particular, for the
＜制御装置の第三の構成例＞ <Third configuration example of the control device>
制御装置の第三の構成例について、図１０～図１２を用いて説明する。 A third configuration example of the control device will be described with reference to FIGS. 10 to 12.
図１０は、本発明の別の実施例における制御装置１０の構成の一例を示すブロック図である。
FIG. 10 is a block diagram showing an example of the configuration of the
なお、図１０において、図２に示した第一の構成例と同じ機能には、同じ番号を割り振っている。図１０に示す制御装置１０は、図２に示したものと同様の構成に加えて、吸着パターン生成部１３１を有する。吸着パターン生成部１３１は、複数の吸着パッドを持つ吸着ハンドにおいて、各吸着パッドの吸引圧力制御情報を生成する。
In FIG. 10, the same number is assigned to the same function as the first configuration example shown in FIG. The
図１１は、本発明の別の実施例における制御装置１０の動作手順の一例を示すフローチャートである。
FIG. 11 is a flowchart showing an example of the operation procedure of the
なお、図３に示した第一の構成例と同じ手順には、同じステップ番号を割り振っている。図１１の例では、ステップＳ１２の次にステップＳ３１が実行され、その次にステップＳ１３が実行される。吸着パターン生成（ステップＳ３１）において、制御装置１０は、複数の吸着パッドを持つ吸着ハンドにおいて、各吸着パッドの吸引圧力制御情報を生成する。
The same step number is assigned to the same procedure as that of the first configuration example shown in FIG. In the example of FIG. 11, step S31 is executed after step S12, and then step S13 is executed. In the suction pattern generation (step S31), the
図１２は、本発明の別の実施例における吸引圧力制御が可能な制御型吸着ハンドの一例を示す説明図である。 FIG. 12 is an explanatory diagram showing an example of a controlled suction hand capable of controlling suction pressure in another embodiment of the present invention.
制御型吸着ハンド１３１１には、複数の吸着パッド１３１２が配置されている。図１２の例では、それぞれの吸着パッド１３１２が円形で示され、４８個の吸着パッド１３１２が６行×８列に配列されている。制御装置１０は、各吸着パッド１３１２の吸引圧力を制御することができる。一点鎖線の矩形で示す物品位置１３１３は、吸着ハンド１３１１に対する物品の位置を示しており、撮影装置１１で認識した物品形状および位置から算出することができる。
A plurality of
一般的に、段ボール箱および紙箱は、直方体形状であり、頂点部分は三面の壁で構成されているため、構造的に強度が高い。箱の中に入れられた内容部にかかる重力によって、箱の側壁が下に引っ張られるような力が働くが、上面の頂点部分を吸着把持することによって、上面を曲げる力を発生させることなく、壁にかかる重力を支えることができる。したがって、箱上面のミシン目を破壊しない吸着を可能とするためには、物品位置１３１３に対し、箱の頂点付近にある吸着パッドを高い圧力で吸引する高圧吸着パッド１３１４とし、その他の吸着パッドの吸引力をＯＦＦして無吸引吸着パッド１３１５とすることが、好適である。
Generally, a cardboard box and a paper box have a rectangular parallelepiped shape, and the apex portion is composed of a three-sided wall, so that the strength is structurally high. Gravity applied to the contents of the box exerts a force that pulls the side wall of the box downward, but by sucking and gripping the apex of the upper surface, it does not generate a force to bend the upper surface. It can support the gravity on the wall. Therefore, in order to enable suction without destroying the perforations on the upper surface of the box, a high-
把持する物品が重く、頂点部分の高圧吸着パッド１３１４だけでは移動に必要な吸着力を得られない場合は、高圧吸着パッド１３１４の内側に配置されている吸着パッドを、高圧吸着パッド１３１４より小さい圧力で吸引する低圧吸着パッド１３１６とすることで、重い物品を持ち上げる吸着力を確保することも可能とする。頂点近傍にある吸着パッドより、上面中央部にある吸着パッドの吸引圧力を小さくすることで、箱上面の反りを凹状にすることができるため、箱上面にミシン目がある箱においても、ミシン目部分にかかる力を小さくすることができる。
If the article to be gripped is heavy and the suction force required for movement cannot be obtained only with the high-
なお、図１２の例では、すべての吸着パッド１３１２を円形で示し、それらのうち高圧吸着パッド１３１４を黒塗りの円形で、無吸引吸着パッド１３１５を白抜きの円形で、低圧吸着パッド１３１６をグレーに網掛けした円形で、それぞれ示している。また、図１２に示した複数の円形の吸着パッド１３１２は一例であり、実際の吸着パッド１３１２の形状は円形に限定されず、その数も１以上であれば図示したものに限定されない。例えば、吸着面全面をスポンジ状のパッドで覆い、吸着部に穴をあけた構造の吸着パッドを用いてもよい。
In the example of FIG. 12, all the
最適な吸着パターンを得るために、制御装置１０は、撮影装置１１で取得した画像から、最適な吸着パターンを生成してもよい。あるいは、撮影装置１１で撮影した吸着面画像と、様々な吸着パターンと、ピック動作、プレイス動作および移動動作と、その吸着パターンで吸着して動作させたときに生じた箱ダメージとを一つにまとめた情報をニューラルネットワークに入力し、深層強化学習によって獲得した吸着パターン生成器によって、吸着パターンを生成する方式を採用してもよい。
In order to obtain the optimum adsorption pattern, the
吸着パターンによって、吸着面強度が変化することから、ピック・プレイス動作評価値生成や移動動作・評価値生成における評価値も変化する。複数の吸着パターンを動作によって使い分けることにより、ピック動作、プレイス動作および移動動作の評価値を向上させ、箱へのダメージをさらに低減することができる。 Since the suction surface strength changes depending on the suction pattern, the evaluation values in the pick-place operation evaluation value generation and the movement operation / evaluation value generation also change. By properly using a plurality of suction patterns according to the operation, the evaluation values of the pick operation, the place operation, and the moving operation can be improved, and the damage to the box can be further reduced.
記憶部１０１に格納されている情報について図１３～図１７を用いて説明する。この情報は、図２、図８および図１０のいずれの構成にも共通する。
The information stored in the
図１３は、本発明の一実施例におけるハンド情報記憶領域１０２に格納されているハンド情報管理テーブル１０２０の一例を示す説明図である。
FIG. 13 is an explanatory diagram showing an example of the hand information management table 1020 stored in the hand
ハンド情報管理テーブル１０２０には、Ｉ型またはＬ型などのハンド形状、メイン吸着部およびサブ吸着部の寸法、ならびに吸着タイプ（例えば全面を吸着するタイプまたは吸着エリアを制御できるタイプのいずれであるか、および、吸着パッドの配列）などが格納されている。 The hand information management table 1020 shows the hand shape such as I type or L type, the dimensions of the main suction part and the sub suction part, and whether the suction type (for example, the type that sucks the entire surface or the type that can control the suction area). , And the arrangement of suction pads) are stored.
図１４は、本発明の一実施例における物品情報記憶領域１０３に格納されている物品情報管理テーブル１０３０の一例を示す説明図である。
FIG. 14 is an explanatory diagram showing an example of the article information management table 1030 stored in the article
物品情報管理テーブル１０３０には、物品タイプ、物性、ピック基本動作、プレイス動作、および吸着に関する条件が格納されている。ここで、吸着面Ａ、Ｂとは、例えば、６面体の場合、各面にＡ～Ｆのアルファベットを割り付けることで、吸着ハンドによって吸着する対象の面を特定可能としている。また、移動方向は、ロボット座標系における（ｘ，ｙ，ｚ，Ｒｏｌｌ，Ｐｉｔｃｈ，Ｙａｗ）で、移動方向を表している。また、吸着可能面は、壁に穴が開いているために吸着できないといった物品の特性上の制約、または、プレイス姿勢を取ることができないなどの動作上の制約によって決定することができる。プレイス姿勢は、ロボット座標系の（ｘ，ｙ，ｚ）方向に対して、Ｗ，Ｌ，Ｈ寸法を持つ物品のどの辺を向けるかという指定方法例を示している。 The article information management table 1030 stores conditions relating to the article type, physical properties, pick basic operation, place operation, and adsorption. Here, the suction surfaces A and B are, for example, in the case of a hexahedron, by assigning the alphabets A to F to each surface, it is possible to specify the surface to be sucked by the suction hand. Further, the moving direction is (x, y, z, Roll, Pitch, Yaw) in the robot coordinate system, and represents the moving direction. Further, the adsorbable surface can be determined by the characteristic restriction of the article such as being unable to be adsorbed due to the hole in the wall, or the operational restriction such as being unable to take the place posture. The place posture shows an example of a method of specifying which side of an article having W, L, and H dimensions should be oriented with respect to the (x, y, z) direction of the robot coordinate system.
図１５は、本発明の一実施例における動作情報記憶領域１０５に格納されている動作情報管理テーブル１０５０の一例を示す説明図である。
FIG. 15 is an explanatory diagram showing an example of the operation information management table 1050 stored in the operation
動作情報管理テーブル１０５０には、生成した把持位置、ピック動作、プレイス動作、および移動動作に関する情報について、複数の中間データと一つの最終データ（すなわち複数の中間データの中から最終的に選択されたデータ）が格納されている。 In the operation information management table 1050, a plurality of intermediate data and one final data (that is, a plurality of intermediate data are finally selected for information regarding the generated gripping position, pick operation, place operation, and movement operation. Data) is stored.
図１６は、本発明の一実施例における吸着面強度情報記憶領域１０４に格納されている吸着面強度情報管理テーブル１０４０の一例を示す説明図である。
FIG. 16 is an explanatory diagram showing an example of the suction surface strength information management table 1040 stored in the suction surface strength
吸着面強度情報管理テーブル１０４０は、吸着面（すなわち吸着ハンドによる吸着の対象となる物品の面）と動作のマトリクスとなっている。縦軸は吸着面を示しており、メイン吸着面とサブ吸着面との組合せである。ここで、メイン吸着面とは、Ｉ型ハンドによって吸着する対象の物品の面、又は、Ｌ型ハンドの二つの吸着面のうち、主となる吸着面によって吸着する対象の物品の面である。一方、サブ吸着面とは、Ｌ型ハンドのうち、補助的な吸着面によって吸着する対象の物品の面である。Ｉ型ハンドの場合、物品の１面のみが吸着されるため、サブ吸着面はない。 The suction surface strength information management table 1040 is a matrix of the suction surface (that is, the surface of the article to be sucked by the suction hand) and the operation. The vertical axis shows the adsorption surface, which is a combination of the main adsorption surface and the sub adsorption surface. Here, the main suction surface is the surface of the object to be adsorbed by the I-type hand, or the surface of the object to be adsorbed by the main adsorption surface of the two adsorption surfaces of the L-type hand. On the other hand, the sub-suction surface is the surface of the object to be adsorbed by the auxiliary suction surface in the L-shaped hand. In the case of the I-type hand, since only one surface of the article is adsorbed, there is no sub-adsorption surface.
横軸は動作方向を示しており、ロボット座標系における、並進（ｘ，ｙ，ｚ）と回転（Ｒ，Ｐ，Ｙ）である。評価値は、最大可搬重量を示しており、例えば、メイン吸着面がＡ、サブ吸着面がＢ、移動方法が並進ｚ－であるとき、評価値は４０ｋｇとなる。本マトリクスは、ハンド番号（Ｎｏ．）と物品番号（Ｎｏ．）に関連付けられており、ハンド種類数と物品種類数の積の数だけマトリクスが格納されている。 The horizontal axis indicates the direction of operation, which is translation (x, y, z) and rotation (R, P, Y) in the robot coordinate system. The evaluation value indicates the maximum payload. For example, when the main suction surface is A, the sub suction surface is B, and the movement method is translation z-, the evaluation value is 40 kg. This matrix is associated with a hand number (No.) and an article number (No.), and the matrix is stored as many as the product of the number of hand types and the number of article types.
図１７は、本発明の一実施例における周辺環境情報記憶領域１０６に格納されている周辺環境情報管理テーブル１０６０の一例を示す説明図である。
FIG. 17 is an explanatory diagram showing an example of the peripheral environment information management table 1060 stored in the peripheral environment
周辺環境情報管理テーブル１０６０には、周辺環境に配置されている環境物の形状、サイズおよび配置位置が格納されている。 The surrounding environment information management table 1060 stores the shape, size, and placement position of the environmental objects arranged in the surrounding environment.
図１８は、本発明の一実施例における表示部１１２に表示される表示情報１１２０の一例を示す説明図である。
FIG. 18 is an explanatory diagram showing an example of
物品情報表示部１１２１には物品の品種と物性が、ハンド情報表示部１１２２にはハンドＮｏ．および吸着パターンが表示される。把持位置・移動方向表示部１１２３には、物品群６における把持対象の物品の位置、ハンドの吸着面と方向、および移動方向が表示される。移動姿勢表示部１１２４には、移動時の物品姿勢が表示される。移動情報表示部１１２５には、箱位置毎の移動順序、吸着位置、移動方向、吸着面強度、移動姿勢が一覧表で表示される。
The article
変更ボタン１１２６を操作することによって、移動情報表示部１１２５に表示された情報を編集可能となる。実行ボタン１１２７を操作することによって、移動情報表示部１１２５に表示された移動作業が実行される。また、自動運転ボタン１１２８を操作することによって、自動運転モードと、確認・実行モードとを切り替えることができる。吸着面強度情報ボタン１１２９を操作することによって、吸着面強度情報を編集することができる。
By operating the
以上説明した実施例によれば、箱の強度に応じた動作を生成することができ、把持物をダメージなく高速で移動させることが可能となり、スループットの向上や設備稼働率の向上、把持物のダメージ低減を図ることができる。 According to the above-described embodiment, it is possible to generate an operation according to the strength of the box, the gripped object can be moved at high speed without damage, the throughput is improved, the equipment operating rate is improved, and the gripped object is improved. Damage can be reduced.
なお、上記の実施例ではハンド３が吸着ハンドである場合を例として説明したが、ハンド３が例えば複数の指によって物品を挟むことで把持する多指ハンドであってもよい。その場合、吸着面強度情報の代わりに、ハンドによる把持部分の強度情報が保持され、それに基づいてピック動作、プレイス動作および移動動作の評価値が計算される。
In the above embodiment, the case where the
また、上記の実施例では制御装置１０が自動移動機械１００を制御する例を示したが、制御装置１０が評価値に基づいて選択した動作を提示することで、手動の移動機械の操作をサポートすることもできる。
Further, in the above embodiment, an example in which the
また、本発明の実施形態のシステムは次のように構成されてもよい。 Further, the system of the embodiment of the present invention may be configured as follows.
（１）自動移動機械（例えば自動移動機械１００又はその中の移動装置１２）の制御装置（例えば制御装置１０）であって、自動移動機械は、物品を把持するハンド（例えばハンド３）を有し、制御装置は、プロセッサ（例えばＣＰＵ１２０）と、記憶部（例えば記憶部１０１）と、を有し、記憶部は、前記物品を前記ハンドで把持したときの物品の把持部分の強度を示す強度情報（例えば吸着面強度情報管理テーブル１０４０）を保持し、プロセッサは、第１の位置に置かれた物品をハンドで把持するピック動作と、把持された物品を第１の位置とは異なる第２の位置に配置するプレイス動作と、の複数の組合せを生成し（例えばステップＳ１２）、強度情報に基づいて、生成されたピック動作の評価値及び生成されたプレイス動作の評価値を計算し（例えばステップＳ１３）、生成されたピック動作とプレイス動作との組合せの各々について、ピック動作の終点からプレイス動作の始点まで把持された物品を移動するための移動動作を生成し（例えばステップＳ１４）、強度情報に基づいて、移動動作の評価値を計算し（例えばステップＳ１４）、評価値に基づいて、ピック動作、プレイス動作及び移動動作の組合せのいずれかを選択する（例えばステップＳ１５、Ｓ１６）。
(1) A control device (for example, a control device 10) of an automatic moving machine (for example, the automatic moving
これによって、把持位置・姿勢、ピック動作、プレイス動作および移動動作を、把持する物品の強度に応じて、適切に生成することができ、ロボットの稼働率向上と作業効率向上、物品の損傷リスク低減を実現することができる。 As a result, the gripping position / posture, picking motion, place motion, and moving motion can be appropriately generated according to the strength of the article to be gripped, and the operating rate of the robot is improved, the work efficiency is improved, and the risk of damage to the article is reduced. Can be realized.
（２）上記（１）において、プロセッサは、複数の物品の各々の状態を示す情報に基づいて、複数の物品を第１の位置から第２の位置に移動するための移動順序を複数生成し（例えばステップＳ２１）、生成したそれぞれの移動順序に従って、複数の物品の各々について、評価値に基づいて、ピック動作、プレイス動作及び移動動作の組合せのいずれかを選択し（例えばステップＳ１５）、評価値に基づいて、複数の移動順序のいずれかを選択する（例えばステップＳ２６、Ｓ１６）。 (2) In the above (1), the processor generates a plurality of movement orders for moving the plurality of articles from the first position to the second position based on the information indicating the state of each of the plurality of articles. (For example, step S21), for each of the plurality of articles, one of the combination of pick motion, place motion, and move motion is selected based on the evaluation value according to each generated movement order (for example, step S15) and evaluated. Select one of the plurality of movement orders based on the value (eg, steps S26, S16).
これによって、ハンド交換しながら物品を移動させるための最適な順序を生成することができる。 This makes it possible to generate an optimal order for moving articles while exchanging hands.
（３）上記（１）において、物品の形状および位置を検出する撮影部（例えば撮影装置１１）をさらに有し、ハンドは、１以上の吸着面を有し、各吸着面が吸引力を制御可能な複数の吸着パッド（例えば吸着パッド１３１２）を有する吸着ハンドであり、強度情報は、物品のハンドによる吸着対象の面の強度を示す情報であり、プロセッサは、物品の位置及び形状に基づいて、物品を把持するための吸着パッドの吸引パターンを生成し（例えばステップＳ３１）、強度情報及び吸引パターンに基づいて、ピック動作、プレイス動作及び移動動作の評価値を計算する。 (3) In the above (1), the hand further has a photographing unit (for example, an imaging device 11) for detecting the shape and position of the article, the hand has one or more suction surfaces, and each suction surface controls the suction force. It is a suction hand having a plurality of possible suction pads (for example, suction pad 1312), and the strength information is information indicating the strength of the surface to be sucked by the hand of the article, and the processor is based on the position and shape of the article. , A suction pattern of a suction pad for gripping an article is generated (for example, step S31), and evaluation values of a pick operation, a place operation, and a movement operation are calculated based on the strength information and the suction pattern.
これによって、ピック動作、プレイス動作および移動動作の評価値を向上させ、箱へのダメージをさらに低減することができる。 As a result, the evaluation values of the pick motion, the place motion, and the move motion can be improved, and the damage to the box can be further reduced.
（４）上記（１）において、記憶部は、物品の性質及び物品に対する動作の条件を示す物品情報（例えば物品情報管理テーブル１０３０）、ハンドの性質を示すハンド情報（例えばハンド情報管理テーブル１０２０）、並びに、ピック動作、プレイス動作及び移動動作が行われる環境に存在する物体に関する環境情報（例えば周辺環境情報管理テーブル１０６０）をさらに保持し、プロセッサは、物品情報、ハンド情報、物品情報及び環境情報に基づいて、隣接して積載された物品及び環境に存在する物体に干渉しないように、ピック動作、プレイス動作及び移動動作を生成する。 (4) In the above (1), the storage unit stores the article information (for example, the article information management table 1030) indicating the property of the article and the conditions of operation for the article, and the hand information indicating the property of the hand (for example, the hand information management table 1020). , And further retains environmental information (eg, peripheral environment information management table 1060) about objects present in the environment in which the pick, place, and move movements are performed, and the processor has article information, hand information, article information, and environmental information. Based on, pick motion, place motion and move motion are generated so as not to interfere with adjacently loaded articles and objects existing in the environment.
これによって、実行可能な動作を生成することができる。 This can generate a feasible action.
（５）上記（１）において、前記記憶部は、前記ハンドの性質を示すハンド情報（例えばハンド情報管理テーブル１０２０）をさらに含み、 (5) In the above (1), the storage unit further includes hand information (for example, a hand information management table 1020) indicating the nature of the hand.
強度情報は、ハンドの形状と、物品のハンドによる把持部分と、の組み合わせごとの強度を示す情報を含む。 The strength information includes information indicating the strength of each combination of the shape of the hand and the gripped portion of the article by the hand.
これによって、評価値を適切に計算することができる。 This makes it possible to appropriately calculate the evaluation value.
（６）上記（５）において、強度情報は、ハンドの形状と、物品のハンドによる把持部分と、ハンドの動作と、の組合せに対応付けられた最大可搬重量を含み、プロセッサは、最大可搬重量から物品の実際の重量を減算した差分が大きいほど評価が高くなるように、前記ピック動作及び前記プレイス動作の評価値を計算する（例えば式１）。 (6) In the above (5), the strength information includes the maximum payload associated with the combination of the shape of the hand, the gripped portion of the article by the hand, and the movement of the hand, and the processor can be the maximum. The evaluation values of the pick operation and the place operation are calculated so that the larger the difference obtained by subtracting the actual weight of the article from the carried weight, the higher the evaluation (for example, Equation 1).
これによって、評価値を適切に計算することができる。 This makes it possible to appropriately calculate the evaluation value.
（７）上記（１）において、プロセッサは、ピック動作及びプレイス動作の生成において、物品を把持するハンドの種類、及び、ハンドが把持する物品の面を決定し、移動動作の生成において、物品を把持するハンドの種類、及び、ハンドが把持する物品の面のいずれも同一であるピック動作とプレイス動作との組合せについて、ピック動作の終点からプレイス動作の始点までの移動動作を生成する。 (7) In the above (1), the processor determines the type of the hand holding the article and the surface of the article held by the hand in the generation of the pick motion and the place motion, and determines the surface of the article held by the hand, and in the generation of the moving motion, the article is selected. For a combination of a pick motion and a place motion in which both the type of hand to be gripped and the surface of the article held by the hand are the same, a movement motion from the end point of the pick motion to the start point of the place motion is generated.
これによって、作業効率のよい動作を生成することができる。 As a result, it is possible to generate a work-efficient operation.
（８）上記（１）において、プロセッサは、ピック動作及びプレイス動作の生成において、物品を把持するハンドの種類、及び、ハンドが把持する物品の面を決定し、移動動作の生成において、ハンドが把持する物品の面が異なる前記ピック動作とプレイス動作との組合せについて、ピック動作の終点からプレイス動作の始点までの移動動作を生成する。 (8) In the above (1), the processor determines the type of the hand holding the article and the surface of the article held by the hand in the generation of the pick motion and the place motion, and the hand determines the surface of the article held by the hand, and in the generation of the moving motion, the hand For the combination of the pick motion and the place motion having different surfaces of the articles to be gripped, a movement motion from the end point of the pick motion to the start point of the place motion is generated.
これによって、ハンドの持ち替えが必要となる場合でも、作業効率のよい動作を生成することができる。 As a result, even when it is necessary to change hands, it is possible to generate a work-efficient operation.
（９）上記（１）において、前記ハンドは、それぞれが物品の吸着対象の面を吸着する一つ以上の吸着面を有し、各吸着面が一つ以上の吸着パッド（例えば吸着パッド１３１２）を有する吸着ハンドであり、強度情報は、物品のハンドによる吸着対象の面の強度を示す情報を含み、プロセッサは、一つ以上の吸着面の吸着対象の面に生じる変形に伴う評価値を、移動動作の評価値として計算する（例えば式３）。 (9) In the above (1), each of the hands has one or more suction surfaces for sucking the surface of the article to be sucked, and each suction surface has one or more suction pads (for example, suction pad 1312). The strength information includes information indicating the strength of the surface of the object to be adsorbed by the hand of the article, and the processor evaluates the evaluation value due to the deformation occurring on the surface of the object of adsorption of one or more adsorption surfaces. It is calculated as an evaluation value of the moving motion (for example, Equation 3).
これによって、評価値を適切に計算することができる。 This makes it possible to appropriately calculate the evaluation value.
（１０）上記（９）において、強度情報は、物品のハンドによる吸着対象の面の最大許容曲げモーメントを含み、ハンドは、それぞれが物品の異なる面を吸着する二つの吸着面を有し、プロセッサは、二つの吸着面の吸着対象の各々の面に生じる曲げモーメントの大きさと各々の面の最大許容曲げモーメントとの比が同一に近づくように、移動動作において把持される物品の傾きを計算する。 (10) In the above (9), the strength information includes the maximum allowable bending moment of the surface to be sucked by the hand of the article, and the hand has two suction surfaces, each of which sucks a different surface of the article, and the processor. Calculates the tilt of the article gripped in the moving motion so that the ratio of the magnitude of the bending moment generated on each surface of the two suction surfaces to the maximum allowable bending moment of each surface approaches the same. ..
これによって、移動動作による物品の損傷リスクを低減することができる。 This makes it possible to reduce the risk of damage to the article due to the moving motion.
（１１）上記（１）において、プロセッサは、ピック動作の評価値、プレイス動作の評価値及び移動動作の評価値の合計に基づいて、最も評価が高くなるピック動作、プレイス動作及び移動動作の組合せを選択する（例えば式４）。 (11) In the above (1), the processor is a combination of the pick operation, the place operation, and the move operation, which have the highest evaluation based on the sum of the evaluation value of the pick operation, the evaluation value of the place operation, and the evaluation value of the move operation. Is selected (for example, Equation 4).
これによって、総合的な物品の損傷のリスクが低い動作を選択することができる。 This makes it possible to select an operation with a low risk of damage to the overall article.
（１２）上記（３）において、プロセッサは、吸着面の大きさが物品の吸着対象の面の大きさと同じ又はそれより大きく、吸着面が物品の吸着対象の面の全体を覆うように吸着し、かつ、物品の吸着対象の面が矩形である場合、吸着面の吸着パッドのうち、矩形の面の頂点部分を吸引する吸着パッド（例えば高圧吸着パッド１３１４）を吸引し、矩形の面の頂点以外の部分を吸引する吸着パッドを吸引しないように、吸着パッドの吸引パターンを生成する。 (12) In the above (3), the processor adsorbs so that the size of the suction surface is the same as or larger than the size of the surface of the article to be adsorbed, and the adsorption surface covers the entire surface of the object to be adsorbed. In addition, when the surface to be adsorbed by the article is rectangular, the suction pad (for example, the high-pressure suction pad 1314) that sucks the apex portion of the rectangular surface among the suction pads on the suction surface is sucked, and the apex of the rectangular surface is sucked. A suction pattern for the suction pad is generated so that the suction pad that sucks the parts other than the above is not sucked.
これによって、ピック動作、プレイス動作および移動動作の評価値を向上させ、物品の損傷リスクをさらに低減することができる。 As a result, the evaluation values of the pick motion, the place motion and the move motion can be improved, and the risk of damage to the article can be further reduced.
（１３）上記（３）において、プロセッサは、吸着面の大きさが物品の吸着対象の面の大きさと同じ又はそれより大きく、吸着面が物品の吸着対象の面の全体を覆うように吸着し、かつ、物品の吸着対象の面が矩形である場合、吸着面の吸着パッドのうち、矩形の面の頂点部分を吸引する吸着パッド（例えば高圧吸着パッド１３１４）の吸引圧力が、矩形の面の頂点以外の部分を吸引する少なくともいずれかの吸着パッド（例えば低圧吸着パッド１３１６）の吸引圧力より高くなるように、吸着パッドの吸引パターンを生成する。 (13) In the above (3), the processor adsorbs the suction surface so that the size of the suction surface is the same as or larger than the size of the surface of the article to be adsorbed, and the suction surface covers the entire surface of the article to be adsorbed. In addition, when the surface to be sucked by the article is rectangular, the suction pressure of the suction pad (for example, high-pressure suction pad 1314) that sucks the apex portion of the rectangular surface among the suction pads on the suction surface is the rectangular surface. The suction pattern of the suction pad is generated so as to be higher than the suction pressure of at least one suction pad (for example, the low pressure suction pad 1316) that sucks the portion other than the apex.
これによって、ピック動作、プレイス動作および移動動作の評価値を向上させ、物品の損傷リスクをさらに低減することができる。 As a result, the evaluation values of the pick motion, the place motion and the move motion can be improved, and the risk of damage to the article can be further reduced.
（１４）上記（１）において、ピック動作の評価値、プレイス動作の評価値及び移動動作の評価値は、把持された物品の損傷の起こりにくさの評価値であり、プロセッサは、評価値に基づいて、物品の損傷が起こりにくいピック動作、プレイス動作及び移動動作の組合せを選択する。 (14) In the above (1), the evaluation value of the pick operation, the evaluation value of the place operation, and the evaluation value of the moving operation are the evaluation values of the resistance to damage of the gripped article, and the processor is used as the evaluation value. Based on this, a combination of pick motion, place motion, and move motion that is less likely to damage the article is selected.
これによって、物品の損傷リスクを低減することができる。 This can reduce the risk of damage to the article.
なお、本発明は上記した実施例に限定されるものではなく、様々な変形例が含まれる。例えば、上記した実施例は本発明のより良い理解のために詳細に説明したのであり、必ずしも説明の全ての構成を備えるものに限定されるものではない。また、ある実施例の構成の一部を他の実施例の構成に置き換えることが可能であり、また、ある実施例の構成に他の実施例の構成を加えることが可能である。また、各実施例の構成の一部について、他の構成の追加・削除・置換をすることが可能である。 The present invention is not limited to the above-described embodiment, and includes various modifications. For example, the above-mentioned examples have been described in detail for a better understanding of the present invention, and are not necessarily limited to those having all the configurations of the description. Further, it is possible to replace a part of the configuration of one embodiment with the configuration of another embodiment, and it is possible to add the configuration of another embodiment to the configuration of one embodiment. Further, it is possible to add / delete / replace a part of the configuration of each embodiment with another configuration.
また、上記の各構成、機能、処理部、処理手段等は、それらの一部又は全部を、例えば集積回路で設計する等によってハードウェアで実現してもよい。また、上記の各構成、機能等は、プロセッサがそれぞれの機能を実現するプログラムを解釈し、実行することによってソフトウェアで実現してもよい。各機能を実現するプログラム、テーブル、ファイル等の情報は、不揮発性半導体メモリ、ハードディスクドライブ、ＳＳＤ（Ｓｏｌｉｄ Ｓｔａｔｅ Ｄｒｉｖｅ）等の記憶デバイス、または、ＩＣカード、ＳＤカード、ＤＶＤ等の計算機読み取り可能な非一時的データ記憶媒体に格納することができる。 Further, each of the above configurations, functions, processing units, processing means and the like may be realized by hardware by designing a part or all of them by, for example, an integrated circuit. Further, each of the above configurations, functions, and the like may be realized by software by the processor interpreting and executing a program that realizes each function. Information such as programs, tables, and files that realize each function can be stored in non-volatile semiconductor memories, hard disk drives, storage devices such as SSDs (Solid State Drives), or computer-readable non-readable devices such as IC cards, SD cards, and DVDs. It can be stored in a temporary data storage medium.
また、制御線及び情報線は説明上必要と考えられるものを示しており、製品上必ずしも全ての制御線及び情報線を示しているとは限らない。実際にはほとんど全ての構成が相互に接続されていると考えてもよい。 In addition, the control lines and information lines indicate what is considered necessary for explanation, and do not necessarily indicate all the control lines and information lines in the product. In practice, it can be considered that almost all configurations are interconnected.
１・・・ロボット
６・・・物品群
１０・・・制御装置
１１・・・撮影装置
１２・・・移動装置
１００・・・自動移動機械
1 ...
Claims (15)
前記移動機械は、物品を把持するハンドを有し、
前記制御装置は、プロセッサと、記憶部と、を有し、
前記記憶部は、前記物品を前記ハンドで把持したときの前記物品の把持部分の強度を示す強度情報を保持し、
前記プロセッサは、
第１の位置に置かれた物品を前記ハンドで把持するピック動作と、把持された前記物品を前記第１の位置とは異なる第２の位置に配置するプレイス動作と、の複数の組合せを生成し、
前記強度情報に基づいて、生成された前記ピック動作の評価値及び生成された前記プレイス動作の評価値を計算し、
生成された前記ピック動作と前記プレイス動作との組合せの各々について、前記ピック動作の終点から前記プレイス動作の始点まで前記把持された物品を移動するための移動動作を生成し、
前記強度情報に基づいて、前記移動動作の評価値を計算し、
前記評価値に基づいて、前記ピック動作、前記プレイス動作及び前記移動動作の組合せのいずれかを選択することを特徴とする制御装置。 It is a control device for mobile machines.
The moving machine has a hand for gripping an article and has a hand.
The control device includes a processor, a storage unit, and the like.
The storage unit holds strength information indicating the strength of the gripped portion of the article when the article is gripped by the hand.
The processor
Generates a plurality of combinations of a pick motion in which the article placed in the first position is gripped by the hand and a place motion in which the gripped article is placed in a second position different from the first position. death,
Based on the intensity information, the generated evaluation value of the pick motion and the generated evaluation value of the place motion are calculated.
For each of the generated combinations of the pick motion and the place motion, a moving motion for moving the gripped article from the end point of the pick motion to the start point of the place motion is generated.
Based on the strength information, the evaluation value of the moving motion is calculated.
A control device comprising selecting one of a combination of the pick operation, the place operation, and the moving operation based on the evaluation value.
前記プロセッサは、
複数の前記物品の各々の状態を示す情報に基づいて、前記複数の物品を前記第１の位置から前記第２の位置に移動するための移動順序を複数生成し、
生成したそれぞれの前記移動順序に従って、前記複数の物品の各々について、前記評価値に基づいて、前記ピック動作、前記プレイス動作及び前記移動動作の組合せのいずれかを選択し、
前記評価値に基づいて、前記複数の移動順序のいずれかを選択することを特徴とする制御装置。 The control device according to claim 1.
The processor
Based on the information indicating the state of each of the plurality of articles, a plurality of movement sequences for moving the plurality of articles from the first position to the second position are generated.
For each of the plurality of articles according to the generated movement order, one of the combination of the pick operation, the place operation and the movement operation is selected based on the evaluation value.
A control device comprising selecting one of the plurality of movement orders based on the evaluation value.
前記物品の形状および位置を検出する撮影部をさらに有し、
前記ハンドは、１以上の吸着面を有し、各吸着面が吸引力を制御可能な複数の吸着パッドを有する吸着ハンドであり、
前記強度情報は、前記物品の前記ハンドによる吸着対象の面の強度を示す情報であり、
前記プロセッサは、
前記物品の位置及び形状に基づいて、前記物品を把持するための前記吸着パッドの吸引パターンを生成し、
前記強度情報及び前記吸引パターンに基づいて、前記ピック動作、前記プレイス動作及び前記移動動作の評価値を計算することを特徴とする制御装置。 The control device according to claim 1.
Further having a photographing unit for detecting the shape and position of the article,
The hand is a suction hand having one or more suction surfaces, and each suction surface has a plurality of suction pads whose suction force can be controlled.
The strength information is information indicating the strength of the surface of the article to be adsorbed by the hand.
The processor
Based on the position and shape of the article, a suction pattern of the suction pad for gripping the article is generated.
A control device for calculating evaluation values of the pick operation, the place operation, and the moving operation based on the intensity information and the suction pattern.
前記記憶部は、前記物品の性質及び前記物品に対する動作の条件を示す物品情報、前記ハンドの性質を示すハンド情報、並びに、前記ピック動作、前記プレイス動作及び前記移動動作が行われる環境に存在する物体に関する環境情報をさらに保持し、
前記プロセッサは、前記物品情報、前記ハンド情報及び前記環境情報に基づいて、隣接して積載された物品及び前記環境に存在する物体に干渉しないように、前記ピック動作、前記プレイス動作及び前記移動動作を生成することを特徴とする制御装置。 The control device according to claim 1.
The storage unit exists in an environment in which article information indicating the properties of the article and conditions for operation with respect to the article, hand information indicating the properties of the hand, and the pick operation, the place operation, and the movement operation are performed. It retains more environmental information about the object and
Based on the article information, the hand information, and the environment information, the processor performs the pick operation, the place operation, and the movement operation so as not to interfere with the adjacently loaded articles and objects existing in the environment. A control device characterized by producing.
前記記憶部は、前記ハンドの形状を示すハンド情報をさらに含み、
前記強度情報は、前記ハンドの形状と、前記物品の前記ハンドによる把持部分と、の組み合わせごとの強度を示す情報を含むことを特徴とする制御装置。 The control device according to claim 1.
The storage unit further includes hand information indicating the shape of the hand.
The strength information is a control device including information indicating the strength of each combination of the shape of the hand and the gripped portion of the article by the hand.
前記強度情報は、前記ハンドの形状と、前記物品の前記ハンドによる把持部分と、前記ハンドの動作と、の組合せに対応付けられた最大可搬重量を含み、
前記プロセッサは、前記最大可搬重量から前記物品の実際の重量を減算した差分が大きいほど評価が高くなるように、前記ピック動作及び前記プレイス動作の評価値を計算することを特徴とする制御装置。 The control device according to claim 5.
The strength information includes a maximum payload associated with a combination of the shape of the hand, the gripped portion of the article by the hand, and the movement of the hand.
The processor is characterized in that the evaluation value of the pick operation and the place operation is calculated so that the larger the difference obtained by subtracting the actual weight of the article from the maximum payload, the higher the evaluation. ..
前記プロセッサは、
前記ピック動作及び前記プレイス動作の生成において、前記物品を把持する前記ハンドの種類、及び、前記ハンドが把持する前記物品の面を決定し、
前記移動動作の生成において、前記物品を把持する前記ハンドの種類、及び、前記ハンドが把持する前記物品の面のいずれも同一である前記ピック動作と前記プレイス動作との組合せについて、前記ピック動作の終点から前記プレイス動作の始点までの移動動作を生成することを特徴とする制御装置。 The control device according to claim 1.
The processor
In the generation of the pick motion and the place motion, the type of the hand holding the article and the surface of the article held by the hand are determined.
In the generation of the moving motion, the combination of the pick motion and the place motion in which both the type of the hand holding the article and the surface of the article gripped by the hand are the same is the pick motion of the pick motion. A control device characterized by generating a moving motion from an end point to the start point of the place motion.
前記プロセッサは、
前記ピック動作及び前記プレイス動作の生成において、前記物品を把持する前記ハンドの種類、及び、前記ハンドが把持する前記物品の面を決定し、
前記移動動作の生成において、前記ハンドが把持する前記物品の面が異なる前記ピック動作と前記プレイス動作との組合せについて、前記ピック動作の終点から前記プレイス動作の始点までの移動動作を生成することを特徴とする制御装置。 The control device according to claim 1.
The processor
In the generation of the pick motion and the place motion, the type of the hand holding the article and the surface of the article held by the hand are determined.
In the generation of the moving motion, for the combination of the picking motion and the place motion in which the surfaces of the articles held by the hand are different, the moving motion from the end point of the pick motion to the start point of the place motion is generated. Characteristic control device.
前記ハンドは、それぞれが物品の吸着対象の面を吸着する一つ以上の吸着面を有し、各吸着面が一つ以上の吸着パッドを有する吸着ハンドであり、
前記強度情報は、前記物品の前記ハンドによる吸着対象の面の強度を示す情報を含み、
前記プロセッサは、前記一つ以上の吸着面の吸着対象の面に生じる変形に伴う評価値を、前記移動動作の前記評価値として計算することを特徴とする制御装置。 The control device according to claim 1.
The hand is a suction hand each having one or more suction surfaces for sucking a surface to be sucked by an article, and each suction surface has one or more suction pads.
The strength information includes information indicating the strength of the surface of the article to be adsorbed by the hand.
The processor is a control device, characterized in that an evaluation value associated with deformation of one or more suction surfaces to be attracted is calculated as the evaluation value of the movement operation.
前記強度情報は、前記物品の前記ハンドによる吸着対象の面の最大許容曲げモーメントを含み、
前記ハンドは、それぞれが前記物品の異なる面を吸着する二つの前記吸着面を有し、
前記プロセッサは、前記二つの吸着面の吸着対象の各々の面に生じる曲げモーメントの大きさと各々の面の最大許容曲げモーメントとの比が同一に近づくように、前記移動動作において把持される前記物品の傾きを計算することを特徴とする制御装置。 The control device according to claim 9.
The strength information includes the maximum permissible bending moment of the surface of the article to be attracted by the hand.
The hand has two said suction surfaces, each of which adsorbs a different surface of the article.
The processor is gripped in the moving motion so that the ratio of the magnitude of the bending moment generated on each surface of the suction target of the two suction surfaces to the maximum allowable bending moment of each surface approaches the same. A control device characterized by calculating the slope of.
前記プロセッサは、前記ピック動作の評価値、前記プレイス動作の評価値及び前記移動動作の評価値の合計に基づいて、最も評価が高くなる前記ピック動作、前記プレイス動作及び前記移動動作の組合せを選択することを特徴とする制御装置。 The control device according to claim 1.
The processor selects the combination of the pick operation, the place operation, and the move operation having the highest evaluation based on the sum of the evaluation value of the pick operation, the evaluation value of the place operation, and the evaluation value of the move operation. A control device characterized by
前記プロセッサは、前記吸着面の大きさが前記物品の吸着対象の面の大きさと同じ又はそれより大きく、前記吸着面が前記物品の吸着対象の面の全体を覆うように吸着し、かつ、前記物品の吸着対象の面が矩形である場合、前記吸着面の前記吸着パッドのうち、前記矩形の面の頂点部分を吸引する吸着パッドを吸引し、前記矩形の面の頂点以外の部分を吸引する吸着パッドを吸引しないように、前記吸着パッドの吸引パターンを生成することを特徴とする制御装置。 The control device according to claim 3.
The processor sucks the suction surface so that the size of the suction surface is equal to or larger than the size of the surface to be sucked by the article, the suction surface covers the entire surface of the suction target of the article, and the suction surface is covered. When the surface to be sucked by the article is rectangular, the suction pad that sucks the apex portion of the rectangular surface among the suction pads on the suction surface is sucked, and the portion other than the apex of the rectangular surface is sucked. A control device characterized in that a suction pattern of the suction pad is generated so as not to suck the suction pad.
前記プロセッサは、前記吸着面の大きさが前記物品の吸着対象の面の大きさと同じ又はそれより大きく、前記吸着面が前記物品の吸着対象の面の全体を覆うように吸着し、かつ、前記物品の吸着対象の面が矩形である場合、前記吸着面の前記吸着パッドのうち、前記矩形の面の頂点部分を吸引する吸着パッドの吸引圧力が、前記矩形の面の頂点以外の部分を吸引する吸着パッドの吸引圧力より高くなるように、前記吸着パッドの吸引パターンを生成することを特徴とする制御装置。 The control device according to claim 3.
The processor sucks the suction surface so that the size of the suction surface is equal to or larger than the size of the surface to be sucked by the article, the suction surface covers the entire surface of the suction target of the article, and the suction surface is covered. When the surface to be sucked by the article is rectangular, the suction pressure of the suction pad that sucks the apex portion of the rectangular surface among the suction pads on the suction surface sucks the portion other than the apex of the rectangular surface. A control device characterized in that a suction pattern of the suction pad is generated so as to be higher than the suction pressure of the suction pad.
前記ピック動作の評価値、前記プレイス動作の評価値及び前記移動動作の評価値は、前記把持された物品の損傷の起こりにくさの評価値であり、
前記プロセッサは、前記評価値に基づいて、前記物品の損傷が起こりにくい前記ピック動作、前記プレイス動作及び前記移動動作の組合せを選択することを特徴とする制御装置。 The control device according to claim 1.
The evaluation value of the pick movement, the evaluation value of the place movement, and the evaluation value of the movement movement are evaluation values of the resistance to damage of the gripped article.
The processor is a control device that selects a combination of the pick operation, the place operation, and the moving operation in which damage to the article is unlikely to occur, based on the evaluation value.
前記移動機械は、物品を把持するハンドを有し、
前記制御装置は、プロセッサと、記憶部と、を有し、
前記記憶部は、前記物品を前記ハンドで把持したときの前記物品の把持部分の強度を示す強度情報を保持し、
前記制御方法は、
前記プロセッサが、第１の位置に置かれた物品を前記ハンドで把持するピック動作と、把持された前記物品を前記第１の位置とは異なる第２の位置に配置するプレイス動作と、の複数の組合せを生成する手順と、
前記プロセッサが、前記強度情報に基づいて、生成された前記ピック動作の評価値及び生成された前記プレイス動作の評価値を計算する手順と、
前記プロセッサが、生成された前記ピック動作と前記プレイス動作との組合せの各々について、前記ピック動作の終点から前記プレイス動作の始点まで前記把持された物品を移動するための移動動作を生成する手順と、
前記プロセッサが、前記強度情報に基づいて、前記移動動作の評価値を計算する手順と、
前記プロセッサが、前記評価値に基づいて、前記ピック動作、前記プレイス動作及び前記移動動作の組合せのいずれかを選択する手順と、を含むことを特徴とする制御方法。 It is a control method executed by the control device of a mobile machine.
The moving machine has a hand for gripping an article and has a hand.
The control device includes a processor, a storage unit, and the like.
The storage unit holds strength information indicating the strength of the gripped portion of the article when the article is gripped by the hand.
The control method is
A plurality of a pick operation in which the processor grips the article placed in the first position with the hand and a place operation in which the gripped article is placed in a second position different from the first position. And the procedure to generate a combination of
A procedure in which the processor calculates the generated evaluation value of the pick operation and the generated evaluation value of the place operation based on the intensity information.
A procedure in which the processor generates a movement motion for moving the gripped article from the end point of the pick motion to the start point of the place motion for each of the generated combinations of the pick motion and the place motion. ,
A procedure in which the processor calculates an evaluation value of the moving operation based on the strength information, and
A control method comprising the procedure in which the processor selects one of the combination of the pick operation, the place operation, and the move operation based on the evaluation value.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2020182369A JP7437288B2 (en) | 2020-10-30 | 2020-10-30 | Control device and control method for mobile machinery |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2020182369A JP7437288B2 (en) | 2020-10-30 | 2020-10-30 | Control device and control method for mobile machinery |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2022072752A true JP2022072752A (en) | 2022-05-17 |
| JP7437288B2 JP7437288B2 (en) | 2024-02-22 |
Family
ID=81604582
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2020182369A Active JP7437288B2 (en) | 2020-10-30 | 2020-10-30 | Control device and control method for mobile machinery |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP7437288B2 (en) |
Family Cites Families (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2002205288A (en) | 2001-01-11 | 2002-07-23 | Mitsubishi Heavy Ind Ltd | Working robot |
| JP7204587B2 (en) | 2019-06-17 | 2023-01-16 | 株式会社東芝 | OBJECT HANDLING CONTROL DEVICE, OBJECT HANDLING DEVICE, OBJECT HANDLING METHOD AND OBJECT HANDLING PROGRAM |
-
2020
- 2020-10-30 JP JP2020182369A patent/JP7437288B2/en active Active
Also Published As
| Publication number | Publication date |
|---|---|
| JP7437288B2 (en) | 2024-02-22 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP7290280B2 (en) | ROBOT SYSTEM HAVING OBJECT IDENTIFICATION MECHANISM AND OBJECT HANDLING MECHANISM AND METHOD OF OPERATION THEREOF | |
| CN110329710B (en) | Robot system with robot arm adsorption control mechanism and operation method thereof | |
| JP6807949B2 (en) | Interference avoidance device | |
| KR102325417B1 (en) | A robotic system with packing mechanism | |
| JP7021160B2 (en) | Handling equipment, handling methods and programs | |
| JP4655309B2 (en) | Picking order determination method, apparatus and program thereof, and picking system | |
| JP2022009120A (en) | Robot type multi gripper assembly and method for gripping and holding object | |
| KR20210149091A (en) | Robot and method for palletizing boxes | |
| JP6931457B2 (en) | Motion generation method, motion generator, system and computer program | |
| JP7364534B2 (en) | Handling system and control method | |
| CN108495738A (en) | System and method for providing dynamic robot control system | |
| US20220016779A1 (en) | Autonomous Robot Packaging of Arbitrary Objects | |
| JP2024052998A (en) | Handling Equipment | |
| JP6948033B1 (en) | Method and calculation system for performing grip area detection | |
| JP7437288B2 (en) | Control device and control method for mobile machinery | |
| JP7364505B2 (en) | Handling equipment, control equipment and programs | |
| JP7028092B2 (en) | Gripping posture evaluation device and gripping posture evaluation program | |
| WO2022244418A1 (en) | Mobile machine, hand of mobile machine, and method for controlling mobile machine | |
| US20220388787A1 (en) | Handling system, transport system, control device, storage medium, and handling method | |
| US20240149462A1 (en) | Variable payload robot | |
| US20220274252A1 (en) | Handling system, transport system, control device, storage medium, and handling method | |
| WO2023171687A1 (en) | Robot control device and robot control method | |
| JP2023067373A (en) | Conveyance operation generation device, conveyance operation generation method and movement machine system | |
| JP2024065780A (en) | Handling system, control device, handling method, and control program | |
| JP2023182175A (en) | Picking system operational support apparatus and picking system |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20230515 |
|
| 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: 20240130 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20240131 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20240209 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 7437288 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |