JP3931907B2 - Autonomous mobile device - Google Patents

Autonomous mobile device Download PDF

Info

Publication number
JP3931907B2
JP3931907B2 JP2005071685A JP2005071685A JP3931907B2 JP 3931907 B2 JP3931907 B2 JP 3931907B2 JP 2005071685 A JP2005071685 A JP 2005071685A JP 2005071685 A JP2005071685 A JP 2005071685A JP 3931907 B2 JP3931907 B2 JP 3931907B2
Authority
JP
Japan
Prior art keywords
autonomous mobile
stop
mobile device
area
route
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
Application number
JP2005071685A
Other languages
Japanese (ja)
Other versions
JP2005222560A (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.)
Panasonic Electric Works Co Ltd
Original Assignee
Matsushita Electric Works 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 Matsushita Electric Works Ltd filed Critical Matsushita Electric Works Ltd
Priority to JP2005071685A priority Critical patent/JP3931907B2/en
Publication of JP2005222560A publication Critical patent/JP2005222560A/en
Application granted granted Critical
Publication of JP3931907B2 publication Critical patent/JP3931907B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

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 another moving body such as a person or 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 Technology Research Association Medical and Welfare Equipment Research Institute” 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”.

いずれにしても、基本的には環境認識手段で進行方向に障害物を検出すれば回避を試み、また、回避ができない場合には停止するものとなっている。   In any case, basically, if an obstacle is detected in the traveling direction by the environment recognition means, an attempt is made to avoid it, and if it cannot be avoided, it is stopped.

しかし、これらの自律移動装置は、障害物を回避することはできるものの、他に移動体があった時、その移動体の動きを妨げてしまうことがあった。たとえば、狭い通路で前方から大きな台車が来た場合など、自律移動装置は障害物である台車を回避しようとするが、上手くすれ違うことができず、立ち往生してしまうことがある。   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 invented in view of the above-described conventional problems, and it is an object of the present invention 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 what.

上記課題を解決するために本発明に係る自律移動装置は、稼動領域の地図と走行用の各種パラメータを記憶するための記憶手段と、目的地や操作指令の入力のためのインターフェースと、目的地までの経路を生成する経路生成手段と、障害物や自己位置を認識するための環境認識手段と、走行を行うための走行手段とを備えるとともに、環境認識手段で得られた情報を元に上記地図上で自己の位置を認識し且つ障害物を回避しながら目的地まで走行手段を制御する走行制御手段を備えている自律移動装置であって、他の移動体を回避するための停留開始信号を検出する停留開始信号検出手段を有して、上記走行制御手段は停留開始信号検出手段で停留開始信号を検出した場合に記憶手段に予め記憶させた他の移動体の回避用の停留領域に停留させるものであるとともに、前記停留開始信号を検出した地点から進行方向に所定の距離だけ前進した地点を中継点として該中継点までの移動中に該中継点から上記停留領域までの経路を算出し、上記中継点から上記算出経路に従って停留領域に向かわせるものであることに特徴を有している。通路の適当な場所である停留領域に停止させて他の移動体に通路を譲ることができるものである。 In order to solve the above problems, an autonomous mobile device according to the present invention includes a storage means for storing a map of an operating area and various parameters for traveling, an interface for inputting a destination and an operation command, a destination, A route generating means for generating a route to the vehicle, an environment recognizing means for recognizing an obstacle or a self-position, and a traveling means for traveling, and based on information obtained by the environment recognizing means. An autonomous mobile device having travel control means for recognizing its own position on the map and controlling the travel means to the destination while avoiding obstacles, and a stop start signal for avoiding other moving objects a stopping start signal detecting means for detecting, in the stationary region for avoiding the running control means other mobile body stored in advance in the memory means when detecting the stop initiation signal in stopping the start signal detecting means Stop With those which calculates a route from the relay point point has advanced by a predetermined distance in the traveling direction from the point of detecting the stopping start signal during movement to the relay point as a relay point to the stationary region In this case, the vehicle is directed to the stop area from the relay point according to the calculation route . 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.

しかも停留領域までの経路の算出に時間を要するとしても、停留開始信号を検出した地点から進行方向に所定の距離だけ前進した地点を中継点として該中継点を経由させて停留領域に向かわせるとともに、中継点への移動中に中継点から停留領域までの経路算出を行うために、いったん停止させたりしなくても停留動作を行うことができる。In addition, even if it takes time to calculate the route to the stop area, a point that has advanced a predetermined distance in the direction of travel from the point where the stop start signal is detected is used as a relay point to go to the stop area via the relay point. In order to calculate the route from the relay point to the stop area during movement to the relay point, the stop operation can be performed without stopping.

特に上記所定の距離を、走行速度と停留領域までの経路算出に必要な時間とに基づいて決定する場合、滑らかに停留動作に移ることができる。In particular, when the predetermined distance is determined based on the travel speed and the time required for calculating the route to the stop area, the stop operation can be smoothly performed.

