JP2010134656A - Autonomous mobile body and speed control method - Google Patents

Autonomous mobile body and speed control method Download PDF

Info

Publication number
JP2010134656A
JP2010134656A JP2008309046A JP2008309046A JP2010134656A JP 2010134656 A JP2010134656 A JP 2010134656A JP 2008309046 A JP2008309046 A JP 2008309046A JP 2008309046 A JP2008309046 A JP 2008309046A JP 2010134656 A JP2010134656 A JP 2010134656A
Authority
JP
Japan
Prior art keywords
speed
obstacle
shadow
mobile body
autonomous mobile
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2008309046A
Other languages
Japanese (ja)
Other versions
JP5319255B2 (en
Inventor
Akira Horiguchi
彰 堀口
Fumio Koshiio
文夫 小椎尾
Shinya Izumikawa
真也 泉川
Makoto Kaneko
真 金子
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.)
Sohgo Security Services Co Ltd
Original Assignee
Sohgo Security Services Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Sohgo Security Services Co Ltd filed Critical Sohgo Security Services Co Ltd
Priority to JP2008309046A priority Critical patent/JP5319255B2/en
Publication of JP2010134656A publication Critical patent/JP2010134656A/en
Application granted granted Critical
Publication of JP5319255B2 publication Critical patent/JP5319255B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

<P>PROBLEM TO BE SOLVED: To further improve the safety of traveling by properly determining a shade dynamically generated while reducing processing time and processing load. <P>SOLUTION: The mobile robot 100 includes: a laser range sensor (LRS) 101 which detects an obstacle existing in a traveling direction; a shade determination part 110 which determines presence of a shade based on the distance between the detected obstacle and a measuring point; and a speed control part 111 which limits, when the shade is determined, the traveling speed of the mobile robot 100 based on the distance to the shade. <P>COPYRIGHT: (C)2010,JPO&INPIT

Description

本発明は、走行速度を制御することができる自律移動体および速度制御方法に関する。   The present invention relates to an autonomous mobile body and a speed control method capable of controlling a traveling speed.

移動ロボットなどの自律移動体が高速走行する場合には、走行を停止するまでの制動距離が長くなるため、危険を事前に予測して走行速度を調整する必要がある。このため、従来から、自律移動体の近くに物体が存在する場合や、移動する障害物が自己の走行経路上に進入してくる場合に走行速度の制限を行っているが、物陰から障害物が飛び出してきた場合には、走行速度を急に制限することは困難である。   When an autonomous mobile body such as a mobile robot travels at a high speed, the braking distance until the travel is stopped becomes long. Therefore, it is necessary to predict the danger in advance and adjust the travel speed. For this reason, conventionally, when an object is present near an autonomous mobile body or when a moving obstacle enters the own travel route, the travel speed is limited. It is difficult to limit the traveling speed suddenly when the jumps out.

このような問題を解決するため、従来技術では、監視カメラで撮像された画像から周囲にある物体を認識して走行する移動ロボットにおいて、予め地図データを記憶しておき、撮像された画像から検出された静止物の境界線と地図データを照合して基準距離を算出し、撮像された画像の中で隣接する画素の基準距離が異なる場合に、物陰があると判断している(例えば、特許文献1参照)。   In order to solve such a problem, in the prior art, in a mobile robot that travels by recognizing a surrounding object from an image captured by a surveillance camera, map data is stored in advance and detected from the captured image. The reference distance is calculated by collating the boundary line of the captured stationary object with the map data, and if the reference distance between adjacent pixels in the captured image is different, it is determined that there is a shadow (for example, patent) Reference 1).

特許第3781370号公報Japanese Patent No. 3781370

しかしながら、このような従来技術では、予め地図データを保持しておく必要があるため、地図データ上に登録されていない障害物により物陰が生じた場合には、物陰を認識することができず、安全な走行ができないという問題がある。   However, in such a conventional technique, since it is necessary to hold map data in advance, when a shadow is caused by an obstacle that is not registered on the map data, the shadow cannot be recognized, There is a problem that safe driving is not possible.

また、このような従来技術では、撮像した画像を画像処理して物陰の有無を判断しているため、物陰の認識処理に時間を要するばかりか、処理負担が過大となる。   Further, in such a conventional technique, since the captured image is subjected to image processing to determine the presence / absence of a shadow, not only does the recognition processing of the shadow take time, but the processing load becomes excessive.

本発明は、上記に鑑みてなされたものであって、検知手段を用いて物陰を認識して走行速度を制限することにより、処理時間の短縮化および処理負担の軽減を図りつつ、動的に生じた物陰を正確に判断して走行の安全性をより向上させることができる自律移動体および速度制御方法を提供することを主な目的とする。   The present invention has been made in view of the above, and by dynamically detecting a shadow using a detection unit and limiting the traveling speed, the processing time can be shortened and the processing load can be reduced dynamically. The main object is to provide an autonomous mobile body and a speed control method that can accurately determine the shade of the object and improve the safety of traveling.

上述した課題を解決し、目的を達成するために、本発明にかかる自律移動体は、走行方向に存在する障害物を検知する検知手段と、検知された障害物の計測点間の距離に基づいて、物陰の存在の有無を判断する物陰判断手段と、前記物陰が存在すると判定された場合に、前記物陰の近傍で前記物陰との距離に基づいて前記自律移動体の走行速度を制限する速度制御手段と、を備えたことを特徴とする。   In order to solve the above-described problems and achieve the object, the autonomous mobile body according to the present invention is based on a distance between a detection unit that detects an obstacle existing in the traveling direction and a measurement point of the detected obstacle. A shadow determining means for determining presence / absence of a shadow, and a speed that limits a traveling speed of the autonomous mobile body based on a distance from the shadow in the vicinity of the shadow when it is determined that the shadow is present And a control means.

また、本発明にかかる速度制御方法は、自律移動体の走行速度を制御する速度制御方法であって、走行方向に存在する障害物を検知する検知ステップと、検知された障害物の計測点間の距離に基づいて、物陰の存在の有無を判断する物陰判断ステップと、前記物陰が存在すると判定された場合に、前記物陰の近傍で前記物陰との距離に基づいて前記自律移動体の走行速度を制限する速度制御ステップと、含むことを特徴とする。   The speed control method according to the present invention is a speed control method for controlling the traveling speed of an autonomous mobile body, and includes a detection step for detecting an obstacle present in the traveling direction and a measurement point between the detected obstacles. A step of determining the presence / absence of a shade based on the distance of the vehicle, and a travel speed of the autonomous mobile body based on a distance from the shade in the vicinity of the shade when it is determined that the shade exists. And a speed control step for limiting.

本発明によれば、地図データを必須とせず、検知手段を用いて物陰を認識して走行速度を制限しているので、物陰の判断処理時間の短縮化および処理負担の軽減を図りつつ、動的に生じた物陰を正確に判断して走行の安全性をより向上させることができるという効果を奏する。   According to the present invention, map data is not essential, and the traveling speed is limited by recognizing the shade using the detection means, so that the movement processing time can be shortened and the processing load can be reduced while reducing the shade. Thus, it is possible to accurately determine the shadows generated and to improve the safety of traveling.

以下に添付図面を参照して、この発明にかかる自律移動体および速度制御方法の最良な実施の形態を詳細に説明する。   Exemplary embodiments of an autonomous mobile body and a speed control method according to the present invention will be explained below in detail with reference to the accompanying drawings.

(実施の形態1)
本発明が適用される移動体の一例である移動ロボット100の構成について説明する。図1は、実施の形態1にかかる移動ロボット100の機能的構成を示すブロック図である。また、図2は、実施の形態1にかかる移動ロボット100の外観の一例を示す説明図である。
(Embodiment 1)
A configuration of a mobile robot 100 as an example of a mobile body to which the present invention is applied will be described. FIG. 1 is a block diagram of a functional configuration of the mobile robot 100 according to the first embodiment. FIG. 2 is an explanatory diagram of an example of the appearance of the mobile robot 100 according to the first embodiment.

本実施の形態にかかる移動ロボット100は、レーザレンジセンサ101(以下、「LRS101」という。)と、検知情報受信部102と、監視カメラ103と、画像情報受信部104と、操作パネル部105と、操作パネル制御部106と、スピーカ107と、音声出力制御部108と、現在位置取得部109と、物陰判断部110と、走行制御部112と、通信部113と、駆動部114とを主に備えている。   The mobile robot 100 according to the present embodiment includes a laser range sensor 101 (hereinafter referred to as “LRS 101”), a detection information receiving unit 102, a monitoring camera 103, an image information receiving unit 104, and an operation panel unit 105. The operation panel control unit 106, the speaker 107, the audio output control unit 108, the current position acquisition unit 109, the shadow determination unit 110, the travel control unit 112, the communication unit 113, and the drive unit 114 are mainly used. I have.

