Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JP7609211B2 - AUTONOMOUS MOBILE DEVICE AND METHOD FOR CONTROLLING MOBILITY OF AUTONOMOUS MOBILE DEVICE - Google Patents
[go: Go Back, main page]

JP7609211B2 - AUTONOMOUS MOBILE DEVICE AND METHOD FOR CONTROLLING MOBILITY OF AUTONOMOUS MOBILE DEVICE - Google Patents

AUTONOMOUS MOBILE DEVICE AND METHOD FOR CONTROLLING MOBILITY OF AUTONOMOUS MOBILE DEVICE Download PDF

Info

Publication number
JP7609211B2
JP7609211B2 JP2023119717A JP2023119717A JP7609211B2 JP 7609211 B2 JP7609211 B2 JP 7609211B2 JP 2023119717 A JP2023119717 A JP 2023119717A JP 2023119717 A JP2023119717 A JP 2023119717A JP 7609211 B2 JP7609211 B2 JP 7609211B2
Authority
JP
Japan
Prior art keywords
panel
detection
self
propelled robot
mobile device
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2023119717A
Other languages
Japanese (ja)
Other versions
JP2023126668A (en
Inventor
紘 片山
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.)
Ricoh Co Ltd
Original Assignee
Ricoh Co Ltd
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 Ricoh Co Ltd filed Critical Ricoh Co Ltd
Priority to JP2023119717A priority Critical patent/JP7609211B2/en
Publication of JP2023126668A publication Critical patent/JP2023126668A/en
Application granted granted Critical
Publication of JP7609211B2 publication Critical patent/JP7609211B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Description

本発明は、自律移動装置および自律移動装置の移動制御方法に関する。 The present invention relates to an autonomous mobile device and a method for controlling the movement of an autonomous mobile device.

従来、自律移動装置である無人搬送車(AGV:Automated Guided Vehicle)を用いて、倉庫内の搬送作業を自動化することは、世の中で広く検討されている。具体的には、無人搬送車に接続機構を設け、無人搬送車に搬送対象物(カゴ車)を接続して倉庫内を搬送する、という構成は既に知られている。 The use of an autonomous mobile device, an automated guided vehicle (AGV), to automate transport operations within a warehouse has been widely considered. Specifically, a configuration is already known in which a connection mechanism is provided to an automated guided vehicle, and the object to be transported (cart) is connected to the automated guided vehicle to transport it within a warehouse.

特許文献1には、無人搬送車と該無人搬送車の移動目標との両方にセンサを搭載し、これらセンサを用いて通信を行いながら、無人搬送車の移動制御を行う技術が開示されている。また、特許文献2には、無人搬送車側のみにセンサを設け、このセンサを用いて移動目標に向かって無人搬送車の移動制御を行う技術が開示されている。さらに、特許文献2には、レーザ光により搬送対象物(台車)の前面の角(両端)を検出することより搬送対象物(台車)の向きを検出し、検出した搬送対象物(台車)の向きに基づいて無人搬送車を移動させて搬送対象物(台車)と自動連結する技術が開示されている。 Patent Document 1 discloses a technology in which sensors are mounted on both the automated guided vehicle and the target of the automated guided vehicle, and the movement of the automated guided vehicle is controlled while communicating using these sensors. Patent Document 2 discloses a technology in which a sensor is provided only on the automated guided vehicle, and the movement of the automated guided vehicle is controlled using this sensor toward the target. Patent Document 2 also discloses a technology in which the orientation of the object to be transported (cart) is detected by detecting the corners (both ends) of the front of the object to be transported (cart) with a laser beam, and the automated guided vehicle is moved based on the detected orientation of the object to be transported (cart) to automatically connect to the object to be transported (cart).

しかしながら、特許文献2に開示の技術によれば、レーザ光により搬送対象物(台車)の前面の角(両端)を検出しているため、搬送対象物(台車)の形状や搬送対象物(台車)の周囲に物(他の台車や荷物)が存在する場合に誤検出する可能性が懸念される。具体的には、カゴ車のような端部が特定し辛い形状の搬送対象物では、誤検出することが懸念される。また、カゴ車に荷物が積載されている場合や複数のカゴ車が隣接して置かれている場合などは、更に誤検出の可能性が高まることが懸念される。 However, according to the technology disclosed in Patent Document 2, the front corners (both ends) of the transported object (cart) are detected using laser light, so there is a concern that erroneous detection may occur depending on the shape of the transported object (cart) or when there are objects (other carts or luggage) around the transported object (cart). Specifically, there is a concern that erroneous detection may occur for transported objects with shapes whose ends are difficult to identify, such as baskets. In addition, there is a concern that the possibility of erroneous detection may increase further when luggage is loaded on the basket or when multiple baskets are placed adjacent to each other.

さらに、特許文献2に開示の技術によれば、台車の前面の角(両端)を検出することより搬送対象物(台車)の向きを検出するためには、両端部にある程度の距離(長さ)が必要となることから、遠距離からの検出には不向きである。 Furthermore, according to the technology disclosed in Patent Document 2, in order to detect the orientation of the transported object (cart) by detecting the corners (both ends) of the front of the cart, a certain distance (length) is required at both ends, making it unsuitable for detection from long distances.

したがって、特許文献1,2に開示の技術によれば、角度検出の精度や角度検出できる距離という観点において改善の余地がある。 Therefore, the techniques disclosed in Patent Documents 1 and 2 leave room for improvement in terms of the accuracy of angle detection and the distance at which angles can be detected.

本発明は、上記に鑑みてなされたものであって、搬送対象物の角度検出の精度向上や従来技術よりも遠距離から搬送対象物の角度を検出できるようにすることを目的とする。 The present invention has been made in consideration of the above, and aims to improve the accuracy of angle detection of the transported object and to enable the angle of the transported object to be detected from a longer distance than with conventional technology.

上述した課題を解決し、目的を達成するために、本発明の自律移動装置は、自律移動装置であって、検出領域に光を射出することで前記検出領域を光走査し、射出された前記光が前記検出領域に存在する物体により反射された反射光を受光するセンサにより、前記検出領域に存在する識別部材を検出する検出装置を有し、前記検出装置は、前記センサが受光した光に基づき前記物体から反射された光の反射強度を検出する反射強度検出手段と、前記センサが受光した光に基づき、前記識別部材の検出面までの距離を検出する距離検出手段と、を有し、前記検出装置は、前記反射強度検出手段で検出した情報から前記識別部材の候補を検出し、前記距離検出手段で検出した情報から前記候補の形状平面を検出し、前記識別部材は、搬送対象車に装着されており、当該自律移動装置を前記搬送対象車と連結する位置である目標位置へ移動させ、前記目標位置にて、当該自律移動装置を前記搬送対象車と連結させる制御手段を有し、前記搬送対象車に装着された前記識別部材に記載されている識別情報は、前記搬送対象車の種類ごとに用意されていて、前記識別情報に紐付けて移動量を登録しておき、前記検出装置は、前記識別部材に記載されている識別情報を検出し、前記制御手段は、前記識別情報に紐付けられた移動量に基づいて、前記目標位置を変更する、ことを特徴とする。 In order to solve the above-mentioned problems and achieve the object, an autonomous mobile device of the present invention is an autonomous mobile device having a detection device that optically scans a detection area by emitting light into the detection area and detects an identification member present in the detection area by a sensor that receives reflected light of the emitted light reflected by an object present in the detection area, the detection device having reflection intensity detection means that detects a reflection intensity of light reflected from the object based on the light received by the sensor, and distance detection means that detects a distance to a detection surface of the identification member based on the light received by the sensor, and the detection device detects candidates for the identification member from information detected by the reflection intensity detection means. the candidate shape plane is detected from the information detected by the distance detection means , the identification member is attached to the vehicle to be transported, the autonomous mobile device is moved to a target position where it will be connected to the vehicle to be transported, and the autonomous mobile device is connected to the vehicle to be transported at the target position, the identification information written on the identification member attached to the vehicle to be transported is prepared for each type of vehicle to be transported, the amount of movement is registered in association with the identification information, the detection device detects the identification information written on the identification member, and the control means changes the target position based on the amount of movement linked to the identification information .

本発明によれば、搬送対象物の角度検出の精度向上や従来技術よりも遠距離から搬送対象物の角度を検出できる、という効果を奏する。 The present invention has the effect of improving the accuracy of angle detection of the transported object and being able to detect the angle of the transported object from a longer distance than with conventional technology.

図1は、第1の実施の形態にかかる搬送システムにおける自走ロボットとカゴ台車とを示す説明図である。FIG. 1 is an explanatory diagram showing a self-propelled robot and a basket cart in a transport system according to a first embodiment. 図2は、カゴ台車にIDパネルが配置された例を示す斜視図である。FIG. 2 is a perspective view showing an example in which an ID panel is arranged on a cart. 図3は、IDパネルの例を示す図である。FIG. 3 is a diagram showing an example of an ID panel. 図4は、物流倉庫の一例を示す説明図である。FIG. 4 is an explanatory diagram showing an example of a logistics warehouse. 図5は、自走ロボットのコントローラのハードウェア構成の一例を示すブロック図である。FIG. 5 is a block diagram showing an example of the hardware configuration of a controller of the self-running robot. 図6は、自走ロボットのコントローラが発揮する機能的構成例を示すブロック図である。FIG. 6 is a block diagram showing an example of the functional configuration performed by the controller of the self-running robot. 図7は、IDパネルの検出処理の流れを概略的に示すフローチャートである。FIG. 7 is a flowchart showing an outline of the flow of the ID panel detection process. 図8は、IDパネルの検出におけるピーク値検出状態を示す図である。FIG. 8 is a diagram showing a peak value detection state in the detection of an ID panel. 図9は、ピーク値を検出する手法について説明する図である。FIG. 9 is a diagram for explaining a technique for detecting a peak value. 図10は、IDパネルの検出における距離情報値検出状態を示す図である。FIG. 10 is a diagram showing a state of distance information value detection in detecting an ID panel. 図11は、自走ロボットとカゴ台車とが接続可能な範囲を示す図である。FIG. 11 is a diagram showing the range in which the self-propelled robot and the basket cart can be connected. 図12は、IDパネルの傾きの算出例を示す図である。FIG. 12 is a diagram showing an example of calculation of the inclination of an ID panel. 図13は、IDパネルの検出処理の完了後における目標位置への移動処理の流れを示すフローチャートである。FIG. 13 is a flowchart showing the flow of the process of moving to the target position after the detection process of the ID panel is completed. 図14は、IDパネルの傾きの検出手法を示す図である。FIG. 14 is a diagram showing a method for detecting the inclination of an ID panel. 図15は、IDパネルの方向の検出手法を示す図である。FIG. 15 is a diagram showing a method for detecting the orientation of an ID panel. 図16は、相対目標位置の算出方法を示す図である。FIG. 16 is a diagram showing a method for calculating a relative target position. 図17は、相対目標位置への走行経路を模式的に示す図である。FIG. 17 is a diagram showing a schematic diagram of a travel route to a relative target position. 図18は、第2の実施の形態にかかるIDパネルの検出処理の流れを概略的に示すフローチャートである。FIG. 18 is a flowchart illustrating a flow of a detection process of an ID panel according to the second embodiment. 図19は、IDパネルの検出におけるピーク値検出状態を示す図である。FIG. 19 is a diagram showing a peak value detection state in the detection of an ID panel. 図20は、IDパネルに対する接近状態を示す図である。FIG. 20 is a diagram showing an approach state to the ID panel. 図21は、IDパネルの内容識別例を示す図である。FIG. 21 is a diagram showing an example of content identification on an ID panel. 図22は、第3の実施の形態にかかる搬送システムにおける自走ロボットのハードウェア構成の一例を示すブロック図である。FIG. 22 is a block diagram illustrating an example of a hardware configuration of a self-running robot in the transfer system according to the third embodiment. As illustrated in FIG. 図23は、IDパネルの検出処理の流れを概略的に示すフローチャートである。FIG. 23 is a flowchart showing an outline of the flow of the ID panel detection process. 図24は、IDパネルの内容識別例を示す図である。FIG. 24 is a diagram showing an example of content identification of an ID panel. 図25は、第4の実施の形態にかかるIDパネルの検出処理の完了後における目標位置への移動処理の流れを示すフローチャートである。FIG. 25 is a flowchart showing the flow of the movement process to the target position after the detection process of the ID panel according to the fourth embodiment is completed. 図26は、相対目標位置のシフト方法を示す図である。FIG. 26 is a diagram showing a method of shifting the relative target position.

以下に添付図面を参照して、自律移動装置および自律移動装置の移動制御方法の実施の形態を詳細に説明する。 DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS Hereinafter, an embodiment of an autonomous mobile device and a method for controlling the movement of an autonomous mobile device will be described in detail with reference to the accompanying drawings.

(第1の実施の形態)
図1は、第1の実施の形態にかかる搬送システムにおける自走ロボット1とカゴ台車2とを示す説明図である。本実施形態は、連結対象であるカゴ台車2のような被牽引台車に自動で接続して牽引することで、カゴ台車2を所望の搬送先へ自動搬送する無人搬送車(AGV:Automated Guided Vehicle)としての自走ロボット1を、自律移動装置に適用した搬送システムの例である。
(First embodiment)
1 is an explanatory diagram showing a self-propelled robot 1 and a cage cart 2 in a transport system according to a first embodiment. This embodiment is an example of a transport system in which the self-propelled robot 1 is applied to an autonomous mobile device as an automated guided vehicle (AGV) that automatically connects to and tows a towed vehicle such as the cage cart 2 to be connected, thereby automatically transporting the cage cart 2 to a desired destination.