本発明に係る自律移動装置においては、自律移動装置を通路の適当な場所に停止させて他の移動体に通路を譲ることができるものであり、このために安全性や使い勝手が向上する。また、停留開始信号を検出した地点から進行方向に所定の距離だけ前進した地点を中継点として該中継点までの移動中に該中継点から上記停留領域までの経路を算出し、上記中継点から上記算出経路に従って停留領域に向かわせるものであるために、停留領域までの経路算出に要する時間にかかわらず、停止したりすることなく停留領域への移動が可能である。 In the autonomous mobile device according to the present invention, the autonomous mobile device can be stopped at an appropriate place in the passage and the passage can be given to another mobile body, which improves safety and usability. In addition, a route from the relay point to the stop area is calculated while moving to the relay point, using a point that has advanced a predetermined distance in the traveling direction from the point where the stop start signal is detected as a relay point. Since the vehicle travels to the stop area according to the calculation route, it is possible to move to the stop region without stopping regardless of the time required for calculating the route to the stop region.

以下本発明に係る自律移動装置を実施の形態の一例に基づいて詳述すると、図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 interface 12 for inputting operation commands, route generation means 13 for generating a route to the destination, environment recognition means 14 for recognizing obstacles and self-location, and travel means 10 for traveling. And a traveling control means 15 for controlling the traveling means 10 and a stop start signal detecting means 16. In the figure, reference numeral 17 denotes a battery as a power source.

上記走行制御手段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 mobile device 1 is moving in the operation area M where the stop area S is set along the walls on both sides, the stop start signal detecting means 16 stops the stop start signal. 2 (b), the traveling control means 15 controls the traveling means 10 to start the stopping operation toward the stopping area S, and the stopping area S is moved to the stopping area S as shown in FIG. 2 (c). If the autonomous mobile device 1 arrives, it stops and stays at that position. After stopping, for example, the CPU of the traveling control means 15 measures a certain time, and automatically returns to the work that was being performed when the stop start signal detecting means 16 detected the signal.

自律移動装置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 mobile device 1, as shown in FIG. 3, when the autonomous mobile device 1 goes to the final destination (xd, yd) on the coordinates (x1, y1) fixed to the operation area M, the route The route to the final destination final destination (xd, yd) going through several points (xi, yi) [1 = <i <d] generated by the generation means 13 is moved to the point (xm −1, ym−1), or between the point (xm−1, ym−1) and the point (xm, ym), the stop start signal detecting means 16 detects the stop start signal. As shown in FIG. 3 (b), the traveling control means 15 sets a route SP for stopping from the point (xm-1, ym-1) to the stop point (xed, yed) of the selected stop region S. Generate. In the figure, (xem, ym) is the coordinates of a transit point on the route SP. Then, the traveling control means 15 replaces the waypoint (xm, ym) that is currently heading with the coordinates of the waypoint or the stop position on the route SP for the stop. After the stop, the vehicle heads to the original transit point (xm, ym). Of course, a new route directly from the stop position (xed, yd) to the destination (xd, yd) may be generated after the stop. Meanwhile, people and trolleys can “pass” and “pass each other”. Although the travel control unit 15 generates a route for stopping, the route generation unit 13 may have this function. In any case, safety and usability are improved by stopping the vehicle in the stop area S set in advance at an appropriate place in the passage and giving the passage to another moving body.

停留領域Sは図4(a) に示すように、直線として定義する場合、その表現が簡単になるとともに、より狭い場所での設定が可能となる。この場合、各停留領域は絶対座標上で、始点(xn0,yn0)と終点(xn1,yn1)で表せばよい。nは領域の番号とする、そして停留を行う際には、自律移動装置1に記憶されている地図の座標系で予め設定された停留領域Sの始点終点の座標を自律移動装置1を原点にその進行方向をX軸とする座標に変換する。上記座標が始点(xrn0,yrn0)と終点(xrn1,yrn1)となるとすると、この始点と終点の座標で表される線分まで原点から直交する直線を引ける場合は、その交点と原点との距離を領域nまでの距離とする。   When the stationary region S is defined as a straight line as shown in FIG. 4 (a), 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 mobile apparatus 1 are used as the origin. The travel direction is converted into coordinates with the X axis. Assuming that the above coordinates are the start point (xrn0, yrn0) and the end point (xrn1, yrn1), if a straight line perpendicular to the origin can be drawn up to the line segment represented by the coordinates of the start point and the end point, the distance between the intersection and the origin Is the distance to region n.

