JP3931906B2 - Autonomous mobile device - Google Patents
Autonomous mobile device Download PDFInfo
- Publication number
- JP3931906B2 JP3931906B2 JP2005070763A JP2005070763A JP3931906B2 JP 3931906 B2 JP3931906 B2 JP 3931906B2 JP 2005070763 A JP2005070763 A JP 2005070763A JP 2005070763 A JP2005070763 A JP 2005070763A JP 3931906 B2 JP3931906 B2 JP 3931906B2
- Authority
- JP
- Japan
- Prior art keywords
- stop
- autonomous mobile
- mobile device
- area
- start signal
- 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.)
- Expired - Fee Related
Links
- 238000001514 detection method Methods 0.000 claims description 38
- 238000007726 management method Methods 0.000 description 22
- 238000004891 communication Methods 0.000 description 16
- 230000002265 prevention Effects 0.000 description 9
- 238000013459 approach Methods 0.000 description 8
- 230000006870 function Effects 0.000 description 6
- 238000004364 calculation method Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 238000011156 evaluation Methods 0.000 description 4
- 238000000034 method Methods 0.000 description 3
- 238000012937 correction Methods 0.000 description 2
- 238000005070 sampling Methods 0.000 description 2
- 238000004140 cleaning Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000012447 hatching Effects 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
人や台車など他の移動体と同じ領域において、障害物を回避して移動し所望の動作を達成する自律移動装置に関する。 The present invention relates to an autonomous mobile device that achieves a desired operation by moving around an obstacle in the same area as other mobile objects such as a person and a carriage.
自己位置を認識をしながら障害物を回避しつつ目的地まで到達する自律移動装置が「医療福祉機器技術研究開発報告書 平成11年11月 技術研究組合医療福祉機器研究所」や「Johon M. Evans, Bala Krishnamurthy, "HelpMate, TheTrackless Robotic Courier:A perspective on the Development of a Commercial Autonomous Mobile Robot"」などに記述され、また、レーザーレーダの情報から壁の情報を検出し、記憶している地図とマッチングして位置認識する方法が「Li Zhang, Bijoy K.Ghosh, "Line Segment Based map building and Localization Using 2D Laser Rangefinder", IEEE Int. Conf. On Robotics & Automation, pp.2538-2543, 2000」にある。また、障害物を検出して回避する方法については、「Sean Quinlan, Oussama Khatib,“Elastic Bands:Connecting Path Planning and Control", lCRA, 1993」などに様々な方法が提案されている。 Autonomous mobile devices that reach their destination while recognizing their own position while avoiding obstacles are “Medical and Welfare Equipment Technology Research and Development Report November 1999, Research Institute for Medical and Welfare Equipment” and “Johon M. Evans, Bala Krishnamurthy, "HelpMate, The Trackless Robotic Courier: A perspective on the Development of a Commercial Autonomous Mobile Robot", etc. Matching and recognizing position in Li Zhang, Bijoy K. Ghosh, "Line Segment Based map building and Localization Using 2D Laser Rangefinder", IEEE Int. Conf. On Robotics & Automation, pp.2538-2543, 2000 is there. Various methods have been proposed for detecting and avoiding obstacles such as “Sean Quinlan, Oussama Khatib,“ Elastic Bands: Connecting Path Planning and Control ”, lCRA, 1993”.
いずれにしても、基本的には環境認識手段で進行方向に障害物を検出すれば回避を試み、また、回避ができない場合には停止するものとなっている。
しかし、これらの自律移動装置は、障害物を回避することはできるものの、他に移動体があった時、その移動体の動きを妨げてしまうことがあった。たとえば、狭い通路で前方から大きな台車が来た場合など、自律移動装置は障害物である台車を回避しようとするが、上手くすれ違うことができず、立ち往生してしまうことがある。 However, although these autonomous mobile devices can avoid an obstacle, when there is another mobile body, the movement of the mobile body may be hindered. For example, when a large cart comes from the front in a narrow passage, the autonomous mobile device tries to avoid the cart, which is an obstacle, but cannot pass each other well and may get stuck.
また自律移動装置の後方から他の台車がきた場合、自律移動装置の速度が遅くても、自律移動装置が通路の中央付近を移動していて台車が自律移動装置を追い抜こうとしても、自律移動装置は道を譲ることなく移動を続行するために追い抜くことができない。 Also, when another cart comes from behind the autonomous mobile device, even if the autonomous mobile device is slow, even if the autonomous mobile device is moving near the center of the aisle and the cart tries to overtake the autonomous mobile device, A mobile device cannot overtake to continue moving without giving way.
本発明はこのような点に鑑みなされたものであって、その目的とするところは他の移動体に道を譲る動作を行って他の移動体の移動をスムーズにする自律移動装置を提供するにある。 The present invention has been made in view of these points, and an object of the present invention is to provide an autonomous mobile device that performs an operation of giving way to another moving body to smoothly move the other moving body. It is in.
しかして本発明に係る自律移動装置は、稼動領域の地図と走行用の各種パラメータを記憶するための記憶手段と、目的地や操作指令の入力のためのインターフェースと、目的地までの経路を生成する経路生成手段と、障害物や自己位置を認識するための環境認識手段と、走行を行うための走行手段とを備えるとともに、環境認識手段で得られた情報を元に上記地図上で自己の位置を認識し且つ障害物を回避しながら目的地まで走行手段を制御する走行制御手段を備えている自律移動装置であって、他の移動体を回避するための停留開始信号を検出する停留開始信号検出手段を有して、走行制御手段は停留開始信号検出手段で停留開始信号を検出した場合に記憶手段に予め記憶させた他の移動体の回避用の停留領域に停留させるものであることに特徴を有している。通路の適当な場所である停留領域に停止させて他の移動体に通路を譲ることができるものである。 Thus, the autonomous mobile device according to the present invention generates a storage means for storing a map of an operation area and various parameters for traveling, an interface for inputting a destination and an operation command, and a route to the destination. A route generating means, an environment recognizing means for recognizing obstacles and self-location, and a traveling means for running, and on the map based on the information obtained by the environment recognizing means. An autonomous mobile device having travel control means for recognizing a position and controlling a travel means to a destination while avoiding an obstacle, and starting a stop for detecting a stop start signal for avoiding another moving body It has signal detection means, and when the stop start signal detection means detects the stop start signal, the travel control means is to stop in the stop area for avoiding another moving body stored in advance in the storage means. It has a feature. It can be stopped at a stop area, which is an appropriate place of the passage, and the passage can be given to another moving body.
上記停留領域は一つのラインで定義されたものであっても、多角形で定義されたものであってもよい。停留領域を一つのラインで定義している場合には、狭い通路においても停留でき、また、停留領域を多角形で定義している場合には、停留できる場所に幅を持たせることができて、停止姿勢を決める必要がないものとなる。 The stationary region may be defined by one line or may be defined by a polygon. If the stop area is defined by a single line, it can be stopped even in a narrow passage. If the stop area is defined by a polygon, it can be widened where it can be stopped. Therefore, it is not necessary to determine the stop posture.
走行制御手段には、停留領域中の自己位置から最短の位置を停留位置として停留動作に移行するもの、停留領域中の自己位置からの距離と進路変更に要する回転量の二つを考慮して停留位置を決定するもの、停留領域をレベル分けして自己位置からの距離と上記レベルとから停留位置を定めて停留動作に移行するもの、進行方向に決まった距離だけ前進してから、停留位置に向かわせるもの、進行方向に速度に応じた距離だけ前進してから、停留位置に向かわせるもの、あるいは停留領域内で停留位置設定方法は停留領域内で壁に沿って定めた所定距離内を停留位置とするものなどを好適に用いることができる。 The travel control means considers two things: the distance from the self position in the stop area to the stop operation with the shortest position as the stop position, the distance from the self position in the stop area and the amount of rotation required to change the course. Those that determine the stop position, those that divide the stop area into levels, determine the stop position based on the distance from the self-position and the above level, and move to the stop operation, advance after a predetermined distance in the direction of travel, then stop position To move to the stop position after moving forward by a distance corresponding to the speed in the direction of travel, or within the stop area, the stop position setting method is within a predetermined distance determined along the wall in the stop area. What makes a stop position etc. can be used suitably.
停留開始信号検出手段としては、通信手段を介して受信する防災情報を停留開始信号として検出するもののほか、複数取り付けられた接触式のセンサ、検出した音声レベルのパターンが予め登録したパターンと適合したかを出力するセンサ、音声認識手段、他の移動体が発した信号を認識する装置、稼動領域に設置された信号機を認識する装置、環境認識手段で検出される障害物の予め設定した距離の中への接近を検出するものなどを用いることができる。 As the stop start signal detecting means, in addition to detecting the disaster prevention information received via the communication means as the stop start signal, a plurality of contact type sensors attached, and the detected sound level pattern is compatible with the pre-registered pattern. Sensors that output the sound, a device that recognizes a signal emitted by another moving body, a device that recognizes a traffic light installed in the operation area, a predetermined distance of an obstacle detected by the environment recognition device What detects the approach to the inside can be used.
また、走行制御手段は、停留開始時、進行方向に障害物がない場合は前方の停留可能領域に、進行方向に障害物がある場合は後方の停留領域に向かわせるものとしたり、信号検出領域を前後両方に備えて、停留開始時に信号検出のない方向の停留領域に向かわせるものを用いることができる。 In addition, the travel control means, at the start of the stop, if there are no obstacles in the direction of travel, the travel control means may be directed to the front stop area, and if there are obstacles in the direction of travel, the travel control means may be directed to the rear stop area. Can be used for both the front and rear sides, and to be directed to a stop area in a direction where no signal is detected at the start of the stop.
音声源の位置を認識する装置を備えて、停留開始時に音声源と反対方向の停留可能領域に向かわせるものであってもよい。 A device for recognizing the position of the sound source may be provided, and the sound source may be directed to a stoppable area in the opposite direction to the sound source when the stop is started.
また、走行制御手段には、環境認識手段として備えている水平面内をスキャンするレンジファインダデータの2次元時系列データから他の移動体の通過を判断して停留動作を終了させるものを好適に用いることができる。 Further, as the travel control means, one that determines the passage of another moving body from the two-dimensional time series data of the range finder data that scans the horizontal plane provided as the environment recognition means and terminates the stopping operation is preferably used. be able to.
停留動作中を表示する表示手段を備えたものとするのも好ましい。 It is also preferable to provide display means for displaying the stopping operation.
さらに本発明に係る自律移動装置運用システムは、稼動領域の地図と走行用の各種パラメータを記憶するための記憶手段と、目的地や操作指令の入力のためのインターフェースと、目的地までの経路を生成する経路生成手段と、障害物や自己位置を認識するための環境認識手段と、走行を行うための走行手段とを備えるとともに、環境認識手段で得られた情報を元に上記地図上で自己の位置を認識し且つ障害物を回避しながら目的地まで走行手段を制御する走行制御手段と、通信回線に接続するための通信手段とを備え、他の移動体を回避するための停留開始信号を検出する停留開始信号検出手段を有するとともに上記走行制御手段が停留開始信号検出手段で停留開始信号を検出した場合に記憶手段に予め記憶させた他の移動体の回避用の停留領域に停留させる自律移動装置と、上記自律移動装置の稼動領域の地図と上記自律移動装置が進入できる領域と他の移動体の回避用の停留領域とを入力する手段と、通信回線に接続する手段とを有して、通信回線を経由して自律移動装置から送られてくる自律移動装置の位置情報とシステム外から取得した情報とを元に自律移動装置の運用を行う管理装置とからなることに特徴を有している。自律移動装置の動作を遠隔で監視でき、また自律移動装置の記憶手段に記憶した内容を管理装置で管理できて複数の自律移動装置を使用する場合にも記憶データの共有が可能となる。 Furthermore, the autonomous mobile device operation system according to the present invention includes a storage means for storing a map of an operation area and various parameters for traveling, an interface for inputting a destination and an operation command, and a route to the destination. A route generating means for generating, an environment recognizing means for recognizing obstacles and self-location, and a traveling means for running, and on the map based on the information obtained by the environment recognizing means. A stop control signal for avoiding other moving objects, comprising travel control means for recognizing the position of the vehicle and controlling the travel means to the destination while avoiding obstacles, and communication means for connecting to the communication line And a stop start signal detecting means for detecting other stop moving objects stored in advance in the storage means when the travel control means detects a stop start signal with the stop start signal detecting means. An autonomous mobile device to be stopped in the area, a map of an operation area of the autonomous mobile device, a region for the autonomous mobile device to enter, and a stop area for avoiding other mobile objects are connected to the communication line. And a management device that operates the autonomous mobile device based on the position information of the autonomous mobile device sent from the autonomous mobile device via the communication line and the information acquired from outside the system. It has a special feature. The operation of the autonomous mobile device can be monitored remotely, the content stored in the storage means of the autonomous mobile device can be managed by the management device, and the stored data can be shared even when a plurality of autonomous mobile devices are used.
自律移動装置の稼動領域の地図と上記自律移動装置が進入できる領域と他の移動体の回避用の停留領域とは、複数のエリアに分けて入力記憶しておくのが好ましい。そして自律移動装置はエリアをまたがる移動時に管理装置から必要エリアの地図や進入可能領域、停留領域の情報を取得するものであることが好ましい。 The map of the operation area of the autonomous mobile device, the area where the autonomous mobile device can enter, and the stop area for avoiding other moving objects are preferably input and stored in a plurality of areas. And it is preferable that an autonomous mobile apparatus acquires the information of the map of a required area, the approachable area | region, and a stop area | region from a management apparatus at the time of the movement which crosses an area.
自律移動装置側で変更された地図や領域の情報で管理装置側の情報が更新されるものであってもよい。 The information on the management device side may be updated with the map or area information changed on the autonomous mobile device side.
請求項1の発明に係る自律移動装置においては、稼動領域の地図と走行用各種パラメータを記憶するための記憶手段と、目的地や操作指令の入力のためのインターフェースと、目的地までの経路を生成する経路生成手段と、障害物や自己位置を認識するための環境認識手段と、走行を行うための走行手段とを備えるとともに、環境認識手段で得られた情報を元に上記地図上で自己の位置を認識し且つ障害物を回避しながら目的地まで走行手段を制御する走行制御手段を備えている自律移動装置であって、他の移動体を回避するための停留開始信号を検出する停留開始信号検出手段を有して、走行制御手段は停留開始信号検出手段で停留開始信号を検出した場合に記憶手段に予め記憶させた他の移動体の回避用の停留領域に停留させるものであるために、自律移動装置を通路の適当な場所に停止させて他の移動体に通路を譲ることができるものであり、このために安全性や使い勝手が向上する。また、停留開始信号検出手段が信号検出領域を両サイドに備え、走行制御手段が停留開始時に信号検出のない方向の停留領域に向かわせるものであるために、待避させたい方向を指示することができる。
また請求項2の発明は、停留開始信号検出手段を、各サイドの前方と後方に備えたものであるために、自律移動装置が進行方向に進んで停留領域に向かうのか、方向を変えて停留領域に向かうのかを指示することができる。
In the autonomous mobile device according to the invention of
Further, since the invention of
また請求項3の発明では、走行制御手段が、停留領域中の自己位置からの距離と進路変更に要する回転量の二つを考慮して停留位置を決定するものであるために、停留までの時間を短くすることができるとともに滑らかな動作が可能となる。
In the invention of
また請求項4の発明は、走行制御手段が、停留領域をレベル分けして自己位置からの距離と上記レベルとから停留位置を定めて停留動作に移行するものであるために、設定した安全度合いと距離とを考慮して適切な停留位置を決めることができる。
In the invention of
また、走行制御手段が、進行方向に決まった距離だけ前進してから、停留位置に向かわせるものであれば、一旦停止しなくても、停留動作が可能となる。 Further, if the traveling control means moves forward by a predetermined distance in the traveling direction and then moves toward the stopping position, the stopping operation can be performed without stopping once.
また、走行制御手段が、進行方向に速度に応じた距離だけ前進してから、停留位置に向かわせるものであれば、急停止せず滑らかに停留動作に移ることができる。 Further, if the traveling control means moves forward in the traveling direction by a distance corresponding to the speed and then moves toward the stop position, the stop control can be smoothly performed without sudden stop.
また、走行制御手段が、停留領域内で停留位置設定方法は停留領域内で壁に沿って定めた所定距離内を停留位置とするものであれば、自律移動装置が上から見て円形でない場合に壁により近くまで接近させた状態で停留させることができる。 In addition, if the traveling control means is a stop position setting method within the stop area and the stop position is set within a predetermined distance along the wall in the stop area, the autonomous mobile device is not circular when viewed from above. It can be stopped in a state where it is closer to the wall.
また、停留開始信号検出手段が通信手段を介して受信する防災情報を停留開始信号として検出するものであれば、避難する人の邪魔になることがないものであり、防災時の防火扉に挟まれることがないようにすることもできる。 Also, if the stop start signal detection means detects the disaster prevention information received via the communication means as a stop start signal, it will not interfere with the evacuation person, and will be sandwiched between fire prevention doors during disaster prevention. You can also prevent it from happening.
または、停留開始信号検出手段が複数取り付けられた接触式のセンサであれば、確実に信号が検出でき且つ停留すべき方向を指示することができる。 Or if it is a contact-type sensor in which a plurality of stop start signal detecting means are attached, it is possible to reliably detect a signal and to indicate the direction to stop.
また、停留開始信号検出手段が検出した音声レベルのパターンが予め登録したパターンと適合したかを出力するセンサであれば、非接触で信号を検出することができる。 In addition, a signal can be detected in a non-contact manner as long as it is a sensor that outputs whether or not the voice level pattern detected by the stop start signal detecting means matches a previously registered pattern.
また、停留開始信号検出手段が音声認識手段であれば、やはり非接触で信号を検出することができる。 If the stop start signal detecting means is a voice recognition means, the signal can be detected without contact.
また、停留開始信号検出手段が、他の移動体が発した信号を認識する装置である場合には、道を譲る対象が近づく前に停留のための行動を開始することができる。 In addition, when the stop start signal detecting means is a device that recognizes a signal emitted by another moving body, it is possible to start an action for stopping before a target to give way approaches.
また、停留開始信号検出手段が、稼動領域に設置された信号機を認識する装置である場合には、道を護る対象が近づく前に停留のための行動を開始することができるとともに、道を譲る対象が見通せない時にも停留動作に移行させることができる。 In addition, when the stop start signal detecting means is a device that recognizes a traffic light installed in the operation area, it is possible to start an action for stopping before the object to protect the road approaches, and to give way. Even when the subject cannot be seen, it is possible to shift to the stopping operation.
また、停留開始信号検出手段が環境認識手段で検出される障害物の予め設定した距離の中への接近を検出するものであれば、道を譲る対象がアクションを取る前に自動的に停留のための行動を開始することができるほか、専用の停留開始信号検出手段を別に必要としなくなる。 In addition, if the stop start signal detection means detects the approach of the obstacle detected by the environment recognition means within a preset distance, the target to give way automatically stops before taking action. In addition to the need for a separate stop start signal detection means.
また、走行制御手段が、停留開始時、進行方向に障害物がない場合は前方の停留可能領域に、進行方向に障害物がある場合は後方の停留領域に向かわせるものであれば、停留のための進行方向を選択することができる。 In addition, if the traveling control means starts at the stop, if there are no obstacles in the direction of travel, the travel control means is directed to the forward stop area, and if there are obstacles in the travel direction, it is directed to the rear stop area. The direction of travel can be selected.
また、音声源の位置を認識する装置を備えて、走行制御手段が停留開始時に音声源と反対方向の停留可能領域に向かわせるものである場合も、人に道を譲る際に人の邪魔にならない方向に移動するものとなる。 Also, when the travel control means is provided with a device for recognizing the position of the sound source and the traveling control means is directed to a stoppable area in the opposite direction to the sound source at the start of the stop, it may disturb the person when giving way to the person. It will move in the direction that will not be.
また、走行制御手段が、環境認識手段として備えている水平面内をスキャンするレンジファインダデータの2次元時系列データから他の移動体の通過を判断して停留動作を終了させるものであれば、停留時間が常に適切なものとなる。 In addition, if the traveling control means determines the passage of another moving body from the two-dimensional time series data of the range finder data that scans the horizontal plane provided as the environment recognition means, and terminates the stopping operation, Time will always be appropriate.
また、停留動作中を表示する表示手段を備えている場合には、自律移動装置の動作が周囲にいる人にわかり、安心できるものとなる。 In addition, when a display means for displaying the stopping operation is provided, the operation of the autonomous mobile device can be recognized by the people around and can be relieved.
以下本発明に係る自律移動装置を実施の形態の一例に基づいて詳述すると、図1に示すように、稼動領域の地図と走行用の各種パラメータを記憶するための記憶手段11と、目的地や操作指令の入力のためのインターフェース12と、目的地までの経路を生成する経路生成手段13と、障害物や自己位置を認識するための環境認識手段14と、走行を行うための走行手段10と、走行手段10を制御する走行制御手段15と、停留開始信号検出手段16とを備えたものとなっている。図中17は電源としての電池である。
An autonomous mobile device according to the present invention will be described in detail below based on an example of an embodiment. As shown in FIG. 1, a storage means 11 for storing a map of an operation area and various parameters for traveling, a destination And
上記走行制御手段15は、通常時、環境認識手段14で得られた情報を元に上記地図上で自己の位置を認識するとともに環境認識手段14で検出された障害物を回避しながら目的地まで走行手段10を制御する。 The traveling control means 15 normally recognizes its position on the map based on the information obtained by the environment recognition means 14 and avoids obstacles detected by the environment recognition means 14 until reaching the destination. The traveling means 10 is controlled.
ここにおいて、上記記憶手段11には稼動領域の地図と走行用の各種パラメータのほかに、他の移動体の回避用の領域として予め設定した停留領域を記憶させてある。そして、上記停留開始信号検出手段16によって停留開始信号が検出された時、走行制御手段15は記憶手段11に記憶させた停留領域の中で最寄りのところに自律移動装置を移動させてそこで停止させ、停留状態に入る。 Here, in addition to the operating area map and various parameters for travel, the storage means 11 stores a stop area set in advance as an area for avoiding other moving objects. When the stop start signal is detected by the stop start signal detecting means 16, the traveling control means 15 moves the autonomous mobile device to the nearest place in the stop area stored in the storage means 11 and stops it there. Enter the stop state.
今、図2(a)に示すように、両側の壁に沿って停留領域Sを設定した稼働領域M内を自律移動装置1が移動している時、停留開始信号検出手段16で停留開始信号を検出すると、図2(b)に示すように、走行制御手段15が走行手段10を制御して停留領域Sに向かう停留動作を開始させ、図2(c)に示すように停留領域Sに自律移動装置1が到達すれば、その位置において停止して留まる。停留後は、例えば、走行制御手段15のCPUで一定時間を計測するなどして、自動的に停留開始信号検出手段16で信号を検出した時に行っていた仕事に復帰する。
As shown in FIG. 2 (a), when the autonomous
自律移動装置1のプログラム上では、図3に示すように、自律移動装置1が稼動領域Mに固定された座標(x1,y1)上で、最終目的地(xd,yd)に向う場合、経路生成手段13によって生成された幾つかの地点(xi,yi) [1=<i<d〕を経由して行く最終目的地最終目的地(xd,yd)までの経路を移動して地点(xm-1,ym-1)にいる時、または地点(xm-1,ym-1)と地点(xm,ym)との間にいる時に、停留開始信号検出手段16で停留開始信号が検出されると、走行制御手段15は図3(b)に示すように地点(xm-1,ym-1)から選択された停留領域Sの停留地点(xed,yed)までの停留のための経路SPを生成する。図中の(xem,yem)は経路SP上の経由地点の座標である。そして、走行制御手段15は現在向かっている経由地点(xm,ym)を上記停留のための経路SP上の経由地点または停留位置の座標に置き換える。そして停留終了後、もとの経由地点(xm,ym)の地点に向かう。もちろん、停留終了後に停留位置(xed,yed)から目的地(xd,yd)に直接向かう新たな経路を生成してもよい。その間に人や台車などは、「追い抜き」や「すれ違い」ができる。なお、走行制御手段15で停留のための経路を生成しているが、この機能は経路生成手段13に持たせてもよい。いずれにしても、このように通路の適当な場所に予め設定した停留領域Sで停止させて他の移動体に通路を譲ることで、安全性や使い勝手が向上する。
On the program of the autonomous
停留領域Sは図4(a)に示すように、直線として定義する場合、その表現が簡単になるとともに、より狭い場所での設定が可能となる。この場合、各停留領域は絶対座標上で、始点(xn0,yn0)と終点(xn1,yn1)で表せばよい。nは領域の番号とする、そして停留を行う際には、自律移動装置1に記憶されている地図の座標系で予め設定された停留領域Sの始点終点の座標を自律移動装置1を原点にその進行方向をX軸とする座標に変換する。上記座標が始点(xrn0,yrn0)と終点(xrn1,yrn1)となるとすると、この始点と終点の座標で表される線分まで原点から直交する直線を引ける場合は、その交点と原点との距離を領域nまでの距離とする。
When the stop area S is defined as a straight line as shown in FIG. 4A, the expression is simplified and the setting can be made in a narrower place. In this case, each stop area may be represented by a start point (xn0, yn0) and an end point (xn1, yn1) on absolute coordinates. n is the number of the area, and when stopping, the coordinates of the start point and end point of the stopping area S set in advance in the coordinate system of the map stored in the autonomous
直交するかどうかは、例えば、始点から終点のベクトルと始点から原点までのベクトルとの内積及び終点から始点のベクトルと終点から原点までのベクトルとの内積から判断することができる。上記の二つの内積がともに正の時は直交する直線を引くことができる。そして直交する線分と領域を示す線分との交点が求まれば距離も求めることができる。それ以外の場合には、原点と始点の距離、原点と終点との距離のうち、短い方を領域nまでの距離とすればよい。そして、上記停留領域Sのうち、最短距離にある停留領域Sを選択し、その領域に向かえばよい。 Whether or not they are orthogonal can be determined from, for example, the inner product of the vector from the start point to the end point and the vector from the start point to the origin, and the inner product of the vector from the end point to the start point and the vector from the end point to the origin. When the above two inner products are both positive, an orthogonal straight line can be drawn. If the intersection of the orthogonal line segment and the line segment indicating the region is obtained, the distance can also be obtained. In other cases, the shorter one of the distance between the origin and the start point and the distance between the origin and the end point may be set as the distance to the region n. And the stop area S in the shortest distance among the stop areas S may be selected and directed to that area.
図5(a)に示した状態の場合、原点(自律移動装置1の位置)からは、領域nと原点からの垂線との交点が一番近いことからその位置に向かう。また、ここでは進行方向と停留領域Sは並行であるが、並行でない場合も同様の計算で求めることができる。 In the state shown in FIG. 5A, from the origin (position of the autonomous mobile device 1), the intersection point between the region n and the perpendicular from the origin is closest to that position. Here, the traveling direction and the stop area S are parallel to each other, but even when they are not parallel, they can be obtained by the same calculation.
停留領域Sを選択する際に、停留領域Sまでの距離dと、その距離を与える停留領域S上の座標に向かう為に変更しなければならない角度Θ(図5(b)参照)とを考慮して、d+α・Θを各停留領域Sについて求め、この評価式が最小となる停留領域Sに停留させることにすれば、進路変更に必要な時間を短縮することができる。なお、αは予め定めて記憶手段11に記憶させた重み係数であって、一定値であってもΘの値によって値の変わる関数であってもよい。 When selecting the stop area S, consider the distance d to the stop area S and the angle Θ (see FIG. 5 (b)) that must be changed to go to the coordinates on the stop area S that give that distance. Then, if d + α · Θ is obtained for each stop region S and is stopped in the stop region S where the evaluation formula is minimized, the time required for the course change can be shortened. Α is a weighting factor that is determined in advance and stored in the storage unit 11 and may be a constant value or a function that changes depending on the value of Θ.
停留領域Sに予めレベルを設定しておけば、より安全性や使い勝手が向上する。つまり、図6に示すように、各停留領域Sにレベル付けを行っておく。このレベルとしては、たとえば0より大きく1以下の値とし、1>=レベル1>レベル2>0とする。そして停留領域Sの選択に際し、
停留領域までの距離/レベルの小ささで評価するのである。この場合、自律移動装置1の位置がレベル2の停留領域Sに近くても、レベル1に設定された停留領域Sに停留する場合が増加する。このことは、柱等の凹凸のある方の停留領域Sのレベルを大きくしておくことにより、幅のある他の移動体が通過しやすくなることを意味する。ただし、レベル2の停留領域Sが非常に近い場合には、停留までの時間を優先してレベル2の停留領域Sに停留するようにしてもよい。なお、上記評価式は一例であって、レベルによる重みや評価式自体も様々なものを使用することができる。
If a level is set in advance in the stop area S, safety and usability are further improved. That is, as shown in FIG. 6, leveling is performed on each stop region S. As this level, for example, a value greater than 0 and less than or equal to 1 is set such that 1> =
Evaluation is based on the small distance / level to the stop area. In this case, even if the position of the autonomous
このほか、停留領域Sの選択のための計算に要する時間を考慮して、図7に示すように、停留開始信号を検出した地点よりも予め設定した距離xdだけ前進したところから停留領域Sに向かう動作を開始させると、一旦停止させなくても停留動作に移行させることができる。つまり、図5(a)では原点から停留領域Sまでの計算をしたが、座標(xd,0)から各停留領域Sまでの距離を計算して停留位置を決定するのである。従ってこの場合の停留動作は地点(xd,0)を経由して停留位置へ向かうことになる。 In addition, in consideration of the time required for calculation for selecting the stop area S, as shown in FIG. 7, the stop area S is moved from a position advanced by a preset distance xd from the point where the stop start signal is detected. When the heading operation is started, it is possible to shift to the stopping operation without stopping once. That is, in FIG. 5A, the calculation from the origin to the stop area S is performed, but the stop position is determined by calculating the distance from the coordinates (xd, 0) to each stop area S. Therefore, the stopping operation in this case goes to the stopping position via the point (xd, 0).
また上記xdは予め定めた値とするのではなく、速度の関数としてもよい。例えば、最大速度をVmax、停留動作の計算に必要な時間をTeとすると、Xmax>Vmax・TeとなるXmaxを予め設定しておき、自律移動装置1の速度Vによってxd=Xmax(V/Vmax)として、Xdを決定するのである。速度Vが0の場合はxd=0となる。このようにすることで、停留位置が決まってから停留動作開始までの時間を短縮することができる。 Further, the above xd may not be a predetermined value but may be a function of speed. For example, assuming that the maximum speed is Vmax and the time required for calculation of the stationary operation is Te, Xmax satisfying Xmax> Vmax · Te is set in advance, and xd = Xmax (V / Vmax) depending on the speed V of the autonomous mobile device 1. ) To determine Xd. When the speed V is 0, xd = 0. In this way, the time from when the stop position is determined until the stop operation is started can be shortened.
また、このように中継点(xd,0)を経て停留位置Ssに向かう時、図8に示すように、中継点(xd,0)の前後に補間ポイントHpを置いて、経路をスムージングするとさらに滑らかで高速な停留動作が可能となる。 Further, when moving toward the stop position Ss via the relay point (xd, 0) in this way, as shown in FIG. 8, the interpolation point Hp is placed before and after the relay point (xd, 0) to further smooth the route. Smooth and fast stopping operation is possible.
また、図9に示すように、停留位置Ss到達後に停留領域S内で停留後の動作方向へ予め定めた距離(その距離が移動できない場合は、移動できる最大量)だけ移動させることで、自律移動装置1をまっすぐ進行方向に向けることができ、この結果、通路を広く開けることができる。これは特に自律移動装置1が幅方向よりも進行方向の長さが長い場合に有効である。停留終了後の動作再開の時間も短縮することができる。
Further, as shown in FIG. 9, after reaching the stop position Ss, it is moved autonomously by moving a predetermined distance in the stop region S in the operation direction after the stop (the maximum amount that can be moved if the distance cannot be moved). The moving
停留領域Sは上述のようにラインで定義するほか、図4(b)に示すように多角形(特に四角形)として定義してもよい。ただし、ここで言う多角形は、その角に多少の丸みを有するものも含むものとする。この場合、図10(a)に示すように、ラインLの始点(xrn0,yrn0)と終点(xrn1,yrn1)と幅Wで定義する。領域選択は幅Wのある領域Sの通路側のラインLで行うものとする。このようにすると、図10(b)に示すように、障害物9が停留場所付近にあったとしても、障害物9を回避をしながら移動していくことで停留領域Sに入ることができる。また、この場合は、当初の停留位置Ssでなくとも、前記ラインLからの距離が前記幅Wよりも短い場合は、その位置を停留位置として停止させてもよい。
The stationary region S may be defined as a polygon (particularly a quadrangle) as shown in FIG. However, the polygons referred to here include those having some roundness at the corners. In this case, as shown in FIG. 10A, the line L is defined by the start point (xrn0, yrn0), the end point (xrn1, yrn1), and the width W. The region selection is performed on the line L on the passage side of the region S having the width W. If it does in this way, as shown in FIG.10 (b), even if the
次に停留開始信号検出手段16について説明すると、この停留開始信号検出手段16としては、図11に示すように、自律移動装置1に取り付けた接触式のセンサ16を用いることができる。この場合、すれ違いたい人が自律移動装置1のセンサ16に触れることで、自律移動装置1に停留動作を指示することができる。また、センサ16を複数取り付ければ、自律移動装置1に待避させいたい方向を指示することができる。図12(a)(b)(c)は、自律移動装置1の後ろから人が近づいて自律移動装置1を追い抜きたい時、上記接触式センサ16に触れることで自律移動装置1を停留領域Sに向かわせている。そして接触式センサ16を自律移動装置1の両サイドに取リ付けて、例えば左サイドの接触式センサ16に接触すれば、自律移動装置1が右方向の停留領域に向かうようにしておくと、自律移動装置1の停留のための向きの変更方向を人が判断し損ねてしまうということがない。
Next, the stop start signal detecting means 16 will be described. As the stop start signal detecting means 16, a contact-
また、自律移動装置1の各サイドの前方と後方に接触式センサ16を配置しておけば、1の前方から人がきた場合、人を障害物として回避するが、この時、図12(d)(e)(f)に示すように、片側の接触式センサ16に人が触れることで、自律移動装置1は所定の方向に向きを変えて停留領域Sに向かうものとなる。つまり、自律移動装置1が進行方向に進んで停留領域に向かうのか、方向を変えて停留領域Sに向かうのかを指示することができる。
If the
停留開始信号検出手段16としては、ある強度以上の音声があったかどうかを連続的に収集し、その音声有無波形から予め登録した音声有無パターンと適合した部分があると検出信号を出力するセンサ用いるようにしてもよい。この場合、非接触で停留を指示することができる。 The stop start signal detecting means 16 is a sensor that continuously collects whether or not there is a sound of a certain intensity or more and outputs a detection signal when there is a portion that matches a pre-registered sound presence / absence pattern from the sound presence / absence waveform. It may be. In this case, the stop can be instructed without contact.
予め停留動作を行うための言葉(複数でも可)をきめておき、その言葉、たとえば「どいて」という言葉の音声有無パターンVpを予めそのセンサ内に記憶させておく。上記音声有無パターンVpは、図13(a)に示すように、あるサンプリング周期tでのn個のデータ[f(i):0=<i<nの整数]であらわされる。そして連続して収集している音声有無波形[g(k):0=<k<mの整数でm>n](図13(b)参照)から、予め記憶したパターンVpと合う部分を探索する。例えば、g(k)のk=l(ただし、0=<l=<m−n)からn個とf(i)との相関をとり、ある閾値以上になるとセンサから検出信号を出すのである。この検出信号により、走行制御手段15は停留動作を開始する。 A word (or a plurality of words) for performing the stopping operation is determined in advance, and a voice presence / absence pattern Vp of the word, for example, “DOI” is stored in the sensor in advance. The voice presence / absence pattern Vp is represented by n pieces of data [f (i): 0 = <an integer of i <n] in a certain sampling period t, as shown in FIG. Then, a portion that matches the prestored pattern Vp is searched from the voice presence / absence waveforms [g (k): 0 = <k <m is an integer m> n] (see FIG. 13B). To do. For example, a correlation between n and f (i) is obtained from k = l (where 0 = <l = <mn) of g (k), and a detection signal is output from the sensor when a certain threshold value is exceeded. . In response to this detection signal, the traveling control means 15 starts a stopping operation.
音声の有無だけではなく、音声レベルパターンで認識しても良い。たとえば音声レベルパターンを記憶する記憶部と、収集した音声レベル波形から予め記憶した音声レベルパターンと合う部分を検索する検索手段とを停留開始信号検出手段16に設けておき、停留開始信号検出手段16が音声レベルを連続的に収集してその音声レベル波形から予め登録したパターンと適合した部分があると検出信号を出力するようにしておくと、予め記憶させておく音声レベルパターンに応じて、認識すべき音声パターン(言葉)を詳細に指定することができる。まず、停留動作を行うための言葉(複数でも可)をきめておき、この言葉(例えば「どいて」の音声のパターンVpを予めそのセンサ内に記憶させておく。この言葉は、図14(a)に示すように、あるサンプリング周期tでのn個のデータ[f(i):0=<i<nの整数]であらわすことができる。そして連続して収集している音声レベル波形[g(k):0=<k<mの整数でm>n](図14(b)参照)から、予め記憶したパターンVpと合う部分を探索する。例えば、g(k)のk=l(ただし、0=<l<m−n)からn個とf(i)との相関をとり、ある閾値以上になるとセンサから停留開始検出信号を出すのである。
You may recognize not only with the presence or absence of a sound but with a sound level pattern. For example, a storage start
停留開始信号検出手段16は、他の移動体が備えている装置が発する信号を認識する装置であってもよい。この場合、非接触で確実に信号を検出することができる。例えば、自律移動装置1に対して停留を要求する可能性のある台車等に、赤外線を発光する装置を付けておく。常時発光しているものでも、自律移動装置1を停留させたいときだけ操作に応じて発光するものであってもよい。そして自律移動装置1に上記赤外線を受光するセンサを停留開始信号検出手段16として設置するのである。
The stop start signal detecting means 16 may be a device that recognizes a signal emitted by a device provided in another moving body. In this case, the signal can be reliably detected without contact. For example, a device that emits infrared light is attached to a cart that may request the autonomous
停留開始信号検出手段16で検出する信号は、自律移動装置1の稼動領域の壁や天井などに取リ付けられた装置から発するようにしてもよい。この場合、停留を要求する台車等が自律移動装置1から見えないところに位置する時にも自律移動装置1に停留動作を開始させることができ、効率の良い停留動作を実現することができる。例えば図15のようにコーナー部分に自律移動装置1が通路を譲るべき対象を認識するとともに自律移動装置1へ前記対象が接近していることを知らせるための信号を発する装置8を設置する。上記対象の認識は、カメラで収集した画像を処理することで行うものや、前記対象に取り付けられた装置から発せられる信号を検知することで行うものを用いることができる。そして上記対象を検知したならば、自律移動装置1に対する信号を発して、これを自律移動装置1の停留開始信号検出手段16が検出することにより、見通し位置にない対象を自律移動装置1は検出して早期に停留動作に入ることができる。上記装置8が発生する信号を赤外線とすれば、自律移動装置1の停留開始信号検出手段16は赤外線検出センサで構成すればよい。
The signal detected by the stop start signal detection means 16 may be emitted from a device attached to the wall or ceiling of the operation area of the autonomous
停留開始信号検出手段16は、自律移動装置1に取り付けられた障害物検出機能を有する環境認識手段16を利用してもよい。特に障害物検出のために図16に示すように2次元水平面の領域SCをスキャンして障害物までの距離を測定するレーザー装置を用いている場合、精度良く障害物の位置を認識することができる。従って、図17に示すように、自律移動装置1と現在向かっている地点7との間に障害物9があり且つその障害物9が接近してくる場合は障害物回避ではなく停留動作を行うのである。自律移動装置1が速度vで移動している時にレーダー装置で検出があるととともに、その障害物9が上記地点7との間にあって距離がr1であることがわかったとし、Δt時間後の測定でも上記地点7との間に障害物がありその距離がr2であった時、r2<r1−v・Δtの関係があれば、自律移動装置1は障害物9が移動体であって接近してきていると判断して停留動作に入るのである。
The stop start signal detection means 16 may use the environment recognition means 16 having an obstacle detection function attached to the autonomous
また、非接触型の停留開始信号検出手段16で移動体の検出があり且つ障害物検出手段(環境認識手段14)で進行方向に障害物の検出がない場合は進行方向側の停留領域Sに、障害物の検出がある場合は後方の停留領域Sに向かうと決めておけば、停留開始信号検出手段16で停留位置の指定ができない場合でも、適切な停留領域Sの選択が可能になる。例えば、停留開始信号検出手段16で停留開始信号の検出があった場合に、図17(a)のようなレーダー装置で現在向かっている地点と自律移動装置1との間に障害物が検出され且つそのときの検出距離が予め記憶手段11に設定した距離より小さければ、上記地点と逆の方向で、そうでなければ上記地点のある方向で停留領域Sを選択するようにしておくのである。
Further, when the moving body is detected by the non-contact type stop start signal detecting means 16 and no obstacle is detected in the traveling direction by the obstacle detecting means (environment recognition means 14), the stop area S on the traveling direction side is displayed. If there is an obstacle detected, if it is decided to go to the rear stop area S, an appropriate stop area S can be selected even if the stop position cannot be specified by the stop start
また、停留開始信号検出手段16がその信号検出領域を自律移動装置1の前方と後方との二つを区別できるものである場合には、検出があった時、検出がなかった方向の停留領域Sに向かうことにすれば、停留領域Sの選択が簡単ですむ。例えば、停留開始信号検出手段16として音声を検出するものを利用する際に、指向性のあるマイク2つを利用して音声を収集するとともに一つで自律移動装置の前方の音を検出し、他方で後方の音を検出するように配置しておき、音を検出したならば、検出のなかった方向で停留領域Sを選択するのである。停留開始信号検出手段16が自律移動装置1の前部の信号を検出する検出部と後部の信号を検出する検出部との二つの検出部を持つようにすると同様の効果が得られる。
In addition, when the stop start signal detecting means 16 can distinguish the signal detection area between the front and the rear of the autonomous
さらに、音によって停留開始信号検出を行う際には、複数のマイクを利用することによって、音声源の方向を特定し、音声源と反対方向の停留可能領域に向かうことにすれば、より最適な停留領域Sの選択を行うことができる。 Furthermore, when detecting the stop start signal by sound, it is more optimal if the direction of the sound source is specified by using a plurality of microphones and the stop direction is in the direction opposite to the sound source. The stop area S can be selected.
停留開始信号検出手段16として、図18に示すように、無線での通信手段18を備えたものとし、火災等が生じた場合に通信手段18を通じて防災システムから災害の信号をうければ、この信号を停留開始信号として停留動作を行い、再度命令が与えられるまで停留を続けるようにしてもよい。この場合、避難者に対して通路を確保することができる。また停留領域Sは、非常扉の付近を避けて設定しておくことで、自律移動装置1が非常扉に挟まれる虞を減らすことができる。さらに、停留位置に達した時に自律移動装置1側から防災システムヘ信号を送り、防災システムはその信号を受けてから、非常扉の制御を行うようにすれば、自律移動装置1が非常扉に挟まれることがなくなる。なお、通信手段18としては、無線LANやPHSなどを利用するとよい。
As the stop start signal detection means 16, as shown in FIG. 18, it is assumed that a wireless communication means 18 is provided, and if a disaster signal is received from the disaster prevention system through the communication means 18 in the event of a fire or the like, The stop operation may be performed using the signal as a stop start signal, and the stop may be continued until an instruction is given again. In this case, a passage can be secured for the evacuees. Further, by setting the stop area S so as to avoid the vicinity of the emergency door, the possibility that the autonomous
以上、停留開始信号検出手段16として、いくつかの例を示したが、これら以外のものであってもよく、またいくつかの種類のものを併せ持つようにしてもよい。 As described above, some examples of the stop start signal detection means 16 have been shown, but other examples may be used, and some types may be provided.
いったん停留領域Sで停留した後、元の動作に復帰させるのは、前述のような時間制御のほか、環境認識手段14の障害物認識機能を利用して停留解除を決定するようにしてもよい。たとえば、環境認識手段14が2次元水平面をスキャンして障害物9までの距離を測定するレーダー装置を有している場合、自律移動装置1はそのレーダー装置の出力データから道を譲った対象が通過したかどうかを判断し、通過したと判断した時、停留動作を終了すれば、最も適切な時に停留を終了することができる。例えば、後方から来る移動体に通路を譲った場合、レーダー装置のデータは後方からの移動体の通過に伴い、図19(a)から図19(b)、19(c)に示すよう変化する。なお、図中のハッチング部はレーダー装置が障害物(移動体)が無いと判断しているエリアである。従って、一定時間ごとのレーダー装置の複数のデータから、移動体(前記複数のデータで検出距離が異なる物体)が自律移動装置1の後方から前方へと移動(物体までの角度で評価)し、物体までの距離Laが設定した距離以上に大きくなった時、停留動作を終了させるのである。前方から来る移動体についても、同様に前方から後方への移動を観測して停留動作の終了時期を判断することができる。上記物体が通過をやめてしまう場合もあるが、この場合については、予め記憶手段11に記憶してある時間、物体の移動がレーダー装置で観測できない時に、停留動作を終了すればよい。
After stopping in the stop area S, returning to the original operation may be determined by using the obstacle recognition function of the environment recognition means 14 in addition to the time control as described above. . For example, when the environment recognizing means 14 has a radar device that scans a two-dimensional horizontal plane and measures the distance to the
停留動作中にその動作についての表示を行うための表示手段19を自律移動装置1に設けておけば、自律移動装置1が次にどのような動作をするか周囲にいる人が予測することができるものとなる。例えば、図20(a)に示すように自律移動装置1にディスプレイ19が備わっている場合には、このディスプレイ19上に移動方向を矢印で示したりすればよく、図20(b)に示すように自律移動装置1が複数のランプ19を備えている場合には、移動する方向のランプ19を点灯(点滅)させるとよい。
If the autonomous
次に上記の自律移動装置1のための運用システムについて説明すると、この運用システムは図21に示すように1台もしくは複数台の自律移動装置1と、自律移動装置1の運用を管理する管理装置2とからなる。図中3は管理装置2に通信回線を介して接続されて、自律移動装置1の稼動領域の地図、自律移動装置1が進入できる領域、他の移動体を回避するための停留領域等の入力や修正、ならびに自律移動装置1の位置や状態を確認する手段として機能させるユーザ端末である。
Next, the operation system for the autonomous
上記管理装置2は、ユーザ端末3を通じて入力修正された上記情報を記憶する記憶手段20を備えるとともに、ユーザ端末3や自律移動装置1との間で有線あるいは無線で上記情報のやり取りをするためのインターフェース21を備えたものであり、エレベータ管理システムや防災システム等にも接続されている。
The
また、ここで用いる自律移動装置1は、管理装置2との間で上記情報や環境情報、各自律移動装置1に個別に付されたID情報、位置情報等をやり取りするための通信手段を備えている。
In addition, the autonomous
そして上記管理装置2は、通信回線を経由して各自律移動装置1から送られてくる自律移動装置1の位置情報と、本システム外から送られてくる情報とを元に自律移動装置1の運用を行うことで、自律移動装置1を病院等のビルの中での搬送や案内、清掃などの作業に従事させる。
Then, the
例えば自律移動装置1が操作されて稼動する時、管理装置2と通信を確立し、付されたID情報と位置・目的地及び状態(移動中、停留中、移動不能など)を予め定めて記憶手段11に記憶してある周期で通信手段を介して管理装置2に送りながら走行を行い、目的地に着くと通信を終了する。従って管理装置2は自律移動装置1の状況がわかり、また通信回線に接続した他のユーザ端末3からも管理装置2を介して自律移動装置の状況を把握することができる。また、ユーザ端末3から自律移動装置1を操作することも可能であり、他のエレベータや防災システムとの連動も可能となる。自律移動装置1の動作を遠隔で監視できるものであり、また自律移動装置1の記憶手段13に記憶した内容を管理装置2で管理できるとともに複数の自律移動装置1を使用する場合に記憶データの共有が可能となるものである。
For example, when the autonomous
そして、自律移動装置1及び管理装置2に記憶する稼動する領域の地図、自律移動装置が進入できる領域、他の移動体を回避するために停留できる領域を複数のエリアに分けて入力記憶させておくと、大量のデータを分割して管理することができ、データの修正追加が容易となる。例えば、図22に示すように、あるブロックで分けたり、複数の階を走行する場合に階別に分けてエリアA,Bを設定し、各エリアA,B毎に部屋の位置座標、壁を表す線分や停留領域Sを表す線分の始点、終点の座標を記憶しておく。また、各自律移動装置1は、異なるエリアへの移動に際して、管理装置2から異なるエリアの地図や進入可能領域、停留領域の情報をダウンロードして、それまでのエリアの地図や進入可能領域、停留領域の情報に代えて記憶手段11に記憶するものとする。
And the map of the active area memorize | stored in the autonomous
今、自律移動装置1にエリアA,Bを跨ぐ移動の指示、たとえば図22に示すように、エリアAのRoomA2からエリアBのRoomB4への移動指示があった時、自律移動装置1における経路生成手段13はまずRoomA2からエリアA,Bの境界地点Pまでの経路を生成してこの経路で移動を開始する。そして、境界地点Pに近づいた時点でエリアBの情報を管理装置1からダウンロードし、P地点からRoomB4までの経路を生成し、境界地点Pに達した時には新たに生成した経路での走行を開始する。自律移動装置1で管理及び処理するデータ量が少なくて済むものである。
When the autonomous
このほか、自律移動装置1で変更修正した地図や領域の情報を管理装置2に反映させるとともに、他の自律移動装置1のデータの修正もなされるようにしておくと、データの修正を1台の自律移動装置1に施せば全ての自律移動装置1に反映させることができて、全自律移動装置1が常に最新の情報で稼動されるものとなる。例えば、あるエリアに在る自律移動装置1で記憶している停留領域Sを削除すると、管理装置2の情報も修正され、また、あるエリアで自律移動装置1が停留領域Sに停留すると、その情報が管理装置2に伝えられ、一時的にその領域を他の自律移動装置1では停留できない領域として、そのエリアにいる他の自律移動装置1の情報が書き換えられるようにしておき、その後、停留していた自律移動装置1が動き出すと再度そのエリアにいる他の自律移動装置1の情報を停留可能に書き換えられるようにしておくのである。
In addition, when the map and area information changed and corrected by the autonomous
1 自律移動装置
2 管理装置
10 走行手段
11 記憶手段
12 インターフェース
13 経路生成手段
14 環境認識手段
15 走行制御手段
16 停留開始信号検出手段
DESCRIPTION OF
Claims (4)
信号検出領域を両サイドに備えて他の移動体を回避するための停留開始信号を検出する停留開始信号検出手段を有して、
走行制御手段は、停留開始信号検出手段で停留開始信号を検出した場合に記憶手段に予め記憶させた他の移動体の回避用の停留領域に停留させるものであって、停留開始時に信号検出のない方向の停留領域に向かわせるものであることを特徴とする自律移動装置。 Storage means for storing operating area maps and various parameters for driving, interface for inputting destinations and operation commands, route generating means for generating routes to destinations, obstacles and self-location Environment recognition means for recognizing and traveling means for running, while recognizing its position on the map and avoiding obstacles based on information obtained by the environment recognition means An autonomous mobile device comprising travel control means for controlling travel means to a destination,
It has a stop start signal detecting means for detecting a stop start signal for avoiding other moving bodies by providing a signal detection region on both sides ,
The travel control means is for stopping the vehicle in a stop area for avoiding another moving body previously stored in the storage means when the stop start signal detecting means detects the stop start signal. An autonomous mobile device characterized by being directed to a stop area in a non-direction.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005070763A JP3931906B2 (en) | 2005-03-14 | 2005-03-14 | Autonomous mobile device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005070763A JP3931906B2 (en) | 2005-03-14 | 2005-03-14 | Autonomous mobile device |
Related Parent Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2001336863A Division JP3675386B2 (en) | 2001-11-01 | 2001-11-01 | Autonomous mobile device and autonomous mobile device operation system |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2005202978A JP2005202978A (en) | 2005-07-28 |
JP3931906B2 true JP3931906B2 (en) | 2007-06-20 |
Family
ID=34824848
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2005070763A Expired - Fee Related JP3931906B2 (en) | 2005-03-14 | 2005-03-14 | Autonomous mobile device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3931906B2 (en) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3931907B2 (en) * | 2005-03-14 | 2007-06-20 | 松下電工株式会社 | Autonomous mobile device |
JP4328819B2 (en) | 2007-11-30 | 2009-09-09 | 本田技研工業株式会社 | Mobile device and control program thereof |
WO2023132080A1 (en) * | 2022-01-07 | 2023-07-13 | 本田技研工業株式会社 | Work vehicle, control device, control method, and system |
CN114779761A (en) * | 2022-03-22 | 2022-07-22 | 广东博智林机器人有限公司 | Mobile robot fault stopping control method, device, equipment and storage medium |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2661023B2 (en) * | 1986-12-16 | 1997-10-08 | 神鋼電機株式会社 | Collision Avoidance Method for Autonomous Unmanned Vehicle System |
JP2885628B2 (en) * | 1993-12-27 | 1999-04-26 | 日本電気株式会社 | Control method of automatic guided vehicle using track |
JPH09330123A (en) * | 1996-06-07 | 1997-12-22 | Mitsubishi Heavy Ind Ltd | Travel control system |
JPH1129205A (en) * | 1997-07-11 | 1999-02-02 | Mitsubishi Electric Corp | Mobile carrying equipment and its control method |
-
2005
- 2005-03-14 JP JP2005070763A patent/JP3931906B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2005202978A (en) | 2005-07-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3675386B2 (en) | Autonomous mobile device and autonomous mobile device operation system | |
US11554488B2 (en) | Robot navigation using 2D and 3D path planning | |
US9020682B2 (en) | Autonomous mobile body | |
US8924068B2 (en) | Autonomous mobile body | |
JP5539596B2 (en) | Autonomous mobile device, autonomous mobile method, and program for autonomous mobile device | |
JP2020509500A (en) | Control method of autonomous mobile robot | |
JP5768273B2 (en) | A robot that predicts a pedestrian's trajectory and determines its avoidance behavior | |
JP6069606B2 (en) | Robot control system and robot control method | |
JPH05257533A (en) | Method and device for sweeping floor surface by moving robot | |
EP3667450B1 (en) | Mobile body and method for control of mobile body | |
JPH09185412A (en) | Autonomous moving device | |
US11642791B2 (en) | Autonomous mobile robot and control program for autonomous mobile robot | |
EP3892426A1 (en) | Autonomously traveling mobile robot and traveling control method therefor | |
JP3931907B2 (en) | Autonomous mobile device | |
US20140297066A1 (en) | Remote control system | |
JP5553220B2 (en) | Moving body | |
JP3931906B2 (en) | Autonomous mobile device | |
JP6638348B2 (en) | Mobile robot system | |
JP2020004182A (en) | Robot, robot control program and robot control method | |
KR20130044859A (en) | Autonomously travelling mobile robot and travel control method and system thereof | |
KR20130045289A (en) | Travel control method of autonomously travelling mobile robot and entrance and exit control system thereof | |
JP3846506B2 (en) | Autonomous mobile device | |
US20220022715A1 (en) | Autonomously traveling mobile robot and traveling control method therefor | |
JP7317436B2 (en) | ROBOT, ROBOT CONTROL PROGRAM AND ROBOT CONTROL METHOD | |
KR20130045291A (en) | Autonomously travelling mobile robot and travel control method therof |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20060801 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20060929 |
|
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: 20070220 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20070305 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100323 Year of fee payment: 3 |
|
S533 | Written request for registration of change of name |
Free format text: JAPANESE INTERMEDIATE CODE: R313533 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100323 Year of fee payment: 3 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100323 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110323 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120323 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120323 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130323 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130323 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140323 Year of fee payment: 7 |
|
LAPS | Cancellation because of no payment of annual fees |