自走ロボット1は、搬送物を積載するカゴ台車2に自動で連結する機能を持った自律移動装置である。これにより、自走ロボット1には積載が可能な構成を持たせることなく、簡易な移動装置によってカゴ台車2を牽引させることで、カゴ台車2に積載された多数の搬送物を搬送させることができる。 The self-propelled robot 1 is an autonomous mobile device that has the ability to automatically couple to a basket cart 2 that carries objects to be transported. This allows the self-propelled robot 1 to transport a large number of objects loaded on the basket cart 2 by towing the basket cart 2 with a simple mobile device, without the need for the self-propelled robot 1 to have a configuration capable of carrying objects.

図1に示すように、自走ロボット1は、装置本体であるロボット本体部100、磁気センサ3、検出装置であるコントローラ4、電力源(バッテリー)6、動力モータ7、モータドライバ8、第1のセンサである測域センサ9、連結装置10、駆動車輪71及び従動車輪72等を備える。測域センサ9は、自走ロボット1の周辺環境を認識する。 As shown in FIG. 1, the self-propelled robot 1 includes a robot main body 100, which is the device body, a magnetic sensor 3, a controller 4, which is a detection device, a power source (battery) 6, a power motor 7, a motor driver 8, a range sensor 9, which is a first sensor, a coupling device 10, drive wheels 71, and driven wheels 72. The range sensor 9 recognizes the surrounding environment of the self-propelled robot 1.

本実施形態の搬送システムでは、自走ロボット1の走行可能な経路の床面に磁気テープを設置し、磁気センサ3を用いて磁気テープを検出することにより自走ロボット1が走行可能な経路上に位置していることを認識することができる。床面にテープを設置する誘導方式としては、磁気テープを用いる構成(磁気式)に限らず、光学テープを用いる構成(光学式)としてもよい。光学テープを用いる場合は、磁気センサ3の代わりに反射センサやイメージセンサなどが利用できる。 In the transport system of this embodiment, a magnetic tape is placed on the floor surface of the route that the self-propelled robot 1 can travel, and the magnetic sensor 3 is used to detect the magnetic tape, thereby making it possible for the self-propelled robot 1 to recognize that it is located on the route that it can travel. The guidance method for placing the tape on the floor surface is not limited to a configuration using magnetic tape (magnetic type), but may also be a configuration using optical tape (optical type). When optical tape is used, a reflective sensor or image sensor can be used instead of the magnetic sensor 3.

また、本実施形態の搬送システムでは、二次元あるいは三次元地図と測域センサ9の検出結果との照合によって自己位置を認識する自律走行を行うことができる。測域センサ9は、物体にレーザ光を照射してその反射光から物体までの距離を測定する走査式のレーザ距離センサ(レーザレンジファインダ(LRF))である。以降において、測域センサ9をLRF9と表記する場合がある。 The transportation system of this embodiment can perform autonomous driving that recognizes its own position by comparing a two-dimensional or three-dimensional map with the detection results of the range sensor 9. The range sensor 9 is a scanning type laser distance sensor (laser range finder (LRF)) that irradiates an object with laser light and measures the distance to the object from the reflected light. Hereinafter, the range sensor 9 may be referred to as LRF9.

なお、検出結果と二次元あるいは三次元地図との照合によって自己位置の認識に用いるセンサとしては、ステレオカメラやデプスカメラなども利用できる。 Stereo cameras and depth cameras can also be used as sensors to recognize the vehicle's position by comparing the detection results with a two-dimensional or three-dimensional map.

自走ロボット1は、磁気センサ3や測域センサ9の検出結果に基づいてコントローラ4がモータドライバ8を介して動力モータ7の駆動を制御し、動力モータ7が駆動車輪71を回動駆動することで自走ロボット1が自律走行を行う。 Based on the detection results of the magnetic sensor 3 and the range sensor 9, the controller 4 controls the driving of the power motor 7 via the motor driver 8, and the power motor 7 drives the drive wheels 71 to rotate, allowing the self-propelled robot 1 to travel autonomously.

図1に示すように、カゴ台車2は、カゴ部20を保持する底板22と、四角形状の底板22の四隅に配置されたキャスター23と、カゴ部20の側面に配置された識別部材であるIDパネル21とを備える。 As shown in FIG. 1, the basket cart 2 includes a bottom plate 22 that holds the basket section 20, casters 23 arranged at the four corners of the rectangular bottom plate 22, and an ID panel 21, which is an identification member arranged on the side of the basket section 20.

所定の場所に置かれたカゴ台車2には、認識用のマーカーが表示されたIDパネル21が取り付けられている。マーカーは、帯状部材の再帰反射テープ21b(図3参照)等を用いて、カゴ台車2の識別番号情報(ID情報)、搬送位置などの搬送先情報、搬送の優先度情報がコード化されている。カゴ台車2の識別番号情報(ID情報)は、テーブル参照などによって認識することができる。 An ID panel 21 with a marker for recognition is attached to the basket cart 2 placed in a specified location. The marker is encoded with the identification number information (ID information) of the basket cart 2, destination information such as the transport position, and transport priority information using a strip-shaped member such as retroreflective tape 21b (see Figure 3). The identification number information (ID information) of the basket cart 2 can be recognized by referencing a table, etc.

自走ロボット1には、マーカー読取装置が設置されている。マーカー読取装置はID認識手段である測域センサ9と復号部とからなる。本実施形態ではコントローラ4が復号部としての機能を有する。コントローラ4は、測域センサ9の検出結果からマーカーのコードを認識する。コントローラ4の復号部では認識したマーカーのコード情報をデコードすることで、カゴ台車2の認識番号情報、搬送先情報、優先度情報を得る。 The self-propelled robot 1 is equipped with a marker reading device. The marker reading device is made up of a range sensor 9, which is an ID recognition means, and a decoding unit. In this embodiment, the controller 4 functions as the decoding unit. The controller 4 recognizes the marker code from the detection results of the range sensor 9. The decoding unit of the controller 4 decodes the code information of the recognized marker to obtain the identification number information, destination information, and priority information of the basket cart 2.

本実施形態では、詳細は後述するが、カゴ台車2に設置されたマーカーとして再帰反射テープ21bを用いている。自走ロボット1は、周辺環境との距離を取得するレーザーレンジファインダ(LRF)等の測域センサ9を用いて読み取る。コントローラ4は、測域センサ9によって位置を認識したIDパネル21と測域センサ9との距離情報からIDパネル21の位置座標を算出する。算出したIDパネル21の位置座標を用いて、コントローラ4が動力モータ7の駆動制御を行うことで、自走ロボット1をカゴ台車2におけるIDパネル21正面の所定の位置に位置決めする。 In this embodiment, the details will be described later, but retroreflective tape 21b is used as a marker attached to the basket cart 2. The self-propelled robot 1 reads using a range sensor 9 such as a laser range finder (LRF) that acquires the distance from the surrounding environment. The controller 4 calculates the position coordinates of the ID panel 21 from the distance information between the ID panel 21, the position of which is recognized by the range sensor 9, and the range sensor 9. Using the calculated position coordinates of the ID panel 21, the controller 4 controls the drive of the power motor 7, thereby positioning the self-propelled robot 1 at a predetermined position in front of the ID panel 21 on the basket cart 2.

次に、IDパネル21について詳述する。 Next, we will explain the ID panel 21 in detail.

ここで、図2はカゴ台車2にIDパネル21が配置された例を示す斜視図である。図2に示すように、IDパネル21は、カゴ台車2の正面の略中央部に配置される。より詳細には、IDパネル21は、自走ロボット1の測域センサ9に対して対向する位置に配置される(図1参照)。IDパネル21は、カゴ台車2に着脱可能であって、カゴ台車2の中央の骨組み(縦棒)などの所定の位置に作業者によって設置される。なお、IDパネル21の角度は、カゴ台車2の角度と同義となるので、カゴ台車2の正面部分に対して平行になるように設置する。 Here, FIG. 2 is a perspective view showing an example in which an ID panel 21 is arranged on a cage cart 2. As shown in FIG. 2, the ID panel 21 is arranged in approximately the center of the front of the cage cart 2. More specifically, the ID panel 21 is arranged in a position facing the range sensor 9 of the self-propelled robot 1 (see FIG. 1). The ID panel 21 is detachable from the cage cart 2, and is installed by an operator in a predetermined position such as the central framework (vertical bar) of the cage cart 2. Note that the angle of the ID panel 21 is synonymous with the angle of the cage cart 2, so it is installed so that it is parallel to the front part of the cage cart 2.

自走ロボット1がカゴ台車2を連結するために、自走ロボット1は、カゴ台車2と自走ロボット1との距離と角度を検出して、カゴ台車2に向かって走行を行う必要がある。しかしながら、測域センサ9でカゴ台車2の形状を認識する場合、カゴ台車2の積載状況により認識すべき形状が変化することから、カゴ台車2との距離と角度を正確に検出することは難しい。そこで、本実施形態においては、カゴ台車2にIDパネル21を装着して、自走ロボット1に搭載した測域センサ9でIDパネル21を検出する。 In order for the self-propelled robot 1 to connect to the basket trolley 2, the self-propelled robot 1 needs to detect the distance and angle between the basket trolley 2 and the self-propelled robot 1, and travel towards the basket trolley 2. However, when recognizing the shape of the basket trolley 2 with the range sensor 9, it is difficult to accurately detect the distance and angle from the basket trolley 2 because the shape to be recognized changes depending on the loading condition of the basket trolley 2. Therefore, in this embodiment, an ID panel 21 is attached to the basket trolley 2, and the ID panel 21 is detected by the range sensor 9 mounted on the self-propelled robot 1.

ここで、識別部材であるIDパネル21を技術的に説明する。IDパネル21はレーザーレンジファインダ(LRF)等の電磁波等を用いた検出装置により、検出対象の検出や識別を行うための識別部材である。電磁波等で検出するために、電磁波等が検出する検出面(例えば、IDパネル21の表面)を幾何学的に第一の方向において少なくとも3つの領域に分割し、分割された複数の領域において、少なくとも隣り合う領域の電磁波等に対する反射率が異なるように設定されている。 Here, we provide a technical explanation of the ID panel 21, which is an identification member. The ID panel 21 is an identification member for detecting and identifying a detection target using a detection device that uses electromagnetic waves, such as a laser range finder (LRF). In order to detect using electromagnetic waves, the detection surface (e.g., the surface of the ID panel 21) on which the electromagnetic waves are detected is geometrically divided into at least three regions in a first direction, and the divided regions are set so that at least adjacent regions have different reflectances to the electromagnetic waves.

この第一の方向は、検出装置による走査方向と平行する方向である。図3に示すIDパネル21の例では、紙面横方向(水平方向)において領域が分割されており、検出装置の走査方向は紙面横方向(水平方向)となる。 This first direction is parallel to the scanning direction of the detection device. In the example of the ID panel 21 shown in FIG. 3, the area is divided in the lateral direction (horizontal direction) of the paper, and the scanning direction of the detection device is the lateral direction (horizontal direction) of the paper.

そして、検出装置は、電磁波等を照射した際の反射信号の強度の違いを利用して特定のパターン(信号)を検出することで、検出対象の検出や識別を行う。 The detection device then detects and identifies the target by detecting a specific pattern (signal) using the difference in intensity of the reflected signal when electromagnetic waves or the like are irradiated.

図3は、IDパネル21の例を示す図である。図3に示すように、本実施の形態においては、例えばA4サイズの厚紙のような板状部材を識別部材であるIDパネル21とする。該板状部材の表面21aに対して、該板状部材の表面21aの両端やその間に、再帰反射テープ21bを貼ることにより、IDを表示するマーカーを形成する。また、板状部材の表面21aと再帰反射テープ21bにより、検出面21cを構成する。 Figure 3 is a diagram showing an example of an ID panel 21. As shown in Figure 3, in this embodiment, a plate-like member such as A4-sized cardboard is used as the ID panel 21, which is an identification member. A marker that displays the ID is formed by attaching retroreflective tape 21b to both ends and between the surface 21a of the plate-like member. In addition, the surface 21a of the plate-like member and the retroreflective tape 21b form a detection surface 21c.

板状部材の表面21aと再帰反射テープ21bとは電磁波等に対する反射率が異なるので、このように構成することで、上記した電磁波等が検出する検出面を幾何学的に第一の方向において少なくとも3つの領域a,b,cに分割し、分割された複数の領域a,b,cにおいて、少なくとも隣り合う領域の電磁波等に対する反射率が異なるように設定することを実現する。 The surface 21a of the plate-like member and the retroreflective tape 21b have different reflectivities for electromagnetic waves, etc., so by configuring it in this way, the detection surface that detects the electromagnetic waves, etc. described above is geometrically divided into at least three regions a, b, and c in the first direction, and the reflectivities for electromagnetic waves, etc. of at least adjacent regions in the divided multiple regions a, b, and c are set to be different.

図3(a)に示すように、分割された少なくとも3つの領域は、第一の方向における検出面21cの一端側から他端側に向かって、第一領域aである再帰反射テープ21b、第二領域bである板状部材の表面21a、第三領域cである再帰反射テープ21bであり、第一領域aの反射率と第二領域bの反射率は異なり、第三領域cの反射率と第二領域bの反射率は異なるように構成される。 As shown in FIG. 3(a), the at least three divided regions are, from one end side of the detection surface 21c in the first direction to the other end side, a first region a of retroreflective tape 21b, a second region b of the plate-like member surface 21a, and a third region c of retroreflective tape 21b, and are configured so that the reflectance of the first region a is different from the reflectance of the second region b, and the reflectance of the third region c is different from the reflectance of the second region b.

ここで、第一領域aと第三領域cとに異なる反射率の再帰反射テープ21bを貼ることで、第一領域aの反射率と、第二領域bの反射率と、第三領域cの反射率と、を異ならせることを実現できる。また、第一領域aと第三領域cとに同じ反射率の再帰反射テープ21bを貼ることで、第一領域aの反射率と第三領域cの反射率とが等しくなるように構成してもよい。 Here, by applying a retroreflective tape 21b having a different reflectivity to the first region a and the third region c, it is possible to make the reflectivity of the first region a, the reflectivity of the second region b, and the reflectivity of the third region c different. In addition, by applying a retroreflective tape 21b having the same reflectivity to the first region a and the third region c, the reflectivity of the first region a and the reflectivity of the third region c may be configured to be equal.