LRS101は、検知領域における障害物を検知し、障害物との距離を計測する距離センサである。LRS101は、移動ロボット100が走行中に一定時間ごとに検知動作を行い、障害物の位置である計測点を逐次検出している。LRS101は、図2に示すように移動ロボット100の足元に設置されている。検知情報受信部102は、LRS101が障害物を検知した際の検知情報を受信する。   The LRS 101 is a distance sensor that detects an obstacle in the detection region and measures a distance from the obstacle. The LRS 101 performs a detection operation at regular intervals while the mobile robot 100 is traveling, and sequentially detects measurement points that are positions of obstacles. The LRS 101 is installed at the foot of the mobile robot 100 as shown in FIG. The detection information receiving unit 102 receives detection information when the LRS 101 detects an obstacle.

監視カメラ103は、監視領域を撮像する。監視カメラ103は、図2に示すように移動ロボット100の頭部に設置されている。画像情報受信部104は、監視カメラ103が撮像した画像情報を受信する。操作パネル部105は、移動ロボット100に対する操作のメニューや種々の情報を表示し、メニューからの指示を受け付ける。操作パネル制御部106は、操作パネル部105に対する入出力制御を行う。   The monitoring camera 103 images the monitoring area. The monitoring camera 103 is installed on the head of the mobile robot 100 as shown in FIG. The image information receiving unit 104 receives image information captured by the monitoring camera 103. The operation panel unit 105 displays an operation menu for the mobile robot 100 and various information, and receives instructions from the menu. The operation panel control unit 106 performs input / output control for the operation panel unit 105.

現在位置取得部109は、移動ロボット100の現在位置を取得する。この現在位置の取得の手法については、任意であり、GPSからの位置情報を利用したり、出発地点からの走行距離を用いることにより現在位置を取得する等公知技術を用いればよい。   The current position acquisition unit 109 acquires the current position of the mobile robot 100. The method for acquiring the current position is arbitrary, and a known technique such as acquiring the current position by using position information from the GPS or using a travel distance from the departure point may be used.

物陰判断部110は、LRS101による検知結果から走行経路上において、走行速度を制限すべき物陰(速度制限対象の物陰)の存在を判断する。物陰判断部110の詳細については後述する。   The shade determination unit 110 determines the presence of a shade (a shade of a speed limit target) whose travel speed should be limited on the travel route from the detection result by the LRS 101. Details of the shade determination unit 110 will be described later.

駆動部114は、移動ロボット100の車輪(不図示)を駆動する車輪モータ等である。走行制御部112は、記憶部(不図示)に記憶された巡回経路に従って、移動ロボット100の走行(移動および回転)を制御する。具体的には、移動ロボット100の駆動部114(車輪モータ)を駆動するものであり、例えば、モータドライバおよび制御モジュール等が該当する。この走行制御部112は、速度制御部111を備えている。   The drive unit 114 is a wheel motor that drives wheels (not shown) of the mobile robot 100. The travel control unit 112 controls the travel (movement and rotation) of the mobile robot 100 according to the patrol route stored in the storage unit (not shown). Specifically, the driving unit 114 (wheel motor) of the mobile robot 100 is driven, and examples thereof include a motor driver and a control module. The travel control unit 112 includes a speed control unit 111.

速度制御部111は、物陰判断部110により速度制限対象の物陰が存在することが判明した場合、速度制限を行う領域である速度制限領域内で物陰との距離に応じて移動ロボット100の走行速度の限界である制限速度を変化させることにより走行速度を制限し、駆動部114を制御する。速度制御部111の詳細については後述する。   The speed control unit 111, when the shade determination unit 110 finds that a shade subject to speed restriction exists, the traveling speed of the mobile robot 100 in accordance with the distance from the shade in the speed restriction region that is a speed restriction region. The driving speed is controlled by changing the speed limit, which is the limit of the driving speed, and the drive unit 114 is controlled. Details of the speed control unit 111 will be described later.

通信部113は、ネットワークで接続された監視装置(不図示)と各種情報の送受信を行う。具体的には、監視装置から巡回経路の巡回の開始、停止などの指示を受信する。また、監視カメラ103で撮像した画像情報や、LRS101が検知した検知情報を監視装置に送信してもよい。   The communication unit 113 transmits and receives various types of information to and from a monitoring device (not shown) connected via a network. Specifically, an instruction for starting and stopping the patrol route is received from the monitoring device. Further, image information captured by the monitoring camera 103 and detection information detected by the LRS 101 may be transmitted to the monitoring device.

スピーカ107は、音声メッセージを出力する。スピーカ107は、図2に示すように移動ロボット100の前面に配置されている。音声出力制御部108は、音声メッセージのスピーカ107による出力を制御する。   The speaker 107 outputs a voice message. The speaker 107 is disposed in front of the mobile robot 100 as shown in FIG. The voice output control unit 108 controls the output of the voice message by the speaker 107.

次に、物陰判断部110の詳細について説明する。物陰判断部110は、LRS101により検知された計測点間の距離が人体幅以上である場合に、速度制限対象の物陰が存在すると判定する。   Next, details of the object shade determination unit 110 will be described. The shade determination unit 110 determines that there is a speed limit target shade when the distance between the measurement points detected by the LRS 101 is equal to or greater than the human body width.

図3−1、図3−2は、物陰判断を説明するための模式図である。図3−1に示すように、LRS101では障害物33が計測点のデータの集合として検出されるが、通常は、図3−1に示すように、自由空間32と死角領域34の間には障害物33がある。そして、検出される移動ロボット100の周囲の計測点のデータの中で、死角領域34と自由空間32が接しているラインから死角領域34の中が物陰31となる。   FIGS. 3A and 3B are schematic diagrams for explaining the object shade determination. As shown in FIG. 3A, the LRS 101 detects the obstacle 33 as a set of measurement point data. Normally, as shown in FIG. 3A, the obstacle 33 is between the free space 32 and the blind spot region 34. There is an obstacle 33. In the data of the measurement points around the mobile robot 100 to be detected, the inside of the blind spot area 34 becomes the shadow 31 from the line where the blind spot area 34 and the free space 32 are in contact.

図3−2に示すように、このような物陰31のうち、LRS101による複数回の検知により得られた複数の計測点37の間隔が人体幅以上である物陰31から人間が飛び出してくる可能性がある。このため、物陰判断部110では、LRS101による複数回の検知により得られた複数の計測点37の間隔と人体幅とを比較し、計測点37の間隔が人体幅以上である場合に、人間が飛び出してくる可能性がある物陰、すなわち、速度制限対象の物陰として判断している。   As shown in FIG. 3-2, among such shadows 31, humans may jump out of the shadow 31 in which the intervals between the plurality of measurement points 37 obtained by multiple detections by the LRS 101 are equal to or greater than the human body width. There is. For this reason, the shadow determination unit 110 compares the distance between the measurement points 37 obtained by multiple detections by the LRS 101 with the human body width, and if the distance between the measurement points 37 is equal to or greater than the human body width, It is determined as a shadow that may pop out, that is, a shadow that is subject to speed limitation.

また、物陰判断部110は、人体幅以上である間隔の2つの計測点のうち、移動ロボット100に最も近い計測点を物陰の最近傍点として記憶しておき、後述の速度制御部111による速度制限の処理で使用する。   Also, the shade determination unit 110 stores the measurement point closest to the mobile robot 100 among the two measurement points at intervals equal to or greater than the human body width as the nearest point of the shade, and speed limit by the speed control unit 111 described later. Used in processing.

次に、速度制御部111の詳細について説明する。図4は、速度制限領域を示す模式図である。本実施の形態では、図4に示すように、移動ロボット100の現在位置を含み、かつ移動ロボット100の直近の位置から移動ロボット100の進行方向に向かう扇状の領域を速度制限領域40として記憶部(不図示)に設定される。この速度制限領域は、移動ロボット100の現在位置を含むため、移動ロボット100が進行するに従って移動ロボット100とともに移動することになる。速度制限領域をこのような領域に設定する理由は、移動ロボット100が車両と同様なノンホロノミックな移動を行う場合、移動方向が前方に限定されるためである。なお、速度制限領域40の形状は、扇状に限定されるものではなく、移動ロボット100の移動方式を考慮した形状とすればよい。また、移動ロボット100の進行方向を考慮した速度制限領域を用いてもよい。   Next, details of the speed control unit 111 will be described. FIG. 4 is a schematic diagram showing a speed limiting region. In the present embodiment, as shown in FIG. 4, a fan-shaped area including the current position of the mobile robot 100 and moving from the position closest to the mobile robot 100 toward the traveling direction of the mobile robot 100 is used as the speed limit area 40. (Not shown). Since the speed limit region includes the current position of the mobile robot 100, the speed limit region moves with the mobile robot 100 as the mobile robot 100 advances. The reason why the speed limit region is set to such a region is that when the mobile robot 100 performs a nonholonomic movement similar to that of a vehicle, the moving direction is limited to the front. Note that the shape of the speed limiting region 40 is not limited to a fan shape, and may be a shape that considers the moving method of the mobile robot 100. Further, a speed limit region in consideration of the traveling direction of the mobile robot 100 may be used.

