JP2021109257A - Cargo handling control device and sensor device - Google Patents

Cargo handling control device and sensor device Download PDF

Info

Publication number
JP2021109257A
JP2021109257A JP2020001064A JP2020001064A JP2021109257A JP 2021109257 A JP2021109257 A JP 2021109257A JP 2020001064 A JP2020001064 A JP 2020001064A JP 2020001064 A JP2020001064 A JP 2020001064A JP 2021109257 A JP2021109257 A JP 2021109257A
Authority
JP
Japan
Prior art keywords
article
articles
unit
wave
ultrasonic
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
Application number
JP2020001064A
Other languages
Japanese (ja)
Other versions
JP7493941B2 (en
Inventor
純平 小川
Junpei Ogawa
純平 小川
芳富 鮫田
Yoshitomi Sameda
芳富 鮫田
浩行 西川
Hiroyuki Nishikawa
浩行 西川
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Toshiba Corp
Toshiba Infrastructure Systems and Solutions Corp
Original Assignee
Toshiba Corp
Toshiba Infrastructure Systems and Solutions Corp
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Toshiba Corp, Toshiba Infrastructure Systems and Solutions Corp filed Critical Toshiba Corp
Priority to JP2020001064A priority Critical patent/JP7493941B2/en
Publication of JP2021109257A publication Critical patent/JP2021109257A/en
Application granted granted Critical
Publication of JP7493941B2 publication Critical patent/JP7493941B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)

Abstract

To enable a plurality of articles to be moved properly, even when the articles are brought together by a sheet-like cover.SOLUTION: A cargo handling device according to an embodiment comprises a transmission/reception part and a control part. The transmission/reception part is provided in the cargo handling device that moves articles placed on a placement part while gripping the articles, transmits as a transmission wave an ultrasonic wave or a radio wave in a direction in which the placement part exists, and receives a reflected wave of the transmission wave. The control part, when recognizing that a plurality of articles exist on the placement part on the basis of photographed images of the articles placed on the placement part, determines whether the plurality of articles are brought together by a sheet-like cover or not, on the basis a recognized result based on the photographed images and a received result of the reflected wave by the transmission/reception part, and controls the cargo handling device on the basis of the determined result.SELECTED DRAWING: Figure 4

Description

本発明の実施形態は、荷役制御装置、及びセンサ装置に関する。 Embodiments of the present invention relate to a cargo handling control device and a sensor device.

従来、物流倉庫等に設置され、カメラの撮像画像に基づいて、荷物等の物品を把持して当該物品を移動させる荷役システムの荷役制御装置、及びセンサ装置が知られている。 Conventionally, a cargo handling control device and a sensor device of a cargo handling system that is installed in a distribution warehouse or the like and grips an article such as a baggage and moves the article based on an image captured by a camera are known.

特許第6523883号公報Japanese Patent No. 6523883 特開2019−48367号公報Japanese Unexamined Patent Publication No. 2019-48637

複数の物品がシート状の覆い物によってまとめられている場合であっても、物品の移動を良好に行なうことができる荷役制御装置、及びセンサ装置を提供する。 Provided are a cargo handling control device and a sensor device capable of satisfactorily moving articles even when a plurality of articles are grouped by a sheet-like covering.

実施形態の荷役制御装置は、送受信部と、制御部と、を備える。送受信部は、載置部に戴置された物品を把持して当該物品を移動させる荷役装置に設けられ、前記載置部が存在する方向に超音波または電波を送信波として送信し、前記送信波の反射波を受信する。制御部は、前記載置部に戴置された物品の撮像画像に基づいて、前記載置部に物品が複数存在することを認識した場合に、当該撮像画像に基づいた認識結果及び前記送受信部の前記反射波の受信結果に基づいて、複数の物品がシート状の覆い物でまとめられているか否かを判定し、当該判定した結果に基づいて、前記荷役装置を制御する。 The cargo handling control device of the embodiment includes a transmission / reception unit and a control unit. The transmission / reception unit is provided in a cargo handling device that grips an article placed on the mounting unit and moves the article, transmits ultrasonic waves or radio waves as a transmission wave in the direction in which the above-mentioned placement unit exists, and transmits the above-mentioned transmission / reception unit. Receive the reflected wave of the wave. When the control unit recognizes that there are a plurality of articles in the pre-described placement unit based on the captured image of the article placed on the pre-described placement unit, the control unit and the recognition result based on the captured image and the transmission / reception unit Based on the reception result of the reflected wave, it is determined whether or not a plurality of articles are put together by a sheet-like covering, and the cargo handling device is controlled based on the determination result.

図1は、第1の実施形態の荷役システムの構成の一例を示す図である。FIG. 1 is a diagram showing an example of a configuration of a cargo handling system according to the first embodiment. 図2は、第1の実施形態の荷役制御装置におけるセンサ装置の超音波送信素子及び超音波受信素子の配置例を示した図である。FIG. 2 is a diagram showing an arrangement example of an ultrasonic transmitting element and an ultrasonic receiving element of the sensor device in the cargo handling control device of the first embodiment. 図3は、第1の実施形態のセンサ装置から送信された超音波の伝搬経路の一例を示す図である。FIG. 3 is a diagram showing an example of a propagation path of ultrasonic waves transmitted from the sensor device of the first embodiment. 図4は、第1の実施形態の制御装置およびセンサ装置のハードウェア構成の一例を示す図である。FIG. 4 is a diagram showing an example of the hardware configuration of the control device and the sensor device of the first embodiment. 図5は、第1の実施形態の制御装置及びセンサ装置の機能構成の一例を示す図である。FIG. 5 is a diagram showing an example of the functional configuration of the control device and the sensor device of the first embodiment. 図6は、第1の実施形態の荷役システムが実行する荷役処理のフローチャートである。FIG. 6 is a flowchart of cargo handling processing executed by the cargo handling system of the first embodiment. 図7は、第1の実施形態のセンサ装置が実行する距離算出処理を説明するための図であって、隣接する複数の物品が覆い物によって覆われて覆い物によって一つにまとめられている例を示す図である。FIG. 7 is a diagram for explaining the distance calculation process executed by the sensor device of the first embodiment, in which a plurality of adjacent articles are covered with a covering and are grouped together by the covering. It is a figure which shows an example. 図8は、第1の実施形態のセンサ装置が実行する距離算出処理を説明するための図であって、隣接する複数の物品が覆い物によって覆われて覆い物によって一つにまとめられている例を示す図である。FIG. 8 is a diagram for explaining the distance calculation process executed by the sensor device of the first embodiment, in which a plurality of adjacent articles are covered with a covering and are grouped together by the covering. It is a figure which shows an example. 図9は、第1の実施形態のセンサ装置が実行する距離算出処理を説明するための図であって、隣接する複数の物品が覆い物によって覆われておらず覆い物によって一つにまとめられていない例を示す図である。FIG. 9 is a diagram for explaining the distance calculation process executed by the sensor device of the first embodiment, in which a plurality of adjacent articles are not covered by a covering and are grouped together by the covering. It is a figure which shows the example which is not. 図10は、第1の実施形態のセンサ装置が実行する距離算出処理を説明するための図であって、隣接する複数の物品が覆い物によって覆われておらず覆い物によって一つにまとめられていない例を示す図である。FIG. 10 is a diagram for explaining the distance calculation process executed by the sensor device of the first embodiment, in which a plurality of adjacent articles are not covered by a covering and are grouped together by the covering. It is a figure which shows the example which is not. 図11は、第1の実施形態の第1の変形例におけるセンサ装置の超音波送信素子及び超音波受信素子の配置例を示した図である。FIG. 11 is a diagram showing an arrangement example of an ultrasonic transmitting element and an ultrasonic receiving element of the sensor device in the first modification of the first embodiment. 図12は、第2の実施形態のセンサ装置の超音波送信素子と超音波受信素子との配置例を示した図である。FIG. 12 is a diagram showing an arrangement example of an ultrasonic transmitting element and an ultrasonic receiving element of the sensor device of the second embodiment. 図13は、第2の実施形態の反射波の到来方向の検出方法を説明するための図である。FIG. 13 is a diagram for explaining a method of detecting the arrival direction of the reflected wave of the second embodiment. 図14は、第2の実施形態の荷役システムが実行する荷役処理のフローチャートである。FIG. 14 is a flowchart of cargo handling processing executed by the cargo handling system of the second embodiment. 図15は、第3の実施形態の制御装置及びセンサ装置の機能構成の一例を示す図である。FIG. 15 is a diagram showing an example of the functional configuration of the control device and the sensor device of the third embodiment.

以下、本発明の例示的な実施形態が開示される。以下に示される実施形態の構成、ならびに当該構成によってもたらされる作用、結果、および効果は、一例である。本発明は、以下の実施形態に開示される構成以外によっても実現可能であるとともに、基本的な構成に基づく種々の効果や、派生的な効果のうち、少なくとも一つを得ることが可能である。 Hereinafter, exemplary embodiments of the present invention will be disclosed. The configurations of the embodiments shown below, as well as the actions, results, and effects produced by such configurations, are examples. The present invention can be realized by a configuration other than the configurations disclosed in the following embodiments, and at least one of various effects based on the basic configuration and derivative effects can be obtained. ..

(第1の実施形態)
図1は、第1の実施形態の荷役システムの構成の一例を示す図である。図2は、第1の実施形態のセンサ装置の超音波送信素子及び超音波受信素子の配置例を示した図である。
(First Embodiment)
FIG. 1 is a diagram showing an example of a configuration of a cargo handling system according to the first embodiment. FIG. 2 is a diagram showing an arrangement example of an ultrasonic transmitting element and an ultrasonic receiving element of the sensor device of the first embodiment.

図1に示すように、荷役システム1は、荷役装置10と、センサ装置20と、カメラ30と、フレーム40と、を備える。また、荷役装置10は、移動装置50と、制御装置60と、を備える。また、センサ装置20、カメラ30、および制御装置60は、荷役制御装置70を構成している。ここで、制御装置60と、カメラ30、センサ装置20および移動装置50とは、例えば、シリアルケーブルやLAN(Local Area Network)等を介して接続される。 As shown in FIG. 1, the cargo handling system 1 includes a cargo handling device 10, a sensor device 20, a camera 30, and a frame 40. Further, the cargo handling device 10 includes a moving device 50 and a control device 60. Further, the sensor device 20, the camera 30, and the control device 60 constitute the cargo handling control device 70. Here, the control device 60, the camera 30, the sensor device 20, and the mobile device 50 are connected via, for example, a serial cable or a LAN (Local Area Network).

以下の説明において、本実施形態の荷役システム1における上下方向とは、例えば、下方向は、重力が向かう方向ベクトルを含んでおり、上方向は、当該下方向と反対方向であって、荷役装置10が物品W1を持ち上げる方向とする。 In the following description, the vertical direction in the cargo handling system 1 of the present embodiment includes, for example, a downward direction including a direction vector toward which gravity is directed, and an upward direction is a direction opposite to the downward direction, and the cargo handling device. 10 is the direction in which the article W1 is lifted.

荷役装置10は、パレット2の上面2a上に載置された物品W1を目的地(不図示)に荷役(移動)するための装置である。本実施形態の目的地は、物品W1の移動先であればよく、例えばコンベアが考えられる。パレット2は、フレーム40が設置された床面Gに配置されている。すなわち、パレット2は、フレーム40を基準として規定の位置に位置されており、当該規定の位置に位置されたパレット2の上面2aの全領域が、物品W1の載置領域R1である。パレット2は、載置部の一例である。なお、載置部(載置領域R1)は、これに限定されない。載置部(載置領域R1)は、例えば、床面G等に設けられていてもよい。床面Gは、水平方向に広がっている。載置領域R1には、複数の物品W1が載置されうる。物品W1は、例えば、ペットボトル、段ボール等の箱等である。本実施形態においては、1以上の物品W1を含む複数の荷物を指す場合に、物品群Wという。パレット2は、フォークリフト等により、移動される。物品W1は、対象物や荷物等とも称される。 The cargo handling device 10 is a device for cargo handling (moving) the article W1 placed on the upper surface 2a of the pallet 2 to a destination (not shown). The destination of the present embodiment may be a destination of the article W1, for example, a conveyor. The pallet 2 is arranged on the floor surface G on which the frame 40 is installed. That is, the pallet 2 is positioned at a specified position with respect to the frame 40, and the entire area of the upper surface 2a of the pallet 2 located at the specified position is the placement area R1 of the article W1. The pallet 2 is an example of a mounting portion. The mounting portion (mounting area R1) is not limited to this. The mounting portion (mounting area R1) may be provided on, for example, the floor surface G or the like. The floor surface G extends in the horizontal direction. A plurality of articles W1 may be placed in the mounting area R1. The article W1 is, for example, a PET bottle, a box such as a cardboard box, or the like. In the present embodiment, when referring to a plurality of packages including one or more articles W1, it is referred to as an article group W. The pallet 2 is moved by a forklift or the like. Article W1 is also referred to as an object, luggage, or the like.

フレーム40は、四角枠状の下枠部材41と、四角枠状の上枠部材42と、四つ(複数)の柱部材43と、を有する。なお、図1では、四つの柱部材43のうち二つが示されている。下枠部材41は、床面Gに固定されている。上枠部材42は、下枠部材41の上方に設けられている。四つの柱部材43は、下枠部材41の四つの角部と上枠部材42の四つの角部とを接続している。下枠部材41内の床面Gにパレット2が配置されている。すなわち、パレット2は、フレーム40内に配置されている。 The frame 40 has a square frame-shaped lower frame member 41, a square frame-shaped upper frame member 42, and four (plural) pillar members 43. In addition, in FIG. 1, two out of four pillar members 43 are shown. The lower frame member 41 is fixed to the floor surface G. The upper frame member 42 is provided above the lower frame member 41. The four pillar members 43 connect the four corners of the lower frame member 41 and the four corners of the upper frame member 42. The pallet 2 is arranged on the floor surface G in the lower frame member 41. That is, the pallet 2 is arranged in the frame 40.

カメラ30は、パレット2の上方に設けられている。具体的には、カメラ30は、フレーム40の上枠部材42に取付部材(不図示)を介して固定されている。カメラ30は、上枠部材42の枠内の中央部に配置されている。カメラ30は、一例として3Dカメラである。 The camera 30 is provided above the pallet 2. Specifically, the camera 30 is fixed to the upper frame member 42 of the frame 40 via a mounting member (not shown). The camera 30 is arranged at the center of the frame of the upper frame member 42. The camera 30 is, for example, a 3D camera.