また、第一領域aの反射率と第三領域cとは、第二領域bの反射率よりも高い必要はなく、第一領域aの反射率と第三領域cとの少なくとも一方が、第二領域bの反射率より低くてもよい。 Furthermore, the reflectance of the first region a and the third region c do not need to be higher than the reflectance of the second region b, and at least one of the reflectance of the first region a and the third region c may be lower than the reflectance of the second region b.

また、識別部材であるIDパネル21は、一つの板状部材で構成されなくてもよく、例えば2つの板状部材を並べることで検出面21cを構成してもよい。 In addition, the ID panel 21, which is the identification member, does not have to be composed of a single plate-shaped member, and the detection surface 21c may be formed, for example, by arranging two plate-shaped members side by side.

第1のセンサである測域センサ9により、第一領域aで反射された第一受光量と、第二領域bで反射された第二受光量と、及び第三領域cで反射された第三受光量と、測域センサ9から第一領域aまでの第一距離と、測域センサ9から第二領域bまでの第二距離と、測域センサ9から第三領域cまでの第三距離と、が検出される。 The first sensor, the range sensor 9, detects a first amount of received light reflected in the first area a, a second amount of received light reflected in the second area b, and a third amount of received light reflected in the third area c, as well as a first distance from the range sensor 9 to the first area a, a second distance from the range sensor 9 to the second area b, and a third distance from the range sensor 9 to the third area c.

詳細は後述するが、IDパネル21は、第一受光量と、第二受光量と、第三受光量と、第一距離と、第二距離と、第三距離と、に基づいて識別される。 As will be described in more detail below, the ID panel 21 is identified based on the first amount of received light, the second amount of received light, the third amount of received light, the first distance, the second distance, and the third distance.

IDパネル21の両端の再帰反射テープ21bは、スタートビットおよびストップビットを表すものであり、認識領域を規定する。このスタートビットおよびストップビットを表す両端の再帰反射テープ21bの間に貼られたパターンを構成する再帰反射テープ21bの位置に応じて、IDパネル21が保有する情報(カゴ台車2の認識番号情報、搬送先情報、優先度情報)が表される。なお、パターンを構成する再帰反射テープ21bは、検出面21c基板部材21aの両端に配置された2つの再帰反射テープ21bに比べて、水平方向の長さが短く(すなわち、細く)なっていてもよい。すなわち、第二領域bに配置される再帰反射テープ21bは、情報を有するパターンである。 The retroreflective tape 21b at both ends of the ID panel 21 represents a start bit and a stop bit, and defines a recognition area. The information held by the ID panel 21 (recognition number information of the cart 2, destination information, priority information) is displayed according to the position of the retroreflective tape 21b constituting the pattern affixed between the retroreflective tape 21b at both ends representing the start bit and the stop bit. The retroreflective tape 21b constituting the pattern may be shorter (i.e. thinner) in horizontal length than the two retroreflective tapes 21b arranged at both ends of the detection surface 21c substrate member 21a. In other words, the retroreflective tape 21b arranged in the second area b is a pattern having information.

図3に示したIDパネル21の例では、板状部材の表面21aに対して再帰反射テープ21bを貼ることで、IDパネル21の表面である検出面を矩形形状の領域に分割しているが、分割される領域の形状は矩形に限定されるものではなく、幾何学的な形状であればよい。なお、この図3に示したIDパネル21の例は、再帰反射テープ21bを貼っているので、簡単で安価に識別部材を製造することが可能となる。 In the example of the ID panel 21 shown in FIG. 3, the detection surface, which is the surface of the ID panel 21, is divided into rectangular regions by attaching retroreflective tape 21b to the surface 21a of the plate-like member, but the shape of the divided regions is not limited to rectangular and may be any geometric shape. Note that, because the example of the ID panel 21 shown in FIG. 3 has retroreflective tape 21b attached, it is possible to manufacture the identification member simply and inexpensively.

測域センサ9から照射されたレーザは、検出面21cを構成するIDパネル21の再帰反射テープ21bおよび板状部材の表面21aに当たった後、(反射率や入射角などに応じた強度で)反射し、測域センサ9内部のディテクタで検出される。測域センサ9の内部では、レーザの往復にかかった時間から距離を算出し、検出したレーザ光の強度値から反射強度を算出し、結果をコントローラ4に送信する。 The laser emitted from the range sensor 9 hits the retroreflective tape 21b of the ID panel 21 and the surface 21a of the plate-like member that constitutes the detection surface 21c, then is reflected (with an intensity according to the reflectivity, angle of incidence, etc.) and detected by a detector inside the range sensor 9. Inside the range sensor 9, the distance is calculated from the time it takes for the laser to travel back and forth, the reflection intensity is calculated from the intensity value of the detected laser light, and the result is sent to the controller 4.

図3(a)に示すIDパネル21の例によれば、Amm、Bmmのそれぞれの距離(幅)に応じて、IDパネル21が保有する情報(カゴ台車2の認識番号情報、搬送先情報、優先度情報)が識別される。また、図3(b)に示すIDパネル21の例によれば、Cmm、Dmm、Emmのそれぞれの距離(幅)に応じて、IDパネル21が保有する情報(カゴ台車2の認識番号情報、搬送先情報、優先度情報)が識別される。 In the example of the ID panel 21 shown in FIG. 3(a), the information held by the ID panel 21 (the identification number information of the cart 2, the transport destination information, and the priority information) is identified according to the respective distances (widths) of A mm and B mm. In addition, in the example of the ID panel 21 shown in FIG. 3(b), the information held by the ID panel 21 (the identification number information of the cart 2, the transport destination information, and the priority information) is identified according to the respective distances (widths) of C mm, D mm, and E mm.

なお、IDパネル21に貼り付ける再帰反射テープ21bは、IDパネル21の板状部材の表面21aに対して反射(輝度差の絶対値)に差があればよい。したがって、IDパネル21に貼り付ける部材は、光の再帰反射に限るものではなく、光を吸収するものであってもよい。 The retroreflective tape 21b attached to the ID panel 21 only needs to have a difference in reflection (absolute value of brightness difference) with respect to the surface 21a of the plate-like member of the ID panel 21. Therefore, the member attached to the ID panel 21 is not limited to a member that retroreflects light, and may be a member that absorbs light.

マーカーが再帰反射テープ21bとすることで、レーザレンジファインダ(LRF)である測域センサ9を用いた読み取りに好適となる。再帰反射テープ21bを用いる構成では、コントローラ4は、測域センサ9から得たIDパネル21の両端の再帰反射テープ21bまでの距離、反射強度を得て、距離および反射強度からカゴ台車2と自走ロボット1との距離と角度を計算する。 By using the retroreflective tape 21b as the marker, it becomes suitable for reading using the range sensor 9, which is a laser range finder (LRF). In a configuration using the retroreflective tape 21b, the controller 4 obtains the distance and reflection intensity to the retroreflective tape 21b on both ends of the ID panel 21 obtained from the range sensor 9, and calculates the distance and angle between the cart 2 and the self-propelled robot 1 from the distance and reflection intensity.

ここで、反射強度とは、測域センサ9の内部の受光素子で受光した光の強さに応じた電圧を数値化したものである。IDパネル21に貼り付ける再帰反射テープ21bは反射強度の値が高くでるので、位置を正確に識別し、連結時の自走ロボット1の位置決めに用いるフィードバック情報として用いることができる。 Here, reflection intensity is a numerical value that represents a voltage corresponding to the intensity of light received by the light receiving element inside the range sensor 9. The retroreflective tape 21b attached to the ID panel 21 has a high reflection intensity value, so it can accurately identify the position and can be used as feedback information for positioning the self-propelled robot 1 when connected.

自走ロボット1を用いた本実施形態の搬送システムは、物流倉庫などにおける、カゴ台車2などのキャスター付き搬送対象を搬送する作業を自動化するものである。自走ロボット1による搬送動作は、次の(1)~(3)の三つの作業に分割される。
(1)仮置きエリアでの搬送対象の探索および連結
(2)走行エリアの走行
(3)保管エリアでの保管場所探索と荷卸し
The transport system of this embodiment using self-propelled robot 1 automates the task of transporting a transport object with casters, such as a basket cart 2, in a logistics warehouse or the like. The transport operation by self-propelled robot 1 is divided into the following three tasks: (1) to (3).
(1) Searching for and connecting objects to be transported in the temporary storage area (2) Driving in the driving area (3) Searching for storage locations and unloading in the storage area

図4は、搬送システムを適用することが想定される物流倉庫1000の一例を示す説明図である。図4は、物流倉庫1000を天井側から見た床面を平面図として示している。図4に示されたXY平面が床面と並行な面であり、Z軸が高さ方向を示している。図4に示す物流倉庫1000において、上記(1)の仮置きエリアA1は、荷卸しされた荷物を整列しておく場所が想定される。上記(3)の保管エリアA2は、エレベータなどで他階へ移送する場合のエレベータ前エリアが想定される。また、上記(2)の走行エリアA3は図4中の矢印によって仮置きエリアA1と保管エリアA2との往復経路を示す場所が想定される。 Figure 4 is an explanatory diagram showing an example of a logistics warehouse 1000 to which a conveying system is expected to be applied. Figure 4 shows the floor surface of the logistics warehouse 1000 as a plan view when viewed from the ceiling side. The XY plane shown in Figure 4 is a plane parallel to the floor surface, and the Z axis indicates the height direction. In the logistics warehouse 1000 shown in Figure 4, the temporary storage area A1 above (1) is expected to be a place where unloaded luggage is lined up. The storage area A2 above (3) is expected to be an area in front of an elevator when transporting luggage to other floors by elevator or the like. In addition, the running area A3 above (2) is expected to be a place where the arrow in Figure 4 indicates the round trip route between the temporary storage area A1 and the storage area A2.

自走ロボット1は、本線動作は床面に設置された磁気テープのラインをセンサで認識するライン認識による誘導方式で移動する。また、ラインの横にあるエリアマーク52を検出してエリアを判断する。また、IDパネル21には、搬送先となる保管エリアA2の情報と優先順位の情報が含まれている。 The self-propelled robot 1 moves along the main line using a guidance method that uses a sensor to recognize a magnetic tape line installed on the floor. It also detects an area mark 52 next to the line to determine the area. The ID panel 21 also contains information about the storage area A2 to which the robot is to be transported and priority information.

図4に示すように、走行エリアA3には自走ロボット1の誘導用の磁気テープがライン状に設けられ、自走ロボット1が走行する走行ライン51が設けられている。また、走行エリアA3における仮置きエリアA1、保管エリアA2の入り口には、走行ライン51の近傍にエリアマーク52が配置されており、どのエリアに来たかを認識できるようになっている。 As shown in FIG. 4, a line of magnetic tape for guiding the self-propelled robot 1 is provided in the travel area A3, and a travel line 51 along which the self-propelled robot 1 travels is provided. In addition, at the entrances to the temporary placement area A1 and storage area A2 in the travel area A3, area marks 52 are placed near the travel line 51, allowing the robot to recognize which area it has arrived at.

後述する自走ロボット1が実行するプログラムでは、エリアごとに動作を指定できるようになっている。自走ロボット1は、仮置きエリアA1では接続動作、保管エリアA2では車庫入れ動作を行う。 The program executed by self-propelled robot 1, which will be described later, allows the user to specify the operation for each area. Self-propelled robot 1 performs a connection operation in temporary storage area A1 and a parking operation in storage area A2.

本実施形態においては、仮置きエリアA1と保管エリアA2とが走行ライン51のすぐ横にある構成である。自走ロボット1は、走行ライン51を走行したまま、仮置きエリアA1や保管エリアA2のエリア内の探索を行う。仮置きエリアA1内に搬送対象となるカゴ台車2を見つけたら、走行ライン51上からカゴ台車2への連結動作に移行する。また、保管エリアA2に対しても、走行ライン51上から空き番地を探索して、車庫入れ動作を行う。 In this embodiment, the temporary storage area A1 and the storage area A2 are located immediately next to the travel line 51. The self-propelled robot 1 searches the temporary storage area A1 and the storage area A2 while traveling on the travel line 51. When the self-propelled robot 1 finds the basket cart 2 to be transported in the temporary storage area A1, it transitions to a coupling operation with the basket cart 2 from the travel line 51. It also searches for an empty address in the storage area A2 from the travel line 51 and performs a parking operation.

加えて、図4に示す物流倉庫1000において、保管エリアA2に対して走行ライン51を挟んだ向かい側には、複数の再帰反射テープ53が設置されている。複数の再帰反射テープ53は、自走ロボット1の測域センサ9が検出できる位置に設置されている。自走ロボット1は、複数の再帰反射テープ53の設置情報をもとに、自己位置推定を行う。 In addition, in the logistics warehouse 1000 shown in FIG. 4, multiple retroreflective tapes 53 are installed on the opposite side of the travel line 51 from the storage area A2. The multiple retroreflective tapes 53 are installed in positions where they can be detected by the range sensor 9 of the self-propelled robot 1. The self-propelled robot 1 estimates its own position based on the installation information of the multiple retroreflective tapes 53.

次に、自走ロボット1のコントローラ4について説明する。 Next, we will explain the controller 4 of the self-propelled robot 1.