そして、速度制御部111は、移動ロボット100の移動に伴って物陰の最近傍点が速度制限領域に含まれた時点から、物陰の最近傍点と移動ロボット100の現在位置との距離Rに応じて制限速度を変化させ走行速度を制限する。具体的には、速度制御部111は、物陰の最近傍点と移動ロボット100の現在位置との距離Rが、移動ロボット100の現在位置から速度制限領域の外延までの最大距離より短くなった場合に、距離Rが速度制限をする必要のある距離未満になり、物陰の最近傍点が速度制限領域に含まることになったと判断する。そして、速度制御部111は、この時点から、物陰の最近傍点と移動ロボット100の現在位置との距離Rが小さくなるに従って、走行速度の制限速度を低下させる。   Then, the speed control unit 111 performs restriction according to the distance R between the nearest point in the shadow and the current position of the mobile robot 100 from the time when the nearest point in the shadow is included in the speed restriction region as the mobile robot 100 moves. Change the speed to limit the running speed. Specifically, the speed control unit 111 determines that the distance R between the nearest point in the shadow and the current position of the mobile robot 100 is shorter than the maximum distance from the current position of the mobile robot 100 to the extension of the speed limit area. Therefore, it is determined that the distance R is less than the distance that needs to be speed-limited, and that the nearest point in the shade is included in the speed-limiting area. Then, from this time point, the speed control unit 111 decreases the traveling speed limit speed as the distance R between the nearest point in the shadow and the current position of the mobile robot 100 decreases.

図5および6は、距離Rと走行速度の制限速度との関係を示すグラフである。図5および6において、横軸は物陰の最近傍点と移動ロボット100の現在位置との距離Rであり、縦軸は制限速度である。図5では、制限速度が距離Rと比例関係となるように定めており、距離Rが短くなる程、制限速度が遅くなる。   5 and 6 are graphs showing the relationship between the distance R and the travel speed limit speed. 5 and 6, the horizontal axis is the distance R between the nearest point in the shadow and the current position of the mobile robot 100, and the vertical axis is the speed limit. In FIG. 5, the speed limit is determined to be proportional to the distance R, and the speed limit becomes slower as the distance R becomes shorter.

図6は、距離Rに応じて段階的に制限速度を定めており、この例でも距離Rが短くなる程、制限速度が遅くなる。   In FIG. 6, the speed limit is determined stepwise according to the distance R. In this example, the speed limit becomes slower as the distance R becomes shorter.

本実施の形態の速度制御部111では、図5の方式、図6の方式のいずれも採用することができる。なお、速度制御部111を、移動ロボット100が走行状態から停止するまでの制動距離を考慮して制限速度を決定するように構成してもよい。また、移動ロボット100の進行方向に対して水平方向の距離と垂直方向の距離に応じて制限速度を設定し、楕円状の速度制限領域を定めて制限速度を決定するように速度制御部111を構成してもよい。あるいは、物陰の最近傍点に近づくと速度制限がかかってしまうため、移動ロボット100が最近傍点から離れて走行するように走行経路を変更するように走行制御部112を構成してもよい。   In the speed control unit 111 of the present embodiment, either the method of FIG. 5 or the method of FIG. 6 can be adopted. Note that the speed control unit 111 may be configured to determine the speed limit in consideration of the braking distance until the mobile robot 100 stops from the traveling state. Further, the speed control unit 111 is set so that the speed limit is set according to the distance in the horizontal direction and the distance in the vertical direction with respect to the traveling direction of the mobile robot 100, and the speed limit is determined by determining an elliptical speed limit area. It may be configured. Alternatively, since the speed limit is applied when approaching the nearest point in the shade, the travel control unit 112 may be configured to change the travel route so that the mobile robot 100 travels away from the nearest point.

次に、以上のように構成された本実施の形態の移動ロボット100による速度制御処理について説明する。図7は、実施の形態1の速度制御処理の手順を示すフローチャートである。   Next, speed control processing by the mobile robot 100 of the present embodiment configured as described above will be described. FIG. 7 is a flowchart illustrating a procedure of speed control processing according to the first embodiment.

まず、LRS101により障害物を検出する(ステップS11)。この検出は一定時間ごとに行われている。そして、物陰判断部110は、検出された障害物の計測点の間隔が予め定められた人体幅以上であるか否かを判断する(ステップS12)、そして、計測点の間隔が人体幅より小さい場合に(ステップS12:No)、物陰なしと判断し(ステップS17)、速度制限は行わない(ステップS18)。   First, an obstacle is detected by the LRS 101 (step S11). This detection is performed at regular intervals. Then, the shade determination unit 110 determines whether or not the interval between the measurement points of the detected obstacle is greater than or equal to a predetermined human body width (step S12), and the interval between the measurement points is smaller than the human body width. In this case (step S12: No), it is determined that there is no object (step S17), and speed limitation is not performed (step S18).

一方、ステップS12において、計測点の間隔が人体幅以上である場合には(ステップS12:Yes)、物陰判断部110は、物陰が存在すると判定し(ステップS13)、人体幅以上の計測点のうち移動ロボット100への最近傍点を抽出する(ステップS14)。   On the other hand, in step S12, when the interval between the measurement points is equal to or greater than the human body width (step S12: Yes), the shade determination unit 110 determines that the shadow is present (step S13), and determines the measurement points greater than the human body width. Among these, the nearest point to the mobile robot 100 is extracted (step S14).

そして、速度制御部111は、移動ロボット100と最近傍点との距離Rが速度制限する必要がある距離になったか否か、すなわち、物陰の最近傍点と移動ロボット100の現在位置との距離Rが、移動ロボット100の現在位置から速度制限領域の外延までの最大距離より短くなったか否かを判断することにより、速度制限領域内に物陰の近傍点が入ったか否かを判断する(ステップS15)。   Then, the speed control unit 111 determines whether or not the distance R between the mobile robot 100 and the nearest point has become a distance that needs to be speed limited, that is, the distance R between the nearest point in the shadow and the current position of the mobile robot 100 is determined. Then, by determining whether or not the maximum distance from the current position of the mobile robot 100 to the extension of the speed limit area has become shorter, it is determined whether or not a nearby point in the shadow has entered the speed limit area (step S15). .

まだ、移動ロボット100と最近傍点との距離Rが速度制限する必要がある距離になっていない場合(ステップS15:No)、すなわち、物陰の最近傍点と移動ロボット100の現在位置との距離Rが移動ロボット100の現在位置から速度制限領域の外延までの最大距離以上である場合には、物陰の最近傍点がまだ速度制限領域外にあると判断し、速度制限は行われない(ステップS18)。   If the distance R between the mobile robot 100 and the nearest point is not yet a distance that needs to be speed-restricted (step S15: No), that is, the distance R between the nearest point in the shadow and the current position of the mobile robot 100 is If the distance is greater than or equal to the maximum distance from the current position of the mobile robot 100 to the extension of the speed limit area, it is determined that the nearest neighbor point is still outside the speed limit area, and speed limit is not performed (step S18).

一方、移動ロボット100と最近傍点との距離が速度制限する必要がある距離になった場合(ステップS15:Yes)、すなわち、物陰の最近傍点と移動ロボット100の現在位置との距離Rが移動ロボット100の現在位置から速度制限領域の外延までの最大距離未満である場合には、物陰の最近傍点が速度制限領域内に入ったと判断し、移動ロボット100と最近傍点との距離に応じて上述の手法で速度制限を行う(ステップS16)。   On the other hand, when the distance between the mobile robot 100 and the nearest point is a distance that needs to be speed limited (step S15: Yes), that is, the distance R between the nearest point in the shadow and the current position of the mobile robot 100 is the mobile robot. If the distance is less than the maximum distance from the current position of 100 to the extension of the speed limit area, it is determined that the nearest point in the shadow has entered the speed limit area, and the above-described distance is set according to the distance between the mobile robot 100 and the nearest point. The speed is limited by the method (step S16).