直交するかどうかは、例えば、始点から終点のベクトルと始点から原点までのベクトルとの内積及び終点から始点のベクトルと終点から原点までのベクトルとの内積から判断することができる。上記の二つの内積がともに正の時は直交する直線を引くことができる。そして直交する線分と領域を示す線分との交点が求まれば距離も求めることができる。それ以外の場合には、原点と始点の距離、原点と終点との距離のうち、短い方を領域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> = level 1> level 2> 0. And when selecting the stop area S,
Evaluation is based on the small distance / level to the stop area. In this case, even if the position of the autonomous mobile device 1 is close to the level 2 stop area S, the number of cases where it stops in the stop area S set to level 1 increases. This means that by increasing the level of the stationary region S having unevenness such as pillars, it becomes easier for other wide moving bodies to pass through. However, if the level 2 stop area S is very close, the stop time may be prioritized in the level 2 stop area S. The above evaluation formula is an example, and various weights based on the level and the evaluation formula itself can be used.

このほか、停留領域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 is to go to the stopping position via the relay point with the point (xd, 0) as a relay point .

また上記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, if Vmax is the maximum speed and Te is the time required to calculate the stop motion,
Xmax> Vmax · Te
Xmax is set in advance, and xd = Xmax (V / Vmax) depending on the speed V of the autonomous mobile device 1
Xd is determined as follows. 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 device 1 can be directed straight in the traveling direction, and as a result, the passage can be opened widely. This is particularly effective when the autonomous mobile device 1 is longer in the traveling direction than in the width direction. The time for resuming the operation after the stop is also shortened.

停留領域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. In this way, as shown in FIG. 10 (b), even if the obstacle 9 is in the vicinity of the stopping place, it can enter the stopping area S by moving while avoiding the obstacle 9. . Further, in this case, if the distance from the line L is shorter than the width W, the position may be stopped as the stop position, not the initial stop position Ss.

次に停留開始信号検出手段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-type sensor 16 attached to the autonomous mobile device 1 can be used as shown in FIG. In this case, the person who wants to pass can touch the sensor 16 of the autonomous mobile device 1 to instruct the autonomous mobile device 1 to perform a stop operation. If a plurality of sensors 16 are attached, it is possible to instruct the autonomous mobile device 1 in the direction in which it is desired to be saved. 12 (a), 12 (b), and 12 (c) show that when the person approaches from behind the autonomous mobile device 1 and wants to pass the autonomous mobile device 1, the autonomous mobile device 1 is held in the stop region S by touching the contact sensor 16. It is going to. And a contact sensor 16 installed in the both sides of the autonomous mobile equipment 1, for example, if brought into contact with the contact sensor 16 of the left side, the autonomous mobile equipment 1 is kept to be directed to the retention area in the right direction, the autonomous There is no possibility that a person will fail to determine the direction of changing the direction for stopping the mobile device 1.

また、自律移動装置1の各サイドの前方と後方に接触式センサ16を配置しておけば、1の前方から人がきた場合、人を障害物として回避するが、この時、図12(d)(e)(f)に示すように、片側の接触式センサ16に人が触れることで、自律移動装置1は所定の方向に向きを変えて停留領域Sに向かうものとなる。つまり、自律移動装置1が進行方向に進んで停留領域に向かうのか、方向を変えて停留領域Sに向かうのかを指示することができる。 If the contact sensors 16 are arranged in front and rear of each side of the autonomous mobile device 1, when a person comes from the front of 1, the person is avoided as an obstacle. At this time, FIG. As shown in (e) and (f), when the person touches the contact sensor 16 on one side, the autonomous mobile device 1 changes its direction in a predetermined direction toward the stop area S. That is, it can be instructed whether the autonomous mobile device 1 proceeds in the traveling direction toward the stopping area, or changes direction to the stopping area S.

停留開始信号検出手段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 = <an integer of k <m, 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 signal detection unit 16 includes a storage unit that stores a voice level pattern and a search unit that searches a portion that matches a voice level pattern stored in advance from the collected voice level waveform. If the sound level is continuously collected and a detection signal is output when there is a part that matches the pre-registered pattern from the sound level waveform, it is recognized according to the sound level pattern stored in advance. The voice pattern (word) to be specified can be specified in detail. First, a word (or a plurality of words) for performing the stopping operation is determined, and a voice pattern Vp of this word (for example, “doi”) is stored in advance in the sensor. As shown in a), it can be expressed by n data [f (i): 0 = <an integer of i <n] in a certain sampling period t. g (k): 0 = <an integer of k <m and m> n] (see FIG. 14B) is searched for a portion that matches the previously stored pattern Vp, for example, k = l of g (k) (However, the correlation between n and f (i) from 0 = <l <mn) is taken, and a stop start detection signal is output from the sensor when it exceeds a certain threshold.

停留開始信号検出手段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 mobile device 1 to stop. Even what always emits light may emit light according to operation only when it is desired to stop the autonomous mobile device 1. And the sensor which receives the said infrared rays is installed in the autonomous mobile apparatus 1 as the stop start signal detection means 16. FIG.