ここで、図5は自走ロボット1のコントローラ4のハードウェア構成の一例を示すブロック図である。コントローラ4は、図5に示すように、CPU(Central Processing Unit)やGPU(Graphics Processing Unit)などの制御装置11と、ROM(Read Only Memory)やRAM(Random Access Memory)などの主記憶装置12と、SSD(Solid State Drive)などの補助記憶装置13と、ディスプレイなどの表示装置14と、キーボードなどの入力装置15と、無線通信インタフェイスなどの通信装置16と、を備えており、通常のコンピュータを利用したハードウェア構成となっている。 Here, FIG. 5 is a block diagram showing an example of the hardware configuration of the controller 4 of the self-propelled robot 1. As shown in FIG. 5, the controller 4 has a control device 11 such as a CPU (Central Processing Unit) or a GPU (Graphics Processing Unit), a main memory device 12 such as a ROM (Read Only Memory) or a RAM (Random Access Memory), an auxiliary memory device 13 such as an SSD (Solid State Drive), a display device 14 such as a display, an input device 15 such as a keyboard, and a communication device 16 such as a wireless communication interface, and has a hardware configuration that utilizes a normal computer.

制御装置11は、主記憶装置12や補助記憶装置13に記憶されている各種プログラムを実行することで、コントローラ4(自走ロボット1)全体の動作を制御し、後述する各種機能部を実現する。 The control device 11 executes various programs stored in the main memory device 12 and the auxiliary memory device 13 to control the operation of the entire controller 4 (self-propelled robot 1) and realize various functional parts described below.

自走ロボット1のコントローラ4で実行されるプログラムは、インストール可能な形式又は実行可能な形式のファイルでCD-ROM、フレキシブルディスク(FD)、CD-R、DVD(Digital Versatile Disk)等のコンピュータで読み取り可能な記録媒体に記録して提供するように構成してもよい。 The program executed by the controller 4 of the self-propelled robot 1 may be provided by being recorded in an installable or executable file format on a computer-readable recording medium such as a CD-ROM, a flexible disk (FD), a CD-R, or a digital versatile disk (DVD).

さらに、自走ロボット1のコントローラ4で実行されるプログラムを、インターネット等のネットワークに接続されたコンピュータ上に格納し、ネットワーク経由でダウンロードさせることにより提供するように構成しても良い。また、自走ロボット1のコントローラ4で実行されるプログラムをインターネット等のネットワーク経由で提供または配布するように構成しても良い。 Furthermore, the program executed by controller 4 of self-propelled robot 1 may be stored on a computer connected to a network such as the Internet and provided by downloading it via the network. Also, the program executed by controller 4 of self-propelled robot 1 may be provided or distributed via a network such as the Internet.

次に、自走ロボット1のコントローラ4の制御装置11が主記憶装置12や補助記憶装置13に記憶されたプログラムを実行することによって、自走ロボット1のコントローラ4が発揮する機能について説明する。なお、ここでは従来から知られている機能については説明を省略し、本実施の形態の自走ロボット1のコントローラ4が発揮する特徴的な機能について詳述する。 Next, the functions that controller 4 of self-propelled robot 1 performs as a result of control device 11 of controller 4 of self-propelled robot 1 executing programs stored in main memory device 12 and auxiliary memory device 13 will be described. Note that a description of conventionally known functions will be omitted here, and the characteristic functions performed by controller 4 of self-propelled robot 1 of this embodiment will be described in detail.

なお、自走ロボット1のコントローラ4が発揮する機能の一部または全部をIC(Integrated Circuit)などの専用の処理回路を用いて構成してもよい。 In addition, some or all of the functions performed by the controller 4 of the self-propelled robot 1 may be configured using a dedicated processing circuit such as an IC (Integrated Circuit).

図6は、自走ロボット1のコントローラ4が発揮する機能的構成例を示すブロック図である。図6に示すように、自走ロボット1のコントローラ4は、検出手段111と、算出手段112と、移動制御手段113と、を備える。 Figure 6 is a block diagram showing an example of the functional configuration of controller 4 of self-propelled robot 1. As shown in Figure 6, controller 4 of self-propelled robot 1 includes detection means 111, calculation means 112, and movement control means 113.

検出手段111は、測域センサ9を介して、IDパネル21における再帰反射テープ21b間の距離と再帰反射テープ21bのそれぞれの位置とに基づいてIDパネル21を検出する。 The detection means 111 detects the ID panel 21 based on the distance between the retroreflective tapes 21b on the ID panel 21 and the respective positions of the retroreflective tapes 21b via the range sensor 9.

算出手段112は、検出手段111により検出されたIDパネル21までの距離および角度を算出する。 The calculation means 112 calculates the distance and angle to the ID panel 21 detected by the detection means 111.

移動制御手段113は、算出手段112により算出したIDパネル21までの距離および角度に従った目標位置への移動を制御する。 The movement control means 113 controls the movement to the target position according to the distance and angle to the ID panel 21 calculated by the calculation means 112.

次に、自走ロボット1におけるカゴ台車2に設けられたIDパネル21の検出処理について詳述する。 Next, the detection process of the ID panel 21 provided on the basket cart 2 of the self-propelled robot 1 will be described in detail.

ここで、図7はIDパネル21の検出処理の流れを概略的に示すフローチャートである。図7に示すように、自走ロボット1のコントローラ4(検出手段111)は、測域センサ9の反射強度値からピークを検出する(ステップS1)。 Here, FIG. 7 is a flowchart that shows an outline of the flow of the detection process of the ID panel 21. As shown in FIG. 7, the controller 4 (detection means 111) of the self-propelled robot 1 detects a peak from the reflection intensity value of the range sensor 9 (step S1).

図8は、IDパネル21の検出におけるピーク値検出状態を示す図である。図8に示すように、自走ロボット1のコントローラ4(検出手段111)は、測域センサ9の値を確認しながら、走行エリアA3における走行ライン51上を走行する。なお、図8(a)に示している測域センサ9の検出範囲は、本実施の形態においては約270度である。 Figure 8 is a diagram showing the peak value detection state in detection of the ID panel 21. As shown in Figure 8, the controller 4 (detection means 111) of the self-propelled robot 1 travels on the travel line 51 in the travel area A3 while checking the value of the range sensor 9. Note that the detection range of the range sensor 9 shown in Figure 8 (a) is approximately 270 degrees in this embodiment.

そして、図8(b)に示すように、自走ロボット1のコントローラ4(検出手段111)は、測域センサ9からの反射強度のピーク値を検出する。 Then, as shown in FIG. 8(b), the controller 4 (detection means 111) of the self-propelled robot 1 detects the peak value of the reflection intensity from the range sensor 9.

図9は、ピーク値を検出する手法について説明する図である。図9(a)に示すように、反射する部材までの距離が長い場合、測域センサ9が出力する反射強度値は低くなる。なお、一定の材質に対して、距離に応じた反射強度値の対応式を事前に算出しておく。そして、図9(b)に示すように、対応式を用いて正規化した後の値について、比率が一定値以上(この場合は80%)の値をピークとみなす。 Figure 9 is a diagram explaining a method for detecting peak values. As shown in Figure 9(a), when the distance to the reflecting material is long, the reflection intensity value output by the range measurement sensor 9 is low. Note that for a certain material, a correspondence equation for reflection intensity values according to distance is calculated in advance. Then, as shown in Figure 9(b), for values normalized using the correspondence equation, a value with a ratio equal to or greater than a certain value (80% in this case) is considered to be a peak.

図7に戻り、自走ロボット1のコントローラ4(検出手段111)は、測域センサ9の反射強度値からピークを検出すると(ステップS1)、検出したピーク間距離(幅)がIDパネル21の再帰反射テープ21b間の距離(幅)と該当するかを判断する(ステップS2)。 Returning to FIG. 7, when the controller 4 (detection means 111) of the self-propelled robot 1 detects a peak from the reflection intensity value of the range sensor 9 (step S1), it determines whether the distance (width) between the detected peaks corresponds to the distance (width) between the retroreflective tapes 21b of the ID panel 21 (step S2).

具体的には、図8(b)に示すように、自走ロボット1のコントローラ4(検出手段111)は、検出したピーク間の距離(幅)を計算し、IDパネル21の再帰反射テープ21b間距離と比較する。 Specifically, as shown in FIG. 8(b), the controller 4 (detection means 111) of the self-propelled robot 1 calculates the distance (width) between the detected peaks and compares it with the distance between the retroreflective tapes 21b of the ID panel 21.

自走ロボット1のコントローラ4(検出手段111)は、検出したピーク間距離がIDパネル21の再帰反射テープ21b間の距離(幅)と該当すると判断した場合(ステップS2のYes)、IDパネル21の候補とし、ステップS3に進む。 If the controller 4 (detection means 111) of the self-propelled robot 1 determines that the detected inter-peak distance corresponds to the distance (width) between the retroreflective tapes 21b of the ID panel 21 (Yes in step S2), it selects it as a candidate for the ID panel 21 and proceeds to step S3.

一方、自走ロボット1のコントローラ4(検出手段111)は、検出したピーク間距離がIDパネル21の再帰反射テープ21b間の距離(幅)と該当しないと判断した場合(ステップS2のNo)、IDパネル21の候補とせず、ステップS1に戻る。 On the other hand, if the controller 4 (detection means 111) of the self-propelled robot 1 determines that the detected peak-to-peak distance does not correspond to the distance (width) between the retroreflective tapes 21b of the ID panel 21 (No in step S2), it does not select it as a candidate for the ID panel 21 and returns to step S1.

次いで、自走ロボット1のコントローラ4(検出手段111)は、ピークを含めたピーク間における測域センサ9の距離情報値を、後述するように判断する(ステップS3)。 Next, the controller 4 (detection means 111) of the self-propelled robot 1 determines the distance information value of the range sensor 9 between the peaks, including the peak, as described below (step S3).

ここで、図10はIDパネル21の検出における距離情報値検出状態を示す図である。図10において、カゴ台車2は天井側から見た平面図として示している。図10に示すように、ステップS2で候補とされたIDパネル21のエリアについて、測域センサ9からIDパネル21までの距離を求める。なお、測域センサ9からの距離は、レーザが戻ってくる時間によって求めることが可能である。そして、測域センサ9により距離情報値に基づき、検出範囲内にある物体の測域センサ9から見た形状を検出することが可能となる。検出範囲内にIDパネル21が存在する場合は、測域センサ9から見たIDパネル21の検出面21cの形状(面形状)を検出することが可能となる。 Here, FIG. 10 is a diagram showing the distance information value detection state in detecting the ID panel 21. In FIG. 10, the cart 2 is shown as a plan view seen from the ceiling side. As shown in FIG. 10, for the area of the ID panel 21 that was determined as a candidate in step S2, the distance from the range sensor 9 to the ID panel 21 is calculated. Note that the distance from the range sensor 9 can be calculated from the time it takes for the laser to return. Then, based on the distance information value, the range sensor 9 can detect the shape of an object within the detection range as seen from the range sensor 9. If the ID panel 21 is present within the detection range, it can detect the shape (surface shape) of the detection surface 21c of the ID panel 21 as seen from the range sensor 9.

例えば、測域センサ9の走査方向におけるIDパネル21の検出面21cの中心に対して正面からIDパネル21の検出面21cに正対して測域センサ9で検出動作を行った場合(測域センサ9とIDパネル21の検出面21cとの位置関係が図10(a)の場合)、測域センサ9が検出するIDパネル21までの距離情報値はほぼ同じ値となる(厳密にいえば、両端部が遠距離となるが、簡潔に説明するために、ここでは距離情報値はほぼ同じ値として説明する)ので、検出範囲内に測域センサ9から見た形状が平面の物体が存在する、と判断することができる。 For example, when the range sensor 9 performs a detection operation by facing the detection surface 21c of the ID panel 21 from the front with respect to the center of the detection surface 21c of the ID panel 21 in the scanning direction of the range sensor 9 (when the positional relationship between the range sensor 9 and the detection surface 21c of the ID panel 21 is as shown in Figure 10 (a)), the distance information values to the ID panel 21 detected by the range sensor 9 will be approximately the same value (strictly speaking, both ends will be at long distances, but for simplicity, the distance information values will be described here as approximately the same value), so it can be determined that an object whose shape is flat as seen from the range sensor 9 is present within the detection range.

また、IDパネル21の検出面21cが測距センサ9に対して斜めになっている場合は、測域センサ9が検出するIDパネル21までの距離情報値は、測域センサ9の走査方向における一方から他方に向かって一定の割合で変化するので、検出範囲内に測域センサ9から見た形状平面の物体が存在する、と判断することができる。 In addition, when the detection surface 21c of the ID panel 21 is at an angle to the distance measurement sensor 9, the distance information value to the ID panel 21 detected by the range measurement sensor 9 changes at a constant rate from one side to the other in the scanning direction of the range measurement sensor 9, so it can be determined that an object with a planar shape as seen from the range measurement sensor 9 is present within the detection range.

また、IDパネル21の検出面21cが曲面の場合は、測域センサ9が検出するIDパネル21までの距離情報値が、測距センサ9とIDパネル21の検出面21cとの位置関係、及び検出面21cの曲率とに応じて変化しているか否かを判断することで、検出範囲内に測域センサ9から見た形状が曲面の物体が存在する、と判断することができる。 In addition, if the detection surface 21c of the ID panel 21 is curved, it can be determined that an object whose shape is curved as seen by the range sensor 9 is present within the detection range by determining whether the distance information value to the ID panel 21 detected by the range sensor 9 changes depending on the positional relationship between the range sensor 9 and the detection surface 21c of the ID panel 21 and the curvature of the detection surface 21c.

図10(a)のグラフに示すように、測域センサ9の走査方向におけるIDパネル21の検出面21cの中心に対して正面からIDパネル21の検出面21cに正対して測域センサ9で検出動作を行った場合、反射強度のピークを含めたピーク間における測域センサ9が検出する距離情報値は、ほぼ同じ値となる。この場合、IDパネル21の候補とする。 As shown in the graph of FIG. 10(a), when the range sensor 9 performs a detection operation by facing the detection surface 21c of the ID panel 21 from the front with respect to the center of the detection surface 21c of the ID panel 21 in the scanning direction of the range sensor 9, the distance information values detected by the range sensor 9 between peaks, including the peak of the reflection intensity, are approximately the same value. In this case, it is determined to be a candidate for the ID panel 21.