このように本実施の形態では、LRS101による検知結果により物陰の有無を判断して、速度制限対象の物陰が存在する場合には、物陰の最近傍点が速度制限領域に入った場合に、物陰の最近傍点と移動ロボット100の現在位置との距離Rに応じて走行速度の制限を行うので、移動ロボット100に環境マップを必須とせず、物陰の判断処理時間の短縮化および処理負担の軽減を図りつつ、動的に生じた物陰を正確に判断してより走行の安全性を向上させることができる。   As described above, in this embodiment, the presence / absence of a shadow is determined based on the detection result of the LRS 101, and when the shadow of the speed limit target exists, when the nearest point of the shadow enters the speed limit region, Since the traveling speed is limited according to the distance R between the nearest neighbor point and the current position of the mobile robot 100, the environment map is not required for the mobile robot 100, and the determination process time and the processing burden of the object are reduced. On the other hand, it is possible to improve the safety of traveling by accurately determining the dynamically generated shade.

(変形例)
実施の形態1では、速度制限対象の物陰が存在する場合に走行速度の制限を行っていたが、さらに、検知された障害物を固定静止物、変動静止物、移動体のいずれであるか判定し、この判定結果に基づいて速度制限を行う範囲である速度制限領域の広狭を定めて走行速度の制限を行うように構成してもよい。
(Modification)
In the first embodiment, the traveling speed is limited when there is an object to be speed limited. Further, it is determined whether the detected obstacle is a stationary stationary object, a variable stationary object, or a moving object. Then, it may be configured to limit the traveling speed by determining the width of the speed limiting area that is a range in which the speed is limited based on the determination result.

図8は、このような実施の形態1の変形例の移動ロボット800の機能的構成を示すブロック図である。本実施の形態にかかる移動ロボット800は、LRS101と、検知情報受信部102と、監視カメラ103と、画像情報受信部104と、操作パネル部105と、操作パネル制御部106と、スピーカ107と、音声出力制御部108と、現在位置取得部109と、物体判断部809と、物陰判断部110と、走行制御部812と、駆動部114と、通信部113と、環境マップ815とを主に備えている。   FIG. 8 is a block diagram showing a functional configuration of the mobile robot 800 according to the modification of the first embodiment. The mobile robot 800 according to the present embodiment includes an LRS 101, a detection information receiving unit 102, a monitoring camera 103, an image information receiving unit 104, an operation panel unit 105, an operation panel control unit 106, a speaker 107, It mainly includes an audio output control unit 108, a current position acquisition unit 109, an object determination unit 809, a shadow determination unit 110, a travel control unit 812, a drive unit 114, a communication unit 113, and an environment map 815. ing.

ここで、LRS101、検知情報受信部102、監視カメラ103、画像情報受信部104、操作パネル部105、操作パネル制御部106、スピーカ107、音声出力制御部108、現在位置取得部109、物陰判断部110、駆動部114、通信部113の機能および構成は実施の形態1と同様である。   Here, the LRS 101, the detection information receiving unit 102, the monitoring camera 103, the image information receiving unit 104, the operation panel unit 105, the operation panel control unit 106, the speaker 107, the audio output control unit 108, the current position acquisition unit 109, and the object judgment unit 110, the drive unit 114, and the communication unit 113 have the same functions and configurations as those in the first embodiment.

環境マップ815は、壁などの静止物を登録した地図データであり、HDD(ハードディスクドライブ装置)やメモリ等の記憶媒体(記憶部)に記憶されている。   The environment map 815 is map data in which a stationary object such as a wall is registered, and is stored in a storage medium (storage unit) such as an HDD (Hard Disk Drive Device) or a memory.

物体判断部809は、LRS101により検知された障害物が環境マップ815に登録されているか否かを判断し、登録されていない場合に、LRS101による複数回の障害物の検知結果から、障害物が移動しているか否かを判断する。   The object determination unit 809 determines whether or not an obstacle detected by the LRS 101 is registered in the environment map 815. If the obstacle is not registered, the object determination unit 809 determines whether the obstacle is detected from a plurality of obstacle detection results by the LRS 101. Determine if it is moving.

すなわち、本実施の形態では、LRS101で検知された障害物が固定静止物、変動静止物、移動体のいずれかであるかを物体判断部809で分類して、それぞれ異なる範囲の速度制限領域を定める。   That is, in the present embodiment, the object determination unit 809 classifies whether the obstacle detected by the LRS 101 is a stationary stationary object, a floating stationary object, or a moving object, and sets different speed limiting regions in different ranges. Determine.

ここで、固定静止物とは、環境マップ815の壁などと判定された障害物であり、この場合には移動する可能性はないため速度制限領域は小さくてよい。   Here, the stationary stationary object is an obstacle determined as a wall of the environment map 815 or the like, and in this case, there is no possibility of movement, so the speed limit area may be small.

変動静止物とは、環境マップ815の扉などと判定された障害物や環境マップ815にない静止物であり、移動する可能性のある障害物として扱う。これは、突然移動し始める可能性があるため、固定静止物よりも広い速度制限領域を設定する必要がある。   The variable stationary object is an obstacle that is determined as a door of the environment map 815 or the like, or a stationary object that is not in the environment map 815, and is handled as an obstacle that may move. Since this may start moving suddenly, it is necessary to set a speed limiting area wider than that of the stationary stationary object.

移動体は、現在移動している障害物であり、その移動方向を維持する可能性が高いが、突然方向を変えることも予想される。このため、最も広い速度制限領域を設定する必要がある。物陰には、この移動体が存在する可能性があるため、物陰も移動体と同じ速度制限領域を用いる。   The moving body is an obstacle that is currently moving, and it is highly likely that the moving direction will be maintained, but it is also expected that the direction will suddenly change. For this reason, it is necessary to set the widest speed limit region. Since there is a possibility that this moving object exists in the shadow, the same speed limiting region as the moving object is used for the shadow.

本実施の形態では、具体的には、速度制限領域として、速度制限領域1、速度制限領域2、速度制限領域3の3つの領域を考える。そして、速度制限領域1を所定の面積として、以下のような関係で各速度制限領域の面積を設定する。   In the present embodiment, specifically, three regions of a speed limiting region 1, a speed limiting region 2, and a speed limiting region 3 are considered as the speed limiting region. Then, with the speed limiting area 1 as a predetermined area, the area of each speed limiting area is set according to the following relationship.

速度制限領域1の領域⊂速度制限領域2の領域⊂速度制限領域3の領域
すなわち、第3速度制限領域が第2速度制限領域を包含し、第2速度制限領域が第1速度制限領域を包含する関係となっている。図9は、速度制限領域1〜3の一例を示す模式図である。ここで、各速度制限領域は、図9に示すように、実施の形態1と同様に、移動ロボット800の現在位置を含み、かつ移動ロボット800の直近の位置から移動ロボット100の進行方向に向かう扇状の領域であるが、形状はこれに限定されるものではない。
Area of speed limit area 1 area of speed limit area 2 area of speed limit area 3 That is, the third speed limit area includes the second speed limit area, and the second speed limit area includes the first speed limit area It has become a relationship. FIG. 9 is a schematic diagram illustrating an example of the speed limiting regions 1 to 3. Here, as shown in FIG. 9, each speed limiting region includes the current position of mobile robot 800 and travels in the traveling direction of mobile robot 100 from the position closest to mobile robot 800 as in the first embodiment. Although it is a fan-shaped area, the shape is not limited to this.

そして、速度制御部811は、障害物が固定静止物である場合には、速度制限領域1を用いて速度制限を行い、障害物が変動静止物である場合には、速度制限領域2を用いて速度制限を行い、障害物が移動体である場合には速度制限領域3を用いて速度制限を行う。   The speed control unit 811 limits the speed using the speed limit area 1 when the obstacle is a stationary stationary object, and uses the speed limit area 2 when the obstacle is a variable stationary object. The speed is limited by using the speed limiting area 3 when the obstacle is a moving body.

次に、以上のように構成された実施の形態1の変形例の速度制御処理について説明する。図10は、実施の形態1の変形例の速度制御処理の手順を示すフローチャートである。まず、LRS101により障害物が検知されると(ステップS31)、物体判断部809は、環境マップ815を参照し(ステップS32)、検知された障害物が環境マップ815に静止物として登録されているか否かを判断する(ステップS33)。   Next, a speed control process according to a modification of the first embodiment configured as described above will be described. FIG. 10 is a flowchart illustrating a procedure of speed control processing according to the modification of the first embodiment. First, when an obstacle is detected by the LRS 101 (step S31), the object determination unit 809 refers to the environment map 815 (step S32), and whether the detected obstacle is registered as a stationary object in the environment map 815. It is determined whether or not (step S33).