停留開始信号検出手段16で検出する信号は、自律移動装置1の稼動領域の壁や天井などに取り付けられた装置から発するようにしてもよい。この場合、停留を要求する台車等が自律移動装置1から見えないところに位置する時にも自律移動装置1に停留動作を開始させることができ、効率の良い停留動作を実現することができる。例えば図15のようにコーナー部分に自律移動装置1が通路を譲るべき対象を認識するとともに自律移動装置1へ前記対象が接近していることを知らせるための信号を発する装置8を設置する。上記対象の認識は、カメラで収集した画像を処理することで行うものや、前記対象に取り付けられた装置から発せられる信号を検知することで行うものを用いることができる。そして上記対象を検知したならば、自律移動装置1に対する信号を発して、これを自律移動装置1の停留開始信号検出手段16が検出することにより、見通し位置にない対象を自律移動装置1は検出して早期に停留動作に入ることができる。上記装置8が発生する信号を赤外線とすれば、自律移動装置1の停留開始信号検出手段16は赤外線検出センサで構成すればよい。 Signals detected by stopping the start signal detecting means 16, may be issued from the apparatus attached taken to a wall or ceiling of the work area of the autonomous mobile equipment 1. In this case, the autonomous mobile device 1 can start the stop operation even when a cart or the like that requests the stop is not visible from the autonomous mobile device 1, and an efficient stop operation can be realized. For example, as shown in FIG. 15, a device 8 that recognizes a target for which the autonomous mobile device 1 should yield a passage and issues a signal for notifying the autonomous mobile device 1 that the target is approaching is installed at a corner portion. The recognition of the object can be performed by processing an image collected by a camera, or can be performed by detecting a signal emitted from a device attached to the object. And if the said object is detected, the autonomous mobile device 1 will detect the target which is not in a line-of-sight position by issuing the signal with respect to the autonomous mobile device 1 and detecting this by the stop start signal detection means 16 of the autonomous mobile device 1. Then, the stop operation can be started at an early stage. If the signal generated by the device 8 is infrared, the stationary start signal detection means 16 of the autonomous mobile device 1 may be constituted by an infrared detection sensor.

停留開始信号検出手段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 mobile device 1. In particular, when a laser device that scans a two-dimensional horizontal area SC and measures the distance to an obstacle is used for obstacle detection, the position of the obstacle can be recognized with high accuracy. it can. Therefore, as shown in FIG. 17, when there is an obstacle 9 between the autonomous mobile device 1 and the point 7 that is currently heading and the obstacle 9 approaches, a stop operation is performed instead of obstacle avoidance. It is. When the autonomous mobile device 1 is moving at a speed v, it is detected by the radar device, and the obstacle 9 is between the point 7 and the distance is r1, and the measurement is performed after Δt time. But when there is an obstacle between the point 7 and the distance is r2,
r2 <r1-v · Δt
If there is a relationship, the autonomous mobile device 1 determines that the obstacle 9 is a moving body and is approaching, and enters the stopping operation.

また、非接触型の停留開始信号検出手段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 signal detecting means 16. For example, when the stop start signal is detected by the stop start signal detecting means 16, an obstacle is detected between the point where the radar is moving and the autonomous mobile device 1 as shown in FIG. And if the detection distance at that time is smaller than the distance previously set in the memory | storage means 11, the stop area | region S is selected in the direction opposite to the said point, and if not, the direction with the said point is selected.

また、停留開始信号検出手段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 mobile device 1, the stop area in the direction in which no detection was detected when the detection was made. If it goes to S, selection of the stop area S will be easy. For example, when using the stop detection signal detection means 16 that detects sound, the sound is collected using two directional microphones and the sound in front of the autonomous mobile device is detected alone, On the other hand, it arrange | positions so that a back sound may be detected, and if a sound is detected, the stop area | region S will be selected in the direction which did not detect. The same effect can be obtained if the stop start signal detection means 16 has two detection units, a detection unit for detecting the front signal of the autonomous mobile device 1 and a detection unit for detecting the rear signal.

さらに、音によって停留開始信号検出を行う際には、複数のマイクを利用することによって、音声源の方向を特定し、音声源と反対方向の停留可能領域に向かうことにすれば、より最適な停留領域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 mobile device 1 is caught between the emergency doors can be reduced. Furthermore, when the stop position is reached, a signal is sent from the autonomous mobile device 1 to the disaster prevention system, and the disaster prevention system receives the signal and then controls the emergency door so that the autonomous mobile device 1 becomes the emergency door. It will not be pinched. As the communication means 18, a wireless LAN, PHS or the like may be used.