カメラ30は、パレット2の載置領域R1に載置された物品群Wを上方から撮像し、撮像によって得られた撮像画像を制御装置60に出力する。カメラ30の撮像範囲は、少なくとも物品群Wを含むように設定されている。カメラ30は、物品W1とカメラ30との間の距離を測定可能である。カメラ30は、撮像装置および距離測定装置の一例である。 The camera 30 images the article group W placed on the mounting area R1 of the pallet 2 from above, and outputs the captured image obtained by the imaging to the control device 60. The imaging range of the camera 30 is set to include at least the article group W. The camera 30 can measure the distance between the article W1 and the camera 30. The camera 30 is an example of an imaging device and a distance measuring device.

移動装置50は、パレット2、およびコンベアの周囲に配置されている。 The moving device 50 is arranged around the pallet 2 and the conveyor.

移動装置50は、基台111と、基台111に支持されたアーム部112と、アーム部112の先端に設けられた把持部113と、を備える。 The moving device 50 includes a base 111, an arm portion 112 supported by the base 111, and a grip portion 113 provided at the tip of the arm portion 112.

基台111は、床面Gに固定された筐体である。 The base 111 is a housing fixed to the floor surface G.

アーム部112は、一例として多関節ロボットアームである。アーム部112は、把持部113によって保持された物品W1を上下方向に移動する動作、および水平方向に移動する動作を実行可能に構成されている。 The arm portion 112 is, for example, an articulated robot arm. The arm portion 112 is configured to be able to perform an operation of moving the article W1 held by the grip portion 113 in the vertical direction and an operation of moving the article W1 in the horizontal direction.

例えば、アーム部112は、1軸または2軸回りに回動可能な複数の関節により連結された3つの可動部112a〜112dで構成される。可動部112aは、基台111から延出している。可動部112bは、可動部112aから延出している。可動部112cは、可動部112bから延出している。可動部112dは、可動部112cから延出している。以後、可動部112dにおける可動部112c側の端部(基端部)から、可動部112dにおける可動部112cとは反対側の端部(先端部)へ向かう方向を、D1方向とも称する。 For example, the arm portion 112 is composed of three movable portions 112a to 112d connected by a plurality of joints that can rotate around one or two axes. The movable portion 112a extends from the base 111. The movable portion 112b extends from the movable portion 112a. The movable portion 112c extends from the movable portion 112b. The movable portion 112d extends from the movable portion 112c. Hereinafter, the direction from the end portion (base end portion) of the movable portion 112d on the movable portion 112c side to the end portion (tip portion) of the movable portion 112d opposite to the movable portion 112c is also referred to as a D1 direction.

アーム部112(可動部112d)の先端には、把持部113が取り付けられている。把持部113は、物品W1を挟み込んで把持する。把持部113は、例えば、ベース部113aと、ベース部113aからD1方向に突出した複数のアーム113bと、を備え、複数のアーム113bによって物品W1を挟み込んで把持する。なお、物品W1の把持は、挟持による把持方法に限定されない。例えば、把持部113は、負圧によって物品W1を吸着把持してもよい。また、把持部113は、2つの物品W1を一度に把持してもよい。なお、把持部113は、把持機構や保持部とも称される。 A grip portion 113 is attached to the tip of the arm portion 112 (movable portion 112d). The grip portion 113 sandwiches and grips the article W1. The grip portion 113 includes, for example, a base portion 113a and a plurality of arms 113b protruding from the base portion 113a in the D1 direction, and the article W1 is sandwiched and gripped by the plurality of arms 113b. The gripping of the article W1 is not limited to the gripping method by pinching. For example, the grip portion 113 may suck and grip the article W1 by a negative pressure. Further, the grip portion 113 may grip the two articles W1 at the same time. The grip portion 113 is also referred to as a grip mechanism or a holding portion.

センサ装置20は、超音波を用いて、例えばエコーロケーション技術等により、物品検出を行う。センサ装置20は、移動装置50の先端部(把持部113)に設けられ、パレット2に載置された物品群Wの上方等から当該物品群Wをセンシングし、そのセンシング結果を制御装置60に出力する。 The sensor device 20 detects an article using ultrasonic waves, for example, by echolocation technology or the like. The sensor device 20 is provided at the tip end portion (grip portion 113) of the moving device 50, senses the article group W from above the article group W placed on the pallet 2, and transmits the sensing result to the control device 60. Output.

図2に示すように、センサ装置20は、ハウジング22と、超音波送信素子23(図2)と、超音波受信素子24(図2)と、を有する。ハウジング22は、把持部113のベース部113aの側面に固定されている。超音波送信素子23および超音波受信素子24は、素子群25を構成している。把持部113を有するアーム部112は、超音波送信素子23と超音波受信素子24とを組み合わせた超音波センサユニットの向きを変更可能な駆動機構の一例を示したものとなる。 As shown in FIG. 2, the sensor device 20 includes a housing 22, an ultrasonic transmitting element 23 (FIG. 2), and an ultrasonic receiving element 24 (FIG. 2). The housing 22 is fixed to the side surface of the base portion 113a of the grip portion 113. The ultrasonic wave transmitting element 23 and the ultrasonic wave receiving element 24 constitute an element group 25. The arm portion 112 having the grip portion 113 shows an example of a drive mechanism capable of changing the direction of an ultrasonic sensor unit in which an ultrasonic transmission element 23 and an ultrasonic reception element 24 are combined.

図2に示すように、超音波送信素子23は、一例として、1個設けられている。超音波送信素子23は、ハウジング22の取付面22aに配置されている。超音波送信素子23は、アンテナ素子によって構成されている。超音波送信素子23は、送信素子の一例である。なお、超音波送信素子23の個数は、上記に限定されない。 As shown in FIG. 2, one ultrasonic wave transmitting element 23 is provided as an example. The ultrasonic wave transmitting element 23 is arranged on the mounting surface 22a of the housing 22. The ultrasonic wave transmitting element 23 is composed of an antenna element. The ultrasonic wave transmitting element 23 is an example of a transmitting element. The number of ultrasonic wave transmitting elements 23 is not limited to the above.

超音波受信素子24の個数は、一例として、3個(複数)設けられている。超音波受信素子24は、取付面22aにおいて超音波送信素子23の周囲に配置されている。超音波受信素子24は、超音波送信素子23から送信された超音波の反射波を受信する。超音波受信素子24は、アンテナ素子によって構成されている。超音波受信素子24は、受信素子の一例である。なお、超音波受信素子24の個数は、上記に限定されない。 As an example, the number of the ultrasonic wave receiving elements 24 is three (plural). The ultrasonic wave receiving element 24 is arranged around the ultrasonic wave transmitting element 23 on the mounting surface 22a. The ultrasonic wave receiving element 24 receives the reflected wave of the ultrasonic wave transmitted from the ultrasonic wave transmitting element 23. The ultrasonic wave receiving element 24 is composed of an antenna element. The ultrasonic wave receiving element 24 is an example of a receiving element. The number of ultrasonic wave receiving elements 24 is not limited to the above.

本実施形態のセンサ装置20は、超音波受信素子24を3個設けることとした。そして、センサ装置20は、超音波送信素子23が送信した超音波の反射波を、3個の超音波受信素子24の各々が受信したタイミングの違いに応じて、センサ装置20と、超音波を反射波として反射させた対象物と、の間の相対的な位置関係を認識できる。 The sensor device 20 of the present embodiment is provided with three ultrasonic receiving elements 24. Then, the sensor device 20 transmits the reflected wave of the ultrasonic wave transmitted by the ultrasonic wave transmitting element 23 to the sensor device 20 and the ultrasonic wave according to the difference in the timing received by each of the three ultrasonic wave receiving elements 24. The relative positional relationship between the object reflected as a reflected wave and the object can be recognized.

具体的には、センサ装置20は、超音波送信素子23から、物品群Wに含まれる物品W1の上方等から物品W1に対して超音波を送信した場合に、物品W1で反射した反射波を、3個の超音波受信素子24が受信する。そして、センサ装置20は、3個の超音波受信素子24の各々が受信した反射波に基づいて、センサ装置20を基準とした、物品群Wに含まれる物品W1の相対的な位置を検出する。 Specifically, the sensor device 20 transmits the reflected wave reflected by the article W1 when the ultrasonic wave transmitting element 23 transmits ultrasonic waves to the article W1 from above the article W1 included in the article group W. The three ultrasonic receiving elements 24 receive the sound. Then, the sensor device 20 detects the relative position of the article W1 included in the article group W with reference to the sensor device 20 based on the reflected wave received by each of the three ultrasonic receiving elements 24. ..

次に、センサ装置20における超音波の伝搬経路について説明する。 Next, the propagation path of ultrasonic waves in the sensor device 20 will be described.

図3は、第1の実施形態のセンサ装置20から送信された超音波の伝搬経路の一例を示す図である。図3中の矢印は、超音波の伝播経路の一例を示す。図3に示すように、例えば、センサ装置20の超音波送信素子23は、パレット2の載置領域R1(図1参照)の方向に対して超音波を送信する。パレット2の載置領域R1に物品W1が存在する場合、超音波送信素子23は、物品W1の斜め上方から物品W1に向けて超音波31を送信することになる。波形33は、超音波31の波の形状を示している。超音波31は、物品W1の上部のエッジ部W1aで反射する。そして、センサ装置20の超音波受信素子24は、エッジ部W1aで反射した反射波32を受信する。波形34は、反射波32の波の形状を示している。反射波32の波形34は、減衰や反射等の影響で、超音波31の波形33と比べて振幅が小さくなる。しかしながら、超音波受信素子24が受信した反射波のうち、エッジ部W1aで反射した反射波32の波形34は、振幅が最も大きい(最も信号強度が大きい)。換言すれば、本実施形態のセンサ装置20は、超音波受信素子24が受信した反射波に基づいて、物品W1のエッジ部W1aを検出できる。 FIG. 3 is a diagram showing an example of a propagation path of ultrasonic waves transmitted from the sensor device 20 of the first embodiment. The arrow in FIG. 3 shows an example of the propagation path of ultrasonic waves. As shown in FIG. 3, for example, the ultrasonic wave transmitting element 23 of the sensor device 20 transmits ultrasonic waves in the direction of the mounting region R1 (see FIG. 1) of the pallet 2. When the article W1 is present in the placement region R1 of the pallet 2, the ultrasonic wave transmitting element 23 transmits the ultrasonic wave 31 toward the article W1 from diagonally above the article W1. The waveform 33 shows the shape of the wave of the ultrasonic wave 31. The ultrasonic wave 31 is reflected by the upper edge portion W1a of the article W1. Then, the ultrasonic wave receiving element 24 of the sensor device 20 receives the reflected wave 32 reflected by the edge portion W1a. The waveform 34 shows the shape of the reflected wave 32. The amplitude of the waveform 34 of the reflected wave 32 is smaller than that of the waveform 33 of the ultrasonic wave 31 due to the influence of attenuation, reflection, and the like. However, among the reflected waves received by the ultrasonic receiving element 24, the waveform 34 of the reflected wave 32 reflected by the edge portion W1a has the largest amplitude (the largest signal intensity). In other words, the sensor device 20 of the present embodiment can detect the edge portion W1a of the article W1 based on the reflected wave received by the ultrasonic wave receiving element 24.

図4は、制御装置60およびセンサ装置20のハードウェア構成の一例を示す図である。図4に示すように、センサ装置20は、超音波送信素子23及び超音波受信素子24の他に、送信制御部301、オペアンプ302、オペアンプ305、混合器306および処理部307等を備える。本実施形態においては、超音波送信素子23及び超音波受信素子24の組み合わせを、超音波センサユニット(送受信部の一例)とも称する。 FIG. 4 is a diagram showing an example of the hardware configuration of the control device 60 and the sensor device 20. As shown in FIG. 4, the sensor device 20 includes a transmission control unit 301, an operational amplifier 302, an operational amplifier 305, a mixer 306, a processing unit 307, and the like, in addition to the ultrasonic transmission element 23 and the ultrasonic reception element 24. In the present embodiment, the combination of the ultrasonic transmitting element 23 and the ultrasonic receiving element 24 is also referred to as an ultrasonic sensor unit (an example of a transmission / reception unit).

送信制御部301は、使用する超音波の周波数(超音波波形)に応じた周波数信号を生成して送信する。送信制御部301で生成された周波数信号は、オペアンプ302を介して増幅された後、超音波送信素子23に入力される。また、送信制御部301で生成された周波数信号は、混合器306にも入力される。より具体的には、送信制御部301は、バースト信号またはチャープ信号を超音波送信素子23に送信する。これにより、超音波送信素子23から送信される超音波が、バースト波またはチャープ波となる。送信制御部301は、信号生成部とも称される。 The transmission control unit 301 generates and transmits a frequency signal corresponding to the frequency (ultrasonic waveform) of the ultrasonic wave to be used. The frequency signal generated by the transmission control unit 301 is amplified via the operational amplifier 302 and then input to the ultrasonic transmission element 23. Further, the frequency signal generated by the transmission control unit 301 is also input to the mixer 306. More specifically, the transmission control unit 301 transmits a burst signal or a chirp signal to the ultrasonic transmission element 23. As a result, the ultrasonic waves transmitted from the ultrasonic wave transmitting element 23 become burst waves or chirp waves. The transmission control unit 301 is also referred to as a signal generation unit.

超音波送信素子23および超音波受信素子24は、上述のようにそれぞれアンテナ素子によって構成されている。超音波送信素子23は、周波数信号に応じた超音波(超音波)として送信し、その反射波を超音波受信素子24が受信する。超音波受信素子24で受信された反射波は、オペアンプ302を介して増幅された後、反射波信号として混合器306に入力される。 The ultrasonic wave transmitting element 23 and the ultrasonic wave receiving element 24 are each composed of an antenna element as described above. The ultrasonic transmitting element 23 transmits as ultrasonic waves (ultrasonic waves) corresponding to a frequency signal, and the reflected wave is received by the ultrasonic receiving element 24. The reflected wave received by the ultrasonic wave receiving element 24 is amplified via the operational amplifier 302 and then input to the mixer 306 as a reflected wave signal.

混合器306は、入力された周波数信号および反射波信号の両信号に対して所定の式に基づいて相関を算出し、処理部307に出力する。相関を算出するための所定の式は、どのような式を用いてもよく、周知の手法による式でもよい。 The mixer 306 calculates the correlation between the input frequency signal and the reflected wave signal based on a predetermined formula, and outputs the correlation to the processing unit 307. Any formula may be used as the predetermined formula for calculating the correlation, and a well-known formula may be used.