そして、障害物が環境マップ815に静止物として登録されている場合には(ステップS33:Yes)、物体判断部809は障害物を固定静止物と判定する(ステップS34)。そして、速度制御部811は、速度制限領域1を選択して(ステップS35)、固定静止物としての障害物が速度制限領域1に含まれることになったら、固定静止物と移動ロボット800の距離に応じた速度制限を行う(ステップS36)。   If the obstacle is registered as a stationary object in the environment map 815 (step S33: Yes), the object determination unit 809 determines that the obstacle is a fixed stationary object (step S34). Then, the speed control unit 811 selects the speed limiting area 1 (step S35), and when an obstacle as a stationary stationary object is included in the speed limiting area 1, the distance between the stationary stationary object and the mobile robot 800 is determined. The speed is limited according to (step S36).

一方、ステップS33において、障害物が静止物として環境マップ815に登録されていない場合には(ステップS33:No)、LRS101による複数回の検知結果を取得し(ステップS37)、その複数回の検知結果から障害物の物体位置が移動しているか否かを判断する(ステップS38)。   On the other hand, when the obstacle is not registered in the environment map 815 as a stationary object in step S33 (step S33: No), a plurality of detection results by the LRS 101 are acquired (step S37), and the plurality of detections are performed. It is determined from the result whether the object position of the obstacle is moving (step S38).

そして、変動していると判断した場合には(ステップS38:Yes)、物体判断部809は障害物を移動体と判定する(ステップS39)。そして、速度制御部811は、速度制限領域3を選択して(ステップS40)、移動体としての障害物が速度制限領域3に含まれることになったら、移動体と移動ロボット800の距離に応じた速度制限を行う(ステップS36)。   And when it is judged that it is changing (step S38: Yes), the object determination part 809 determines an obstruction as a moving body (step S39). Then, the speed control unit 811 selects the speed limiting area 3 (step S40), and when an obstacle as a moving body is included in the speed limiting area 3, the speed control unit 811 corresponds to the distance between the moving body and the mobile robot 800. The speed is limited (step S36).

一方、ステップS38において、障害物の物体位置が変動していないと判断された場合には(ステップS38:No)、物体判断部809は障害物を変動静止物と判定する(ステップS41)。そして、速度制御部811は、速度制限領域2を選択して(ステップS42)、変動静止物としての障害物が速度制限領域3に含まれることになったら、変動静止物と移動ロボット800の距離に応じた速度制限を行う(ステップS36)。   On the other hand, when it is determined in step S38 that the object position of the obstacle has not changed (step S38: No), the object determination unit 809 determines that the obstacle is a variable stationary object (step S41). Then, the speed control unit 811 selects the speed limit area 2 (step S42), and when an obstacle as a variable stationary object is included in the speed limit area 3, the distance between the variable stationary object and the mobile robot 800 is determined. The speed is limited according to (step S36).

ここで、障害物が各速度制限領域に含まれるか否かの判断手法は、移動ロボット800の最近傍点だけでなく、すべての計測点について行い、各速度制限領域内の最近傍点を使用して制限速度を決定する。障害物と移動ロボット800の距離に応じた速度制限の手法については、実施の形態1と同様である。   Here, the determination method of whether or not an obstacle is included in each speed limit area is performed not only on the nearest point of the mobile robot 800 but also on all measurement points, and using the nearest point in each speed limit area. Determine the speed limit. The speed limiting method according to the distance between the obstacle and the mobile robot 800 is the same as in the first embodiment.

このように実施の形態1の変形例では、さらに、障害物を固定静止物、変動静止物、移動体のいずれかを判定し、それぞれに応じて異なる範囲の速度制限領域を選択して移動ロボット800の走行速度の制限を行っているので、検知された障害物に応じてより的確に速度制限を行うことができ、走行の安全性をより向上させることができる。   As described above, in the modified example of the first embodiment, the mobile robot further determines whether the obstacle is a fixed stationary object, a variable stationary object, or a moving object, and selects a speed limiting region in a different range according to each obstacle. Since the limit of the traveling speed of 800 is performed, the speed can be more accurately limited according to the detected obstacle, and the safety of traveling can be further improved.

なお、本変形例では、環境マップ815を設け、検知された障害物が静止物として環境マップ815に登録されているか否かを判断して、静止物として登録されている場合には、速度制限領域1を用いて速度制限を行っているが、環境マップ815を設けない構成とすることもできる。   In this modification, an environment map 815 is provided, and it is determined whether or not the detected obstacle is registered in the environment map 815 as a stationary object. Although the speed limit is performed using the region 1, the environment map 815 may not be provided.

この場合には、速度制御881を、物体判定部809により障害物が移動していると判断された場合において、障害物が速度制限領域3に含まれる時点から走行速度を制限し、障害物が移動していないと判断された場合において、障害物が速度制限領域2に含まれる時点から走行速度を制限するように構成すればよい。   In this case, the speed control 881 limits the traveling speed from the time when the obstacle is included in the speed restriction area 3 when the object determination unit 809 determines that the obstacle is moving, What is necessary is just to comprise so that a travel speed may be restrict | limited from the time when an obstacle is contained in the speed restriction area 2, when it is judged that it is not moving.

(実施の形態2)
実施の形態1では、LRS101の検知結果のみで速度制限の対象の物陰を判断していたが、実施の形態2は、環境マップとLRS101の双方を用いて速度制限対象の物陰を判断し、走行速度の制限を行うものである。
(Embodiment 2)
In the first embodiment, the object of the speed restriction target is determined only by the detection result of the LRS 101. However, in the second embodiment, the object of the speed restriction object is determined using both the environment map and the LRS 101, and the traveling is performed. This is to limit the speed.

図11は、実施の形態2の移動ロボット1100の機能的構成を示すブロック図である。本実施の形態にかかる移動ロボット1100は、LRS101と、検知情報受信部102と、監視カメラ103と、画像情報受信部104と、操作パネル部105と、操作パネル制御部106と、スピーカ107と、音声出力制御部108と、現在位置取得部109と、物陰判断部110と、走行制御部1112と、駆動部114と、通信部113と、環境マップ1115とを主に備えている。   FIG. 11 is a block diagram illustrating a functional configuration of the mobile robot 1100 according to the second embodiment. A mobile robot 1100 according to the present embodiment includes an LRS 101, a detection information receiving unit 102, a monitoring camera 103, an image information receiving unit 104, an operation panel unit 105, an operation panel control unit 106, a speaker 107, It mainly includes an audio output control unit 108, a current position acquisition unit 109, a shadow determination unit 110, a travel control unit 1112, a drive unit 114, a communication unit 113, and an environment map 1115.

ここで、LRS101、検知情報受信部102、監視カメラ103、画像情報受信部104、操作パネル部105、操作パネル制御部106、スピーカ107、音声出力制御部108、現在位置取得部109、物陰判断部110、駆動部114、通信部113の機能および構成は実施の形態1と同様である。   Here, the LRS 101, the detection information receiving unit 102, the monitoring camera 103, the image information receiving unit 104, the operation panel unit 105, the operation panel control unit 106, the speaker 107, the audio output control unit 108, the current position acquisition unit 109, and the object judgment unit 110, the drive unit 114, and the communication unit 113 have the same functions and configurations as those in the first embodiment.

本実施の形態の走行制御部1112は、実施の形態1と同様に移動ロボット1100の走行制御を行い、速度制御部1111を備えている。   The travel control unit 1112 of this embodiment performs travel control of the mobile robot 1100 as in the first embodiment, and includes a speed control unit 1111.

環境マップ1115は、壁などの静止物を登録した地図データであり、HDD(ハードディスクドライブ装置)やメモリ等の記憶媒体(記憶部)に記憶されている。   The environment map 1115 is map data in which a stationary object such as a wall is registered, and is stored in a storage medium (storage unit) such as an HDD (Hard Disk Drive Device) or a memory.