以上、停留開始信号検出手段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 obstacle 9, the autonomous mobile device 1 has a target that has given way from the output data of the radar device. If it is determined whether or not the vehicle has passed, and if it is determined that the vehicle has passed, the stop operation can be ended at the most appropriate time by ending the stop operation. For example, when a passage is given to a moving body coming from behind, the data of the radar device changes as shown in FIGS. 19 (a) to 19 (b) and 19 (c) as the moving body passes from behind. . In addition, the hatching part in a figure is an area which the radar apparatus judges that there is no obstacle (moving body). Therefore, from a plurality of data of the radar device at regular time intervals, a moving body (an object having a different detection distance in the plurality of data) moves from the rear to the front of the autonomous mobile device 1 (evaluated by an angle to the object), When the distance La to the object becomes larger than the set distance, the stopping operation is terminated. Similarly, for a moving body coming from the front, it is possible to determine the end time of the stopping operation by observing the movement from the front to the rear. The object may stop passing, but in this case, the stopping operation may be terminated when the movement of the object cannot be observed by the radar device for the time previously stored in the storage unit 11.

停留動作中にその動作についての表示を行うための表示手段19を自律移動装置1に設けておけば、自律移動装置1が次にどのような動作をするか周囲にいる人が予測することができるものとなる。例えば、図20(a)に示すように自律移動装置1にディスプレイ19が備わっている場合には、このディスプレイ19上に移動方向を矢印で示したりすればよく、図20(b)に示すように自律移動装置1が複数のランプ19を備えている場合には、移動する方向のランプ19を点灯(点滅)させるとよい。   If the autonomous mobile device 1 is provided with the display means 19 for displaying the operation during the stopping operation, the surrounding people can predict what operation the autonomous mobile device 1 will perform next. It will be possible. For example, when the autonomous mobile device 1 has a display 19 as shown in FIG. 20 (a), the moving direction may be indicated by an arrow on the display 19, as shown in FIG. 20 (b). If the autonomous mobile device 1 is provided with a plurality of lamps 19, the lamp 19 in the moving direction may be turned on (flashing).

次に上記の自律移動装置1のための運用システムについて説明すると、この運用システムは図21に示すように1台もしくは複数台の自律移動装置1と、自律移動装置1の運用を管理する管理装置2とからなる。図中3は管理装置2に通信回線を介して接続されて、自律移動装置1の稼動領域の地図、自律移動装置1が進入できる領域、他の移動体を回避するための停留領域等の入力や修正、ならびに自律移動装置1の位置や状態を確認する手段として機能させるユーザ端末である。   Next, the operation system for the autonomous mobile device 1 will be described. This operational system includes one or a plurality of autonomous mobile devices 1 and a management device that manages the operation of the autonomous mobile device 1 as shown in FIG. It consists of two. Reference numeral 3 in the figure is connected to the management device 2 via a communication line, and inputs an operation area map of the autonomous mobile device 1, an area where the autonomous mobile device 1 can enter, a stop area for avoiding other moving objects, and the like. And a user terminal that functions as a means for confirming the position and state of the autonomous mobile device 1.

上記管理装置2は、ユーザ端末3を通じて入力修正された上記情報を記憶する記憶手段20を備えるとともに、ユーザ端末3や自律移動装置1との間で有線あるいは無線で上記情報のやり取りをするためのインターフェース21を備えたものであり、エレベータ管理システムや防災システム等にも接続されている。   The management device 2 includes a storage unit 20 that stores the information input and corrected through the user terminal 3, and exchanges the information between the user terminal 3 and the autonomous mobile device 1 in a wired or wireless manner. An interface 21 is provided and is also connected to an elevator management system, a disaster prevention system, and the like.

また、ここで用いる自律移動装置1は、管理装置2との間で上記情報や環境情報、各自律移動装置1に個別に付されたID情報、位置情報等をやり取りするための通信手段を備えている。   In addition, the autonomous mobile device 1 used here includes a communication means for exchanging the above information and environment information, ID information individually attached to each autonomous mobile device 1, position information, and the like with the management device 2. ing.

そして上記管理装置2は、通信回線を経由して各自律移動装置1から送られてくる自律移動装置1の位置情報と、本システム外から送られてくる情報とを元に自律移動装置1の運用を行うことで、自律移動装置1を病院等のビルの中での搬送や案内、清掃などの作業に従事させる。   Then, the management device 2 uses the position information of the autonomous mobile device 1 sent from each autonomous mobile device 1 via the communication line and the information sent from outside this system based on the location information of the autonomous mobile device 1. By performing the operation, the autonomous mobile device 1 is engaged in work such as transportation, guidance, and cleaning in a building such as a hospital.