処理部307は、混合器306から入力される信号を超音波送信素子23(超音波受信素子24)毎に検波した後、検出信号としてセンサインタフェース126に出力することができる。また、処理部307は、CPUがプログラムを実行することにより実現されてもよいし、専用のハードウェアによって構成されてもよい。処理部307は、演算・検波モジュールとも称される。 The processing unit 307 can detect the signal input from the mixer 306 for each ultrasonic transmitting element 23 (ultrasonic receiving element 24) and then output the signal to the sensor interface 126 as a detection signal. Further, the processing unit 307 may be realized by the CPU executing a program, or may be configured by dedicated hardware. The processing unit 307 is also referred to as an arithmetic / detection module.

さらに、処理部307は、超音波受信素子24によって受信された対象物(ある物品W1)からの反射波に基づいて、対象物(ある物品W1)と、当該対象物と隣接した物品W1とがシート状の覆い物B(図1)によってまとめられているかを判定する。なお、処理の詳細は後述する。 Further, the processing unit 307 combines the object (a certain article W1) and the article W1 adjacent to the object based on the reflected wave from the object (a certain article W1) received by the ultrasonic receiving element 24. It is determined whether or not the sheet-shaped covering B (FIG. 1) is used. The details of the process will be described later.

上記の構成により、センサ装置20では、センシング範囲内に存在する物品W1をセンシングし、そのセンシング結果を検出信号として制御装置60(センサインタフェース126)に出力する。かかる検出信号は、センシング範囲内に存在する物品W1の上面、側面およびエッジ部W1a等の形状を超音波強度(電波強度)等の測定値で表したものとなる。また、センサ装置20は、処理部307の処理結果を制御装置60に送信する。 With the above configuration, the sensor device 20 senses the article W1 existing in the sensing range, and outputs the sensing result as a detection signal to the control device 60 (sensor interface 126). Such a detection signal represents the shape of the upper surface, the side surface, the edge portion W1a, etc. of the article W1 existing in the sensing range by a measured value such as ultrasonic intensity (radio wave intensity). Further, the sensor device 20 transmits the processing result of the processing unit 307 to the control device 60.

図1に戻って、制御装置60は、移動装置50、センサ装置20、およびカメラ30を制御する装置である。すなわち、制御装置60は、荷役システム1全体を制御する装置である。制御装置60は、カメラ30の撮像結果およびセンサ装置20のセンシング結果に基づき、移動装置50の動作を制御する。制御装置60は、移動装置50と一体的に設けられてもよいし、移動装置50と別体として設けられてもよい。 Returning to FIG. 1, the control device 60 is a device that controls the mobile device 50, the sensor device 20, and the camera 30. That is, the control device 60 is a device that controls the entire cargo handling system 1. The control device 60 controls the operation of the mobile device 50 based on the image pickup result of the camera 30 and the sensing result of the sensor device 20. The control device 60 may be provided integrally with the moving device 50, or may be provided separately from the moving device 50.

なお、本実施形態では、移動装置50と制御装置60とを荷役装置としたが、これに限らず、移動装置50を荷役装置としてもよい。 In the present embodiment, the moving device 50 and the control device 60 are used as cargo handling devices, but the present invention is not limited to this, and the moving device 50 may be used as a cargo handling device.

次に、上述した制御装置60の構成について説明する。 Next, the configuration of the control device 60 described above will be described.

図4に示すように、制御装置60は、プロセッサ121、表示部122、操作部123、カメラインタフェース124、移動装置インタフェース125、センサインタフェース126、通信部127、および記憶部128を備える。 As shown in FIG. 4, the control device 60 includes a processor 121, a display unit 122, an operation unit 123, a camera interface 124, a mobile device interface 125, a sensor interface 126, a communication unit 127, and a storage unit 128.

プロセッサ121は、CPU(Central Processing Unit)、GPU(Graphics Processing Unit)、ASIC(Application Specific Integrated Circuit)等の制御装置である。表示部122は、例えば、液晶ディスプレイ、タッチパネル式ディスプレイ等の表示デバイス(出力装置)によって実現される。操作部123は、キーボードやポインティングデバイス等の入力デバイス(入力装置)によって実現される。なお、操作部123は、表示部122の画面上に設けられるタッチパネルであってもよい。 The processor 121 is a control device such as a CPU (Central Processing Unit), a GPU (Graphics Processing Unit), and an ASIC (Application Specific Integrated Circuit). The display unit 122 is realized by, for example, a display device (output device) such as a liquid crystal display or a touch panel display. The operation unit 123 is realized by an input device (input device) such as a keyboard or a pointing device. The operation unit 123 may be a touch panel provided on the screen of the display unit 122.

カメラインタフェース124は、カメラ30と通信可能に接続するインタフェースとする。プロセッサ121は、カメラインタフェース124に接続されたカメラ30を制御する。移動装置インタフェース125は、移動装置50と通信可能に接続するインタフェースとする。プロセッサ121は、移動装置インタフェース125に接続された移動装置50を制御する。センサインタフェース126は、センサ装置20と通信可能に接続するインタフェースとする。プロセッサ121は、センサインタフェース126に接続されたセンサ装置20を制御する。 The camera interface 124 is an interface that is communicably connected to the camera 30. The processor 121 controls the camera 30 connected to the camera interface 124. The mobile device interface 125 is an interface that is communicably connected to the mobile device 50. The processor 121 controls the mobile device 50 connected to the mobile device interface 125. The sensor interface 126 is an interface that is communicably connected to the sensor device 20. The processor 121 controls the sensor device 20 connected to the sensor interface 126.

制御装置60の通信部127は、外部装置と接続するための通信インタフェースである。通信部127は、プロセッサ121の制御の下、外部装置との間で各種データの授受を行う。外部装置としては、例えば、荷役システムを監視する監視装置が考えられる。そして、通信部127は、異常が生じた場合に、監視装置に異常が生じた旨の通知を行う。 The communication unit 127 of the control device 60 is a communication interface for connecting to an external device. The communication unit 127 exchanges various data with and from the external device under the control of the processor 121. As the external device, for example, a monitoring device for monitoring the cargo handling system can be considered. Then, when an abnormality occurs, the communication unit 127 notifies the monitoring device that the abnormality has occurred.

記憶部128は、例えば、RAM(Random Access Memory)等の主記憶装置、フラッシュメモリ等の半導体メモリ素子やハードディスク等の補助記憶装置によって実現される。記憶部128は、荷役装置10の動作に係るプログラムや設定情報等を記憶する。また、記憶部128は、移動装置50の上下方向および水平方向の移動限界位置や、アーム部112の可動範囲、把持部113の把持可能な物品W1の寸法の上限および下限等を示した限界情報を記憶する。また、記憶部128は、物品W1のサイズ(寸法)や形状等を示した荷物情報を記憶する。 The storage unit 128 is realized by, for example, a main storage device such as a RAM (Random Access Memory), a semiconductor memory element such as a flash memory, or an auxiliary storage device such as a hard disk. The storage unit 128 stores programs, setting information, and the like related to the operation of the cargo handling device 10. Further, the storage unit 128 shows limit information indicating the vertical and horizontal movement limit positions of the moving device 50, the movable range of the arm portion 112, the upper limit and the lower limit of the dimensions of the grippable article W1 of the grip portion 113, and the like. Remember. In addition, the storage unit 128 stores baggage information indicating the size (dimensions), shape, and the like of the article W1.

次に、図5を参照して、制御装置60の機能構成の構成について説明する。ここで、図5は、制御装置60とセンサ装置20の機能構成の一例を示す図である。本実施形態においては、制御装置60のプロセッサ121と、センサ装置20の処理部307と、の組み合わせを、制御部の例として示した場合について説明する。しかしながら、制御部の例を、制御装置60のプロセッサ121と、センサ装置20の処理部307と、の組み合わせに、制限するものではなく、例えば、制御装置60のプロセッサ121のみで実現してもよい。制御装置60のプロセッサ121のみで実現する場合、センサ装置20が備える算出部307a及び物品判定部307bが、プロセッサ121内で実現される。 Next, the configuration of the functional configuration of the control device 60 will be described with reference to FIG. Here, FIG. 5 is a diagram showing an example of the functional configuration of the control device 60 and the sensor device 20. In the present embodiment, a case where the combination of the processor 121 of the control device 60 and the processing unit 307 of the sensor device 20 is shown as an example of the control unit will be described. However, the example of the control unit is not limited to the combination of the processor 121 of the control device 60 and the processing unit 307 of the sensor device 20, and may be realized only by the processor 121 of the control device 60, for example. .. When realized only by the processor 121 of the control device 60, the calculation unit 307a and the article determination unit 307b included in the sensor device 20 are realized in the processor 121.

図5に示すように、制御装置60においては、プロセッサ121が記憶部128に記憶されたプログラムを実行することで、認識部1211、移動制御部1212、出力部1216を機能部として実現する。また、移動制御部1212は、計画部1214、計画実行部1215を含み、計画部1214は、把持決定部1214aを含む。 As shown in FIG. 5, in the control device 60, the processor 121 executes the program stored in the storage unit 128 to realize the recognition unit 1211, the movement control unit 1212, and the output unit 1216 as functional units. Further, the movement control unit 1212 includes a planning unit 1214 and a planning execution unit 1215, and the planning unit 1214 includes a gripping determination unit 1214a.

認識部1211は、カメラ30で撮像された撮像画像を取得する。認識部1211は、カメラインタフェース124を介して撮像画像を直接取得してもよいし、カメラインタフェース124を介して一時的に記憶部128に記憶された撮像画像を取得してもよい。 The recognition unit 1211 acquires the captured image captured by the camera 30. The recognition unit 1211 may directly acquire the captured image via the camera interface 124, or may acquire the captured image temporarily stored in the storage unit 128 via the camera interface 124.

認識部1211は、取得した撮像画像に基づいて、パレット2上に置かれた物品W1を認識する。例えば、本実施形態の認識部1211は、取得した撮像画像に対して画像処理を行うことで、撮像されている物品の輪郭を抽出し、当該輪郭に基づいて、パレット2上に置かれた物品W1を認識する。なお、本実施形態の認識部1211は、さらに、記憶部128に記憶された荷物情報で示されている物品W1のサイズ(寸法)や形状と、抽出された輪郭と、を比較することで、パレット2上に置かれた物品W1を認識してもよい。さらには、認識部1211は、カメラ30が設けられた位置と、撮像画像に写っている物品W1の位置と、に基づいて、実際の3次元空間上における、パレット2上に置かれた物品W1の位置情報を特定する。物品W1の位置情報には、物品W1のエッジ部W1aの位置情報も含まれている。 The recognition unit 1211 recognizes the article W1 placed on the pallet 2 based on the acquired captured image. For example, the recognition unit 1211 of the present embodiment extracts the contour of the imaged article by performing image processing on the acquired captured image, and the article placed on the pallet 2 based on the contour. Recognize W1. The recognition unit 1211 of the present embodiment further compares the size (dimensions) and shape of the article W1 indicated by the baggage information stored in the storage unit 128 with the extracted contour. The article W1 placed on the pallet 2 may be recognized. Further, the recognition unit 1211 is the article W1 placed on the pallet 2 in the actual three-dimensional space based on the position where the camera 30 is provided and the position of the article W1 in the captured image. Identify the location information of. The position information of the article W1 also includes the position information of the edge portion W1a of the article W1.

そして、認識部1211は、上記の撮像画像に基づいた認識結果を、センサインタフェース126を介して、センサ装置20に送信する。これにより、センサ装置20の処理部307は、認識された物品W1のサイズや形状、位置情報を把握できる。 Then, the recognition unit 1211 transmits the recognition result based on the captured image to the sensor device 20 via the sensor interface 126. As a result, the processing unit 307 of the sensor device 20 can grasp the size, shape, and position information of the recognized article W1.

センサ装置20の処理部307は、例えば、CPU、及びROMやRAM等のメモリの組み合わせで実現してもよい。処理部307は、混合器306から入力される信号を超音波送信素子23(超音波受信素子24)毎に検波するだけではなく、当該CPUが、ROMに格納されているプログラムを読み込み、実行することで、算出部307aと、物品判定部307bと、を実現する。 The processing unit 307 of the sensor device 20 may be realized by, for example, a combination of a CPU and a memory such as a ROM or RAM. The processing unit 307 not only detects the signal input from the mixer 306 for each ultrasonic transmitting element 23 (ultrasonic receiving element 24), but also the CPU reads and executes a program stored in the ROM. As a result, the calculation unit 307a and the article determination unit 307b are realized.

算出部307aは、混合器306から入力される信号を取得する。算出部307aは、取得した信号に基づいて、物品W1のエッジ部とセンサ装置20との間の距離を算出すると共に、センサ装置20を基準とした物品W1のエッジ部の位置情報を算出する。 The calculation unit 307a acquires a signal input from the mixer 306. The calculation unit 307a calculates the distance between the edge portion of the article W1 and the sensor device 20 based on the acquired signal, and calculates the position information of the edge portion of the article W1 with reference to the sensor device 20.

算出部307aは、制御装置60から、実際の3次元空間上における、センサ装置20の位置情報を取得する。ところで、制御装置60の移動制御部1212は、アーム部112を制御している。このため、制御装置60の移動制御部1212は、アーム部112を制御した場合に、制御された後のアーム部112の関節毎の角度に基づいて、センサ装置20の位置情報を算出する。移動制御部1212は、算出したセンサ装置20の位置情報を、センサ装置20に送信する。これにより、本実施形態の算出部307aは、制御装置60から、実際の3次元空間上のセンサ装置20の位置情報を取得する。算出部307aは、実際の3次元空間上のセンサ装置20の位置情報と、センサ装置20を基準とした物品W1のエッジ部の位置情報と、に基づいて、実際の3次元空間上における物品W1のエッジ部の位置情報を算出する。 The calculation unit 307a acquires the position information of the sensor device 20 in the actual three-dimensional space from the control device 60. By the way, the movement control unit 1212 of the control device 60 controls the arm unit 112. Therefore, when the arm unit 112 is controlled, the movement control unit 1212 of the control device 60 calculates the position information of the sensor device 20 based on the angle of each joint of the arm unit 112 after being controlled. The movement control unit 1212 transmits the calculated position information of the sensor device 20 to the sensor device 20. As a result, the calculation unit 307a of the present embodiment acquires the position information of the sensor device 20 in the actual three-dimensional space from the control device 60. The calculation unit 307a is based on the position information of the sensor device 20 in the actual three-dimensional space and the position information of the edge portion of the article W1 with reference to the sensor device 20, and the article W1 in the actual three-dimensional space. Calculate the position information of the edge part of.