図12は、移動ロボット1100の走行中に現れる物陰の例を示す模式図である。図12に示すように、走行経路上には、大小様々なサイズの物陰が現れる。しかし、これらの全ての物陰に対して移動ロボット1100の走行速度を制限する必要はない。物陰が、例えば、人間が隠れることができない程度の所定サイズ以下の小さな物陰の場合、速度制限対象としない(図12左の例)。これは、このような小さな物陰に人間が隠れている可能性は低く、急な飛び出しが起こる可能性が極めて少ないからである。   FIG. 12 is a schematic diagram showing an example of a shadow appearing while the mobile robot 1100 is traveling. As shown in FIG. 12, shades of various sizes appear on the travel route. However, it is not necessary to limit the traveling speed of the mobile robot 1100 for all these shades. For example, in the case where the shadow is a small shadow of a predetermined size or less that cannot be hidden by a human, the speed is not limited (example on the left in FIG. 12). This is because it is unlikely that a human is hiding in such a small shadow, and there is very little possibility of sudden jumping out.

一方、物陰が、例えば、人間が隠れることができる程度の所定サイズより大きい大きな物陰の場合、速度制限対象とする(図12右の例)。これは、このような大きな物陰には人間が隠れている可能性があり、急な飛び出しが起こる可能性があるからである。   On the other hand, if the shadow is a large shadow that is larger than a predetermined size that can be hidden by a human, for example, the target is a speed limit target (example on the right in FIG. 12). This is because there is a possibility that a human may be hiding in such a large shadow and a sudden jump may occur.

なお、物陰のサイズは、物陰と認定された場所の奥の通路の面積を環境マップ1115上から求めることにより算出すればよい。   The size of the shadow may be calculated by obtaining the area of the passage behind the place that is recognized as the shadow from the environment map 1115.

このため、速度制御部1111では、LRS101の検知結果に基づいて物陰判断部110により物陰があると判断された場合には、環境マップ1115によりこの物陰のサイズを求め、サイズが所定サイズより大きいか否かにより、速度制限を行うか判断する。そして、速度制御部1111は、速度制限を行う場合、移動ロボット1100の制限速度を実施の形態1と同様の手法(図5,6等)で決定する。   For this reason, if the speed control unit 1111 determines that there is a shadow based on the detection result of the LRS 101, the speed control unit 1111 obtains the size of the shadow from the environment map 1115, and whether the size is larger than the predetermined size. It is determined whether or not to limit the speed depending on whether or not. Then, the speed control unit 1111 determines the speed limit of the mobile robot 1100 by the same method (FIGS. 5 and 6 etc.) as in the first embodiment when speed limiting is performed.

次に、このように構成された本実施の形態の速度制御処理について説明する。図13は、実施の形態2の速度制御処理の手順を示すフローチャートである。実施の形態1と同様にLRS101の検知結果から物陰ありと判定されると(ステップS51〜S53)、速度制御部1111は、環境マップ1115を参照して(ステップS54)、判定された物陰が環境マップ1115上で所定サイズより大きいか否かを判断する(ステップS55)。   Next, the speed control process of the present embodiment configured as described above will be described. FIG. 13 is a flowchart illustrating a procedure of speed control processing according to the second embodiment. When it is determined that there is a shadow from the detection result of the LRS 101 as in the first embodiment (steps S51 to S53), the speed controller 1111 refers to the environment map 1115 (step S54), and the determined shadow is the environment. It is determined whether or not it is larger than a predetermined size on the map 1115 (step S55).

そして、物陰が所定サイズ以下の場合には(ステップS55:No)、速度制限対象でない物陰と判断して速度制限は行わない(ステップS60)。   When the shade is equal to or smaller than the predetermined size (step S55: No), it is determined that the shade is not a speed restriction target and the speed is not restricted (step S60).

一方、物陰が所定サイズより大きい場合には(ステップS55:Yes)、速度制限対象の物陰であると判断して、実施の形態1と同様に速度制限領域内での速度制限処理を行う(ステップS56〜S58)。   On the other hand, when the shadow is larger than the predetermined size (step S55: Yes), it is determined that the shadow is a shadow to be speed limited, and the speed limiting process within the speed limiting area is performed as in the first embodiment (step S55). S56-S58).

このように本実施の形態では、LRS101の検知結果から物陰があると判断された場合に環境マップ1115上でその物陰のサイズを参照して、速度制限の対象とするか否かを決定しているので、より的確に速度制限を行ってより安全な走行を行うことができる。   As described above, in this embodiment, when it is determined from the detection result of the LRS 101 that there is a shadow, the size of the shadow is referred to on the environment map 1115 to determine whether or not to be a speed limit target. Therefore, it is possible to perform safer driving by limiting the speed more accurately.

なお、本実施の形態の移動ロボット1100において、さらに実施の形態1の変形例の機能を有するように構成してもよい。   Note that the mobile robot 1100 of the present embodiment may further be configured to have the function of the modification of the first embodiment.

なお、本発明は、上記実施の形態そのままに限定されるものではなく、実施段階ではその要旨を逸脱しない範囲で構成要素を変形して具体化することができる。また、上記実施の形態に開示されている複数の構成要素の適宜な組み合わせにより、種々の発明を形成することができる。例えば、実施の形態に示される全構成要素からいくつかの構成要素を削除してもよい。さらに、異なる実施の形態にわたる構成要素を適宜組み合わせても良い。   It should be noted that the present invention is not limited to the above-described embodiment as it is, and can be embodied by modifying the constituent elements without departing from the scope of the invention in the implementation stage. In addition, various inventions can be formed by appropriately combining a plurality of constituent elements disclosed in the above embodiments. For example, some components may be deleted from all the components shown in the embodiment. Furthermore, constituent elements over different embodiments may be appropriately combined.

実施の形態1にかかる移動ロボットの機能的構成を示すブロック図である。1 is a block diagram showing a functional configuration of a mobile robot according to a first embodiment. 実施の形態1にかかる移動ロボットの外観の一例を示す説明図である。FIG. 3 is an explanatory diagram illustrating an example of an appearance of a mobile robot according to the first embodiment. 物陰判断を説明するための模式図である。It is a schematic diagram for demonstrating a thing shade determination. 物陰判断を説明するための模式図である。It is a schematic diagram for demonstrating a thing shade determination. 速度制限領域を示す模式図である。It is a schematic diagram which shows a speed restriction | limiting area | region. 距離Rと走行速度の制限速度との関係を示すグラフである。It is a graph which shows the relationship between the distance R and the speed limit of traveling speed. 距離Rと走行速度の制限速度との関係の他の例を示すグラフである。It is a graph which shows the other example of the relationship between the distance R and the speed limit of traveling speed. 実施の形態1の速度制御処理の手順を示すフローチャートである。3 is a flowchart illustrating a procedure of speed control processing according to the first embodiment. 実施の形態1の変形例の移動ロボットの機能的構成を示すブロック図である。FIG. 6 is a block diagram showing a functional configuration of a mobile robot according to a modification of the first embodiment. 速度制限領域1〜3の一例を示す模式図である。It is a schematic diagram which shows an example of the speed limit area | regions 1-3. 実施の形態1の変形例の速度制御処理の手順を示すフローチャートである。6 is a flowchart illustrating a procedure of speed control processing according to a modification of the first embodiment. 実施の形態2の移動ロボットの機能的構成を示すブロック図である。6 is a block diagram illustrating a functional configuration of a mobile robot according to a second embodiment. FIG. 移動ロボットの走行中に現れる物陰の例を示す模式図である。It is a schematic diagram which shows the example of the shadow which appears during driving | running | working of a mobile robot. 実施の形態2の速度制御処理の手順を示すフローチャートである。10 is a flowchart illustrating a procedure of speed control processing according to the second embodiment.

符号の説明Explanation of symbols

100,800,1100 移動ロボット
101 レーザレンジセンサ
102 検知情報受信部
103 監視カメラ
104 画像情報受信部
105 操作パネル部
106 操作パネル制御部
107 スピーカ
108 音声出力制御部
109 現在位置取得部
111,811,1111 速度制御部
112,812,1112 走行制御部
113 通信部
114 駆除部
815,1115 環境マップ
100, 800, 1100 Mobile robot 101 Laser range sensor 102 Detection information receiving unit 103 Monitoring camera 104 Image information receiving unit 105 Operation panel unit 106 Operation panel control unit 107 Speaker 108 Audio output control unit 109 Current position acquisition unit 111, 811, 1111 Speed controller 112, 812, 1112 Travel controller 113 Communication unit 114 Exterminator 815, 1115 Environmental map

Claims (9)