例えば自律移動装置1が操作されて稼動する時、管理装置2と通信を確立し、付されたID情報と位置・目的地及び状態(移動中、停留中、移動不能など)を予め定めて記憶手段11に記憶してある周期で通信手段を介して管理装置2に送りながら走行を行い、目的地に着くと通信を終了する。従って管理装置2は自律移動装置1の状況がわかり、また通信回線に接続した他のユーザ端末3からも管理装置2を介して自律移動装置の状況を把握することができる。また、ユーザ端末3から自律移動装置1を操作することも可能であり、他のエレベータや防災システムとの連動も可能となる。自律移動装置1の動作を遠隔で監視できるものであり、また自律移動装置1の記憶手段13に記憶した内容を管理装置2で管理できるとともに複数の自律移動装置1を使用する場合に記憶データの共有が可能となるものである。   For example, when the autonomous mobile device 1 is operated and operated, communication with the management device 2 is established, and the attached ID information, position / destination, and state (moving, stationary, immovable, etc.) are determined and stored in advance. The vehicle travels while sending it to the management device 2 via the communication means at a cycle stored in the means 11 and ends the communication when it arrives at the destination. Therefore, the management device 2 can know the status of the autonomous mobile device 1 and can grasp the status of the autonomous mobile device via the management device 2 from other user terminals 3 connected to the communication line. In addition, the autonomous mobile device 1 can be operated from the user terminal 3 and can be linked with other elevators and disaster prevention systems. The operation of the autonomous mobile device 1 can be monitored remotely, the contents stored in the storage means 13 of the autonomous mobile device 1 can be managed by the management device 2, and the stored data can be stored when a plurality of autonomous mobile devices 1 are used. Sharing is possible.

そして、自律移動装置1及び管理装置2に記憶する稼動する領域の地図、自律移動装置が進入できる領域、他の移動体を回避するために停留できる領域を複数のエリアに分けて入力記憶させておくと、大量のデータを分割して管理することができ、データの修正追加が容易となる。例えば、図22に示すように、あるブロックで分けたり、複数の階を走行する場合に階別に分けてエリアA,Bを設定し、各エリアA,B毎に部屋の位置座標、壁を表す線分や停留領域Sを表す線分の始点、終点の座標を記憶しておく。また、各自律移動装置1は、異なるエリアへの移動に際して、管理装置2から異なるエリアの地図や進入可能領域、停留領域の情報をダウンロードして、それまでのエリアの地図や進入可能領域、停留領域の情報に代えて記憶手段11に記憶するものとする。   And the map of the active area memorize | stored in the autonomous mobile device 1 and the management apparatus 2, the area | region which an autonomous mobile device can approach, and the area | region which can be stopped in order to avoid another mobile body are divided into several areas, and it is made to memorize | store it. In this case, a large amount of data can be divided and managed, and correction of data can be easily added. For example, as shown in FIG. 22, when traveling on a plurality of floors, areas A and B are set separately for each floor, and the position coordinates and walls of the room are represented for each area A and B. The coordinates of the start point and end point of the line segment representing the line segment or the stop area S are stored. In addition, each autonomous mobile device 1 downloads a map of a different area, an accessible area, and a stop area information from the management device 2 when moving to a different area. The information is stored in the storage unit 11 instead of the area information.

今、自律移動装置1にエリアA,Bを跨ぐ移動の指示、たとえば図22に示すように、エリアAのRoomA2からエリアBのRoomB4への移動指示があった時、自律移動装置1における経路生成手段13はまずRoomA2からエリアA,Bの境界地点Pまでの経路を生成してこの経路で移動を開始する。そして、境界地点Pに近づいた時点でエリアBの情報を管理装置1からダウンロードし、P地点からRoomB4までの経路を生成し、境界地点Pに達した時には新たに生成した経路での走行を開始する。自律移動装置1で管理及び処理するデータ量が少なくて済むものである。   When the autonomous mobile device 1 is instructed to move across the areas A and B, for example, as shown in FIG. 22, the route generation in the autonomous mobile device 1 from the room A's Room A2 to the area B's Room B4. The means 13 first generates a route from the room A2 to the boundary point P between the areas A and B, and starts moving along this route. Then, when approaching the boundary point P, the information of the area B is downloaded from the management device 1, a route from the point P to Room B4 is generated, and when the boundary point P is reached, traveling on the newly generated route is started. To do. The amount of data managed and processed by the autonomous mobile device 1 is small.

このほか、自律移動装置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 mobile device 1 are reflected in the management device 2 and the data of other autonomous mobile devices 1 is also corrected, one data correction is performed. If applied to the autonomous mobile device 1, it can be reflected in all the autonomous mobile devices 1, and the entire autonomous mobile device 1 is always operated with the latest information. For example, when the stop area S stored in the autonomous mobile device 1 in a certain area is deleted, the information of the management device 2 is also corrected. When the autonomous mobile device 1 stops in the stop area S in a certain area, The information is transmitted to the management device 2, and the area is temporarily set as a region where other autonomous mobile devices 1 cannot stop, so that the information of other autonomous mobile devices 1 in the area can be rewritten, and then the stop When the autonomous mobile device 1 that has been moved starts, the information of another autonomous mobile device 1 in the area is rewritten so that it can be stopped.