このように、ピークを含めたピーク間の距離情報値、換言すると、第一領域a、第二領域b、第三領域cまでの距離情報値に基づき、IDパネル21の候補を検出する。 In this way, candidates for ID panel 21 are detected based on the distance information values between peaks including the peak, in other words, the distance information values to the first region a, the second region b, and the third region c.

図10(b)に示すように、カゴ台車2のフレームも反射強度の値が高くでることが分かっている。そのため、反射強度比率のピーク値を見るだけでは、カゴ台車2のフレームをIDパネル21と勘違いする可能性がある。そこで、測域センサ9が検出した反射強度のピークを含めたピーク間の距離情報値に基づいて判断することで、IDパネル21の候補を検出する。カゴ台車2のフレームを検出している場合は、IDパネル21とフレームとで距離が異なるので、測域センサ9が検出した反射強度のピークを含めたピーク間の距離情報値に基づいて、IDパネル21の候補から除外されるようにしたものである。 As shown in FIG. 10(b), it is known that the frame of the cage cart 2 also has a high reflection intensity value. Therefore, there is a possibility that the frame of the cage cart 2 may be mistaken for an ID panel 21 simply by looking at the peak value of the reflection intensity ratio. Therefore, candidates for the ID panel 21 are detected by making a judgment based on the distance information value between the peaks, including the reflection intensity peaks, detected by the range sensor 9. When the frame of the cage cart 2 is detected, since the distance between the ID panel 21 and the frame is different, it is excluded from the candidates for the ID panel 21 based on the distance information value between the peaks, including the reflection intensity peaks, detected by the range sensor 9.

このように測域センサ9で測定した距離情報により、カゴ台車2のフレームのような高反射を生じる小さな細いものをIDパネル21の再帰反射テープ21bとして誤認識しないようにすることができる。これは、カゴ台車2に荷物が載っていても同様である。 In this way, the distance information measured by the range sensor 9 can prevent small, thin objects that are highly reflective, such as the frame of the cart 2, from being mistakenly recognized as the retroreflective tape 21b of the ID panel 21. This is also true when there is luggage on the cart 2.

自走ロボット1のコントローラ4(検出手段111)は、IDパネルの検出面21cに該当すると判断した場合(ステップS3のYes)、IDパネル21の候補とし、ステップS4に進む。 If the controller 4 (detection means 111) of the self-propelled robot 1 determines that it corresponds to the detection surface 21c of the ID panel (Yes in step S3), it selects it as a candidate for the ID panel 21 and proceeds to step S4.

一方、自走ロボット1のコントローラ4(検出手段111)は、IDパネルの検出面21cに該当しないと判断した場合(ステップS3のNo)、IDパネル21の候補とせず、ステップS1に戻る。 On the other hand, if the controller 4 (detection means 111) of the self-propelled robot 1 determines that it does not correspond to the detection surface 21c of the ID panel (No in step S3), it does not consider it a candidate for the ID panel 21 and returns to step S1.

以上により、自走ロボット1のコントローラ4(検出手段111)は、現在の測域センサ9の測定値をIDパネル21の候補とする(ステップS4)。 As a result of the above, the controller 4 (detection means 111) of the self-propelled robot 1 sets the current measurement value of the range sensor 9 as a candidate for the ID panel 21 (step S4).

次に、自走ロボット1のコントローラ4(検出手段111)は、IDパネル21の候補について、測域センサ9の走査角度におけるピーク間位置の角度(IDパネル21の候補を検出した際の走査角度)が、自走ロボット1とカゴ台車2とが接続可能な範囲に入っているか、を判断することで、自走ロボット1とカゴ台車2とが接続可能な位置関係にあるか否か、を判断する(ステップS5)。 Next, the controller 4 (detection means 111) of the self-propelled robot 1 determines whether the self-propelled robot 1 and the cart 2 are in a positional relationship that allows connection by determining whether the angle of the inter-peak position in the scanning angle of the range measurement sensor 9 for the candidate ID panel 21 (the scanning angle when the candidate ID panel 21 is detected) is within the range in which the self-propelled robot 1 and the cart 2 can be connected (step S5).

ここで、図11は自走ロボット1とカゴ台車2とが接続可能な範囲を示す図である。図11に示すように、自走ロボット1とカゴ台車2とが接続可能な範囲(角度)が決められている。 Here, FIG. 11 is a diagram showing the range in which the self-propelled robot 1 and the basket cart 2 can be connected. As shown in FIG. 11, the range (angle) in which the self-propelled robot 1 and the basket cart 2 can be connected is determined.

図11(a)は、自走ロボット1の接続可能な範囲にカゴ台車2が存在しない場合を示す図である。図11(a)に示すように、測域センサ9の走査角度におけるピーク間位置の角度(IDパネル21の候補を検出した際の走査角度)が接続可能な範囲(角度)内にない場合には、自走ロボット1とカゴ台車2とが接続可能な位置関係でないと判断する。 Figure 11 (a) is a diagram showing a case where the cart 2 is not present within the connectable range of the self-propelled robot 1. As shown in Figure 11 (a), if the angle of the inter-peak position in the scanning angle of the range sensor 9 (the scanning angle when the candidate ID panel 21 is detected) is not within the connectable range (angle), it is determined that the self-propelled robot 1 and the cart 2 are not in a positional relationship that allows connection.

一方、図11(b)は、自走ロボット1の接続可能な範囲にカゴ台車2が存在する場合を示す図である。図11(b)に示すように、測域センサ9の走査角度におけるピーク間位置の角度(IDパネル21の候補を検出した際の走査角度)が接続可能な範囲(角度)内にある場合には、自走ロボット1とカゴ台車2とが接続可能な位置関係にあると判断する。 On the other hand, FIG. 11(b) is a diagram showing a case where the cart 2 is present within the connectable range of the self-propelled robot 1. As shown in FIG. 11(b), if the angle of the inter-peak position in the scanning angle of the range measurement sensor 9 (the scanning angle when the candidate ID panel 21 is detected) is within the connectable range (angle), it is determined that the self-propelled robot 1 and the cart 2 are in a positional relationship that allows connection.

自走ロボット1のコントローラ4(検出手段111)は、IDパネル21の候補について、測域センサ9の走査角度におけるピーク間位置の角度(IDパネル21の候補を検出した際の走査角度)が、自走ロボット1とカゴ台車2とが接続可能な位置関係にあると判断した場合(ステップS5のYes)、ステップS6に進む。 When the controller 4 (detection means 111) of the self-propelled robot 1 determines that the angle of the peak position in the scanning angle of the range sensor 9 for the candidate ID panel 21 (the scanning angle when the candidate ID panel 21 is detected) is in a positional relationship that allows the self-propelled robot 1 and the basket cart 2 to be connected (Yes in step S5), it proceeds to step S6.

一方、自走ロボット1のコントローラ4(検出手段111)は、IDパネル21の候補について、測域センサ9の走査角度におけるピーク間位置の角度(IDパネル21の候補を検出した際の走査角度)が、自走ロボット1とカゴ台車2とが接続可能な位置関係でないと判断した場合(ステップS5のNo)、ステップS1に戻る。 On the other hand, if the controller 4 (detection means 111) of the self-propelled robot 1 determines that the angle of the peak position in the scanning angle of the range sensor 9 for the candidate ID panel 21 (the scanning angle when the candidate ID panel 21 is detected) is not in a positional relationship that allows the self-propelled robot 1 and the cart 2 to be connected (No in step S5), the process returns to step S1.

次に、自走ロボット1のコントローラ4(検出手段111)は、IDパネル21の候補について、測域センサ9の距離情報から、IDパネル21の傾きを算出する(ステップS6)。 Next, the controller 4 (detection means 111) of the self-propelled robot 1 calculates the inclination of the ID panel 21 for each candidate ID panel 21 from the distance information of the range sensor 9 (step S6).

ここで、図12はIDパネル21の傾きの算出例を示す図である。図12に示すように、IDパネル21の傾きは、測域センサ9が検出したピーク値の距離情報(IDパネル21の検出面21cにおける第一領域aの距離情報と第三領域cの距離情報)から検出可能である。 Here, FIG. 12 is a diagram showing an example of calculating the tilt of the ID panel 21. As shown in FIG. 12, the tilt of the ID panel 21 can be detected from the distance information of the peak value detected by the range measurement sensor 9 (the distance information of the first region a and the distance information of the third region c on the detection surface 21c of the ID panel 21).

続いて、自走ロボット1のコントローラ4(検出手段111)は、IDパネル21の傾きが接続可能な範囲であるかを判断する(ステップS7)。自走ロボット1のコントローラ4(検出手段111)は、傾きが所定範囲内(図12に示す角度θが所定の角度以下)の場合、接続にいける許容範囲の傾きで置かれているカゴ台車2であると判断し(ステップS7のYes)、ステップS8に進む。 Then, the controller 4 (detection means 111) of the self-propelled robot 1 determines whether the inclination of the ID panel 21 is within the range for connection (step S7). If the inclination is within a predetermined range (angle θ shown in FIG. 12 is equal to or less than a predetermined angle), the controller 4 (detection means 111) of the self-propelled robot 1 determines that the basket cart 2 is placed at an inclination within the allowable range for connection (Yes in step S7), and proceeds to step S8.

一方、自走ロボット1のコントローラ4(検出手段111)は、傾きが所定範囲外(図12に示す角度θが所定の角度より大きい)の場合、接続にいける許容範囲の傾きで置かれているカゴ台車2ではないと判断し(ステップS7のNo)、ステップS1に戻る。 On the other hand, if the inclination is outside the predetermined range (angle θ shown in FIG. 12 is greater than the predetermined angle), the controller 4 (detection means 111) of the self-propelled robot 1 determines that the basket cart 2 is not placed at an inclination within the allowable range for connection (No in step S7), and returns to step S1.

そして、自走ロボット1のコントローラ4(検出手段111)は、IDパネル21の検出処理を完了する(ステップS8)。 Then, the controller 4 (detection means 111) of the self-propelled robot 1 completes the detection process of the ID panel 21 (step S8).

続いて、検出したIDパネル21の表面の角度と自走ロボット1との角度を検出する動作について説明する。 Next, we will explain the operation of detecting the angle of the detected surface of the ID panel 21 and the angle between it and the self-propelled robot 1.

概略的には、搬送対象物(カゴ台車2)に装着されたIDパネル21の検出面21cが平面であることを利用して、検出したIDパネル21の検出面21cの角度と自走ロボット1との角度を搬送対象物(カゴ台車2)と自走ロボット1との角度として、自走ロボット1と搬送対象物(カゴ台車2)との自動連結に用いるようにしたものである。 In general terms, by taking advantage of the fact that the detection surface 21c of the ID panel 21 attached to the transport object (cage cart 2) is flat, the angle of the detected detection surface 21c of the ID panel 21 and the angle between the self-propelled robot 1 are taken as the angle between the transport object (cage cart 2) and the self-propelled robot 1, and are used to automatically connect the self-propelled robot 1 and the transport object (cage cart 2).

続いて、IDパネル21の検出処理の完了後における自走ロボット1の目標位置への移動について説明する。 Next, we will explain how the self-propelled robot 1 moves to the target position after the detection process of the ID panel 21 is completed.

ここで、図13はIDパネル21の検出処理の完了後における目標位置への移動処理の流れを示すフローチャートである。図13に示すように、自走ロボット1のコントローラ4(算出手段112)は、IDパネル21に向けて走行を開始し(ステップS31)、IDパネル21までの距離、反射強度情報を測域センサ9から取得する(ステップS32)。 Here, FIG. 13 is a flowchart showing the flow of the process of moving to the target position after the detection process of the ID panel 21 is completed. As shown in FIG. 13, the controller 4 (calculation means 112) of the self-propelled robot 1 starts moving toward the ID panel 21 (step S31), and acquires the distance to the ID panel 21 and reflection intensity information from the range sensor 9 (step S32).

次いで、自走ロボット1のコントローラ4(算出手段112)は、IDパネル21の設計情報(大きさ、再帰反射テープ21bの間隔など)を参考にして、距離・反射強度情報からIDパネル21の自走ロボット1に対する相対位置および傾きを検出する(ステップS33)。 Next, the controller 4 (calculation means 112) of the self-propelled robot 1 detects the relative position and inclination of the ID panel 21 with respect to the self-propelled robot 1 from the distance and reflection intensity information, referring to the design information of the ID panel 21 (size, spacing of the retroreflective tape 21b, etc.) (step S33).

次に説明する図14から図17は、自走ロボット1、IDパネル21を天井側から見た平面図として示している。なお、既述しているように、IDパネル21はカゴ台車2に装着されているが図が煩雑になることを避けるために、カゴ台車2は省略しIDパネル21のみを表示している。 Figures 14 to 17, which will be explained next, show the self-propelled robot 1 and ID panel 21 as plan views seen from the ceiling side. As mentioned above, the ID panel 21 is attached to the cart 2, but to avoid cluttering the illustration, the cart 2 is omitted and only the ID panel 21 is shown.

図14は、IDパネル21の傾きの検出手法を示す図である。図14に示すように、自走ロボット1の中心は、後輪である従動車輪72の車軸中心である。IDパネル21の位置は、IDパネル21の中心である。IDパネル21の傾きは、自走ロボット1の後輪である従動車輪72の車軸方向に平行な直線と、IDパネル21のパネル面に平行な直線とのなす角(図14のθ)である。 Fig. 14 is a diagram showing a method for detecting the inclination of ID panel 21. As shown in Fig. 14, the center of self-propelled robot 1 is the center of the axle of driven wheel 72, which is the rear wheel. The position of ID panel 21 is the center of ID panel 21. The inclination of ID panel 21 is the angle (θ 1 in Fig. 14 ) between a line parallel to the axle direction of driven wheel 72, which is the rear wheel of self-propelled robot 1, and a line parallel to the panel surface of ID panel 21.