自律移動体であって、
走行方向に存在する障害物を検知する検知手段と、
検知された障害物の計測点間の距離に基づいて、物陰の存在の有無を判断する物陰判断手段と、
前記物陰が存在すると判定された場合に、前記物陰の近傍で前記物陰との距離に基づいて前記自律移動体の走行速度を制限する速度制御手段と、
を備えたことを特徴とする自律移動体。
An autonomous mobile body,
Detection means for detecting obstacles present in the traveling direction;
A shade judgment means for judging the presence or absence of a shade based on the distance between the measurement points of the detected obstacle;
A speed control means for limiting a traveling speed of the autonomous mobile body based on a distance from the shadow in the vicinity of the shadow when it is determined that the shadow is present;
An autonomous mobile body characterized by comprising:
前記物陰判断手段は、前記計測点間の距離が人体幅以上である場合に、速度制限対象の物陰が存在すると判断し、
前記速度制御手段は、前記速度制限対象の物陰が存在すると判定された場合に、前記物陰の近傍で前記物陰との距離に基づいて前記走行速度を制限することを特徴とする請求項1に記載の自律移動体。
The shade determination means determines that there is a shadow of a speed limit target when a distance between the measurement points is equal to or greater than a human body width.
The speed control means limits the traveling speed based on a distance from the shadow in the vicinity of the shadow when it is determined that the shadow of the speed restriction target exists. Autonomous mobile body.
前記自律移動体を含むとともに所定の領域である第1速度制限領域と、前記自律移動体を含むとともに前記第1速度制限領域より広い領域である第2速度制限領域と、前記自律移動体を含むとともに前記第2速度制限領域より広い領域である第3速度制限領域とが設定され、
前記検知手段による複数回の前記障害物の検知結果に基づいて、前記障害物が移動しているか否かを判断する物体判断手段をさらに備え、
前記速度制御手段は、前記物体判断手段によって前記障害物が移動していると判断された場合において、前記障害物が前記第3速度制限領域に含まれる時点から前記走行速度を制限し、前記物体判断手段によって前記障害物が移動していないと判断された場合において、前記障害物が前記第2速度制限領域に含まれる時点から前記走行速度を制限することを特徴とする請求項1または2に記載の自律移動体。
A first speed limiting area that includes the autonomous mobile body and a predetermined area; a second speed limiting area that includes the autonomous mobile body and is wider than the first speed limiting area; and the autonomous mobile body And a third speed limit area that is wider than the second speed limit area is set,
Further comprising an object judging means for judging whether or not the obstacle is moving based on a result of detecting the obstacle a plurality of times by the detecting means;
The speed control means limits the traveling speed from the time when the obstacle is included in the third speed restriction area when the object judgment means judges that the obstacle is moving, and the object 3. The travel speed is limited from a time point when the obstacle is included in the second speed limit area when it is determined by the determination means that the obstacle is not moving. The autonomous mobile body described.
壁などの静止物を登録した環境地図を記憶する記憶手段をさらに備え、
前記自律移動体を含むとともに所定の領域である第1速度制限領域と、前記自律移動体を含むとともに前記第1速度制限領域より広い領域である第2速度制限領域と、前記自律移動体を含むとともに前記第2速度制限領域より広い領域である第3速度制限領域とが設定され、
検知された障害物が前記環境地図に登録されている静止物であるか否かを判断し、登録されている静止物でない場合に、前記検知手段による複数回の前記障害物の検知結果に基づいて、前記障害物が移動しているか否かを判断する物体判断手段をさらに備え、
前記速度制御手段は、前記物体判断手段によって前記障害物が移動していると判断された場合において、前記障害物が前記第3速度制限領域に含まれる時点から前記走行速度を制限し、前記物体判断手段によって前記障害物が移動していないと判断された場合において、前記障害物が前記第2速度制限領域に含まれる時点から前記走行速度を制限することを特徴とする請求項1または2に記載の自律移動体。
A storage means for storing an environmental map in which stationary objects such as walls are registered;
A first speed limiting area that includes the autonomous mobile body and a predetermined area; a second speed limiting area that includes the autonomous mobile body and is wider than the first speed limiting area; and the autonomous mobile body And a third speed limit area that is wider than the second speed limit area is set,
It is determined whether or not the detected obstacle is a stationary object registered in the environmental map, and when the detected obstacle is not a registered stationary object, based on a plurality of detection results of the obstacle by the detection means. And an object judging means for judging whether or not the obstacle is moving,
The speed control means limits the traveling speed from the time when the obstacle is included in the third speed restriction area when the object judgment means judges that the obstacle is moving, and the object 3. The travel speed is limited from the time when the obstacle is included in the second speed limit area when the determination means determines that the obstacle is not moving. The autonomous mobile body described.
前記速度制限手段は、前記物体判定手段によって前記検知された障害物が前記環境地図に登録された静止物である判断された場合には、前記自律移動体の移動とともに前記障害物が前記第1速度制限領域に含まれた時点から前記走行速度を制限することを特徴とする請求項4に記載の自律移動体。   The speed limiting means, when the object judging means judges that the detected obstacle is a stationary object registered in the environmental map, the obstacle is moved along with the movement of the autonomous mobile body. The autonomous mobile body according to claim 4, wherein the travel speed is limited from a time point included in the speed limit area. 壁などの静止物を登録した環境地図を記憶する記憶手段をさらに備え、
前記速度制御手段は、さらに、前記物陰の領域サイズが所定サイズより大きいか否かを判断し、所定サイズより大きい場合に、速度制限対象の物陰であると判断し、前記物陰の近傍で前記物陰との距離に基づいて前記走行速度を制限することを特徴とする請求項1または2に記載の自律移動体。
A storage means for storing an environmental map in which stationary objects such as walls are registered;
The speed control means further determines whether or not the area size of the shadow is larger than a predetermined size. If the area size is larger than the predetermined size, the speed control means determines that the shadow is a speed-limited target shadow, and the shadow is near the shadow. The autonomous mobile body according to claim 1, wherein the traveling speed is limited based on a distance from the vehicle.
前記物陰判断手段は、さらに前記速度制限対象の物陰における前記自律移動体に対する最近傍点を求め、
前記速度制御手段は、前記最近傍点と前記自律移動体との距離に応じて前記走行速度を制限することを特徴とする請求項1〜6のいずれか一つに記載の自律移動体。
The shade determination means further determines a nearest point for the autonomous mobile body in the shade of the speed limit target,
The autonomous mobile body according to any one of claims 1 to 6, wherein the speed control means limits the traveling speed according to a distance between the nearest neighbor point and the autonomous mobile body.
前記速度制御手段は、前記速度制限領域内で、前記最近傍点と前記自律移動体との距離に応じて段階的に前記走行速度を制限することを特徴とする請求項7に記載の自律移動体。   The autonomous mobile body according to claim 7, wherein the speed control means limits the travel speed in a stepwise manner in accordance with a distance between the nearest neighbor point and the autonomous mobile body within the speed limiting region. . 自律移動体の走行速度を制御する速度制御方法であって、
走行方向に存在する障害物を検知する検知ステップと、
検知された障害物の計測点間の距離に基づいて、物陰の存在の有無を判断する物陰判断ステップと、
前記物陰が存在すると判定された場合に、前記物陰の近傍で前記物陰との距離に基づいて前記自律移動体の走行速度を制限する速度制御ステップと、
を含むことを特徴とする速度制御方法。
A speed control method for controlling the traveling speed of an autonomous mobile body,
A detection step for detecting an obstacle present in the traveling direction;
A shade determination step for determining the presence or absence of a shadow based on the distance between the measurement points of the detected obstacle;
A speed control step of limiting the traveling speed of the autonomous mobile body based on the distance from the shadow in the vicinity of the shadow when it is determined that the shadow exists;
A speed control method comprising:
JP2008309046A 2008-12-03 2008-12-03 Autonomous mobile body and speed control method Active JP5319255B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2008309046A JP5319255B2 (en) 2008-12-03 2008-12-03 Autonomous mobile body and speed control method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2008309046A JP5319255B2 (en) 2008-12-03 2008-12-03 Autonomous mobile body and speed control method

Publications (2)

Publication Number Publication Date
JP2010134656A true JP2010134656A (en) 2010-06-17
JP5319255B2 JP5319255B2 (en) 2013-10-16

Family

ID=42345902

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2008309046A Active JP5319255B2 (en) 2008-12-03 2008-12-03 Autonomous mobile body and speed control method

Country Status (1)

Country Link
JP (1) JP5319255B2 (en)