本発明に係る自律移動装置の実施の態様の一例のブロック図である。It is a block diagram of an example of the embodiment of the autonomous mobile device concerning the present invention. (a)(b)(c)は同上の動作説明図である。(a) (b) (c) is an operation explanatory view of the above. (a)(b)は同上の経路シーケンスの説明図である。(a) (b) is explanatory drawing of a path | route sequence same as the above. (a)(b)は夫々停留領域の設定の説明図である。(a) (b) is an explanatory view of setting a stop area, respectively. (a)(b)は停留領域への移動のための経路変更の説明図である。(a) (b) is explanatory drawing of the route change for the movement to a stop area. 他例における動作説明図である。It is operation | movement explanatory drawing in another example. 別の例における停留領域への移動のための経路変更の説明図である。It is explanatory drawing of the route change for the movement to the stop area | region in another example. 経路変更の他例の説明図である。It is explanatory drawing of the other example of a route change. 停留領域への移動についての他例の説明図である。It is explanatory drawing of the other example about the movement to a stop area. (a)(b)は停留領域への移動についての別の例の説明図である。(a) (b) is explanatory drawing of another example about the movement to a stop area. 他例の斜視図である。It is a perspective view of another example. (a)〜(f)は同上の動作説明図である。(a)-(f) is operation | movement explanatory drawing same as the above. (a)(b)は音声有無パターンについての説明図である。(a) (b) is explanatory drawing about an audio | voice presence / absence pattern. (a)(b)は他例における音声パターンの説明図である。(a) (b) is explanatory drawing of the audio | voice pattern in another example. (a)(b)(c)はさらに他例における動作説明図である。(a) (b) (c) is an operation explanatory diagram in still another example. レーダー装置を備えた例の概略平面図である。It is a schematic plan view of the example provided with the radar apparatus. (a)(b)(c)は同上の動作説明図である。(a) (b) (c) is an operation explanatory view of the above. 別の例のブロック図である。It is a block diagram of another example. 別の例における動作説明図である。It is operation | movement explanatory drawing in another example. (a)(b)は夫々表示手段を備えた例の斜視図である。(a) (b) is a perspective view of the example provided with the display means, respectively. 本発明に係る運用システムのブロック図である。It is a block diagram of the operation system concerning the present invention. (a)(b)は他例の動作説明図である。(a) and (b) are operation | movement explanatory drawings of another example.

符号の説明Explanation of symbols

1 自律移動装置
2 管理装置
10 走行手段
11 記憶手段
12 インターフェース
13 経路生成手段
14 環境認識手段
15 走行制御手段
16 停留開始信号検出手段
DESCRIPTION OF SYMBOLS 1 Autonomous mobile device 2 Management apparatus 10 Traveling means 11 Storage means 12 Interface 13 Route generation means 14 Environment recognition means 15 Travel control means 16 Stop start signal detection means

Claims (2)