図15は、IDパネル21の方向の検出手法を示す図である。図15に示すように、IDパネル21の方向は、自走ロボット1の後輪である従動車輪72の車軸方向に対して垂直で自走ロボット1の中心を通る直線と、自走ロボット1の中心とIDパネル21の中心をつなぐ直線とのなす角(図15のθ)である。 Fig. 15 is a diagram showing a method for detecting the orientation of ID panel 21. As shown in Fig. 15, the orientation of ID panel 21 is the angle (θ2 in Fig. 15) between a line that is perpendicular to the axle direction of driven wheels 72, which are the rear wheels of self-propelled robot 1, and passes through the center of self-propelled robot 1 , and a line connecting the center of self-propelled robot 1 and the center of ID panel 21.

IDパネル21の自走ロボット1に対する相対位置および傾きが検出されなかった場合(ステップS34のNo)、自走ロボット1のコントローラ4(算出手段112)は、一時停止して(ステップS35)、再度IDパネル21までの距離、反射強度情報を測域センサ9から取得する(ステップS32)。 If the relative position and inclination of the ID panel 21 with respect to the self-propelled robot 1 are not detected (No in step S34), the controller 4 (calculation means 112) of the self-propelled robot 1 temporarily stops (step S35) and again acquires the distance to the ID panel 21 and reflection intensity information from the range sensor 9 (step S32).

なお、IDパネル21を検出した後に、自走ロボット1がIDパネル21を検出できなくなることは自走ロボット1とIDパネル21(カゴ台車2)との位置関係の観点からは考え辛いが、自走ロボット1の駆動エラーや測域センサ9のエラーなどでIDパネル21が検出できなくなったときの対処として、一時停止処理(ステップS35)を設けている。なお、一時停止期間が所定の時間を超えると、異常発生として、自走ロボット1を停止し、カゴ台車2の接続失敗の表示を出すなどの処理をする。 Note that, while it is difficult to imagine that the self-propelled robot 1 will be unable to detect the ID panel 21 after detecting it, given the relative positions of the self-propelled robot 1 and the ID panel 21 (cage cart 2), a temporary suspension process (step S35) is provided as a measure to be taken when the ID panel 21 cannot be detected due to a drive error in the self-propelled robot 1 or an error in the range sensor 9. Note that if the temporary suspension period exceeds a predetermined time, an abnormality is detected, and the self-propelled robot 1 is stopped and a message is displayed indicating that the connection to the cage cart 2 has failed.

IDパネル21の自走ロボット1に対する相対位置および傾きが検出された場合(ステップS34のYes)、自走ロボット1のコントローラ4(算出手段112)は、IDパネル21の位置と傾きに基づく相対目標位置を検出する(ステップS36)。 If the relative position and inclination of the ID panel 21 with respect to the self-propelled robot 1 are detected (Yes in step S34), the controller 4 (calculation means 112) of the self-propelled robot 1 detects a relative target position based on the position and inclination of the ID panel 21 (step S36).