物品判定部307bは、制御装置60から送信された、認識部1211による認識結果に基づいて、パレット2上に置かれた物品W1が複数存在するか否かを判定する。物品判定部307bは、パレット2上に置かれた物品W1が複数存在すると判定した場合に、認識部1211による撮像画像に基づいた認識結果、及び超音波センサユニットによる反射波の受信結果に基づいて、複数の物品W1がシート状の覆い物Bでまとめられているか否かを判定する。 The article determination unit 307b determines whether or not there are a plurality of articles W1 placed on the pallet 2 based on the recognition result by the recognition unit 1211 transmitted from the control device 60. When the article determination unit 307b determines that there are a plurality of articles W1 placed on the pallet 2, the article determination unit 307b is based on the recognition result based on the image captured by the recognition unit 1211 and the reception result of the reflected wave by the ultrasonic sensor unit. , It is determined whether or not a plurality of articles W1 are grouped by a sheet-shaped covering B.

本実施形態の物品判定部307bは、認識結果として撮像画像により認識された複数の物品W1のエッジ部の位置と、反射波の受信結果に基づいて定められる、反射波が反射したエッジ部の位置と、に基づいて、複数の物品W1が、シート状の覆い物Bでまとめられているか否かを判定する。 The article determination unit 307b of the present embodiment is determined based on the positions of the edge portions of the plurality of articles W1 recognized by the captured image as the recognition result and the reception result of the reflected wave, and the positions of the edge portions where the reflected wave is reflected. Based on the above, it is determined whether or not the plurality of articles W1 are put together by the sheet-shaped covering B.

つまり、複数の物品W1がシート状の覆い物Bでまとめられている場合には、まとめられた複数の物品W1の組み合わせにおけるエッジ部からのみ反射波を受信する。これに対し、複数の物品W1がシート状の覆い物Bでまとめられていない場合には、複数の物品W1の各々のエッジ部から反射波を受信する。 That is, when a plurality of articles W1 are grouped by a sheet-shaped covering B, the reflected wave is received only from the edge portion in the combination of the grouped articles W1. On the other hand, when the plurality of articles W1 are not grouped by the sheet-shaped covering B, the reflected wave is received from each edge portion of the plurality of articles W1.

そこで、物品判定部307bは、撮像画像で認識された、複数の物品W1の各々のエッジ部の位置と、反射波が反射した複数の物品W1の各々のエッジ部の位置と、が略一致する場合に、複数の物品W1がシート状の覆い物Bでまとめられていないと判定する。一方、物品判定部307bは、撮像画像で認識された、複数の物品W1の各々のエッジ部に対応する位置に、反射波が反射したエッジ部が存在しない場合に、換言すれば撮像画像と反射波との間で、エッジ部の位置が略一致しない場合に、複数の物品W1がシート状の覆い物Bでまとめられていると判定する。そして、物品判定部307bによる判定結果を、制御装置60の移動制御部1212に送信する。 Therefore, in the article determination unit 307b, the position of each edge portion of the plurality of articles W1 recognized in the captured image and the position of each edge portion of the plurality of articles W1 to which the reflected wave is reflected substantially coincide with each other. In this case, it is determined that the plurality of articles W1 are not grouped by the sheet-shaped covering B. On the other hand, when the article determination unit 307b does not have an edge portion where the reflected wave is reflected at a position corresponding to each edge portion of the plurality of articles W1 recognized in the captured image, in other words, the captured image and the reflection. When the positions of the edge portions do not substantially match with the waves, it is determined that the plurality of articles W1 are grouped by the sheet-shaped covering B. Then, the determination result by the article determination unit 307b is transmitted to the movement control unit 1212 of the control device 60.

物品判定部307bは、シート状の覆い物Bでまとめられているか否かを考慮して、認識した物品W1の中から移動対象物を決定する。移動対象物の決定の手法は、例えば、一番上にある物品W1を選定するなど、種々の公知の技術を採用することができる。 The article determination unit 307b determines a moving object from the recognized articles W1 in consideration of whether or not the sheet-shaped covering B is put together. As a method for determining the moving object, various known techniques can be adopted, for example, selecting the article W1 at the top.

計画部1214は、認識部1211による物品W1の認識結果、および物品判定部307bによって決定された移動対象物を示す情報を、受信する。物品W1の認識結果は、一例として、物品群Wに含まれる物品W1の個数と、物品W1の各々の寸法、形状、デザイン、梱包特徴、および積載特徴、位置である。また、物品W1の各々の位置は、パレット2上の水平方向の位置、および高さ方向の位置である。また、物品W1の各々の位置は、把持部113からの相対距離によって表されてもよい。 The planning unit 1214 receives the recognition result of the article W1 by the recognition unit 1211 and the information indicating the moving object determined by the article determination unit 307b. As an example, the recognition result of the article W1 is the number of articles W1 included in the article group W, and the dimensions, shape, design, packing features, loading features, and positions of each of the articles W1. Further, each position of the article W1 is a position in the horizontal direction and a position in the height direction on the pallet 2. Further, each position of the article W1 may be represented by a relative distance from the grip portion 113.

計画部1214は、認識部1211の認識結果および物品判定部307bの判定結果に基づいて、移動装置50のアーム部112および把持部113の駆動機構を動作させるための行動計画を導出(算出)する。 The planning unit 1214 derives (calculates) an action plan for operating the drive mechanism of the arm unit 112 and the grip unit 113 of the moving device 50 based on the recognition result of the recognition unit 1211 and the determination result of the article determination unit 307b. ..

詳細には、計画部1214の把持決定部1214aは、認識部1211の画像認識結果および物品判定部307bの判定結果に基づいて、把持部113の把持対象物(すなわち移動対象物)の把持位置を決定する。例えば、把持決定部1214aは、覆い物Bによって一つにまとめられている複数の物品W1が移動対象物の場合には、当該一つにまとめられた複数の物品W1のいずれかの位置を把持位置とする。一方、把持決定部1214aは、覆い物Bによって一つにまとめられている複数の物品W1が移動対象物ではなく、物品W1の各々が移動対象物の場合には、移動対象物である物品W1のいずれかの位置を把持位置とする。把持位置は、例えば、アームでつかむタイプのロボットの場合には把持対象物のエッジ部W1aであり、吸着タイプのロボットの場合には把持対象物の中央である。このように、把持の方法に合わせて把持位置を変更してよい。 Specifically, the gripping determination unit 1214a of the planning unit 1214 determines the gripping position of the gripping object (that is, the moving object) of the gripping unit 113 based on the image recognition result of the recognition unit 1211 and the determination result of the article determination unit 307b. decide. For example, when the plurality of articles W1 grouped together by the covering B are objects to be moved, the gripping determination unit 1214a grips any position of the plurality of articles W1 grouped together. Position. On the other hand, in the gripping determination unit 1214a, when the plurality of articles W1 grouped by the covering B are not moving objects and each of the articles W1 is a moving object, the moving object W1 The gripping position is any of the above positions. The gripping position is, for example, the edge portion W1a of the gripping object in the case of a robot that grips with an arm, and the center of the gripping object in the case of a suction type robot. In this way, the gripping position may be changed according to the gripping method.

また、計画部1214は、画像認識結果または判定結果に基づいて、把持対象物を、把持部113が把持可能か否かを判定する。例えば、計画部1214は、物品W1の寸法が、記憶部128に記憶された移動装置50の限界情報に定義された把持部113の把持可能な物品W1の寸法の上限から下限の範囲に含まれない場合に、当該物品W1の把持を回避すると判定する。この場合、計画部1214は、行動計画を導出せずに、把持を回避することを、出力部1216に送出する。また、計画部1214は、把持を回避する対象である物品W1が映り込んだ撮像画像を、出力部1216に送出する。 Further, the planning unit 1214 determines whether or not the gripping unit 113 can grip the gripping object based on the image recognition result or the determination result. For example, in the planning unit 1214, the dimension of the article W1 is included in the range from the upper limit to the lower limit of the dimension of the grippable article W1 of the grip portion 113 defined in the limit information of the moving device 50 stored in the storage unit 128. If not, it is determined that the gripping of the article W1 is avoided. In this case, the planning unit 1214 sends a message to the output unit 1216 to avoid gripping without deriving the action plan. In addition, the planning unit 1214 sends an captured image in which the article W1 to be avoided to be gripped is reflected to the output unit 1216.

出力部1216は、計画部1214から物品W1の把持を回避することを通知された場合に、外部装置に把持回避の報知情報を出力する。例えば、出力部1216は、把持回避の理由と、把持回避される物品W1が映り込んだ撮像画像とを、外部装置に出力する。また、計画部1214は、把持回避の理由と、把持回避される物品W1が映り込んだ撮像画像とを、制御装置60の表示部122に表示させてもよい。 The output unit 1216 outputs the notification information of the grip avoidance to the external device when the planning unit 1214 notifies that the gripping of the article W1 is to be avoided. For example, the output unit 1216 outputs the reason for avoiding gripping and the captured image in which the article W1 to be avoided to grip is reflected to an external device. Further, the planning unit 1214 may display the reason for avoiding gripping and the captured image in which the article W1 to be avoided from gripping is reflected on the display unit 122 of the control device 60.

計画部1214は、把持対象物を把持部113に把持させると判定した場合は、行動計画を導出し、導出した行動計画を、計画実行部1215に送出する。例えば、計画部1214は、把持対象物に設定された1または複数の物品W1をコンベアまで移動する経路(最短経路)を示した行動計画を導出する。なお、計画部1214は、2つ以上の物品W1を同時に把持して移動させる行動計画を導出してもよい。行動計画の導出の手法は、公知の技術を採用することができる。 When the planning unit 1214 determines that the gripping object is to be gripped by the gripping unit 113, the planning unit 1214 derives an action plan and sends the derived action plan to the planning execution unit 1215. For example, the planning unit 1214 derives an action plan showing a route (shortest route) for moving one or more articles W1 set on the gripping object to the conveyor. The planning unit 1214 may derive an action plan for simultaneously grasping and moving two or more articles W1. A known technique can be adopted as the method for deriving the action plan.

計画実行部1215は、計画部1214で導出された行動計画に基づいて、移動装置50の動作(駆動機構)を制御する。例えば、計画実行部1215は、行動計画に基づき移動装置50の動作を制御することで、移動対象物の物品W1を行動計画に示された経路でコンベアまで移動させる。また、行動計画は、計画部1214によって、物品判定部307bによる判定結果と認識部1211による認識結果とに基づいて導出されているため、換言すれば、計画実行部1215は、判定結果と認識結果とに基づいて、物品W1を把持するよう制御する。計画実行部1215の制御対象は、アーム部112および把持部113の駆動機構である。 The plan execution unit 1215 controls the operation (drive mechanism) of the mobile device 50 based on the action plan derived by the planning unit 1214. For example, the plan execution unit 1215 controls the operation of the moving device 50 based on the action plan to move the article W1 of the moving object to the conveyor along the route indicated in the action plan. Further, since the action plan is derived by the planning unit 1214 based on the determination result by the article determination unit 307b and the recognition result by the recognition unit 1211, in other words, the plan execution unit 1215 has the determination result and the recognition result. Based on the above, the article W1 is controlled to be gripped. The control target of the plan execution unit 1215 is the drive mechanism of the arm unit 112 and the grip unit 113.

上述した機能構成により、荷役装置10では、パレット2に置かれた物品W1を、目的地に荷役(移動)させることができる。 With the above-described functional configuration, the cargo handling device 10 can handle (move) the article W1 placed on the pallet 2 to the destination.

次に、荷役システム1が実行する荷役処理の流れを説明する。図6は、第1の実施形態の荷役システム1が実行する荷役処理のフローチャートである。 Next, the flow of cargo handling processing executed by the cargo handling system 1 will be described. FIG. 6 is a flowchart of cargo handling processing executed by the cargo handling system 1 of the first embodiment.

図6に示すように、認識部1211が移動対象物を決定する(S11)。次に、送信制御部301が周波数信号を超音波送信素子23に送信し、超音波送信素子23が超音波を送信する(S12)。 As shown in FIG. 6, the recognition unit 1211 determines the moving object (S11). Next, the transmission control unit 301 transmits a frequency signal to the ultrasonic transmission element 23, and the ultrasonic transmission element 23 transmits ultrasonic waves (S12).

次に、超音波受信素子24が超音波の反射波を受信し、算出部307aは、センサ装置20から超音波の反射地点までの距離(以後、第1の算出距離とも称する)を算出する(S13)。 Next, the ultrasonic wave receiving element 24 receives the reflected ultrasonic wave, and the calculation unit 307a calculates the distance from the sensor device 20 to the ultrasonic wave reflection point (hereinafter, also referred to as the first calculated distance) (hereinafter, also referred to as the first calculated distance). S13).

算出部307aが実行する、センサ装置20から超音波の反射地点までの第1の算出距離の算出処理(距離算出処理)を、図7〜図10を参照して詳細に説明する。図7および図8は、第1の実施形態のセンサ装置20が実行する距離算出処理を説明するための図であって、隣接する複数の物品W1が覆い物Bによって覆われ、一つにまとめられている例を示す図である。図9および図10は、第1の実施形態のセンサ装置20が実行する距離算出処理を説明するための図であって、隣接する複数の物品W1が覆い物Bで覆われておらず、一つにまとめられていない例を示す図である。なお、図1,図7〜図10では、隣り合う二つの物品W1が離間した状態が示されているが、実際には隣り合う二つの物品W1は接触していてもよい。また、図7,9において、矢印は、反射波の進行方向の一例を示し、波形状は、反射波の波形を模式的に示している。ここで、覆い物Bは、透明または半透明のビニールシート等である。覆い物Bは、まとめ物、ラッピングシート(シート)、シュリンクフィルム(フィルム)とも称される。 The calculation process (distance calculation process) of the first calculated distance from the sensor device 20 to the reflection point of the ultrasonic wave, which is executed by the calculation unit 307a, will be described in detail with reference to FIGS. 7 to 10. 7 and 8 are diagrams for explaining the distance calculation process executed by the sensor device 20 of the first embodiment, in which a plurality of adjacent articles W1 are covered with a covering B and are grouped together. It is a figure which shows the example. 9 and 10 are diagrams for explaining the distance calculation process executed by the sensor device 20 of the first embodiment, in which the plurality of adjacent articles W1 are not covered with the covering B, and one It is a figure which shows the example which is not put together. Although FIGS. 1, 7 to 10 show a state in which two adjacent articles W1 are separated from each other, the two adjacent articles W1 may actually be in contact with each other. Further, in FIGS. 7 and 9, the arrows indicate an example of the traveling direction of the reflected wave, and the wave shape schematically shows the waveform of the reflected wave. Here, the covering B is a transparent or translucent vinyl sheet or the like. The covering B is also referred to as a bundle, a wrapping sheet (sheet), or a shrink film (film).