稼動領域の地図と走行用の各種パラメータを記憶するための記憶手段と、目的地や操作指令の入力のためのインターフェースと、目的地までの経路を生成する経路生成手段と、障害物や自己位置を認識するための環境認識手段と、走行を行うための走行手段とを備えるとともに、環境認識手段で得られた情報を元に上記地図上で自己の位置を認識し且つ障害物を回避しながら目的地まで走行手段を制御する走行制御手段を備えている自律移動装置であって、他の移動体を回避するための停留開始信号を検出する停留開始信号検出手段を有して、上記走行制御手段は停留開始信号検出手段で停留開始信号を検出した場合に記憶手段に予め記憶させた他の移動体の回避用の停留領域に停留させるものであるとともに、前記停留開始信号を検出した地点から進行方向に所定の距離だけ前進した地点を中継点として該中継点までの移動中に該中継点から上記停留領域までの経路を算出し、上記中継点から上記算出経路に従って停留領域に向かわせるものであることを特徴とする自律移動装置。 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 a autonomous mobile apparatus and a driving control means for controlling the driving means to a destination, a dwell start signal detecting means for detecting a stopping start signal to avoid the other mobile, the travel control with means those which dwell in the stationary region for avoiding the other mobile body stored in advance in the memory means when detecting the stop initiation signal in stopping the start signal detecting means, detects the stopping start signal A route from the relay point to the stop area is calculated while moving to the relay point using a point that has advanced a predetermined distance from the point as the relay direction, and the route from the relay point to the stop area is calculated according to the calculated route. An autonomous mobile device characterized in that it is a device to be changed. 前記所定の距離は、走行速度と停留領域までの経路算出に必要な時間とに基づいて決定していることを特徴とする請求項1記載の自律移動装置。 The autonomous mobile device according to claim 1, wherein the predetermined distance is determined based on a traveling speed and a time required for calculating a route to the stop area .
JP2005071685A 2005-03-14 2005-03-14 Autonomous mobile device Expired - Fee Related JP3931907B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2005071685A JP3931907B2 (en) 2005-03-14 2005-03-14 Autonomous mobile device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2005071685A JP3931907B2 (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
JP2005222560A JP2005222560A (en) 2005-08-18
JP3931907B2 true JP3931907B2 (en) 2007-06-20

Family

ID=34998087

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2005071685A Expired - Fee Related JP3931907B2 (en) 2005-03-14 2005-03-14 Autonomous mobile device

Country Status (1)

Country Link
JP (1) JP3931907B2 (en)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4997850B2 (en) * 2006-07-11 2012-08-08 富士通株式会社 Mobile robot apparatus and mobile robot control method
JP2008134744A (en) * 2006-11-27 2008-06-12 Matsushita Electric Works Ltd Autonomous moving device group control system
JP2011128899A (en) * 2009-12-17 2011-06-30 Murata Machinery Ltd Autonomous mobile device
JP6974370B2 (en) * 2019-01-18 2021-12-01 日立建機株式会社 Work machine for earthwork
JP2023011376A (en) * 2021-07-12 2023-01-24 ソニーグループ株式会社 Moving body, information processing method, and program

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS62125407A (en) * 1985-11-26 1987-06-06 Komatsu Ltd Traffic control method
JP2661023B2 (en) * 1986-12-16 1997-10-08 神鋼電機株式会社 Collision Avoidance Method for Autonomous Unmanned Vehicle System
JPH07120202B2 (en) * 1987-03-14 1995-12-20 株式会社豊田自動織機製作所 Operation control device for unmanned vehicles
JP2885628B2 (en) * 1993-12-27 1999-04-26 日本電気株式会社 Control method of automatic guided vehicle using track
JP3296105B2 (en) * 1994-08-26 2002-06-24 ミノルタ株式会社 Autonomous mobile robot
JPH08221126A (en) * 1995-02-10 1996-08-30 Yaskawa Electric Corp Moving robot
JPH09330123A (en) * 1996-06-07 1997-12-22 Mitsubishi Heavy Ind Ltd Travel control system
JPH10161744A (en) * 1996-12-02 1998-06-19 Matsushita Electric Ind Co Ltd Unmanned vehicle and unmanned vehicle system
JPH1129205A (en) * 1997-07-11 1999-02-02 Mitsubishi Electric Corp Mobile carrying equipment and its control method
JP2001147121A (en) * 1999-11-19 2001-05-29 Denso Corp Map data distribute center and navigation device
JP3675386B2 (en) * 2001-11-01 2005-07-27 松下電工株式会社 Autonomous mobile device and autonomous mobile device operation system
JP3846506B2 (en) * 2005-03-14 2006-11-15 松下電工株式会社 Autonomous mobile device
JP3931906B2 (en) * 2005-03-14 2007-06-20 松下電工株式会社 Autonomous mobile device

Also Published As

Publication number Publication date
JP2005222560A (en) 2005-08-18

Similar Documents

Publication Publication Date Title
JP3675386B2 (en) Autonomous mobile device and autonomous mobile device operation system
EP3460614B1 (en) Combined robot and cruising path generation method therefor
US8924068B2 (en) Autonomous mobile body
JP5503419B2 (en) Automated guided vehicle and travel control method
JP2020509500A (en) Control method of autonomous mobile robot
JP5539596B2 (en) Autonomous mobile device, autonomous mobile method, and program for autonomous mobile device
US20130166134A1 (en) Autonomous mobile body
JP5768273B2 (en) A robot that predicts a pedestrian&#39;s trajectory and determines its avoidance behavior
JPH05257533A (en) Method and device for sweeping floor surface by moving robot
EP3667450B1 (en) Mobile body and method for control of mobile body
JP3931907B2 (en) Autonomous mobile device
JPH09185412A (en) Autonomous moving device
JP5553220B2 (en) Moving body
US20230266762A1 (en) Autonomous Movement Device, Autonomous Movement Method, And Program
EP3892426A1 (en) Autonomously traveling mobile robot and traveling control method therefor
US11642791B2 (en) Autonomous mobile robot and control program for autonomous mobile robot
JP2018185767A (en) Environment maintenance robot, and control program of the same
JP6638348B2 (en) Mobile robot system
JP3931906B2 (en) Autonomous mobile device
JP3846506B2 (en) Autonomous mobile device
US20220022715A1 (en) Autonomously traveling mobile robot and traveling control method therefor
JP2020004182A (en) Robot, robot control program and robot control method
JP2009223632A (en) Autonomous mobile device and autonomous mobile device system
KR101635585B1 (en) Apparatus for remote controlling unmanned moving object
JP7040673B2 (en) Guidance control device and guidance control system for moving objects

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

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