Cited By (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2012185776A (en) * 2011-03-08 2012-09-27 Sogo Keibi Hosho Co Ltd Autonomous mobile body, direction correction method for autonomous mobile body and direction correction program for autonomous mobile body
US20120310466A1 (en) * 2011-06-01 2012-12-06 Google Inc. Sensor field selection
JP2014123200A (en) * 2012-12-20 2014-07-03 Toyota Motor Corp Moving body control apparatus, moving body control method, and control program
WO2015029331A1 (en) * 2013-08-30 2015-03-05 トヨタ自動車株式会社 Robot and method for controlling same
WO2015072002A1 (en) * 2013-11-15 2015-05-21 株式会社日立製作所 Mobile robot system
JP2015208789A (en) * 2014-04-24 2015-11-24 トヨタ自動車株式会社 Operation restriction device and operation restriction method
JP2016012257A (en) * 2014-06-30 2016-01-21 日本信号株式会社 Robot device
US9381916B1 (en) 2012-02-06 2016-07-05 Google Inc. System and method for predicting behaviors of detected objects through environment representation
KR20180087784A (en) * 2017-01-25 2018-08-02 엘지전자 주식회사 Method of drawing map by identifying moving object and robot implementing thereof
US10071744B2 (en) * 2015-12-08 2018-09-11 Robert Bosch Gmbh Method, computer program, storage medium and electronic control unit for operating a vehicle
US10245730B2 (en) * 2016-05-24 2019-04-02 Asustek Computer Inc. Autonomous mobile robot and control method thereof
KR20190096327A (en) * 2017-01-25 2019-08-19 엘지전자 주식회사 Method of drawing map by identifying moving object and robot implementing thereof
CN110941261A (en) * 2019-10-19 2020-03-31 中国海洋大学 Autonomous underwater vehicle multi-zone traversal path planning method
JP2020095435A (en) * 2018-12-12 2020-06-18 株式会社日立製作所 Moving body

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08275913A (en) * 1995-04-05 1996-10-22 Matsushita Electric Ind Co Ltd Self-traveling type cleaner
JP2001034898A (en) * 1999-07-21 2001-02-09 Toyota Central Res & Dev Lab Inc Investigation disable area estimating device and driving support system
JP2004171165A (en) * 2002-11-19 2004-06-17 Honda Motor Co Ltd Moving apparatus
JP2006293662A (en) * 2005-04-11 2006-10-26 Figla Co Ltd Working robot
JP2009294934A (en) * 2008-06-05 2009-12-17 Ihi Corp Autonomous mobile apparatus and control method for autonomous mobile apparatus

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08275913A (en) * 1995-04-05 1996-10-22 Matsushita Electric Ind Co Ltd Self-traveling type cleaner
JP2001034898A (en) * 1999-07-21 2001-02-09 Toyota Central Res & Dev Lab Inc Investigation disable area estimating device and driving support system
JP2004171165A (en) * 2002-11-19 2004-06-17 Honda Motor Co Ltd Moving apparatus
JP2006293662A (en) * 2005-04-11 2006-10-26 Figla Co Ltd Working robot
JP2009294934A (en) * 2008-06-05 2009-12-17 Ihi Corp Autonomous mobile apparatus and control method for autonomous mobile apparatus

Cited By (28)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2012185776A (en) * 2011-03-08 2012-09-27 Sogo Keibi Hosho Co Ltd Autonomous mobile body, direction correction method for autonomous mobile body and direction correction program for autonomous mobile body
US20120310466A1 (en) * 2011-06-01 2012-12-06 Google Inc. Sensor field selection
US8589014B2 (en) * 2011-06-01 2013-11-19 Google Inc. Sensor field selection
US9766626B1 (en) 2012-02-06 2017-09-19 Waymo Llc System and method for predicting behaviors of detected objects through environment representation
US10564639B1 (en) 2012-02-06 2020-02-18 Waymo Llc System and method for predicting behaviors of detected objects through environment representation
US9381916B1 (en) 2012-02-06 2016-07-05 Google Inc. System and method for predicting behaviors of detected objects through environment representation
US11287820B1 (en) 2012-02-06 2022-03-29 Waymo Llc System and method for predicting behaviors of detected objects through environment representation
JP2014123200A (en) * 2012-12-20 2014-07-03 Toyota Motor Corp Moving body control apparatus, moving body control method, and control program
JP2015047649A (en) * 2013-08-30 2015-03-16 トヨタ自動車株式会社 Robot and control method of the same
WO2015029331A1 (en) * 2013-08-30 2015-03-05 トヨタ自動車株式会社 Robot and method for controlling same
US10232519B2 (en) 2013-08-30 2019-03-19 Toyota Jidosha Kabushiki Kaisha Robot and method of controlling the same
WO2015072002A1 (en) * 2013-11-15 2015-05-21 株式会社日立製作所 Mobile robot system
JP6072934B2 (en) * 2013-11-15 2017-02-01 株式会社日立製作所 Mobile robot system
JPWO2015072002A1 (en) * 2013-11-15 2017-03-09 株式会社日立製作所 Mobile robot system
US10198008B2 (en) 2013-11-15 2019-02-05 Hitachi, Ltd. Mobile robot system
JP2015208789A (en) * 2014-04-24 2015-11-24 トヨタ自動車株式会社 Operation restriction device and operation restriction method
US9469031B2 (en) 2014-04-24 2016-10-18 Toyota Jidosha Kabushiki Kaisha Motion limiting device and motion limiting method
JP2016012257A (en) * 2014-06-30 2016-01-21 日本信号株式会社 Robot device
US10071744B2 (en) * 2015-12-08 2018-09-11 Robert Bosch Gmbh Method, computer program, storage medium and electronic control unit for operating a vehicle
US10245730B2 (en) * 2016-05-24 2019-04-02 Asustek Computer Inc. Autonomous mobile robot and control method thereof
KR20180087784A (en) * 2017-01-25 2018-08-02 엘지전자 주식회사 Method of drawing map by identifying moving object and robot implementing thereof
KR20190096327A (en) * 2017-01-25 2019-08-19 엘지전자 주식회사 Method of drawing map by identifying moving object and robot implementing thereof
KR102012549B1 (en) * 2017-01-25 2019-08-20 엘지전자 주식회사 Method of drawing map by identifying moving object and robot implementing thereof
US10783363B2 (en) 2017-01-25 2020-09-22 Lg Electronics Inc. Method of creating map by identifying moving object, and robot implementing the method
KR102420090B1 (en) * 2017-01-25 2022-07-11 엘지전자 주식회사 Method of drawing map by identifying moving object and robot implementing thereof
JP2020095435A (en) * 2018-12-12 2020-06-18 株式会社日立製作所 Moving body
JP7302966B2 (en) 2018-12-12 2023-07-04 株式会社日立製作所 moving body
CN110941261A (en) * 2019-10-19 2020-03-31 中国海洋大学 Autonomous underwater vehicle multi-zone traversal path planning method

Also Published As

Publication number Publication date
JP5319255B2 (en) 2013-10-16

Similar Documents

Publication Publication Date Title
JP5319255B2 (en) Autonomous mobile body and speed control method
KR20210134530A (en) System and method for avoiding obstacle for autonomous vehicle
US20200001779A1 (en) Method for communicating intent of an autonomous vehicle
KR102207964B1 (en) Method for generating parking track of smart parking system and apparatus thereof
JP6652090B2 (en) Operation mode switching control device, system, method, and program
KR20150135007A (en) Unmanned vehicle driving apparatus and method for obstacle avoidance
JPWO2019058720A1 (en) Information processing equipment, autonomous mobile devices, and methods, and programs
US10688995B2 (en) Method for controlling travel and device for controlling travel of vehicle
EP4097554B1 (en) Traffic light detection and classification for autonomous driving vehicles
JP5974718B2 (en) Vehicle travel support device and vehicle travel support method
US11897331B2 (en) In-vehicle acoustic monitoring system for driver and passenger
US20200361376A1 (en) Rear display device
US20200353950A1 (en) Vehicle control method and system
US11926317B2 (en) Managing lane change threats
JP5448429B2 (en) Moving body detection device and moving body detection method
WO2020121612A1 (en) Vehicle control device, vehicle control method, vehicle control program, non-transitory recording medium, and vehicle
JP2011194507A (en) Apparatus and program for providing services, and service robot
JP2009233839A (en) Moving body, moving body direction control method, and moving body direction control program
JP2018092669A (en) Merging support device, merging support method, and merging support program
KR102413579B1 (en) Apparatus for making a driver operate a car easily and target estimation method thereof
KR20180005482A (en) Apparatus and Method for Controlling Vehicle Camera
WO2015129027A1 (en) Convergence-supporting device, convergence-supporting method, and convergence-supporting program
JP2010238182A (en) Autonomous mobile object and suspicious person detecting method
JP5817270B2 (en) Vehicle control device
JP2020050263A (en) Travel control device, travel control method, and program

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20110624

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20120725

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20120807

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20121009

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20130122

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20130321

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20130711

R150 Certificate of patent or registration of utility model

Ref document number: 5319255

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250