超音波送信素子23によって空気中に送信される超音波すなわち空気中に放射される送信信号をf(t)としたときに、超音波受信素子24は、受信信号(反射波)x(t)を到達時間Tだけ遅れたタイミングで受信する。算出部307aは、超音波受信素子24が受信した受信信号(反射波)x(t)に対して、送信信号f(t)との相関をとることで、超音波の反射地点を算出する。 When the ultrasonic wave transmitted into the air by the ultrasonic wave transmitting element 23, that is, the transmitted signal radiated into the air is f (t), the ultrasonic wave receiving element 24 receives the received signal (reflected wave) x (t). Is received at a timing delayed by the arrival time T. The calculation unit 307a calculates the reflection point of the ultrasonic wave by correlating the received signal (reflected wave) x (t) received by the ultrasonic wave receiving element 24 with the transmission signal f (t).

算出部307aは、相関値が、設定された閾値以上の場合に、超音波送信素子23から送信された送信信号の反射波を超音波受信素子24が受信したと判定する。送信信号の送信時から相関値のピーク地点までの時間に音速を乗算した値の半分が超音波受信素子24から超音波の反射地点までの第1の算出距離となる。 When the correlation value is equal to or greater than the set threshold value, the calculation unit 307a determines that the ultrasonic wave receiving element 24 has received the reflected wave of the transmission signal transmitted from the ultrasonic wave transmitting element 23. Half of the value obtained by multiplying the time from the transmission of the transmission signal to the peak point of the correlation value by the speed of sound is the first calculated distance from the ultrasonic wave receiving element 24 to the reflection point of the ultrasonic wave.

算出部307aは、3個の超音波受信素子24でそれぞれ受信した受信信号に対して、送信信号との相関値を算出して、超音波受信素子24から反射地点までの第1の算出距離を算出する。 The calculation unit 307a calculates the correlation value with the transmission signal for the reception signal received by each of the three ultrasonic reception elements 24, and calculates the first calculated distance from the ultrasonic reception element 24 to the reflection point. calculate.

ここで、超音波の波長に対して物品W1の表面の凹凸は十分に小さいため、物品W1の表面では、超音波は、鏡面反射(正反射)する。このため、物品W1の斜め上方から送信された超音波における、センサ装置20が受信する物品W1からの反射波は、物品W1のエッジ部W1aで反射した信号となる。これは、物品W1が覆い物Bによって覆われた場合も同様である。 Here, since the unevenness of the surface of the article W1 is sufficiently small with respect to the wavelength of the ultrasonic wave, the ultrasonic wave is specularly reflected (normally reflected) on the surface of the article W1. Therefore, the reflected wave from the article W1 received by the sensor device 20 in the ultrasonic wave transmitted from diagonally above the article W1 becomes a signal reflected by the edge portion W1a of the article W1. This is also the case when the article W1 is covered with the covering B.

このように、センサ装置20で受信できる反射波は、物品W1のエッジ部W1aや覆い物Bのエッジ部Baでの反射波となる。このため、図7,8に示すように、隣接する複数の物品W1が覆い物Bで覆われて一つにまとめられている場合には、超音波受信素子24は、複数の物品W1のうち端に位置する物品W1の外側のエッジ部W1aに対応して形成された覆い物Bのエッジ部Baの反射波のみを受信する。つまり、この場合、超音波受信素子24は、覆い物Bにおける、複数の物品W1のエッジ部W1aのうち互いに隣り合うエッジ部W1a(図8中の領域C中のエッジ部W1a)を覆った部分Bb(図8)の反射波は、超音波受信素子24に到達しない。 As described above, the reflected wave that can be received by the sensor device 20 becomes the reflected wave at the edge portion W1a of the article W1 and the edge portion Ba of the covering object B. Therefore, as shown in FIGS. 7 and 8, when a plurality of adjacent articles W1 are covered with the covering B and are grouped together, the ultrasonic receiving element 24 is included in the plurality of articles W1. Only the reflected wave of the edge portion Ba of the covering B formed corresponding to the outer edge portion W1a of the article W1 located at the end is received. That is, in this case, the ultrasonic wave receiving element 24 covers the edge portions W1a (edge portions W1a in the region C in FIG. 8) adjacent to each other among the edge portions W1a of the plurality of articles W1 in the covering object B. The reflected wave of Bb (FIG. 8) does not reach the ultrasonic receiving element 24.

一方、図9,10に示すように、隣接する複数の物品W1が覆い物Bで覆われておらず一つにまとめられていない場合には、超音波受信素子24は、複数の物品W1のそれぞれのエッジ部W1aからの反射波を受信する。 On the other hand, as shown in FIGS. 9 and 10, when the plurality of adjacent articles W1 are not covered with the covering B and are not combined into one, the ultrasonic receiving element 24 is a plurality of articles W1. The reflected wave from each edge portion W1a is received.

図6に戻って、S14にて、算出部307aは、各超音波受信素子24から反射地点迄の各第1の算出距離から、反射位置を算出する。詳細には、3個の超音波受信素子24から反射地点迄の距離がそれぞれ分かるため、算出部307aは、3個の超音波受信素子24のそれぞれの設置位置を中心とし、第1の算出距離を半径とした3個の球の交点の位置を算出する。そして、算出部307aは、算出された3個の球の交点の位置を、反射地点の位置として算出する。 Returning to FIG. 6, in S14, the calculation unit 307a calculates the reflection position from each first calculated distance from each ultrasonic receiving element 24 to the reflection point. In detail, since the distances from the three ultrasonic receiving elements 24 to the reflection points are known respectively, the calculation unit 307a is centered on the respective installation positions of the three ultrasonic receiving elements 24, and the first calculated distance is obtained. The position of the intersection of the three spheres with the radius is calculated. Then, the calculation unit 307a calculates the position of the intersection of the three calculated spheres as the position of the reflection point.

次に、物品判定部307bは、認識部1211によって認識された、移動対象物である物品W1、及び隣接する他の物品W1(以後、隣接物品W1とも称する)のエッジ部W1aの位置と、算出された反射地点の位置と、が一致するか否かを判定する(S15)。物品W1及び隣接物品W1のエッジ部W1aは、認識部1211によって撮像画像データから認識されたものとする。なお、本実施形態では、エッジ部W1aの位置と、算出された反射地点の位置と、が一致するか否かを例に示したが、一致するか否かに制限するものではなく、略一致するか否かを判断できれば良い。例えば、エッジ部W1aの位置と、算出された反射地点の位置と、の類似度が所定の閾値より高いか否かを判断してもよい。 Next, the article determination unit 307b calculates the positions of the article W1 which is a moving object and the edge portion W1a of another adjacent article W1 (hereinafter, also referred to as an adjacent article W1) recognized by the recognition unit 1211. It is determined whether or not the position of the reflected point is the same (S15). It is assumed that the edge portion W1a of the article W1 and the adjacent article W1 is recognized from the captured image data by the recognition unit 1211. In the present embodiment, whether or not the position of the edge portion W1a and the calculated position of the reflection point match is shown as an example, but it is not limited to whether or not they match, and they are substantially the same. It is only necessary to be able to determine whether or not to do so. For example, it may be determined whether or not the degree of similarity between the position of the edge portion W1a and the calculated position of the reflection point is higher than a predetermined threshold value.

物品W1及び隣接物品W1のエッジ部W1aから反射波を受信した場合、物品W1と隣接物品W1と、が覆い物Bでまとめられていない、換言すれば物品W1と隣接物品W1とは、個別の物品と判定できる。ところで、物品W1及び隣接物品W1のエッジ部W1aは、撮像画像に基づいた認識結果から把握できる。従って、撮像画像に基づいた認識結果である、物品W1及び隣接物品W1のエッジ部W1aの位置から反射波を受信した場合には、覆い物Bでまとめられていないと判定できる。そこで、本実施形態の物品判定部307bは、撮像画像に基づいた認識結果である隣接物品W1のエッジ部W1aの位置と、算出された反射地点の位置とが一致する場合には、物品W1と隣接物品W1と、は個別の物品であると判定する。よって、物品判定部307bは、移動対象物に決定された物品W1と隣接する他の物品W1のエッジ部W1aの位置と、算出された反射地点の位置とが一致すると判定した場合には(S15:Yes)、当該隣接する他の物品W1は個別の物品であると判定する。そして、把持決定部1214aは、当該判定結果に基づいて、S11で決定された移動対象物の把持位置を決定する(S16)。このように、移動対象物が覆い物Bによって一つにまとめられていないと判定された場合、物品W1と、隣接する他の物品W1と、をそれぞれ別の移動対象物として処理される。 When the reflected wave is received from the edge portion W1a of the article W1 and the adjacent article W1, the article W1 and the adjacent article W1 are not grouped by the covering B, in other words, the article W1 and the adjacent article W1 are separate. It can be judged as an article. By the way, the edge portion W1a of the article W1 and the adjacent article W1 can be grasped from the recognition result based on the captured image. Therefore, when the reflected wave is received from the position of the edge portion W1a of the article W1 and the adjacent article W1, which is the recognition result based on the captured image, it can be determined that the reflection wave is not collected by the covering B. Therefore, the article determination unit 307b of the present embodiment sets the article W1 when the position of the edge portion W1a of the adjacent article W1 which is the recognition result based on the captured image and the position of the calculated reflection point match. It is determined that the adjacent article W1 and the adjacent article W1 are individual articles. Therefore, when the article determination unit 307b determines that the position of the edge portion W1a of the other article W1 adjacent to the article W1 determined as the moving object and the position of the calculated reflection point match (S15). : Yes), it is determined that the other adjacent article W1 is an individual article. Then, the gripping determination unit 1214a determines the gripping position of the moving object determined in S11 based on the determination result (S16). In this way, when it is determined that the moving objects are not grouped together by the covering object B, the article W1 and the other adjacent articles W1 are processed as separate moving objects.

一方、物品判定部307bは、移動対象物に決定された物品W1と隣接する他の物品W1のエッジ部W1aの位置と、算出された反射地点の位置とが一致しないと判定した場合には(S15:No)、S18に進む。S18にて、物品判定部307bは、移動対象物に決定された物品W1と隣接物品W1との組み合わせを一つの移動対象物と判断する(S18)。すなわち、この場合、把持決定部1217aは、移動対象物に決定された物品W1と、当該移動対象物に決定された物品W1と隣接する他の物品W1とは、覆い物Bによって覆われて一つにまとめられていると判定し、隣接物品W1を移動対象物に加える。つまり、移動対象物が更新される。 On the other hand, when the article determination unit 307b determines that the position of the edge portion W1a of the other article W1 adjacent to the article W1 determined as the moving object does not match the calculated position of the reflection point ( S15: No), proceed to S18. In S18, the article determination unit 307b determines that the combination of the article W1 determined as the moving object and the adjacent article W1 is one moving object (S18). That is, in this case, in the grip determination unit 1217a, the article W1 determined as the moving object and the other article W1 adjacent to the article W1 determined as the moving object are covered with the covering B. It is determined that they are grouped together, and the adjacent article W1 is added to the moving object. That is, the moving object is updated.

そして、物品判定部307bは、認識結果に基づいて、他に隣接物品W1が存在するか否かを判定する(S19)。他に隣接物品W1が存在すると判定した場合(S19:Yes)、センサ装置20の処理部307は、S18で一つと判断された移動対象物と、他の隣接物品W1と、についてエッジ部を検出し(S20)、再びS15に戻り、S15以降の処理を実行する。 Then, the article determination unit 307b determines whether or not there is another adjacent article W1 based on the recognition result (S19). When it is determined that there is another adjacent article W1 (S19: Yes), the processing unit 307 of the sensor device 20 detects the edge portion of the moving object determined to be one in S18 and the other adjacent article W1. Then, the process returns to S15 and the processing after S15 is executed.

一方、物品判定部307bは、認識結果に基づいて、他に隣接物品W1が存在しないと判定した場合(S19:No)、把持決定部1214aは、当該判定結果に基づいて、S18で一つと判断された移動対象物の把持位置を決定する(S21)。 On the other hand, when the article determination unit 307b determines that there is no other adjacent article W1 based on the recognition result (S19: No), the grip determination unit 1214a determines that the article is one in S18 based on the determination result. The gripping position of the moved object is determined (S21).

このように、制御装置60は、移動対象物からの反射波(超音波信号)に基づいて、覆い物Bで複数の物品W1が覆われているか否かを判定できるため、移動対象物の正しい大きさを認識できる。これにより、把持決定部1214aは、移動対象物の適切な把持位置を決定することができる。 In this way, the control device 60 can determine whether or not the covering object B covers the plurality of articles W1 based on the reflected wave (ultrasonic signal) from the moving object, so that the moving object is correct. You can recognize the size. As a result, the gripping determination unit 1214a can determine an appropriate gripping position of the moving object.

S16及びS21の処理の後に、移動制御部1212は、移動対象物を把持部113に把持させて、移動対象物を移動装置50によって移動させる(S17)。そしては、荷役システム1は、S11に戻り、上記の処理を繰り返し実行する。 After the processing of S16 and S21, the movement control unit 1212 causes the gripping unit 113 to grip the moving object, and the moving object is moved by the moving device 50 (S17). Then, the cargo handling system 1 returns to S11 and repeatedly executes the above process.

以上のように、本実施形態では、制御装置60が備える認識部1211及び移動制御部1212と、センサ装置20が備える、算出部307a及び物品判定部307bと、を組み合わせることで、制御部を実現する。当該制御部は、上述した構成を組み合わせることで、パレット2(載置部)に載置された物品W1の撮像画像に基づいて、パレット2に物品W1が複数存在することを認識した場合に、当該認識結果及び超音波センサユニットの反射波の受信結果に基づいて、複数の物品W1がシート状の覆い物Bでまとめられているか否かを判定し、判定結果に基づいて、移動装置50を制御する。よって、本実施形態によれば、複数の物品W1がシート状の覆い物Bによって覆われて覆い物Bによって一つにまとめられている場合であっても、移動対象物の適切な把持位置を決定することができるので、物品W1の移動を良好に行なうことができる。 As described above, in the present embodiment, the control unit is realized by combining the recognition unit 1211 and the movement control unit 1212 included in the control device 60 and the calculation unit 307a and the article determination unit 307b provided in the sensor device 20. do. When the control unit recognizes that a plurality of articles W1 exist on the pallet 2 based on the captured image of the article W1 mounted on the pallet 2 (mounting section) by combining the above configurations, the control unit recognizes that there are a plurality of articles W1 on the pallet 2. Based on the recognition result and the reception result of the reflected wave of the ultrasonic sensor unit, it is determined whether or not the plurality of articles W1 are grouped by the sheet-shaped covering B, and based on the determination result, the moving device 50 is moved. Control. Therefore, according to the present embodiment, even when a plurality of articles W1 are covered with the sheet-shaped covering B and are grouped together by the covering B, an appropriate gripping position of the moving object can be obtained. Since it can be determined, the article W1 can be moved satisfactorily.