ここで、図16は相対目標位置の算出方法を示す図である。図16に示すように、IDパネル21の中心から垂直方向に一定距離、かつ、IDパネル21に対して正対する角度が相対目標位置(x´,y´,θ´)である。 Here, FIG. 16 is a diagram showing a method for calculating the relative target position. As shown in FIG. 16, the relative target position (x', y', θ') is a certain distance in the vertical direction from the center of the ID panel 21 and at an angle directly facing the ID panel 21.

続いて、自走ロボット1のコントローラ4(移動制御手段113)は、現在位置を(x,y,θ)=(0,0,0)として、相対目標位置(x´,y´,θ´)との差分を基に、目標位置への方向角度θを決定し、走行する(ステップS37)。 Next, controller 4 (movement control means 113) of self-running robot 1 sets the current position to (x, y, θ) = (0, 0, 0), and determines a directional angle θ3 to the target position based on the difference between the current position and the relative target position (x', y', θ'), and then moves (step S37).

自走ロボット1のコントローラ4は、ステップS32~S37の処理を、IDパネル21のパネル面に対して垂直な位置に設定された相対目標位置(x´,y´,θ´)へ到着するまで(ステップS38のYes)、繰り返す。 The controller 4 of the self-propelled robot 1 repeats the process of steps S32 to S37 until it arrives at the relative target position (x', y', θ') that is set perpendicular to the panel surface of the ID panel 21 (Yes in step S38).

ここで、図17は相対目標位置への走行経路を模式的に示す図である。図17に示すように、自走ロボット1のコントローラ4は、自走ロボット1が相対目標位置に近づくにつれて速度を減速させるようにしてもよい。例えば自走ロボット1のコントローラ4は、下記式に従って制御すればよい。
v[m/S]=α*(x+Y1/2
α:パラメータ
Here, Fig. 17 is a diagram showing a schematic diagram of a travel path to a relative target position. As shown in Fig. 17, controller 4 of self-running robot 1 may reduce the speed of self-running robot 1 as it approaches the relative target position. For example, controller 4 of self-running robot 1 may perform control according to the following equation.
v[m/S]=α*(x 2 +Y 2 ) 1/2
α: Parameter

また、自走ロボット1のコントローラ4は、回転速度をIDパネル21の方向(図15)に基づいて設定する。
ω[rad/S]=β*θ
*βはパラメータ
Controller 4 of self-running robot 1 also sets the rotation speed based on the orientation of ID panel 21 (FIG. 15).
ω[rad/S]=β*θ
*β is a parameter

このように本実施の形態によれば、IDパネル21を検出する際に、IDパネル21の検出面21cに生成されたコードとIDパネル21の検出面21cまでの距離情報(換言すると、IDパネル21の検出面21cの第一領域a、第二領域b、第三領域cまでの距離情報)とを用いて、IDパネル21を検出する。これにより、IDパネル21を検出するためのコードは情報量が少ない簡易なものでよいので、IDパネル21を検出するためのセンサは簡単な構成でよく、遠距離からでも安定して搬送対象物(IDパネル21)を検出することができる。また、本実施の形態によれば、搬送対象物(IDパネル21)の角度検出の精度向上や従来技術よりも遠距離から搬送対象物(IDパネル21)の角度を検出することができる。 As described above, according to this embodiment, when detecting the ID panel 21, the ID panel 21 is detected using the code generated on the detection surface 21c of the ID panel 21 and distance information to the detection surface 21c of the ID panel 21 (in other words, distance information to the first area a, second area b, and third area c of the detection surface 21c of the ID panel 21). As a result, the code for detecting the ID panel 21 can be simple with a small amount of information, so the sensor for detecting the ID panel 21 can be simply configured and the transport object (ID panel 21) can be stably detected even from a long distance. Furthermore, according to this embodiment, the accuracy of angle detection of the transport object (ID panel 21) is improved and the angle of the transport object (ID panel 21) can be detected from a long distance compared to conventional technology.

(第2の実施の形態)
次に、第2の実施の形態について説明する。
Second Embodiment
Next, a second embodiment will be described.

第2の実施の形態の搬送システムは、IDパネル21の検出と、IDパネル21の内容の識別との2段階にする点が、第1の実施の形態と異なる。以下、第2の実施の形態の説明では、第1の実施の形態と同一部分の説明については省略し、第1の実施の形態と異なる箇所について説明する。 The transport system of the second embodiment differs from the first embodiment in that it has two stages: detection of the ID panel 21 and identification of the contents of the ID panel 21. In the following explanation of the second embodiment, the explanation of the same parts as in the first embodiment will be omitted, and only the differences from the first embodiment will be explained.

第1の実施の形態においては、IDパネル21内の情報量は、IDパネル21の検出面21c(特に、第二領域b)における再帰反射テープ21bの本数に依るものとなっている。しかしながら、再帰反射テープ21bを測域センサ9の分解能より細かい間隔で配置しても情報量を増やすという観点では意味がない。また、測域センサ9の角分解能は距離が離れるほど悪くなるので、自走ロボット1から遠い位置にあるIDパネル21の情報量は少なくなってしまう。 In the first embodiment, the amount of information in the ID panel 21 depends on the number of retroreflective tapes 21b on the detection surface 21c (particularly the second region b) of the ID panel 21. However, arranging the retroreflective tapes 21b at intervals finer than the resolution of the range sensor 9 is meaningless in terms of increasing the amount of information. In addition, the angular resolution of the range sensor 9 deteriorates with distance, so the amount of information of an ID panel 21 located farther from the self-propelled robot 1 will be reduced.

そこで、本実施の形態においては、以下に示すように、IDパネル21の検出時(IDパネル21と自走ロボット1との距離が遠い状態)は、IDパネル21の両端の再帰反射テープ21b(第一領域aと第三領域c)のみを見るようにする。そして、IDパネル21の位置を検出後、自走ロボット1がIDパネル21に近づき、IDパネル21の内容の識別を行うものとする。 Therefore, in this embodiment, as shown below, when detecting the ID panel 21 (when the distance between the ID panel 21 and the self-propelled robot 1 is large), only the retroreflective tape 21b (first area a and third area c) on both ends of the ID panel 21 is viewed. After detecting the position of the ID panel 21, the self-propelled robot 1 approaches the ID panel 21 and identifies the contents of the ID panel 21.

図18は、第2の実施の形態にかかるIDパネルの検出処理の流れを概略的に示すフローチャートである。なお、図18におけるステップS1~S8については、第1の実施の形態で説明した図7におけるステップS1~S8と何ら変わるものではないため、ここでの説明は省略する。 Figure 18 is a flow chart that shows the outline of the flow of the ID panel detection process according to the second embodiment. Note that steps S1 to S8 in Figure 18 are the same as steps S1 to S8 in Figure 7 that were explained in the first embodiment, so a description of them will be omitted here.

自走ロボット1のコントローラ4は、IDパネル21の検出処理を完了すると(ステップS8)、自走ロボット1をカゴ台車2に接続可能な走行ライン51上の位置に停止させる(ステップS9)。 When the controller 4 of the self-propelled robot 1 completes the detection process of the ID panel 21 (step S8), it stops the self-propelled robot 1 at a position on the travel line 51 where it can be connected to the basket cart 2 (step S9).

ここで、図19はIDパネル21の検出におけるピーク値検出状態を示す図である。図19に示すように、本実施の形態において自走ロボット1のコントローラ4は、IDパネル21を検出する際には、IDパネル21の両端の再帰反射テープ21bに対応するピークを検出した場合に、IDパネル21の検出処理を完了する。 Here, FIG. 19 is a diagram showing the peak value detection state in detecting the ID panel 21. As shown in FIG. 19, in this embodiment, when the controller 4 of the self-propelled robot 1 detects the ID panel 21, the detection process of the ID panel 21 is completed when it detects peaks corresponding to the retroreflective tape 21b on both ends of the ID panel 21.

次いで、自走ロボット1のコントローラ4は、自走ロボット1を90度旋回させる(ステップS10)。 Next, the controller 4 of the self-propelled robot 1 turns the self-propelled robot 1 90 degrees (step S10).

次いで、自走ロボット1のコントローラ4は、自走ロボット1をIDパネル21に向かって進行させる(ステップS11)。自走ロボット1のコントローラ4は、測域センサ9からIDパネル21までの間の距離情報値が50cm以下になるまで(ステップS12のYes)、自走ロボット1をIDパネル21に向かって進行させる(ステップS11)。 Next, controller 4 of self-propelled robot 1 causes self-propelled robot 1 to proceed toward ID panel 21 (step S11). Controller 4 of self-propelled robot 1 causes self-propelled robot 1 to proceed toward ID panel 21 (step S11) until the distance information value from range sensor 9 to ID panel 21 becomes 50 cm or less (Yes in step S12).

ここで、図20はIDパネル21に対する接近状態を示す図である。図20に示すように、自走ロボット1は、IDパネル21に対して50cmの距離まで近づくようにする。 Here, FIG. 20 shows the approach state to the ID panel 21. As shown in FIG. 20, the self-propelled robot 1 approaches the ID panel 21 to a distance of 50 cm.

自走ロボット1のコントローラ4は、測域センサ9からIDパネル21までの間の距離情報値が50cm以下になると(ステップS12のYes)、測域センサ9の反射強度値からピークを取得する(ステップS13)。そして、自走ロボット1のコントローラ4は、IDパネル21の両端の再帰反射テープ21bに対応するピーク以外のピーク位置からIDパネル21の内容を識別する(ステップS14)。 When the distance information value between the range sensor 9 and the ID panel 21 becomes 50 cm or less (Yes in step S12), the controller 4 of the self-propelled robot 1 acquires a peak from the reflection intensity value of the range sensor 9 (step S13). The controller 4 of the self-propelled robot 1 then identifies the contents of the ID panel 21 from the peak positions other than the peaks corresponding to the retroreflective tape 21b at both ends of the ID panel 21 (step S14).

ここで、図21はIDパネル21の内容識別例を示す図である。図21に示すように、自走ロボット1のコントローラ4は、IDパネル21の内容の識別の際には、IDパネル21の両端の再帰反射テープ21bに対応するピーク以外のピークを探索する。図21に示すように、自走ロボット1がIDパネル21の50cm手前にまで近づいているので、IDパネル21を検出する時よりも分解能は高く検出できる。 Here, FIG. 21 is a diagram showing an example of identifying the contents of the ID panel 21. As shown in FIG. 21, when identifying the contents of the ID panel 21, the controller 4 of the self-propelled robot 1 searches for peaks other than the peaks corresponding to the retroreflective tape 21b at both ends of the ID panel 21. As shown in FIG. 21, the self-propelled robot 1 has approached to within 50 cm of the ID panel 21, so detection can be performed with a higher resolution than when detecting the ID panel 21.

このように本実施の形態によれば、IDパネル21の検出とIDパネル21の内容の識別とを分けて行うため、簡単な構成のセンサ(測域センサ9)で遠距離からでも安定してIDパネル21を検出した後に、検出したIDパネル21に近づいてから識別番号情報、搬送先情報、搬送の優先度情報等の詳細な情報を取得することができる。 As described above, according to this embodiment, the detection of the ID panel 21 and the identification of the contents of the ID panel 21 are performed separately, so that the ID panel 21 can be stably detected even from a long distance using a sensor with a simple configuration (range measurement sensor 9), and then detailed information such as the identification number information, delivery destination information, and delivery priority information can be obtained by approaching the detected ID panel 21.

(第3の実施の形態)
次に、第3の実施の形態について説明する。
Third Embodiment
Next, a third embodiment will be described.

第3の実施の形態の搬送システムは、更に識別手段(例えば、バーコードリーダなど)を備えて、IDパネル21内のコードを読み取る点が、第1の実施の形態および第2の実施の形態と異なる。以下、第3の実施の形態の説明では、第1の実施の形態または第2の実施の形態と同一部分の説明については省略し、第1の実施の形態および第2の実施の形態と異なる箇所について説明する。 The transport system of the third embodiment differs from the first and second embodiments in that it further includes an identification means (e.g., a barcode reader) for reading the code in the ID panel 21. In the following explanation of the third embodiment, explanations of the same parts as the first and second embodiments will be omitted, and only the differences from the first and second embodiments will be explained.

ここで、図22は第3の実施の形態にかかる搬送システムにおける自走ロボットのハードウェア構成の一例を示すブロック図である。図22に示すように、本実施の形態の自走ロボット1は、第2のセンサであるカメラ5を備えている。また、IDパネル21の第二領域bに配置されるバーコード(画像パターン)は、情報を有するパターンである。 Here, FIG. 22 is a block diagram showing an example of the hardware configuration of a self-propelled robot in a transport system according to the third embodiment. As shown in FIG. 22, the self-propelled robot 1 of this embodiment is equipped with a camera 5, which is a second sensor. In addition, the barcode (image pattern) placed in the second area b of the ID panel 21 is a pattern having information.

カメラ5は、復号部として機能するコントローラ4とともにマーカー読取装置を構成する。コントローラ4は、カメラ5の撮影画像からマーカーの特徴の画像認識によってマーカーのコードを認識する。コントローラ4の復号部では認識したマーカーのコード情報をデコードすることで、カゴ台車2の認識番号情報、搬送先情報、優先度情報を得る。 The camera 5, together with the controller 4 that functions as a decoding unit, constitutes a marker reading device. The controller 4 recognizes the marker code by image recognition of the marker's features from the image captured by the camera 5. The decoding unit of the controller 4 decodes the recognized marker code information to obtain the identification number information, destination information, and priority information of the cart 2.

マーカーのIDの表示方法は、画像パターンとしての一般的なバーコードやQRコード(登録商標)が使える。また、IDとしてカラーコードや、濃淡バーコードなどの画像パターンによって単位面積当たりの情報量を増やすことで、より遠くから認識できるようになる。 The marker ID can be displayed using a standard barcode or QR code (registered trademark) as an image pattern. In addition, by using an image pattern such as a color code or a shaded barcode as the ID, the amount of information per unit area can be increased, allowing the marker to be recognized from a greater distance.

本実施形態では、カゴ台車2に設置されたマーカーとして、バーコードを用いているため、カメラ5をバーコードリーダとして用いて読み取っている。なお、IDを表示するマーカーがQRコードの場合は、ID認識手段としてQRコードリーダが使用できる。 In this embodiment, a barcode is used as the marker attached to the cart 2, so the camera 5 is used as a barcode reader to read it. If the marker that displays the ID is a QR code, a QR code reader can be used as the ID recognition means.

図23は、第3の実施の形態にかかるIDパネルの検出処理の流れを概略的に示すフローチャートである。なお、図23におけるステップS1~S11については、第2の実施の形態で説明した図18におけるステップS1~S11と何ら変わるものではないため、ここでの説明は省略する。 Figure 23 is a flow chart showing the outline of the flow of the ID panel detection process in the third embodiment. Note that steps S1 to S11 in Figure 23 are the same as steps S1 to S11 in Figure 18 described in the second embodiment, so a description of them will be omitted here.

自走ロボット1のコントローラ4は、自走ロボット1をIDパネル21に向かって進行させると(ステップS11)、測域センサ9の距離情報値と、測域センサ9とカメラ5との間の距離の関係から、カメラ5とIDパネル21との間の距離を算出する(ステップS21)。 When the controller 4 of the self-propelled robot 1 moves the self-propelled robot 1 toward the ID panel 21 (step S11), it calculates the distance between the camera 5 and the ID panel 21 from the distance information value of the range sensor 9 and the relationship between the distance between the range sensor 9 and the camera 5 (step S21).

次に、自走ロボット1のコントローラ4は、カメラ5とIDパネル21との間の距離がバーコードの読み取り可能範囲以下になるまで(ステップS22のYes)、自走ロボット1をIDパネル21に向かって進行させる(ステップS11)。 Next, the controller 4 of the self-propelled robot 1 advances the self-propelled robot 1 toward the ID panel 21 (step S11) until the distance between the camera 5 and the ID panel 21 falls within the readable range of the barcode (Yes in step S22).

自走ロボット1のコントローラ4は、カメラ5からIDパネル21までの間の距離情報値がバーコードの読み取り可能範囲以下になると(ステップS22のYes)、カメラ5でIDパネル21のバーコードを読み取る(ステップS23)。 When the distance information value from the camera 5 to the ID panel 21 falls below the readable range of the barcode (Yes in step S22), the controller 4 of the self-propelled robot 1 reads the barcode on the ID panel 21 with the camera 5 (step S23).

そして、自走ロボット1のコントローラ4は、バーコードの内容からIDパネル21の内容を識別する(ステップS24)。 Then, the controller 4 of the self-propelled robot 1 identifies the contents of the ID panel 21 from the contents of the barcode (step S24).

ここで、図24はIDパネル21の内容識別例を示す図である。図24に示すように、自走ロボット1のコントローラ4は、IDパネル21の内容の識別の際には、自走ロボット1がバーコードの読み取り可能範囲までIDパネル21に近づき、カメラ5によりIDパネル21のバーコードを読み取るので、IDパネル21の情報量を多くすることができる。 Here, FIG. 24 is a diagram showing an example of identifying the contents of ID panel 21. As shown in FIG. 24, when identifying the contents of ID panel 21, controller 4 of self-propelled robot 1 moves self-propelled robot 1 close to ID panel 21 as far as the barcode can be read and reads the barcode on ID panel 21 with camera 5, thereby increasing the amount of information on ID panel 21.

このように本実施の形態によれば、IDパネル21の検出とIDパネル21の内容の識別とを分けて行うため、簡単な構成のセンサ(測域センサ9)で遠距離からでも安定してIDパネル21を検出した後に、検出したIDパネル21に近づいてから識別番号情報、搬送先情報、搬送の優先度情報等の詳細な情報を取得することができる。 As described above, according to this embodiment, the detection of the ID panel 21 and the identification of the contents of the ID panel 21 are performed separately, so that the ID panel 21 can be stably detected even from a long distance using a sensor with a simple configuration (range measurement sensor 9), and then detailed information such as the identification number information, delivery destination information, and delivery priority information can be obtained by approaching the detected ID panel 21.

なお、本実施の形態においては、カゴ台車2に設置されたマーカーとして、バーコードやQRコードを用いるようにしたが、これに限るものではない。例えば、カゴ台車2に設置されたマーカーとして、濃淡バーコード、カラーコード等を用いるようにしてもよい。カラーコードは、カメラ5を使った読み取りを行うことで、コードの位置情報を同時に読み取ることができるため、カゴ台車2が置かれている位置を認識することができる。また、濃淡バーコードは、測域センサ9で読み取ることができるので、より正確な位置情報を得ることができ、接続位置決めのフィードバック情報として有効である。 In this embodiment, a barcode or QR code is used as the marker placed on the basket cart 2, but the present invention is not limited to this. For example, a shading barcode, a color code, etc. may be used as the marker placed on the basket cart 2. By reading the color code using the camera 5, the position information of the code can be read at the same time, making it possible to recognize the position where the basket cart 2 is placed. In addition, a shading barcode can be read by the range sensor 9, making it possible to obtain more accurate position information, which is effective as feedback information for connection positioning.

(第4の実施の形態)
次に、第4の実施の形態について説明する。
(Fourth embodiment)
Next, a fourth embodiment will be described.

第4の実施の形態の搬送システムは、自走ロボット1における連結装置10がカゴ台車2にとって最適な位置で接続を行う点が、第1の実施の形態と異なる。以下、第4の実施の形態の説明では、第1の実施の形態と同一部分の説明については省略し、第1の実施の形態と異なる箇所について説明する。 The transport system of the fourth embodiment differs from the first embodiment in that the coupling device 10 of the self-propelled robot 1 connects to the basket cart 2 at an optimal position. In the following explanation of the fourth embodiment, the explanation of the same parts as in the first embodiment will be omitted, and only the differences from the first embodiment will be explained.

カゴ台車2の骨組みの位置関係などによっては、自走ロボット1における連結装置10の接続位置を変更したい場合が考えられる。そこで、本実施の形態においては、カゴ台車2の接続したい位置を考慮してカゴ台車2の種類ごとにIDパネル21のパネルID(識別番号)を用意する。自走ロボット1は、パネルIDを検出して、パネルIDごとに相対目標位置を変え、各カゴ台車2にとって最適な位置で接続を行う。 It may be necessary to change the connection position of the coupling device 10 on the self-propelled robot 1 depending on the relative positions of the cage cart 2 framework. In this embodiment, therefore, a panel ID (identification number) for the ID panel 21 is prepared for each type of cage cart 2, taking into consideration the desired connection position of the cage cart 2. The self-propelled robot 1 detects the panel ID, changes the relative target position for each panel ID, and connects at the optimal position for each cage cart 2.

ここで、図25は第4の実施の形態にかかるIDパネル21の検出処理の完了後における目標位置への移動処理の流れを示すフローチャートである。図25に示すように、自走ロボット1のコントローラ4(算出手段112)は、IDパネル21に向けて走行を開始し(ステップS31)、IDパネル21までの距離、反射強度情報を測域センサ9から取得する(ステップS32)。 Here, FIG. 25 is a flowchart showing the flow of the process of moving to the target position after the detection process of the ID panel 21 according to the fourth embodiment is completed. As shown in FIG. 25, the controller 4 (calculation means 112) of the self-propelled robot 1 starts moving toward the ID panel 21 (step S31), and acquires the distance to the ID panel 21 and reflection intensity information from the range sensor 9 (step S32).

次いで、自走ロボット1のコントローラ4(算出手段112)は、IDパネル21の設計情報(大きさ、再帰反射テープ21bの間隔など)を参考にして、距離・反射強度情報からIDパネル21の自走ロボット1に対する相対位置および傾きを検出するとともにIDパネル21のパネルIDを検出する(ステップS41)。 Next, the controller 4 (calculation means 112) of the self-propelled robot 1 uses the design information of the ID panel 21 (size, spacing of the retroreflective tape 21b, etc.) to detect the relative position and inclination of the ID panel 21 with respect to the self-propelled robot 1 from the distance and reflection intensity information, and detects the panel ID of the ID panel 21 (step S41).

IDパネル21の自走ロボット1に対する相対位置および傾き、IDパネル21のパネルIDが検出されなかった場合(ステップS34のNo)、自走ロボット1のコントローラ4(算出手段112)は、一時停止して(ステップS35)、再度IDパネル21までの距離、反射強度情報を測域センサ9から取得する(ステップS32)。 If the relative position and inclination of the ID panel 21 with respect to the self-propelled robot 1 and the panel ID of the ID panel 21 are not detected (No in step S34), the controller 4 (calculation means 112) of the self-propelled robot 1 temporarily stops (step S35) and again acquires the distance to the ID panel 21 and reflection intensity information from the range sensor 9 (step S32).

一方、IDパネル21の自走ロボット1に対する相対位置および傾き、IDパネル21のパネルIDが検出された場合(ステップS34のYes)、設定ファイルを読み込む(ステップS42)。設定ファイルには、パネルIDに紐付けて移動量が登録されている。 On the other hand, if the relative position and inclination of the ID panel 21 with respect to the self-propelled robot 1 and the panel ID of the ID panel 21 are detected (Yes in step S34), a setting file is read (step S42). The setting file stores the amount of movement associated with the panel ID.

次いで、自走ロボット1のコントローラ4(算出手段112)は、IDパネル21の位置と傾きに基づく相対目標位置を算出するとともに、設定ファイルに登録してあるパネルIDに紐づいた移動量分だけIDパネル21のパネル面と平行な方向へ相対目標位置をシフトさせる(ステップS43)。 Next, the controller 4 (calculation means 112) of the self-propelled robot 1 calculates a relative target position based on the position and inclination of the ID panel 21, and shifts the relative target position in a direction parallel to the panel surface of the ID panel 21 by the amount of movement associated with the panel ID registered in the configuration file (step S43).

ここで、図26は相対目標位置のシフト方法を示す図である。図26に示すように、設定ファイルに登録してあるパネルIDに紐づいた移動量分だけIDパネル21のパネル面と平行な方向へ相対目標位置をシフトさせる。例えば、ID=2の場合には、プラス方向に30mmだけIDパネル21のパネル面と平行に移動させる。 Here, Figure 26 is a diagram showing how to shift the relative target position. As shown in Figure 26, the relative target position is shifted in a direction parallel to the panel surface of the ID panel 21 by an amount of movement associated with the panel ID registered in the setting file. For example, when ID=2, it is moved 30 mm in the positive direction parallel to the panel surface of the ID panel 21.

続いて、自走ロボット1のコントローラ4(移動制御手段113)は、現在位置を(x,y,θ)=(0,0,0)として、相対目標位置(x´,y´,θ´)との差分を基に、目標位置への方向角度θを決定し、走行する(ステップS37)。 Next, controller 4 (movement control means 113) of self-running robot 1 sets the current position to (x, y, θ) = (0, 0, 0), and determines a directional angle θ3 to the target position based on the difference between the current position and the relative target position (x', y', θ'), and then moves (step S37).

自走ロボット1のコントローラ4は、ステップS32~S37の処理を、IDパネル21のパネル面に対して垂直な位置に設定された相対目標位置(x´,y´,θ´)へ到着するまで(ステップS38のYes)、繰り返す。 The controller 4 of the self-propelled robot 1 repeats the process of steps S32 to S37 until it arrives at the relative target position (x', y', θ') that is set perpendicular to the panel surface of the ID panel 21 (Yes in step S38).

このように本実施形態によれば、カゴ台車2の種類ごとにパネルIDを用意することで、AGVはパネルIDを検出して、IDごとに相対目標位置を変え、各カゴ車にとって最適な位置で接続を行うことができる。 In this way, according to this embodiment, by preparing a panel ID for each type of cart 2, the AGV can detect the panel ID, change the relative target position for each ID, and connect at the optimal position for each cart.

なお、各実施形態においては、連結対象であるカゴ台車2のような被牽引台車に自動で接続して牽引することで、カゴ台車2を所望の搬送先へ自動搬送する無人搬送車(AGV)としての自走ロボット1を、自律移動装置に適用した例について説明したが、これに限るものではなく、各種の自律移動装置に適用可能であることはいうまでもない。 In each embodiment, an example has been described in which the self-propelled robot 1 is applied to an autonomous mobile device as an automated guided vehicle (AGV) that automatically connects to and tows a towed vehicle, such as a basket cart 2, which is the object to be connected, and automatically transports the basket cart 2 to a desired destination. However, the present invention is not limited to this, and it goes without saying that the present invention can be applied to various types of autonomous mobile devices.

1 自律移動装置
4 検出手段
5 第2のセンサ
9 第1のセンサ
21 識別部材(IDパネル、板状部材)
21a 板状部材の表面
21b 再帰反射テープ
111 検出装置
112 算出手段
113 移動制御手段
REFERENCE SIGNS LIST 1 Autonomous mobile device 4 Detection means 5 Second sensor 9 First sensor 21 Identification member (ID panel, plate-shaped member)
21a Surface of plate-like member 21b Retroreflective tape 111 Detection device 112 Calculation means 113 Movement control means

特開2000-242335号公報JP 2000-242335 A 特許第6109616号公報Patent No. 6109616

Claims (3)

自律移動装置であって、
検出領域に光を射出することで前記検出領域を光走査し、射出された前記光が前記検出領域に存在する物体により反射された反射光を受光するセンサにより、前記検出領域に存在する識別部材を検出する検出装置を有し、
前記検出装置は、
前記センサが受光した光に基づき前記物体から反射された光の反射強度を検出する反射強度検出手段と、
前記センサが受光した光に基づき、前記識別部材の検出面までの距離を検出する距離検出手段と、を有し、
前記検出装置は、前記反射強度検出手段で検出した情報から前記識別部材の候補を検出し、前記距離検出手段で検出した情報から前記候補の形状平面を検出し、
前記識別部材は、搬送対象車に装着されており、
当該自律移動装置を前記搬送対象車と連結する位置である目標位置へ移動させ、前記目標位置にて、当該自律移動装置を前記搬送対象車と連結させる制御手段を有し、
前記搬送対象車に装着された前記識別部材に記載されている識別情報は、前記搬送対象車の種類ごとに用意されていて、前記識別情報に紐付けて移動量を登録しておき、
前記検出装置は、前記識別部材に記載されている識別情報を検出し、
前記制御手段は、前記識別情報に紐付けられた移動量に基づいて、前記目標位置を変更する
ことを特徴とする自律移動装置。
An autonomous mobile device,
a detection device that detects an identification member present in a detection area by emitting light to the detection area and optically scanning the detection area and receiving light reflected by an object present in the detection area from the emitted light,
The detection device includes:
a reflection intensity detection means for detecting a reflection intensity of light reflected from the object based on the light received by the sensor;
a distance detection means for detecting a distance to a detection surface of the identification member based on the light received by the sensor,
the detection device detects a candidate for the identification member from the information detected by the reflection intensity detection means, and detects a shape plane of the candidate from the information detected by the distance detection means;
The identification member is attached to a vehicle to be transported,
a control means for moving the autonomous mobile device to a target position where the autonomous mobile device is to be coupled to the target vehicle and coupling the autonomous mobile device to the target vehicle at the target position;
The identification information written on the identification member attached to the transportation target vehicle is prepared for each type of the transportation target vehicle, and a movement amount is registered in association with the identification information,
The detection device detects the identification information written on the identification member,
The control means changes the target position based on a movement amount linked to the identification information.
前記制御手段は、前記検出面の位置と傾きに基づく前記目標位置への方向角度が所定の角度以下となるように前記目標位置を設定する、
ことを特徴とする請求項1に記載の自律移動装置。
the control means sets the target position such that a directional angle to the target position based on the position and inclination of the detection surface is equal to or smaller than a predetermined angle.
2. The autonomous mobile device according to claim 1 .
自律移動装置の移動制御方法であって、
前記自律移動装置は、
検出領域に光を射出することで前記検出領域を光走査し、射出された前記光が前記検出領域に存在する物体により反射された反射光を受光するセンサにより、前記検出領域に存在する識別部材を検出する検出装置を有し、
前記検出装置は、前記センサが受光した光に基づき前記物体から反射された光の反射強度を検出する反射強度検出手段と、
前記センサが受光した光に基づき、前記識別部材の検出面までの距離を検出する距離検出手段と、を有し、
前記検出装置は、前記反射強度検出手段で検出した情報から前記識別部材の候補を検出し、前記距離検出手段で検出した情報から前記候補の形状平面を検出し、
前記識別部材は、搬送対象車に装着されており、
前記自律移動装置は、当該自律移動装置を前記搬送対象車と連結する位置である目標位置へ移動させ、前記目標位置にて、当該自律移動装置を前記搬送対象車と連結させる制御手段を有し、
前記搬送対象車に装着された前記識別部材に記載されている識別情報は、前記搬送対象車の種類ごとに用意されていて、前記識別情報に紐付けて移動量を登録しておき、
前記検出装置は、前記識別部材に記載されている識別情報を検出し、
前記制御手段は、前記識別情報に紐付けられた移動量に基づいて、前記目標位置を変更する
ことを特徴とする自律移動装置の移動制御方法。
A method for controlling movement of an autonomous mobile device, comprising:
The autonomous mobile device is
a detection device that detects an identification member present in a detection area by emitting light to the detection area and optically scanning the detection area and receiving light reflected by an object present in the detection area from the emitted light,
The detection device includes a reflection intensity detection unit that detects a reflection intensity of light reflected from the object based on the light received by the sensor;
a distance detection means for detecting a distance to a detection surface of the identification member based on the light received by the sensor,
the detection device detects a candidate for the identification member from the information detected by the reflection intensity detection means, and detects a shape plane of the candidate from the information detected by the distance detection means;
The identification member is attached to a vehicle to be transported,
the autonomous mobile device has a control means for moving the autonomous mobile device to a target position where the autonomous mobile device is to be coupled to the target vehicle, and coupling the autonomous mobile device to the target vehicle at the target position;
The identification information written on the identification member attached to the transportation target vehicle is prepared for each type of the transportation target vehicle, and a movement amount is registered in association with the identification information,
The detection device detects the identification information written on the identification member,
The method for controlling movement of an autonomous mobile device, wherein the control means changes the target position based on a movement amount linked to the identification information.
JP2023119717A 2019-03-18 2023-07-24 AUTONOMOUS MOBILE DEVICE AND METHOD FOR CONTROLLING MOBILITY OF AUTONOMOUS MOBILE DEVICE Active JP7609211B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2023119717A JP7609211B2 (en) 2019-03-18 2023-07-24 AUTONOMOUS MOBILE DEVICE AND METHOD FOR CONTROLLING MOBILITY OF AUTONOMOUS MOBILE DEVICE

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2019050437A JP2020154470A (en) 2019-03-18 2019-03-18 Autonomous mobile device, movement control method of autonomous mobile device, and connection control method of autonomous mobile device and vehicle to be transported
JP2023119717A JP7609211B2 (en) 2019-03-18 2023-07-24 AUTONOMOUS MOBILE DEVICE AND METHOD FOR CONTROLLING MOBILITY OF AUTONOMOUS MOBILE DEVICE

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP2019050437A Division JP2020154470A (en) 2019-03-18 2019-03-18 Autonomous mobile device, movement control method of autonomous mobile device, and connection control method of autonomous mobile device and vehicle to be transported

Publications (2)

Publication Number Publication Date
JP2023126668A JP2023126668A (en) 2023-09-07
JP7609211B2 true JP7609211B2 (en) 2025-01-07

Family

ID=72559055

Family Applications (2)

Application Number Title Priority Date Filing Date
JP2019050437A Pending JP2020154470A (en) 2019-03-18 2019-03-18 Autonomous mobile device, movement control method of autonomous mobile device, and connection control method of autonomous mobile device and vehicle to be transported
JP2023119717A Active JP7609211B2 (en) 2019-03-18 2023-07-24 AUTONOMOUS MOBILE DEVICE AND METHOD FOR CONTROLLING MOBILITY OF AUTONOMOUS MOBILE DEVICE

Family Applications Before (1)

Application Number Title Priority Date Filing Date
JP2019050437A Pending JP2020154470A (en) 2019-03-18 2019-03-18 Autonomous mobile device, movement control method of autonomous mobile device, and connection control method of autonomous mobile device and vehicle to be transported

Country Status (1)

Country Link
JP (2) JP2020154470A (en)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115047407A (en) * 2022-06-02 2022-09-13 北京三快在线科技有限公司 Detection mechanism, detection system and detection method of position information of carrying device
WO2025094230A1 (en) * 2023-10-30 2025-05-08 株式会社Fuji Transport system, automated guided vehicle, and position identification method
WO2025115165A1 (en) * 2023-11-30 2025-06-05 株式会社Fuji Automatic conveyance device and automatic conveyance system

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017102700A (en) 2015-12-02 2017-06-08 株式会社リコー Information acquisition device, information acquisition system, autonomous moving device, autonomous moving device system and moving body location information acquisition method
JP2018090084A (en) 2016-12-02 2018-06-14 株式会社リコー Connecting device, connected traveling device and autonomous traveling device

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5332034B2 (en) * 2008-09-22 2013-11-06 株式会社小松製作所 Driving route generation method for unmanned vehicles
KR101332932B1 (en) * 2009-02-26 2013-11-26 아이신세이끼가부시끼가이샤 Parking assistance device
JP2014006835A (en) * 2012-06-27 2014-01-16 Murata Mach Ltd Autonomous traveling apparatus, autonomous traveling method, markers, and autonomous traveling system
JP6083355B2 (en) * 2013-08-23 2017-02-22 株式会社ダイフク Goods retrieval equipment

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017102700A (en) 2015-12-02 2017-06-08 株式会社リコー Information acquisition device, information acquisition system, autonomous moving device, autonomous moving device system and moving body location information acquisition method
JP2018090084A (en) 2016-12-02 2018-06-14 株式会社リコー Connecting device, connected traveling device and autonomous traveling device

Also Published As

Publication number Publication date
JP2023126668A (en) 2023-09-07
JP2020154470A (en) 2020-09-24

Similar Documents

Publication Publication Date Title
JP7609211B2 (en) AUTONOMOUS MOBILE DEVICE AND METHOD FOR CONTROLLING MOBILITY OF AUTONOMOUS MOBILE DEVICE
US11983667B2 (en) Automated warehousing using robotic forklifts or other material handling vehicles
US10583982B2 (en) Shelf transport system, shelf transport vehicle, and shelf transport method
US11797011B2 (en) Traveling control system for transport vehicle and traveling control method for transport vehicle
JP2021086205A (en) Identification member, autonomous mobile device, connection system and connection method
JP7318244B2 (en) AUTONOMOUS MOBILE DEVICE, PROGRAM AND METHOD OF SELECTING OBJECT TO TRANSFER BY AUTONOMOUS MOBILE DEVICE
CN105974922A (en) Tunnel automatic guide vehicle, guide system, and operating method for guide system
US20240053754A1 (en) Conveyance system and conveyance control method
JP7095301B2 (en) Travel control system for transport vehicles and travel control methods for transport vehicles
JP2022028342A (en) Unmanned conveyance vehicle system
US20240059492A1 (en) Conveyance system and conveyance control method
CN111204556A (en) Conveying device, conveying system and goods shelf conveying method
JP2023165189A (en) Conveyance system, control device, moving object, control method, program, and storage medium
JP7400315B2 (en) Identification member, system for connecting an autonomous mobile device and an object to be transported using the identification member, and method for connecting an autonomous mobile device and an object to be transported using the identification member
JP7207046B2 (en) Autonomous mobile device, guidance system, and method of moving autonomous mobile device
JP2021056764A (en) Movable body
JP2020191008A (en) Autonomous mobile device, and conveyance information reading method for autonomous mobile device
JP7439594B2 (en) Identification member, identification member detection device, autonomous moving device, detection method and program
WO2019069921A1 (en) Mobile body
JPH07191744A (en) Automated guided vehicle position identification method
JP2020155096A (en) Autonomous mobile device, program, steering method of autonomous mobile device and adjustment method of autonomous mobile device
WO2024157301A1 (en) Transport system
JP7283152B2 (en) Autonomous mobile device, program and steering method for autonomous mobile device
JP2001097695A (en) Location management system and manned work vehicle used for it
WO1998004480A1 (en) Apparatus and method for controlling travel of unmanned conveyance car, unmanned cargo handling method, cargo handling control apparatus, travel guiding tape, tape failure discriminating apparatus and method of repairing tape

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230823

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20230823

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20240521

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20240722

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20240917

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20241030

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20241202

R150 Certificate of patent or registration of utility model

Ref document number: 7609211

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150