また、本実施形態では、センサ装置20の超音波センサユニット(送受信部)は、送信波を送信する1個の超音波送信素子23(送信素子)と、反射波を受信する複数個の超音波受信素子24(受信素子)と、を有する。よって、超音波受信素子24が1個の場合と比較して、隣接する複数の物品W1がシート状の覆い物Bによって覆われて覆い物Bによって一つにまとめられているかの判定の精度が向上しやすい。 Further, in the present embodiment, the ultrasonic sensor unit (transmission / reception unit) of the sensor device 20 includes one ultrasonic transmission element 23 (transmission element) that transmits a transmission wave and a plurality of ultrasonic waves that receive the reflected wave. It has a receiving element 24 (receiving element). Therefore, as compared with the case where the ultrasonic wave receiving element 24 is one, the accuracy of determining whether the plurality of adjacent articles W1 are covered by the sheet-shaped covering B and are grouped together by the covering B is more accurate. Easy to improve.

また、本実施形態では、送信制御部301が、超音波送信素子23を駆動させる際にバースト波またはチャープ波を使用する。バースト波を使用することで、反射波の有無によって物品の有無を判定できるという利点と、センサ装置20の移動速度の算出が容易に実施できるという利点がある。また、特定の周波数のみを送信する安価なセンサ装置20を実現できる。チャープ信号は、送受信可能な周波数帯域の広い超音波センサが必要になるが、対象物までの距離の算出の分解能の向上と、耐雑音性を向上することができる。 Further, in the present embodiment, the transmission control unit 301 uses a burst wave or a chirp wave when driving the ultrasonic transmission element 23. By using the burst wave, there is an advantage that the presence / absence of an article can be determined by the presence / absence of a reflected wave, and an advantage that the moving speed of the sensor device 20 can be easily calculated. In addition, an inexpensive sensor device 20 that transmits only a specific frequency can be realized. A chirp signal requires an ultrasonic sensor having a wide frequency band that can be transmitted and received, but it is possible to improve the resolution of calculating the distance to an object and improve the noise immunity.

(第1の変形例)
第1の実施形態においては、1個の超音波送信素子23と、3個の超音波受信素子24と、を備える例について説明した。しかしながら、超音波送信素子23と超音波受信素子24との配置は、様々な態様が考えられる。そこで、第1の変形例では、第1の実施形態とは異なる、超音波送信素子23と超音波受信素子24との配置例について説明する。図11は、第1の実施形態の第1の変形例におけるセンサ装置の超音波送信素子23と超音波受信素子24との配置例を示した図である。
(First modification)
In the first embodiment, an example including one ultrasonic wave transmitting element 23 and three ultrasonic wave receiving elements 24 has been described. However, various aspects can be considered for the arrangement of the ultrasonic wave transmitting element 23 and the ultrasonic wave receiving element 24. Therefore, in the first modification, an example of arrangement of the ultrasonic wave transmitting element 23 and the ultrasonic wave receiving element 24, which is different from the first embodiment, will be described. FIG. 11 is a diagram showing an arrangement example of the ultrasonic wave transmitting element 23 and the ultrasonic wave receiving element 24 of the sensor device in the first modification of the first embodiment.

図11に示すように、本変形例では、超音波送信素子23の個数と超音波受信素子24の個数とが、それぞれ1個である。本変形例は、複数の超音波受信素子24を備えていない。このため、本変形例は、3次元空間上の位置の代わりに、距離に基づいて、覆い物Bで一つにまとめられているか否かを判断する。 As shown in FIG. 11, in this modification, the number of the ultrasonic transmitting elements 23 and the number of the ultrasonic receiving elements 24 are one each. This modification does not include a plurality of ultrasonic receiving elements 24. Therefore, in this modification, it is determined whether or not the covering B is united based on the distance instead of the position in the three-dimensional space.

上記構成の本変形例では、物品判定部307bは、算出したセンサ装置20から超音波の反射地点までの第1の算出距離と、制御装置60の認識部1211がカメラ30の出力に基づいて算出した、センサ装置20から移動対象物のエッジ部W1aまでの第2の算出距離と、を比較して、隣接する複数の物品W1が覆い物Bで覆われて一つにまとめられているかを判定する。具体的には、物品判定部307bは、第1の算出距離と第2の算出距離とが一致する場合には反射点が存在し、隣接物品W1は個別の物品であると判定する。すなわち、この場合、物品判定部307bは、隣接する複数の物品W1が覆い物Bで覆われて一つにまとめられていないと判定する。一方、物品判定部307bは、第1の算出距離と第2の算出距離とが一致しない場合には、移動対象物に決定された物品W1と、当該移動対象物に決定された物品W1と隣接する他の物品W1とは、覆い物Bによって覆われて一つにまとめられていると判定し、隣接物品W1を移動対象物に加える。つまり、移動対象物が更新される。 In this modification of the above configuration, the article determination unit 307b is calculated based on the calculated first calculated distance from the sensor device 20 to the ultrasonic reflection point and the recognition unit 1211 of the control device 60 based on the output of the camera 30. By comparing the second calculated distance from the sensor device 20 to the edge portion W1a of the moving object, it is determined whether or not a plurality of adjacent articles W1 are covered with the covering object B and combined into one. do. Specifically, the article determination unit 307b determines that a reflection point exists when the first calculated distance and the second calculated distance match, and the adjacent article W1 is an individual article. That is, in this case, the article determination unit 307b determines that the plurality of adjacent articles W1 are covered with the covering B and are not combined into one. On the other hand, when the first calculated distance and the second calculated distance do not match, the article determination unit 307b is adjacent to the article W1 determined as the moving object and the article W1 determined as the moving object. It is determined that the other article W1 is covered with the covering object B and is united, and the adjacent article W1 is added to the moving object. That is, the moving object is updated.

以上のように、本変形例では、超音波送信素子23(送信素子)の個数と超音波受信素子24(受信素子)の個数が、それぞれ1個である。よって、超音波送信素子23と超音波受信素子24で構成される超音波センサユニットの小型化がしやすい。 As described above, in this modification, the number of the ultrasonic transmitting elements 23 (transmitting elements) and the number of the ultrasonic receiving elements 24 (receiving elements) are one each. Therefore, it is easy to miniaturize the ultrasonic sensor unit composed of the ultrasonic transmitting element 23 and the ultrasonic receiving element 24.

なお、上述した実施形態及び本変形例では、超音波送信素子23と超音波受信素子24とが別個に設けられているが、これに限定されない。例えば、一つの超音波素子が、超音波の送受信を行なってもよい。すなわち、一つの超音波素子が、超音波送信素子23と超音波受信素子24とを兼ねてもよい。 In the above-described embodiment and this modification, the ultrasonic wave transmitting element 23 and the ultrasonic wave receiving element 24 are separately provided, but the present invention is not limited to this. For example, one ultrasonic element may transmit and receive ultrasonic waves. That is, one ultrasonic element may serve as both the ultrasonic transmitting element 23 and the ultrasonic receiving element 24.

(第2の変形例)
次に、第1の実施形態の第2の変形例を説明する。本変形例では、送信制御部301は、センサ装置20とパレット2(載置部)に載置された物品W1との間の距離に応じて、超音波の送信形態を変更する。例えば、送信制御部301は、センサ装置20とパレット2(載置部)に載置された物品W1との間の距離に応じて、超音波の送信信号の長さや送信間隔を変更する。センサ装置20と物品W1との間の距離は、カメラ30によって測定された検出が用いられる。
(Second modification)
Next, a second modification of the first embodiment will be described. In this modification, the transmission control unit 301 changes the ultrasonic wave transmission form according to the distance between the sensor device 20 and the article W1 mounted on the pallet 2 (mounting unit). For example, the transmission control unit 301 changes the length and transmission interval of the ultrasonic transmission signal according to the distance between the sensor device 20 and the article W1 mounted on the pallet 2 (mounting unit). For the distance between the sensor device 20 and the article W1, the detection measured by the camera 30 is used.

ここで、センサ装置20と物品W1との間の距離が比較的遠い場合には、センサ装置20が超音波(信号)を送信して物品W1の反射波を受信するまでの超音波の伝搬経路が長いため、当該伝搬距離に応じて送信信号が減衰する。このため、チャープ波を送信する場合には、受信時の信号強度を確保するために、ある一定以上の長さの信号長でセンサ装置20の超音波送信素子23を駆動させる必要がある。 Here, when the distance between the sensor device 20 and the article W1 is relatively long, the propagation path of the ultrasonic wave until the sensor device 20 transmits the ultrasonic wave (signal) and receives the reflected wave of the article W1. Is long, so the transmitted signal is attenuated according to the propagation distance. Therefore, when transmitting a chirp wave, it is necessary to drive the ultrasonic transmission element 23 of the sensor device 20 with a signal length of a certain length or more in order to secure the signal strength at the time of reception.

一方、センサ装置20と物品W1との間の距離が比較的近い場合には、伝搬距離が短くなり受信できる信号強度が増加するため、チャープ波を送信する場合には、信号長を短くできる。信号長を短くすることで、反射波から求める相関値のピーク地点を容易に検出でき、センサ装置20から物品W1までの距離の検出精度を向上できる。また、この場合に、超音波(送信信号)を送信する間隔を短くすることで、物品W1の反射波を受信(取得)する回数が増加するので、精度よく反射地点を検出することができる。 On the other hand, when the distance between the sensor device 20 and the article W1 is relatively short, the propagation distance becomes short and the signal strength that can be received increases. Therefore, when transmitting a chirp wave, the signal length can be shortened. By shortening the signal length, the peak point of the correlation value obtained from the reflected wave can be easily detected, and the detection accuracy of the distance from the sensor device 20 to the article W1 can be improved. Further, in this case, by shortening the interval at which the ultrasonic waves (transmission signals) are transmitted, the number of times the reflected wave of the article W1 is received (acquired) increases, so that the reflection point can be detected with high accuracy.

以上のように、センサ装置20と物品W1との間の距離が長い程、超音波の送信信号の長さを長くする。 As described above, the longer the distance between the sensor device 20 and the article W1, the longer the length of the ultrasonic wave transmission signal.

(第2の実施形態)
次に、第2の実施形態を図12〜図14を参照して説明する。図12は、第2の実施形態のセンサ装置の超音波送信素子と超音波受信素子との配置例を示した図である。図13は、第2の実施形態の反射波の到来方向の検出方法を説明するための図である。図14は、第2の実施形態の荷役システムが実行する荷役処理のフローチャートである。
(Second Embodiment)
Next, the second embodiment will be described with reference to FIGS. 12 to 14. FIG. 12 is a diagram showing an arrangement example of an ultrasonic transmitting element and an ultrasonic receiving element of the sensor device of the second embodiment. FIG. 13 is a diagram for explaining a method of detecting the arrival direction of the reflected wave of the second embodiment. FIG. 14 is a flowchart of cargo handling processing executed by the cargo handling system of the second embodiment.

図12に示すように、本実施形態では、複数の超音波受信素子24は、第1の直線L1に沿って並べられた複数個の超音波受信素子24Aと、第1の直線L1と交差する第2の直線L2に沿って並べられた複数個の超音波受信素子24Bと、を含む。換言すると、複数の超音波受信素子24は、D2方向に沿って並べられた複数個の超音波受信素子24Aと、D2方向と交差するD3に沿って並べられた複数個の超音波受信素子24Bと、を含む。一例として、第1の直線L1(D2方向)、第2の直線L2(D3方向)、およびD1方向は、互いに直交している。また、第1の直線L1と第2の直線との交点に位置する超音波受信素子24は、超音波受信素子24Aおよび超音波受信素子24Bを兼ねる。また、超音波受信素子24Aの個数および超音波受信素子24Bの個数は、同じである。超音波受信素子24Aは、第1の受信素子の一例であり、超音波受信素子24Bは、第2の受信素子の一例である。なお、本実施形態は、第1の直線L1と、第1の直線L1と交差する第2の直線L2と、に沿って超音波受信素子24を並べる例について説明するが、複数の直線に沿って超音波受信素子24を並べる手法に制限するものではなく、一つの直線に沿って超音波受信素子24を並べてもよい。 As shown in FIG. 12, in the present embodiment, the plurality of ultrasonic wave receiving elements 24 intersect the plurality of ultrasonic wave receiving elements 24A arranged along the first straight line L1 and the first straight line L1. A plurality of ultrasonic receiving elements 24B arranged along the second straight line L2 are included. In other words, the plurality of ultrasonic receiving elements 24 are a plurality of ultrasonic receiving elements 24A arranged along the D2 direction and a plurality of ultrasonic receiving elements 24B arranged along D3 intersecting the D2 direction. And, including. As an example, the first straight line L1 (D2 direction), the second straight line L2 (D3 direction), and the D1 direction are orthogonal to each other. Further, the ultrasonic wave receiving element 24 located at the intersection of the first straight line L1 and the second straight line also serves as the ultrasonic wave receiving element 24A and the ultrasonic wave receiving element 24B. Further, the number of ultrasonic receiving elements 24A and the number of ultrasonic receiving elements 24B are the same. The ultrasonic wave receiving element 24A is an example of the first receiving element, and the ultrasonic wave receiving element 24B is an example of the second receiving element. In this embodiment, an example in which the ultrasonic receiving elements 24 are arranged along the first straight line L1 and the second straight line L2 intersecting the first straight line L1 will be described, but along a plurality of straight lines. The method is not limited to the method of arranging the ultrasonic wave receiving elements 24, and the ultrasonic wave receiving elements 24 may be arranged along one straight line.

算出部307aは、複数の超音波受信素子24の反射波の受信結果に基づいて、センサ装置20を基準とした、超音波の反射地点の位置を算出する。超音波の反射地点とは、上述した実施形態と同様に、反射波が反射するエッジ部の位置とする。以下に、算出部307aによる超音波の反射地点の位置の算出方法を図13を参照して説明する。 The calculation unit 307a calculates the position of the ultrasonic wave reflection point with reference to the sensor device 20 based on the reception results of the reflected waves of the plurality of ultrasonic wave receiving elements 24. The reflection point of the ultrasonic wave is the position of the edge portion where the reflected wave is reflected, as in the above-described embodiment. Hereinafter, a method of calculating the position of the reflection point of the ultrasonic wave by the calculation unit 307a will be described with reference to FIG.

本実施形態では、受信信号(反射波)に対して、ビームフォーミング法を用いた演算を実施することで、超音波の反射地点の位置を算出する。図13に示すように、反射波を平面波と仮定した場合に、超音波受信素子24と超音波受信素子24との間の距離d0と音速cを用いて、式(1)より遅延時間t0を求めることができる。角度θとは、複数の超音波受信素子24が直線上に並べられた方向と、複数の超音波受信素子24のうち基準となる超音波受信素子24から目的地までの方向と、の間の角度とする。
t0=d0・SINθ/c ・・・(1)
In the present embodiment, the position of the reflection point of the ultrasonic wave is calculated by performing the calculation using the beamforming method on the received signal (reflected wave). As shown in FIG. 13, when the reflected wave is assumed to be a plane wave, the delay time t0 is calculated from the equation (1) by using the distance d0 and the sound velocity c between the ultrasonic receiving element 24 and the ultrasonic receiving element 24. You can ask. The angle θ is between the direction in which the plurality of ultrasonic receiving elements 24 are arranged in a straight line and the direction from the reference ultrasonic receiving element 24 to the destination among the plurality of ultrasonic receiving elements 24. Let it be an angle.
t0 = d0 ・ SINθ / c ・ ・ ・ (1)

ビームフォーミング法を用いた演算を行う方向(D2方向、D3方向)ごとに、各超音波受信素子24の遅延時間を求め、各受信信号に対して求めた遅延時間だけ遅延させた信号全てを加算することで、各方向(D2方向、D3方向)にビームフォーミング法を用いて演算した際の受信信号を作成できる。 The delay time of each ultrasonic receiving element 24 is obtained for each direction (D2 direction, D3 direction) in which the calculation using the beamforming method is performed, and all the signals delayed by the obtained delay time are added to each received signal. By doing so, it is possible to create a received signal when the calculation is performed using the beamforming method in each direction (D2 direction, D3 direction).

超音波の反射地点が、センサ装置20の正面に存在しない場合、複数の超音波受信素子24で受信した反射波を示す信号をそのまま加算すると、それぞれの反射波は位相が異なるため、目的の信号を得る事ができない。このため、反射地点に強く反応した反射波を示す信号を算出するためには、超音波受信素子24毎に算出された遅延時間t0を考慮する必要がある。そこで、算出部307aは、超音波受信素子24の各々が受信した反射波を示す信号に対して、超音波受信素子24毎に算出された遅延時間t0を遅延させた後、遅延させた反射波を示す信号を全て加算する。 When the ultrasonic reflection point does not exist in front of the sensor device 20, if the signals indicating the reflected waves received by the plurality of ultrasonic receiving elements 24 are added as they are, the respective reflected waves have different phases, so that the target signal Cannot be obtained. Therefore, in order to calculate the signal indicating the reflected wave that strongly reacts to the reflection point, it is necessary to consider the delay time t0 calculated for each ultrasonic wave receiving element 24. Therefore, the calculation unit 307a delays the delay time t0 calculated for each ultrasonic wave receiving element 24 with respect to the signal indicating the reflected wave received by each of the ultrasonic wave receiving elements 24, and then delays the reflected wave. All the signals indicating are added.

これにより、反射地点に強く反応した反射波を示す信号を得ることができる。本実施形態においては、算出部307aは、複数の角度θの各々に対応する遅延パターン(角度θ毎の超音波受信素子24の各々の遅延時間の組み合わせ)を備えておく。そして、算出部307aは、複数の超音波受信素子24で受信した反射波を示す信号に対して、複数の遅延パターンを用いて調整することで、反射地点に強く反応する、反射波を示す信号を得られる。そして、算出部307aは、反射地点に強く反応した時に適用された遅延パターンの角度θから、反射地点が存在する方向を認識できる。 As a result, it is possible to obtain a signal indicating a reflected wave that strongly reacts to the reflection point. In the present embodiment, the calculation unit 307a is provided with a delay pattern corresponding to each of the plurality of angles θ (a combination of delay times of each of the ultrasonic receiving elements 24 for each angle θ). Then, the calculation unit 307a adjusts the signal indicating the reflected wave received by the plurality of ultrasonic receiving elements 24 by using a plurality of delay patterns, so that the signal indicating the reflected wave strongly reacts to the reflection point. Can be obtained. Then, the calculation unit 307a can recognize the direction in which the reflection point exists from the angle θ of the delay pattern applied when it reacts strongly to the reflection point.

そして、算出部307aは、反射地点が存在する方向、及び反射地点までの距離を組み合わせることで、センサ装置20を基準とした、反射地点の位置、換言すれば、反射が反射した(移動対象物の)エッジ部の位置を算出できる。 Then, the calculation unit 307a combines the direction in which the reflection point exists and the distance to the reflection point to reflect the position of the reflection point, in other words, the reflection (moving object) with reference to the sensor device 20. The position of the edge part can be calculated.

ビームフォーミングは、超音波受信素子24を直線状に設置した軸の方向しか反射地点が存在する方向を判定できない。このため、本実施形態では、2軸方向を検出(算出)するために、図12に示すような十字状に超音波受信素子24を配置した。超音波受信素子24の個数を増加することで、虚像の低減効果が期待でき、物品W1からの反射波の数が多い場合にそれぞれの反射の分離が容易になるという利点がある。 Beamforming can determine the direction in which the reflection point exists only in the direction of the axis in which the ultrasonic wave receiving element 24 is installed in a straight line. Therefore, in the present embodiment, the ultrasonic wave receiving element 24 is arranged in a cross shape as shown in FIG. 12 in order to detect (calculate) the biaxial direction. By increasing the number of the ultrasonic receiving elements 24, the effect of reducing the virtual image can be expected, and there is an advantage that the reflections of the respective reflections can be easily separated when the number of reflected waves from the article W1 is large.

次に、本実施形態の荷役システム1が実行する荷役処理を図14を参照して説明する。 Next, the cargo handling process executed by the cargo handling system 1 of the present embodiment will be described with reference to FIG.

本実施形態の荷役処理は、図14に示すように、S11〜S13の後にS21を行なう。S21にて、物品判定部307bは、受信した受信信号に対してビームフォーミング処理を行い、各方向(D2方向、D3方向)の受信信号を作成し、十字状に配置された超音波受信素子24の2つの配列方向(D2方向、D3方向)でそれぞれ反射波の到来方向、換言すれば反射地点が存在する方向を算出する(S21)。そして、物品判定部307bは、到来時間差を考慮して求めた超音波受信素子24から反射地点までの距離と、算出した反射地点が存在する方向とから、反射地点の位置を算出する(S14)。到来時間差とは、超音波を送信してから受信するまでの超音波受信素子24間の時間差とする。本実施形態の算出部307aは、複数の超音波受信素子24の到来時間の平均に基づいて反射地点までの距離を算出することで、到来時間差を考慮した、反射地点までの距離を算出できる。他の例としては、算出部307aは、特定の超音波受信素子24(例えば、図13において遅延時間t0=0となる超音波受信素子24)が反射波を受信するまでの到来時間に基づいて、反射地点までの距離を算出してもよい。そして、S15以降の処理が行なわれる。 In the cargo handling process of this embodiment, as shown in FIG. 14, S21 is performed after S11 to S13. In S21, the article determination unit 307b performs beam forming processing on the received received signal, creates a received signal in each direction (D2 direction, D3 direction), and arranges the ultrasonic receiving elements 24 in a cross shape. The arrival direction of the reflected wave, in other words, the direction in which the reflection point exists, is calculated in each of the two arrangement directions (D2 direction and D3 direction) (S21). Then, the article determination unit 307b calculates the position of the reflection point from the distance from the ultrasonic wave receiving element 24 obtained in consideration of the arrival time difference to the reflection point and the calculated direction in which the reflection point exists (S14). .. The arrival time difference is the time difference between the ultrasonic receiving elements 24 from the transmission of ultrasonic waves to the reception of ultrasonic waves. The calculation unit 307a of the present embodiment can calculate the distance to the reflection point in consideration of the arrival time difference by calculating the distance to the reflection point based on the average of the arrival times of the plurality of ultrasonic receiving elements 24. As another example, the calculation unit 307a is based on the arrival time until the specific ultrasonic receiving element 24 (for example, the ultrasonic receiving element 24 having the delay time t0 = 0 in FIG. 13) receives the reflected wave. , The distance to the reflection point may be calculated. Then, the processing after S15 is performed.

以上のように、本実施形態では、超音波送信素子23と超音波受信素子24とを組み合わせた超音波センサユニット(送受信部)は、第1の直線L1に沿って並べられた複数個の超音波受信素子24A(第1の受信素子)と、第1の直線L1と交差する第2の直線L2に沿って並べられた複数個の超音波受信素子24(第2の受信素子)と、を有する。物品判定部307b(判定部)は、超音波受信素子24Aの反射波の受信結果と超音波受信素子24の反射波の受信結果とに基づいて、センサ装置20に対する反射波の到来方向を検出する。よって、物品W1の位置の検出の精度が向上する。 As described above, in the present embodiment, the ultrasonic sensor unit (transmission / reception unit) in which the ultrasonic wave transmitting element 23 and the ultrasonic wave receiving element 24 are combined is a plurality of ultrasonic sensor units arranged along the first straight line L1. A sound wave receiving element 24A (first receiving element) and a plurality of ultrasonic wave receiving elements 24 (second receiving element) arranged along a second straight line L2 intersecting with the first straight line L1. Have. The article determination unit 307b (determination unit) detects the direction of arrival of the reflected wave with respect to the sensor device 20 based on the reception result of the reflected wave of the ultrasonic wave receiving element 24A and the reception result of the reflected wave of the ultrasonic wave receiving element 24. .. Therefore, the accuracy of detecting the position of the article W1 is improved.

(第3の実施形態)
上述した実施形態においては、次に、第3の実施形態を図15を参照して説明する。図15は、第3の実施形態の制御装置及びセンサ装置の機能構成の一例を示す図である。なお、第1の実施形態と同じ構成については同一符号を割り当て、説明を省略する。
(Third Embodiment)
In the above-described embodiment, the third embodiment will be described next with reference to FIG. FIG. 15 is a diagram showing an example of the functional configuration of the control device and the sensor device of the third embodiment. The same reference numerals are assigned to the same configurations as those in the first embodiment, and the description thereof will be omitted.

図15に示すように、本実施形態では、移動制御部1212は、指向性制御部1218を有する。指向性制御部1218は、パレット2に載置された物品W1に向けて超音波が送信されるようにセンサ装置20の向きを制御する。指向性制御部1218は、カメラ30の撮像画像に基づいて、パレット2に載置された物品W1に向けて超音波が送信されるように、移動装置50のアーム部112を制御する。指向性制御部1218は、超音波送信素子23と超音波受信素子24とを組み合わせた超音波センサユニットの向きを変更可能な駆動機構の一例を示したものである。 As shown in FIG. 15, in the present embodiment, the movement control unit 1212 has a directivity control unit 1218. The directivity control unit 1218 controls the orientation of the sensor device 20 so that ultrasonic waves are transmitted toward the article W1 placed on the pallet 2. The directivity control unit 1218 controls the arm unit 112 of the moving device 50 so that ultrasonic waves are transmitted toward the article W1 placed on the pallet 2 based on the captured image of the camera 30. The directivity control unit 1218 shows an example of a drive mechanism capable of changing the direction of an ultrasonic sensor unit that is a combination of an ultrasonic transmitting element 23 and an ultrasonic receiving element 24.

ここで、一般的に超音波センサは正面方向の感度が高く、側面方向では感度が低下する。このため、超音波センサが物品W1の方向を向いていない場合に、反射波を受信できない可能性がある。この問題に対して、本実施形態では、移動制御部1212の指向性制御部1218が、パレット2に載置された物品W1に向けて超音波が送信されるようにセンサ装置20の向きを制御するので、センサ装置20が反射波を精度よく受信することができる。 Here, generally, an ultrasonic sensor has a high sensitivity in the front direction and a low sensitivity in the side direction. Therefore, if the ultrasonic sensor is not facing the direction of the article W1, there is a possibility that the reflected wave cannot be received. In response to this problem, in the present embodiment, the directivity control unit 1218 of the movement control unit 1212 controls the orientation of the sensor device 20 so that ultrasonic waves are transmitted toward the article W1 placed on the pallet 2. Therefore, the sensor device 20 can receive the reflected wave with high accuracy.

なお、把持部113に対するセンサ装置20の姿勢をモータ等の駆動源の駆動力によって変化させる姿勢変化機構を設けてもよい。この場合、指向性制御部1218は、姿勢変化機構の駆動源を制御することにより、パレット2に載置された物品W1に向けて超音波が送信されるようにセンサ装置20の向きを制御してもよい。また、この場合、姿勢変化機構は、把持部113に対してセンサ装置20を回転させる構成であってよい。 A posture change mechanism that changes the posture of the sensor device 20 with respect to the grip portion 113 by the driving force of a drive source such as a motor may be provided. In this case, the directivity control unit 1218 controls the direction of the sensor device 20 so that ultrasonic waves are transmitted toward the article W1 placed on the pallet 2 by controlling the drive source of the attitude change mechanism. You may. Further, in this case, the posture change mechanism may be configured to rotate the sensor device 20 with respect to the grip portion 113.

以上説明したとおり、上記実施形態によれば、複数の物品W1がシート状の覆い物Bによって覆われて覆い物Bによって一つにまとめられている場合であっても、物品W1の移動を良好に行なうことができる。 As described above, according to the above embodiment, even when a plurality of articles W1 are covered with a sheet-shaped covering B and are grouped together by the covering B, the movement of the articles W1 is good. Can be done.

上述の各実施形態の制御装置60で実行されるプログラムおよびセンサ装置20で実行されるプログラムは、インストール可能な形式または実行可能な形式のファイルでCD−ROM、フレキシブルディスク(FD)、CD−R、DVD(Digital Versatile Disk)等のコンピュータで読み取り可能な記録媒体に記録されて提供される。 The program executed by the control device 60 and the program executed by the sensor device 20 of each of the above-described embodiments are files in an installable format or an executable format, such as a CD-ROM, a flexible disk (FD), and a CD-R. , DVD (Digital Versailles Disk) and the like, which are recorded and provided on a computer-readable recording medium.

また、上述の各実施形態の制御装置60で実行されるプログラムおよびセンサ装置20で実行されるプログラムを、インターネット等のネットワークに接続されたコンピュータ上に格納し、ネットワーク経由でダウンロードさせることにより提供するように構成してもよい。また、上述の各実施形態の制御装置60で実行されるプログラムおよびセンサ装置20で実行されるプログラムをインターネット等のネットワーク経由で提供または配布するように構成してもよい。また、上述の各実施形態のプログラムを、ROM等に予め組み込んで提供するように構成してもよい。 Further, the program executed by the control device 60 and the program executed by the sensor device 20 of each of the above-described embodiments are provided by storing them on a computer connected to a network such as the Internet and downloading them via the network. It may be configured as follows. Further, the program executed by the control device 60 and the program executed by the sensor device 20 of each of the above-described embodiments may be provided or distributed via a network such as the Internet. Further, the program of each of the above-described embodiments may be configured to be provided by incorporating it into a ROM or the like in advance.

上述の各実施形態の制御装置60で実行されるプログラムは、上述した各部(取得部、認識部、移動制御部、出力部)を含むモジュール構成となっており、実際のハードウェアとしてはCPU(プロセッサ)が上記記憶媒体からプログラムを読み出して実行することにより上記各部が主記憶装置上にロードされ、取得部、認識部、移動制御部、出力部が主記憶装置上に生成されるようになっている。 The program executed by the control device 60 of each of the above-described embodiments has a module configuration including each of the above-mentioned units (acquisition unit, recognition unit, movement control unit, output unit), and the actual hardware is a CPU ( When the processor) reads the program from the storage medium and executes it, each of the above units is loaded on the main storage device, and the acquisition unit, the recognition unit, the movement control unit, and the output unit are generated on the main storage device. ing.

上述の各実施形態のセンサ装置20で実行されるプログラムは、上述した各部(距離測定部、位置認識部)を含むモジュール構成となっており、実際のハードウェアとしてはCPU(プロセッサ)が上記記憶媒体からプログラムを読み出して実行することにより上記各部が主記憶装置上にロードされ、距離測定部、位置認識部が主記憶装置上に生成されるようになっている。 The program executed by the sensor device 20 of each of the above-described embodiments has a module configuration including the above-mentioned parts (distance measuring unit, position recognition unit), and the CPU (processor) stores the above as the actual hardware. By reading the program from the medium and executing it, each of the above-mentioned parts is loaded on the main storage device, and the distance measuring unit and the position recognition unit are generated on the main storage device.

なお、上記実施形態では、センサ装置20は、超音波に替えて電波(ミリ波)を送受信して、物品W1を検出してもよい。この場合には、センサ装置20は、超音波送信素子23および超音波受信素子24に替えて、電波送信素子と電波受信素子とを有する。 In the above embodiment, the sensor device 20 may detect the article W1 by transmitting and receiving radio waves (millimeter waves) instead of ultrasonic waves. In this case, the sensor device 20 has a radio wave transmitting element and a radio wave receiving element instead of the ultrasonic wave transmitting element 23 and the ultrasonic wave receiving element 24.

また、上記実施形態では、物品判定部307b(判定部)がセンサ装置20に設けられた例が示されたが、これに限定されない。例えば、物品判定部307bは、制御装置60に設けられてもよい。 Further, in the above embodiment, an example in which the article determination unit 307b (determination unit) is provided in the sensor device 20 is shown, but the present invention is not limited to this. For example, the article determination unit 307b may be provided in the control device 60.

本発明のいくつかの実施形態を説明したが、これらの実施形態は、例として提示したものであり、発明の範囲を限定することは意図していない。これら新規な実施形態は、その他の様々な形態で実施されることが可能であり、発明の要旨を逸脱しない範囲で、種々の省略、置き換え、変更を行うことができる。これら実施形態やその変形は、発明の範囲や要旨に含まれるとともに、特許請求の範囲に記載された発明とその均等の範囲に含まれる。 Although some embodiments of the present invention have been described, these embodiments are presented as examples and are not intended to limit the scope of the invention. These novel embodiments can be implemented in various other embodiments, and various omissions, replacements, and changes can be made without departing from the gist of the invention. These embodiments and modifications thereof are included in the scope and gist of the invention, and are also included in the scope of the invention described in the claims and the equivalent scope thereof.

2…パレット(載置部)、10…荷役装置、23…超音波送信素子(送信素子)、24…超音波受信素子(受信素子)、24A…超音波受信素子(第1の受信素子)、24B…超音波受信素子(第2の受信素子)、50…移動装置、70…荷役制御装置、301…送信制御部、307a…算出部、307b…物品判定部(判定部)、1211…認識部、1212…移動制御部(制御部)、B…覆い物、L1…第1の直線、L2…第2の直線、W1…物品。 2 ... Palette (mounting part), 10 ... Cargo handling device, 23 ... Ultrasonic transmitting element (transmitting element), 24 ... Ultrasonic receiving element (receiving element), 24A ... Ultrasonic receiving element (first receiving element), 24B ... Ultrasonic receiving element (second receiving element), 50 ... Moving device, 70 ... Cargo handling control device, 301 ... Transmission control unit, 307a ... Calculation unit, 307b ... Article judgment unit (judgment unit), 1211 ... Recognition unit , 1212 ... Movement control unit (control unit), B ... Cover, L1 ... First straight line, L2 ... Second straight line, W1 ... Article.

Claims (10)

載置部に戴置された物品を把持して当該物品を移動させる荷役装置に設けられ、前記載置部が存在する方向に超音波または電波を送信波として送信し、前記送信波の反射波を受信する送受信部と、
前記載置部に戴置された物品の撮像画像に基づいて、前記載置部に物品が複数存在することを認識した場合に、当該撮像画像に基づいた認識結果及び前記送受信部の前記反射波の受信結果に基づいて、複数の物品がシート状の覆い物でまとめられているか否かを判定し、当該判定した結果に基づいて、前記荷役装置を制御する制御部と、
を備えた荷役制御装置。
It is provided in a cargo handling device that grips an article placed on a mounting portion and moves the article, transmits ultrasonic waves or radio waves as a transmission wave in the direction in which the above-mentioned placement portion exists, and reflects a wave of the transmitted wave. And the transmitter / receiver that receives
When it is recognized that there are a plurality of articles in the above-mentioned placement portion based on the captured image of the article placed on the above-mentioned placement portion, the recognition result based on the captured image and the reflected wave of the transmission / reception portion. Based on the reception result of, it is determined whether or not a plurality of articles are put together by a sheet-like covering, and based on the determination result, a control unit that controls the cargo handling device, and a control unit.
Cargo handling control device equipped with.
前記制御部は、さらに、前記認識結果として、前記撮像画像により認識された前記複数の物品の各々のエッジ部の位置と、前記反射波の受信結果に基づいて定められる、前記反射波が反射したエッジ部の位置と、に基づいて、前記複数の物品が、前記シート状の覆い物でまとめられているか否かを判定する、
請求項1に記載の荷役制御装置。
The control unit further reflects the reflected wave, which is determined based on the position of each edge portion of the plurality of articles recognized by the captured image and the reception result of the reflected wave as the recognition result. Based on the position of the edge portion, it is determined whether or not the plurality of articles are put together by the sheet-like covering.
The cargo handling control device according to claim 1.
前記制御部は、さらに、前記撮像画像により認識された前記複数の物品の各々のエッジ部の位置と、前記反射波が反射した前記複数の物品の各々のエッジ部の位置と、が略一致する場合に、前記複数の物品が、前記シート状の覆い物でまとめられていないと判定する、
請求項2に記載の荷役制御装置。
Further, in the control unit, the position of each edge portion of the plurality of articles recognized by the captured image and the position of each edge portion of the plurality of articles to which the reflected wave is reflected substantially coincide with each other. In some cases, it is determined that the plurality of articles are not grouped by the sheet-like covering.
The cargo handling control device according to claim 2.
前記制御部は、さらに、前記撮像画像により認識された前記複数の物品の各々のエッジ部の位置と、前記反射波が反射した前記複数の物品の各々のエッジ部の位置と、が略一致しない場合に、前記複数の物品が、前記シート状の覆い物でまとめられていると判定する、
請求項3に記載の荷役制御装置。
Further, in the control unit, the position of each edge portion of the plurality of articles recognized by the captured image and the position of each edge portion of the plurality of articles to which the reflected wave is reflected do not substantially match. In some cases, it is determined that the plurality of articles are put together by the sheet-like covering.
The cargo handling control device according to claim 3.
前記送受信部は、前記送信波を送信する1個の送信素子と、前記反射波を受信する複数個の受信素子と、を有した、請求項1〜4のいずれか一つに記載の荷役制御装置。 The cargo handling control according to any one of claims 1 to 4, wherein the transmitting / receiving unit includes one transmitting element for transmitting the transmitted wave and a plurality of receiving elements for receiving the reflected wave. Device. 前記送受信部は、前記送信波を送信する送信素子と、前記反射波を受信する受信素子と、を有し、
前記送信素子の個数と前記受信素子の個数が、それぞれ1個である、請求項1〜4のいずれか一つに記載の荷役制御装置。
The transmission / reception unit includes a transmission element that transmits the transmission wave and a reception element that receives the reflected wave.
The cargo handling control device according to any one of claims 1 to 4, wherein the number of transmitting elements and the number of receiving elements are one each.
前記送受信部は、略直線に並べられた複数の受信素子を少なくとも有し、
前記制御部は、前記複数の受信素子から受信した複数の受信結果の演算結果に基づいて、前記反射波が反射したエッジ部の位置を算出する、
請求項5に記載の荷役制御装置。
The transmitter / receiver has at least a plurality of receiving elements arranged in a substantially straight line, and has at least a plurality of receiving elements.
The control unit calculates the position of the edge portion where the reflected wave is reflected based on the calculation result of the plurality of reception results received from the plurality of receiving elements.
The cargo handling control device according to claim 5.
前記送受信部と前記載置部に載置された前記物品との間の距離に応じて、前記送信波の送信形態を変更する、
請求項1〜7のうちいずれか一つに記載の荷役制御装置。
The transmission form of the transmission wave is changed according to the distance between the transmission / reception unit and the article placed on the above-mentioned storage unit.
The cargo handling control device according to any one of claims 1 to 7.
前記制御部は、前記載置部に載置された前記物品に向けて前記送信波が送信されるように前記送受信部の向きを変更可能な駆動機構を制御する、請求項1〜8のうちいずれか一つに記載の荷役制御装置。 Of claims 1 to 8, the control unit controls a drive mechanism capable of changing the direction of the transmission / reception unit so that the transmission wave is transmitted toward the article mounted on the above-mentioned storage unit. The cargo handling control device according to any one. 載置部に戴置された物品を把持して当該物品を移動させる荷役装置に設けられ、前記載置部が存在する方向に超音波または電波を送信波として送信し、前記送信波の反射波を受信する送受信部と、
撮像部が撮像した撮像画像に基づいた前記載置部に存在する物品の認識結果において、前記載置部に物品が複数存在することが示されている場合に、当該撮像画像に基づいた認識結果及び前記送受信部の前記反射波の受信結果に基づいて、複数の物品がシート状の覆い物でまとめられているか否かを判定する制御部と、
を備えたセンサ装置。
It is provided in a cargo handling device that grips an article placed on a mounting portion and moves the article, transmits ultrasonic waves or radio waves as a transmission wave in the direction in which the above-mentioned placement portion exists, and reflects a wave of the transmitted wave. And the transmitter / receiver that receives
When the recognition result of the article existing in the pre-described placement portion based on the captured image captured by the imaging unit indicates that a plurality of articles are present in the pre-described placement portion, the recognition result based on the captured image. And a control unit that determines whether or not a plurality of articles are put together by a sheet-like covering based on the reception result of the reflected wave of the transmission / reception unit.
Sensor device equipped with.
JP2020001064A 2020-01-07 2020-01-07 Cargo handling control device and sensor device Active JP7493941B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2020001064A JP7493941B2 (en) 2020-01-07 2020-01-07 Cargo handling control device and sensor device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2020001064A JP7493941B2 (en) 2020-01-07 2020-01-07 Cargo handling control device and sensor device

Publications (2)

Publication Number Publication Date
JP2021109257A true JP2021109257A (en) 2021-08-02
JP7493941B2 JP7493941B2 (en) 2024-06-03

Family

ID=77058692

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020001064A Active JP7493941B2 (en) 2020-01-07 2020-01-07 Cargo handling control device and sensor device

Country Status (1)

Country Link
JP (1) JP7493941B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2024057627A1 (en) * 2022-09-13 2024-03-21 株式会社日立製作所 Object recognition device, robot system, and object recognition method

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6536110B2 (en) 2015-03-20 2019-07-03 セイコーエプソン株式会社 Robot control device and control method

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2024057627A1 (en) * 2022-09-13 2024-03-21 株式会社日立製作所 Object recognition device, robot system, and object recognition method

Also Published As

Publication number Publication date
JP7493941B2 (en) 2024-06-03

Similar Documents

Publication Publication Date Title
US8725285B2 (en) Robot system and transfer method
US20150127162A1 (en) Apparatus and method for picking up article randomly piled using robot
US10175354B2 (en) Object detection apparatus
JP7433915B2 (en) Sensor devices and cargo handling systems
JPWO2008026463A1 (en) Position measurement system, robot, position measurement method, and sound source position calculation program
JP6828579B2 (en) Environmental maintenance robot and its control program
CN105549018B (en) Object test equipment
CN114026462A (en) Electronic device and control method thereof
JP2021109257A (en) Cargo handling control device and sensor device
JPH02170004A (en) Three-dimensional position measuring instrument
JP7042703B2 (en) Information processing equipment, unloading system equipped with information processing equipment, and information processing program
US20170011521A1 (en) Systems and methods for a dual modality sensor system
US10324565B2 (en) Optical proximity sensor
US11774585B2 (en) Estimating a location of an object in close proximity to an ultrasonic transducer
JP2020165858A (en) Object detector
JP2011212818A (en) Environment recognition robot
WO2024057627A1 (en) Object recognition device, robot system, and object recognition method
JPH0854926A (en) Guidance device for autonomous mobile robot
KR20180076450A (en) Apparatus and method for preventing collision of robot
Uehara et al. Multiple Objects Detection Using an Airborne Ultrasonic Phased Array with MUSIC Method
WO2015138396A1 (en) Systems and methods for a dual modality sensor system
JP2023162799A (en) Information processor, information processing method, program, and system
WO2022269984A1 (en) Control device, control method, and program
Llata et al. Three-dimensional robotic vision using ultrasonic sensors
JPH05257530A (en) Method and device for correcting bearing and position of moving robot

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20221108

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20230914

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230919

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20231027

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20240109

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20240311

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: 20240423

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20240522

R150 Certificate of patent or registration of utility model

Ref document number: 7493941

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150