JP5448429B2 - Moving body detection device and moving body detection method - Google Patents

Moving body detection device and moving body detection method Download PDF

Info

Publication number
JP5448429B2
JP5448429B2 JP2008305082A JP2008305082A JP5448429B2 JP 5448429 B2 JP5448429 B2 JP 5448429B2 JP 2008305082 A JP2008305082 A JP 2008305082A JP 2008305082 A JP2008305082 A JP 2008305082A JP 5448429 B2 JP5448429 B2 JP 5448429B2
Authority
JP
Japan
Prior art keywords
blind spot
area
map
obstacle
spot area
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2008305082A
Other languages
Japanese (ja)
Other versions
JP2010127849A (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.)
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 JP2008305082A priority Critical patent/JP5448429B2/en
Publication of JP2010127849A publication Critical patent/JP2010127849A/en
Application granted granted Critical
Publication of JP5448429B2 publication Critical patent/JP5448429B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Optical Radar Systems And Details Thereof (AREA)

Description

本発明は、障害物を検知し、検知した障害物が移動体であるか否かを判定する移動体検知装置および移動体検知方法に関する。   The present invention relates to a moving body detection apparatus and a moving body detection method for detecting an obstacle and determining whether or not the detected obstacle is a moving body.

移動ロボット等において、障害物を検知し、検知した障害物が移動体であるか否かを判定する移動体検知装置としては従来から以下のような技術が知られている。例えば、レーザレンジセンサ(以下、「LRS」という。)で一定時間毎に障害物を検知し、一回前にLRSにより検知した障害物の位置データから移動ロボットの移動量を差し引いた位置と現在LRSにより検知した障害物とを比較して、障害物の位置の変化の有無を判定し、変化している場合には、この障害物は移動していると判定する技術が知られている(特許文献1等参照)。   Conventionally, the following techniques are known as a mobile body detection apparatus that detects an obstacle in a mobile robot or the like and determines whether or not the detected obstacle is a mobile body. For example, an obstacle is detected at regular intervals with a laser range sensor (hereinafter referred to as “LRS”), and the position obtained by subtracting the moving amount of the mobile robot from the position data of the obstacle detected by the LRS one time before and the current position A technique is known in which an obstacle detected by LRS is compared to determine whether or not the position of the obstacle has changed, and when the obstacle has changed, the obstacle is determined to be moving ( (See Patent Document 1).

特開2006−158690号公報JP 2006-158690 A

しかしながら、このような従来技術では、検知する側の移動ロボットも移動しているため、移動した位置によってLRSにより検知不可能な領域、すなわち死角領域も変化していく。このため、このような死角領域の変化により静止物である障害物も移動体と誤って判定されてしまう場合がある。   However, in such a conventional technique, since the mobile robot on the detection side is also moving, the area that cannot be detected by the LRS, that is, the blind spot area, also changes depending on the moved position. For this reason, an obstacle that is a stationary object may be erroneously determined as a moving object due to such a change in the blind spot area.

本発明は、上記に鑑みてなされたものであって、より正確に移動体の判定を行うことができる移動体検知装置および移動体検知方法を提供することを主な目的とする。   The present invention has been made in view of the above, and it is a main object of the present invention to provide a moving body detection apparatus and a moving body detection method capable of more accurately determining a moving body.

上述した課題を解決し、目的を達成するために、本発明にかかる移動体検知装置は、所定の移動領域を移動可能な移動体検知装置であって、前記移動体検知装置の第1の位置、および前記第1の位置から前記移動体検知装置の移動後の第2の位置のそれぞれにおいて、障害物の位置を検知する検知手段と、前記第1の位置および前記第2の位置のそれぞれにおいて、前記移動体検知装置の現在位置を取得する現在位置取得手段と、前記第1の位置および前記第2の位置のそれぞれに対して、前記移動領域において、前記現在位置と検知された複数の障害物の各位置を直線で結び、前記直線で描かれる領域である空領域以外の領域である死角領域を認識する死角領域認識手段と、前記第1の位置において検知された前記障害物の位置から前記第2の位置において認識された前記死角領域に含まれる位置を除外することにより第1計測位置を選択し、前記第2の位置において検知された前記障害物の位置から前記第1の位置において認識された前記死角領域に含まれる位置を除外することにより第2計測位置を選択する計測位置選択手段と、前記第1計測位置と前記第2計測位置とに差分があるか否かを判断し、前記差分がある場合に前記差分の位置の障害物が移動体であると判定する移動体判定手段と、を備えたことを特徴とする。 In order to solve the above-described problems and achieve the object, a mobile body detection device according to the present invention is a mobile body detection device capable of moving in a predetermined movement area, and the first position of the mobile body detection device. And detecting means for detecting the position of an obstacle at each of the second positions after the moving body detecting device has moved from the first position, and at each of the first position and the second position. a current position obtaining means for obtaining a current position of the moving body detecting device, wherein the first position and for each of said second position, in the moving area, a plurality of failures the sensed current position From the position of the obstacle detected at the first position, blind spot area recognition means for recognizing a blind spot area that is an area other than the sky area that is an area drawn by the straight line, connecting each position of the object with a straight line Said First select the measurement location by excluding locations that are included in recognized the blind area was in position, recognized in the first position from the position of the detected the obstacle in the second position A measurement position selecting means for selecting a second measurement position by excluding a position included in the blind spot area, and determining whether or not there is a difference between the first measurement position and the second measurement position; It characterized in that the obstacle position of the difference is and a moving object determination unit to determine the constant to be mobile when there is.

また、本発明にかかる移動体検知方法は、所定の移動領域を移動可能な移動体検知装置で実行される移動体検知方法あって、検知手段が、前記移動体検知装置の第1の位置において、障害物の位置を検知する第1検知ステップと、現在位置取得手段が、前記第1の位置において、前記移動体検知装置の現在位置を取得する第1現在位置取得ステップと、死角領域認識手段が、前記第1の位置に対して、前記移動領域において、前記現在位置と検知された複数の障害物の各位置を直線で結び、前記直線で描かれる領域である空領域以外の領域である死角領域を認識する第1死角領域認識ステップと、前記検知手段が、前記第1の位置から前記移動体検知装置の移動後の第2の位置において、前記障害物の位置を検知する第2検知ステップと、前記現在位置取得手段が、前記第2の位置において、前記移動体検知装置の現在位置を取得する第2現在位置取得ステップと、死角領域認識手段が、前記第2の位置に対して、前記移動領域において、前記現在位置と検知された複数の障害物の各位置を直線で結び、前記直線で描かれる領域である空領域以外の領域である死角領域を認識する第2死角領域認識ステップと、計測位置選択手段が、前記第1の位置において検知された前記障害物の位置から前記第2の位置において認識された前記死角領域に含まれる位置を除外することにより第1計測位置を選択し、前記第2の位置において検知された前記障害物の位置から前記第1の位置において認識された前記死角領域に含まれる位置を除外することにより第2計測位置を選択する計測位置選択ステップと、移動体判定手段が、前記第1計測位置と前記第2計測位置とに差分があるか否かを判断し、前記差分がある場合に前記差分の位置の障害物が移動体であると判定する移動体判定ステップと、を含むことを特徴とする。 The mobile body detection method according to the present invention is a mobile body detection method executed by a mobile body detection device capable of moving in a predetermined movement area, wherein the detection means is at a first position of the mobile body detection device. A first detection step for detecting the position of the obstacle; a current position acquisition unit for acquiring a current position of the moving object detection device at the first position; and a blind spot area recognition unit. but for the first position, in the moving area, the respective position of the current plurality of obstacle detected with the position connected by a straight line, is the area other than the empty area which is an area drawn by the straight line A first blind spot area recognizing step for recognizing a blind spot area; and a second detection in which the detection means detects the position of the obstacle at the second position after movement of the mobile body detection device from the first position. Step and before Current position obtaining unit, in the second position, and a second current position acquisition step of acquiring a current position of the moving body detecting apparatus, the blind area recognition means, for the second position, the movement area A second blind spot area recognition step for recognizing a blind spot area that is an area other than an empty area that is an area drawn by the straight line by connecting each position of the detected obstacles with the current position in a straight line. position selection means selects the first measurement position by the position of the detected the obstacle to exclude position included in recognized the blind regions in the second position in the first position, the second sensed measurement position selection for selecting the second measurement position by excluding position included in recognized the blind regions in the first position from the position of the obstacle at the location And the step, the moving object determination unit, wherein it is determined whether there is a difference between the first measurement position and the second measurement position, the obstacle position of the difference is a moving body when there is the difference characterized in that it comprises a, a moving object determination step of determine a constant and.

本発明によれば、移動体検知装置が第1の位置から第2の位置に移動する場合に、第2の位置において認識された死角領域に基づいて、第1の位置において検知された障害物の位置から第1計測位置を選択し、第1の位置において認識された死角領域に基づいて、第2の位置において検知された障害物の位置から第2計測位置を選択し、第1計測位置と第2計測位置とに基づいて障害物が移動体であるか否かを判定することで、第1の位置における死角領域と第2の位置における死角領域の変化を考慮して、より正確な移動体の判定を行うことができるという効果を奏する。   According to the present invention, when the moving body detection device moves from the first position to the second position, the obstacle detected at the first position based on the blind spot area recognized at the second position. The first measurement position is selected from the positions, the second measurement position is selected from the positions of the obstacles detected at the second position based on the blind spot area recognized at the first position, and the first measurement position is selected. And determining whether the obstacle is a moving object based on the second measurement position and taking into account the change of the blind spot area at the first position and the blind spot area at the second position, more accurate There exists an effect that determination of a moving body can be performed.

以下に添付図面を参照して、この発明にかかる移動体検知装置および移動体検知方法の最良な実施の形態を詳細に説明する。   Exemplary embodiments of a mobile object detection device and a mobile object detection method according to the present invention will be explained below in detail with reference to the accompanying drawings.

なお、以下の実施の形態では、本発明にかかる移動体検知装置を自律移動可能な移動ロボットに適用した例をあげて説明するが、これに限定されるものではない。自律移動可能でなく、外部からの操作等により移動可能なものであれば本発明を適用することができる。また、移動ロボット以外であっても移動可能な装置であればいずれの装置にも本発明を適用することができる。   In the following embodiment, an example in which the mobile body detection device according to the present invention is applied to a mobile robot capable of autonomous movement will be described. However, the present invention is not limited to this. The present invention can be applied as long as it is not autonomously movable and can be moved by an external operation or the like. Further, the present invention can be applied to any apparatus that is movable even if it is not a mobile robot.

図1は、本実施の形態にかかる移動ロボットの機能的構成を示すブロック図である。図2は、本実施の形態にかかる移動ロボットの外観の一例を示す模式図である。本実施の形態にかかる移動ロボット100は、図1に示すように、レーザレンジセンサ(LRS)101と、検知情報受信部102と、監視カメラ103と、画像情報受信部104と、操作パネル部105と、操作パネル制御部106と、スピーカ107と、音声出力制御部108と、現在位置取得部109と、死角領域認識部110と、計測点選択部111と、移動体判定部115と、走行制御部112と、駆動部114と、通信部113とを主に備えている。   FIG. 1 is a block diagram showing a functional configuration of the mobile robot according to the present embodiment. FIG. 2 is a schematic diagram showing an example of the appearance of the mobile robot according to the present embodiment. As shown in FIG. 1, a mobile robot 100 according to the present embodiment includes a laser range sensor (LRS) 101, a detection information receiving unit 102, a monitoring camera 103, an image information receiving unit 104, and an operation panel unit 105. An operation panel control unit 106, a speaker 107, an audio output control unit 108, a current position acquisition unit 109, a blind spot area recognition unit 110, a measurement point selection unit 111, a moving body determination unit 115, and a travel control. It mainly includes a unit 112, a drive unit 114, and a communication unit 113.

LRS101は、検知領域における障害物を検知し、障害物との距離を計測する距離センサである。LRS101は、移動ロボット100が走行中に一定時間ごとに検知動作を行い、障害物の位置である計測点を逐次検出している。ここで、本実施の形態では、移動体判定のために、第1の位置(位置a)と第2の位置(位置b)を考え、移動ロボット100が移動中、第1の位置から第2の位置を移動し、この第1の位置および第2の位置のそれぞれで、LRS101が障害物の位置を検知するものとする。LRS101は、図2に示すように移動ロボット100の足元に設置されている。   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. Here, in the present embodiment, the first position (position a) and the second position (position b) are considered in order to determine the moving body, and the mobile robot 100 moves from the first position to the second position while moving. It is assumed that the LRS 101 detects the position of the obstacle at each of the first position and the second position. The LRS 101 is installed at the foot of the mobile robot 100 as shown in FIG.

検知情報受信部102は、LRS101が障害物を検知した際の検知情報を受信する。   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 105.

現在位置取得部109は、移動ロボット100の現在位置を取得する。この現在位置の取得の手法については、任意の手法を用いることができる。例えば、GPSからの位置情報を利用したり、出発地点からの走行距離を用いることにより現在位置を取得する等公知技術を用いればよい。また、本実施の形態では、移動ロボット100が移動する第1の位置および第2の位置のそれぞれで、現在位置取得部109が移動ロボット100の現在位置を取得するものとする。   The current position acquisition unit 109 acquires the current position of the mobile robot 100. Any technique can be used for obtaining the current position. For example, a known technique may be used such as using the position information from the GPS or acquiring the current position by using the travel distance from the departure point. In the present embodiment, it is assumed that the current position acquisition unit 109 acquires the current position of the mobile robot 100 at each of the first position and the second position where the mobile robot 100 moves.

死角領域認識部110は、第1の位置および第2の位置のそれぞれにおいて、障害物の位置と移動体の現在位置とに基づいて死角領域を認識する。具体的には、死角領域認識部110は、移動ロボットが走行中監視する監視領域のマップを第1の位置、第2の位置ごとに記憶部(不図示)に生成する。第1の位置におけるマップを第1マップ、第2の位置におけるマップを第2マップと呼ぶ。そして、死角領域認識部110は、第1の位置、第2の位置のそれぞれで検知した障害物の位置座標を求め、その位置座標を計測点として第1の位置における第1マップ、第2の位置における第2マップ上にそれぞれ登録する。また、死角領域認識部110は、第1の位置、第2の位置における移動ロボット100の現在位置(すなわち、LRS101の現在位置)のそれぞれを第1マップ、第2マップ上に登録する。そして、死角領域認識部110は、第1マップおよび第2マップ上のそれぞれにおいて、移動ロボット100の現在位置と障害物の各計測点を結び、この直線により描かれる領域を空領域として求め、第1マップ、第2マップの領域でこの空領域以外の領域を死角領域と認識する。上記処理は、第1の位置、第2の位置でそれぞれ別個に行われる。   The blind spot area recognition unit 110 recognizes the blind spot area based on the position of the obstacle and the current position of the moving body at each of the first position and the second position. Specifically, the blind spot area recognizing unit 110 generates, in a storage unit (not shown), a monitoring area map to be monitored while the mobile robot is traveling for each of the first position and the second position. The map at the first position is called the first map, and the map at the second position is called the second map. Then, the blind spot area recognition unit 110 obtains the position coordinates of the obstacle detected at each of the first position and the second position, and uses the position coordinates as a measurement point to measure the first map and the second map at the first position. Each is registered on the second map at the position. In addition, the blind spot area recognition unit 110 registers the current position of the mobile robot 100 at the first position and the second position (that is, the current position of the LRS 101) on the first map and the second map, respectively. The blind spot area recognition unit 110 connects the current position of the mobile robot 100 and each measurement point of the obstacle on each of the first map and the second map, obtains an area drawn by this straight line as an empty area, The areas other than the empty area in the areas of the first map and the second map are recognized as blind spot areas. The above processing is performed separately at the first position and the second position.

計測点選択部111は、第1マップ上で、第1の位置において検知された障害物の位置の計測点から、第2の位置において認識された死角領域に含まれる位置の計測点を除外し、これにより第1マップ上に残った計測点を第1計測点として選択する。ここで、第1計測点とは、第1マップ上の計測点のうち、第2マップの死角領域に含まれない計測点である。   The measurement point selection unit 111 excludes the measurement point at the position included in the blind spot area recognized at the second position from the measurement point of the position of the obstacle detected at the first position on the first map. Thus, the measurement point remaining on the first map is selected as the first measurement point. Here, a 1st measurement point is a measurement point which is not contained in the blind spot area | region of a 2nd map among the measurement points on a 1st map.

また、計測点選択部111は、第2マップ上において、第2の位置において検知された障害物の位置の計測点から第1の位置において認識された死角領域に含まれる位置の計測点を除外し、これにより第2マップ上に残った計測点を第2計測点として選択する。ここで、第2計測点とは、第2マップ上の計測点のうち、第1マップの死角領域に含まれない計測点である。   In addition, the measurement point selection unit 111 excludes the measurement points at the positions included in the blind spot area recognized at the first position from the measurement points at the position of the obstacle detected at the second position on the second map. Thus, the measurement points remaining on the second map are selected as the second measurement points. Here, the second measurement point is a measurement point that is not included in the blind spot area of the first map among the measurement points on the second map.

移動体判定部115は、第1マップ上における第1計測点と第2マップ上における第2計測点を比較し、差分の有無を判断する。そして、移動体判定部115は、両者に差分がある場合には、その差分の計測点を示す障害物は移動体であると判定し、差分がない場合には移動体は存在しないと判定する。   The moving body determination unit 115 compares the first measurement point on the first map with the second measurement point on the second map, and determines whether there is a difference. Then, when there is a difference between the two, the moving body determination unit 115 determines that the obstacle indicating the difference measurement point is a moving body, and when there is no difference, determines that there is no moving body. .

駆動部114は、移動ロボット100の車輪(不図示)を駆動する車輪モータ等である。走行制御部112は、記憶部(不図示)に記憶された巡回経路に従って、移動ロボット100の走行(移動および回転)を制御する。具体的には、移動ロボット100の駆動部114(車輪モータ)を駆動するものであり、例えば、モータドライバおよび制御モジュール等が該当する。   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.

通信部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.

次に、以上のように構成された本実施の形態の移動ロボット100による移動体検知処理について説明する。図3は、移動体検知処理の手順を示すフローチャートである。   Next, the moving body detection process by the mobile robot 100 of the present embodiment configured as described above will be described. FIG. 3 is a flowchart showing the procedure of the moving object detection process.

まず、現在位置取得部109により移動ロボット100の現在位置を取得する(ステップS11)。LRS101は、一定時間ごとに障害物を検知しているが、移動ロボットが第1の位置(位置a)にいる時点で、LRS101により障害物を検出する(ステップS12)。次いで、死角領域認識部110により第1の位置(位置a)において死角領域の認識処理を行う(ステップS13)。   First, the current position acquisition unit 109 acquires the current position of the mobile robot 100 (step S11). The LRS 101 detects an obstacle at regular intervals, but when the mobile robot is at the first position (position a), the LRS 101 detects the obstacle (step S12). Next, the blind spot area recognition unit 110 performs a blind spot area recognition process at the first position (position a) (step S13).

図4は、死角領域認識処理の手順を示すフローチャートである。死角領域認識部110は、まず、上述した第1マップを生成する。図5は、第1マップの状態を示す説明図である。図5の例では、第1マップはグリッドが設けられている。グリッドのサイズは任意に定めることができ、例えば、1辺5cmのように定めておく。なお、第2マップも同様である。図5に示すように、第1マップの初期状態は、まだLRS101による検知が行われていないため、全ての領域が死角領域となる。   FIG. 4 is a flowchart showing the procedure of blind spot area recognition processing. The blind spot area recognition unit 110 first generates the first map described above. FIG. 5 is an explanatory diagram showing the state of the first map. In the example of FIG. 5, the first map is provided with a grid. The size of the grid can be determined arbitrarily. For example, the grid size is determined to be 5 cm per side. The same applies to the second map. As shown in FIG. 5, since the detection by the LRS 101 has not yet been performed in the initial state of the first map, all areas are blind spot areas.

そして、死角領域認識部110は、ステップS11で取得した移動ロボットの現在位置(LRS101の現在位置)を第1マップ上に記録し、また、ステップS12でLRS101により検知した障害物の位置座標を求め、その移動ロボットの現在位置からの相対座標を計測点として第1マップに記録する(ステップS31)。   The blind spot area recognition unit 110 records the current position of the mobile robot (the current position of the LRS 101) acquired in step S11 on the first map, and obtains the position coordinates of the obstacle detected by the LRS 101 in step S12. The relative coordinates from the current position of the mobile robot are recorded in the first map as measurement points (step S31).

図6は、計測点及び現在位置が記録された状態の第1マップの状態を示す説明図である。図6に示しように、第1マップのグリッド上に、計測点と現在位置が記録される。ここで、第1マップへの計測点の位置は、移動ロボット100の現在位置、すなわちLRS101の位置からの相対位置として記録される。第2マップへの記録についても同様である。   FIG. 6 is an explanatory diagram showing the state of the first map in which the measurement points and the current position are recorded. As shown in FIG. 6, the measurement point and the current position are recorded on the grid of the first map. Here, the position of the measurement point on the first map is recorded as a current position of the mobile robot 100, that is, a relative position from the position of the LRS 101. The same applies to recording on the second map.

次に、死角領域認識部110は、この第1マップ上で、移動ロボット100の現在位置と各計測点とを直線で結び、かかる直線で形成される領域を空領域として求める(ステップS32)。そして、死角領域認識部110は、第1マップ上の領域でこの空領域以外の領域を死角領域と認識する(ステップS33)。   Next, on the first map, the blind spot area recognition unit 110 connects the current position of the mobile robot 100 and each measurement point with a straight line, and obtains an area formed by the straight line as an empty area (step S32). Then, the blind spot area recognition unit 110 recognizes an area other than the empty area in the area on the first map as a blind spot area (step S33).

すなわち、LRS101の位置(移動ロボット100の現在位置)から各障害物の位置の間は、LRS101から出射されたレーザ光が遮断されずに通過できたことから、他の障害物は存在しない空間である。このため、死角領域認識部110は、マップ上で移動ロボット100の現在位置(LRS101の位置)と各計測点とを直線で結び、かかる直線で形成される領域を障害物が存在しない空領域としている。   That is, between the position of the LRS 101 (the current position of the mobile robot 100) and the position of each obstacle, the laser light emitted from the LRS 101 can pass through without being blocked, so that there is no other obstacle in the space. is there. Therefore, the blind spot area recognition unit 110 connects the current position of the mobile robot 100 (position of the LRS 101) and each measurement point on the map with straight lines, and sets the area formed by the straight lines as an empty area where no obstacle exists. Yes.

図7は、空領域と死角領域を認識した状態の第1マップの説明図である。図7に示すように、計測点と現在位置とで囲まれる領域が空領域701として求められ、空領域701以外の領域が死角領域702として認識される。   FIG. 7 is an explanatory diagram of the first map in a state where the sky area and the blind spot area are recognized. As shown in FIG. 7, an area surrounded by the measurement point and the current position is obtained as an empty area 701, and an area other than the empty area 701 is recognized as a blind spot area 702.

なお、マップのグリッドが細かい場合には、現在位置と各計測点間の直線状のグリッドのみでは、殆どが空領域とならないため、このような場合には、隣接する障害物と現在位置とで形成される三角形状の領域を空領域として求めるように構成してもよい。   Note that if the map grid is fine, the linear grid between the current position and each measurement point will hardly be an empty area. You may comprise so that the triangle-shaped area | region formed may be calculated | required as an empty area | region.

また、LRS101から出射されるレーザ光の広がりを考慮して、現在位置から遠距離の計測点ほど空領域とする範囲を大きくするように構成してもよい。   Further, in consideration of the spread of the laser light emitted from the LRS 101, the range of the sky region may be increased as the measurement point is farther from the current position.

さらに、本実施の形態では、第1マップ、第2マップにグリッドを設け、死角領域もグリッド上の領域として認識しているが、これに限定されるものではなく、多角形状で死角領域や空領域を表すように構成してもよい。   Further, in the present embodiment, grids are provided on the first map and the second map, and the blind spot area is recognized as an area on the grid. However, the present invention is not limited to this. You may comprise so that an area | region may be represented.

図3に戻り、このように第1マップ上の死角領域が認識された後、移動ロボット100が第2の位置まで移動したとする。このとき、移動ロボット100が第2の位置(位置b)にいる時点において、現在位置取得部109により移動ロボット100の現在位置を取得する(ステップS14)。そして、移動ロボット100がこの第2の位置(位置b)にいる時点で、LRS101により障害物を検出する(ステップS15)。そして、死角領域認識部110により第2の位置(位置b)において死角領域の認識処理を行う(ステップS16)。第2の位置における死角領域の認識処理は、第2マップを用いる以外は、図4を用いて説明した上述の処理と同様に行われる。ここで、計測点や現在位置の登録、死角領域の認識は、第1の位置における計測点や現在位置の登録、死角領域の認識における座標系と同じ座標系を用いる。   Returning to FIG. 3, it is assumed that the mobile robot 100 moves to the second position after the blind spot area on the first map is recognized in this way. At this time, when the mobile robot 100 is at the second position (position b), the current position of the mobile robot 100 is acquired by the current position acquisition unit 109 (step S14). When the mobile robot 100 is at the second position (position b), an obstacle is detected by the LRS 101 (step S15). Then, the blind spot area recognition unit 110 performs a blind spot area recognition process at the second position (position b) (step S16). The blind spot area recognition process at the second position is performed in the same manner as the process described above with reference to FIG. 4 except that the second map is used. Here, the registration of the measurement point and the current position and the recognition of the blind spot area use the same coordinate system as the coordinate system in the registration of the measurement point and the current position at the first position and the recognition of the blind spot area.

次に、計測点選択部111は、1回目(ステップS12)に検出された障害物の位置の第1マップ上の計測点から第1計測点の選択処理を行う(ステップS17)。   Next, the measurement point selection unit 111 performs a first measurement point selection process from the measurement points on the first map of the position of the obstacle detected at the first time (step S12) (step S17).

この第1マップ上での第1計測点の選択処理については、以下のように行われる。図8は、移動ロボット100の走行経路の一部を示す模式図である。ここでは、図8に示すように、L字状の壁が障害物として存在し、移動ロボット100が走行経路中の位置a(第1の位置)から位置b(第2の位置)まで移動した場合を考える。   The selection process of the first measurement point on the first map is performed as follows. FIG. 8 is a schematic diagram showing a part of the travel route of the mobile robot 100. Here, as shown in FIG. 8, an L-shaped wall exists as an obstacle, and the mobile robot 100 has moved from position a (first position) to position b (second position) in the travel route. Think about the case.

図9は、ステップS13の死角領域認識処理において、位置a(第1の位置)における計測点、現在位置が第1マップ上に登録され、第1マップ上で死角領域が認識された状態を示す模式図である。   FIG. 9 shows a state where, in the blind spot area recognition processing in step S13, the measurement point and the current position at the position a (first position) are registered on the first map, and the blind spot area is recognized on the first map. It is a schematic diagram.

図10は、ステップS16の死角領域認識処理において、位置b(第2の位置)における計測点、現在位置が第2マップ上に登録され、第2マップ上で死角領域が認識された状態を示す模式図である。   FIG. 10 shows a state where, in the blind spot area recognition process in step S16, the measurement point and the current position at the position b (second position) are registered on the second map, and the blind spot area is recognized on the second map. It is a schematic diagram.

計測点選択部111は、まず、図9に示す第1マップ上の第1の位置(位置a)における計測点を、図10に示す第2マップ上の死角領域に重畳する。図11−1は、第1マップ上の第1の位置(位置a)における計測点を、第2マップ上の死角領域に重畳した状態を示す模式図である。計測点選択部111は、第1マップ上の計測点のうち、第2マップ上の死角領域に含まれる計測点を除去し、これにより残存した計測点を第1計測点として選択する。   First, the measurement point selection unit 111 superimposes the measurement point at the first position (position a) on the first map shown in FIG. 9 on the blind spot area on the second map shown in FIG. FIG. 11A is a schematic diagram illustrating a state in which the measurement point at the first position (position a) on the first map is superimposed on the blind spot area on the second map. The measurement point selection unit 111 removes the measurement points included in the blind spot area on the second map from the measurement points on the first map, and selects the remaining measurement points as the first measurement points.

図11−1において、楕円部分で囲まれた第1マップ上の計測点が第2マップ上の死角領域に含まれるので、これらが除去されることになる。図11−2は、第1マップ上で選択された計測点(第1計測点)を示す模式図である。図11−2に示すように、図11−1で楕円部分に囲まれた計測点が除去されている。   In FIG. 11A, since the measurement points on the first map surrounded by the ellipse portion are included in the blind spot area on the second map, these are removed. FIG. 11B is a schematic diagram illustrating measurement points (first measurement points) selected on the first map. As shown in FIG. 11B, the measurement points surrounded by the ellipse in FIG. 11A are removed.

このように、第1マップ上の計測点のうち、第2マップ上の死角領域に含まれる計測点を除外するのは、第2の位置に移動した状態で第2マップの死角領域に含まれる計測点は、第2の位置において検知できなかっただけであって、この時点においてもその場所に障害物がある可能性があるため、これを除外しないと移動体の判定を行うことができないからである。   As described above, out of the measurement points on the first map, the measurement points included in the blind spot area on the second map are excluded from the blind spot area of the second map in a state of moving to the second position. Since the measurement point could not be detected at the second position and there is a possibility that there is an obstacle at this point, the mobile object cannot be determined unless this is excluded. It is.

第1計測点の選択処理が終了したら、計測点選択部111は、引き続き、2回目(ステップS15)に検出された障害物の位置の第2マップ上の計測点から第2計測点の選択処理を行う(ステップS18)。   When the selection process of the first measurement point is completed, the measurement point selection unit 111 continues the selection process of the second measurement point from the measurement point on the second map of the position of the obstacle detected at the second time (step S15). Is performed (step S18).

この第2マップ上での第2計測点の選択処理については、以下のように行われる。計測点選択部111は、図10に示した第2マップ上の第2の位置(位置b)における計測点を、図9に示した第1マップ上の死角領域に重畳する。図12−1は、第2マップ上の第2の位置(位置b)における計測点を、第1マップ上の死角領域に重畳した状態を示す模式図である。計測点選択部111は、第2マップ上の計測点のうち、第1マップ上の死角領域に含まれる計測点を除去し、これにより残存した計測点を第2計測点として選択する。図12−1において、楕円部分で囲まれた第2マップ上の計測点が第1マップ上の死角領域に含まれるので、これらが除去されることになる。図12−2は、第2マップ上で選択された計測点(第2計測点)を示す模式図である。図12−2に示すように、図12−1で楕円部分に囲まれた計測点が除去されている。   The selection process of the second measurement point on the second map is performed as follows. The measurement point selection unit 111 superimposes the measurement point at the second position (position b) on the second map shown in FIG. 10 on the blind spot area on the first map shown in FIG. FIG. 12A is a schematic diagram illustrating a state in which the measurement point at the second position (position b) on the second map is superimposed on the blind spot area on the first map. The measurement point selection unit 111 removes the measurement points included in the blind spot area on the first map from the measurement points on the second map, and selects the remaining measurement points as the second measurement points. In FIG. 12A, since the measurement points on the second map surrounded by the ellipse are included in the blind spot area on the first map, these are removed. FIG. 12B is a schematic diagram illustrating the measurement points (second measurement points) selected on the second map. As shown in FIG. 12-2, the measurement points surrounded by the ellipse in FIG. 12-1 are removed.

第2計測点の選択処理が終了したら、移動体判定部115は、第1計測点と第2計測点の差分を取得し(ステップS19)差分の有無を判断する(ステップS20)。そして、差分がない場合には(ステップS20:No)、移動体判定部115は、検知された障害物の中に移動体はないと判断する(ステップS22)。   When the selection process of the second measurement point is completed, the moving body determination unit 115 acquires the difference between the first measurement point and the second measurement point (step S19) and determines whether there is a difference (step S20). And when there is no difference (step S20: No), the mobile body determination part 115 judges that there is no mobile body in the detected obstruction (step S22).

一方、第1計測点と第2計測点の差分がある場合には(ステップS20:Yes)、移動体判定部115は、差分の計測点に対応する障害物を移動体であると判定する(ステップS21)。これにより、移動体判定の処理は完了する。   On the other hand, when there is a difference between the first measurement point and the second measurement point (step S20: Yes), the moving body determination unit 115 determines that the obstacle corresponding to the difference measurement point is a moving body ( Step S21). Thereby, the mobile body determination process is completed.

例えば、第1計測点が図11−2に示す例であり、第2計測点が図12−2に示す例である場合には、両者の計測点の差分をとると、図13に示すようになる。すなわち、図13では、差分となる計測点は存在しない。このような場合には、移動体判定部115は、検知された障害物は全て静止物であり、移動体は存在しないと判定する。この例では、図8に示した走行経路において、第1の位置(位置a)から第2の位置(位置b)に移動ロボット100が移動すると、曲がり角の先がLRS101で検知できるようになり、一方、手前側が移動ロボット100の進行によりLRS101による検知が不可能になっただけであるため、移動体は存在しないことがわかる。従来の技術では、このような場合にも、移動体であると判定してしまうおそれがあるが、本実施の形態では、このように正確に移動体の有無の判定を行うことができる。   For example, when the first measurement point is the example shown in FIG. 11-2 and the second measurement point is the example shown in FIG. 12-2, the difference between the two measurement points is shown in FIG. become. That is, in FIG. 13, there is no difference measurement point. In such a case, the moving object determination unit 115 determines that all detected obstacles are stationary objects and that there is no moving object. In this example, when the mobile robot 100 moves from the first position (position a) to the second position (position b) in the travel route shown in FIG. 8, the tip of the corner can be detected by the LRS 101. On the other hand, it can be seen that there is no moving body because the front side only becomes impossible to detect by the LRS 101 due to the progress of the mobile robot 100. In the conventional technique, even in such a case, it may be determined that the object is a moving object, but in the present embodiment, the presence / absence of a moving object can be accurately determined.

この例では、図8に示す走行経路を例として説明したが、図14や図15に示す走行経路の例でも同様に、移動体がないと判定されることになる。   In this example, the travel route shown in FIG. 8 has been described as an example. However, in the example of the travel route shown in FIG. 14 and FIG.

これに対し、図16に示すように、走行経路中に移動体である障害物(例えば人間)があり、移動ロボット100に向かって移動している場合を例にあげて説明する。図16の例では、移動ロボットは、位置a(第1の位置)から位置b(第2の位置)に移動する場合を考える。また、図16に示すように、移動ロボット100が位置aにいる時点で移動体が位置a’に存在し、移動ロボット100が位置bまで移動した時点で移動体が位置b’に移動したものとする。   On the other hand, as shown in FIG. 16, a case where there is an obstacle (for example, a human) as a moving body in the travel route and the robot is moving toward the mobile robot 100 will be described as an example. In the example of FIG. 16, consider a case where the mobile robot moves from a position a (first position) to a position b (second position). Further, as shown in FIG. 16, when the mobile robot 100 is at the position a, the mobile body exists at the position a ′, and when the mobile robot 100 moves to the position b, the mobile body moves to the position b ′. And

図17は、ステップS13の死角領域認識処理において、位置a(第1の位置)における計測点、現在位置が第1マップ上に登録され、第1マップ上で死角領域が認識された状態を示す模式図である。   FIG. 17 shows a state in which the measurement point and the current position at the position a (first position) are registered on the first map and the blind spot area is recognized on the first map in the blind spot area recognition processing in step S13. It is a schematic diagram.

図18は、ステップS16の死角領域認識処理において、位置b(第2の位置)における計測点、現在位置が第2マップ上に登録され、第2マップ上で死角領域が認識された状態を示す模式図である。   FIG. 18 shows a state in which the measurement point and the current position at position b (second position) are registered on the second map and the blind spot area is recognized on the second map in the blind spot area recognition processing in step S16. It is a schematic diagram.

計測点選択部111は、図17に示す第1マップ上の第1の位置(位置a)における計測点を、図18に示す第2マップ上の死角領域に重畳する。図19−1は、第1マップ上の第1の位置(位置a)における計測点を、第2マップ上の死角領域に重畳した状態を示す模式図である。計測点選択部111は、第1マップ上の計測点のうち、第2マップ上の死角領域に含まれる計測点を除去し、これにより残存した計測点を第1計測点として選択する。図19−1において、楕円部分で囲まれた第1マップ上の計測点が第2マップ上の死角領域に含まれるので、これらが除去されることになる。図19−2は、第1マップ上で選択された計測点(第1計測点)を示す模式図である。図19−2に示すように、図19−1で楕円部分に囲まれた計測点が除去されている。   The measurement point selection unit 111 superimposes the measurement point at the first position (position a) on the first map shown in FIG. 17 on the blind spot area on the second map shown in FIG. FIG. 19A is a schematic diagram illustrating a state in which the measurement point at the first position (position a) on the first map is superimposed on the blind spot area on the second map. The measurement point selection unit 111 removes the measurement points included in the blind spot area on the second map from the measurement points on the first map, and selects the remaining measurement points as the first measurement points. In FIG. 19A, since the measurement points on the first map surrounded by the ellipse are included in the blind spot area on the second map, these are removed. FIG. 19-2 is a schematic diagram illustrating measurement points (first measurement points) selected on the first map. As shown in FIG. 19-2, the measurement points surrounded by the ellipse in FIG. 19-1 are removed.

1回目の計測点の選択処理が終了後、第2マップ上での計測点の選択処理(ステップS18)では、計測点選択部111は、図18に示した第2マップ上の第2の位置(位置b)における計測点を、図17に示した第1マップ上の死角領域に重畳する。図20−1は、第2マップ上の第2の位置(位置b)における計測点を、第1マップ上の死角領域に重畳した状態を示す模式図である。計測点選択部111は、第2マップ上の計測点のうち、第1マップ上の死角領域に含まれる計測点を除去し、これにより残存した計測点を第2計測点として選択する。図20−1において、楕円部分で囲まれた第2マップ上の計測点が第1マップ上の死角領域に含まれるので、これらが除去されることになる。図20−2は、第2マップ上で選択された計測点(第2計測点)を示す模式図である。図20−2に示すように、図20−1で楕円部分に囲まれた計測点が除去されている。   After the first measurement point selection process, in the measurement point selection process (step S18) on the second map, the measurement point selection unit 111 selects the second position on the second map shown in FIG. The measurement point at (position b) is superimposed on the blind spot area on the first map shown in FIG. FIG. 20A is a schematic diagram illustrating a state in which the measurement point at the second position (position b) on the second map is superimposed on the blind spot area on the first map. The measurement point selection unit 111 removes the measurement points included in the blind spot area on the first map from the measurement points on the second map, and selects the remaining measurement points as the second measurement points. In FIG. 20-1, since the measurement points on the second map surrounded by the ellipse are included in the blind spot area on the first map, these are removed. FIG. 20B is a schematic diagram illustrating the measurement points (second measurement points) selected on the second map. As shown in FIG. 20-2, the measurement points surrounded by the ellipse in FIG. 20-1 are removed.

そして、ステップS19の処理で、移動体判定部115により、図19−2に示す第1計測点と図20−2に示す第2計測点の差分をとると、図21に示すようになる。すなわち、図21では、差分となる計測点が2つ存在している。このような場合には、移動体判定部115は、ステップS20の処理により、検知された障害物のうち、図21に示される二つの計測点に対応する障害物が移動体であると判断する。   Then, in the process of step S19, when the moving body determination unit 115 takes the difference between the first measurement point shown in FIG. 19-2 and the second measurement point shown in FIG. 20-2, the result is as shown in FIG. That is, in FIG. 21, there are two measurement points that are differences. In such a case, the moving body determination unit 115 determines that the obstacle corresponding to the two measurement points shown in FIG. 21 among the detected obstacles is a moving body by the process of step S20. .

このように本実施の形態では、移動ロボット100の移動に伴う死角領域の変化を考慮にいれて計測点の除去をおこない、除去により残存した計測点により移動体の判定を行っている。このため、本実施の形態によれば、移動ロボット100の移動により死角領域に変化が生じる場合でも、より正確な移動体の判定を行うことができる。   As described above, in the present embodiment, the measurement points are removed in consideration of the change in the blind spot region accompanying the movement of the mobile robot 100, and the moving body is determined based on the measurement points remaining after the removal. For this reason, according to this embodiment, even when a change occurs in the blind spot area due to the movement of the mobile robot 100, the mobile object can be more accurately determined.

なお、本発明は、上記実施の形態そのままに限定されるものではなく、実施段階ではその要旨を逸脱しない範囲で構成要素を変形して具体化することができる。また、上記実施の形態に開示されている複数の構成要素の適宜な組み合わせにより、種々の発明を形成することができる。例えば、実施の形態に示される全構成要素からいくつかの構成要素を削除してもよい。さらに、異なる実施の形態にわたる構成要素を適宜組み合わせても良い。   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.

本実施の形態にかかる移動ロボットの機能的構成を示すブロック図である。It is a block diagram which shows the functional structure of the mobile robot concerning this Embodiment. 本実施の形態にかかる移動ロボットの外観の一例を示す模式図である。It is a schematic diagram which shows an example of the external appearance of the mobile robot concerning this Embodiment. 移動体検知処理の手順を示すフローチャートである。It is a flowchart which shows the procedure of a mobile body detection process. 死角領域認識処理の手順を示すフローチャートである。It is a flowchart which shows the procedure of a blind spot area | region recognition process. 第1マップの状態を示す説明図である。It is explanatory drawing which shows the state of a 1st map. 計測点及び現在位置が記録された状態の第1マップの説明図である。It is explanatory drawing of the 1st map of the state in which the measurement point and the present position were recorded. 空領域と死角領域を認識した状態の第1マップの説明図である。It is explanatory drawing of the 1st map of the state which recognized the sky area | region and the blind spot area | region. 移動ロボット100の走行経路の一部を示す模式図である。4 is a schematic diagram showing a part of a travel route of the mobile robot 100. FIG. 位置a(第1の位置)における計測点、現在位置が第1マップ上に登録され、第1マップ上で死角領域が認識された状態を示す模式図である。It is a schematic diagram showing a state where a measurement point and a current position at a position a (first position) are registered on a first map and a blind spot area is recognized on the first map. 位置b(第2の位置)における計測点、現在位置が第2マップ上に登録され、第2マップ上で死角領域が認識された状態を示す模式図である。It is a schematic diagram which shows the state by which the measurement point in the position b (2nd position) and the present position were registered on the 2nd map, and the blind spot area | region was recognized on the 2nd map. 第1マップ上の第1の位置(位置a)における計測点を、第2マップ上の死角領域に重畳した状態を示す模式図である。It is a schematic diagram which shows the state which superimposed the measurement point in the 1st position (position a) on a 1st map on the blind spot area | region on a 2nd map. 第1マップ上で選択された計測点(第1計測点)を示す模式図である。It is a schematic diagram which shows the measurement point (1st measurement point) selected on the 1st map. 第2マップ上の第2の位置(位置b)における計測点を、第1マップ上の死角領域に重畳した状態を示す模式図である。It is a schematic diagram which shows the state which superimposed the measurement point in the 2nd position (position b) on a 2nd map on the blind spot area | region on a 1st map. 第2マップ上で選択された計測点(第2計測点)を示す模式図である。It is a schematic diagram which shows the measurement point (2nd measurement point) selected on the 2nd map. 第1計測点と第2計測点の差分を示す説明図である。It is explanatory drawing which shows the difference of a 1st measurement point and a 2nd measurement point. 走行経路の他の例を示す模式図である。It is a schematic diagram which shows the other example of a driving | running route. 走行経路の他の例を示す模式図である。It is a schematic diagram which shows the other example of a driving | running route. 走行経路中に移動体である障害物がある場合の走行経路の例を示す模式図である。It is a schematic diagram which shows the example of a travel route when there exists an obstruction which is a moving body in a travel route. 図16の走行経路の場合において、位置a(第1の位置)における計測点、現在位置が第1マップ上に登録され、第1マップ上で死角領域が認識された状態を示す模式図である。FIG. 17 is a schematic diagram showing a state where a measurement point and a current position at a position a (first position) are registered on the first map and a blind spot area is recognized on the first map in the case of the travel route of FIG. 16. . 図16の走行経路の場合において、位置b(第2の位置)における計測点、現在位置が第2マップ上に登録され、第2マップ上で死角領域が認識された状態を示す模式図である。FIG. 17 is a schematic diagram showing a state where a measurement point and a current position at a position b (second position) are registered on the second map and a blind spot area is recognized on the second map in the case of the travel route of FIG. 16. . 図16の走行経路の場合において、第1マップ上の第1の位置(位置a)における計測点を、第2マップ上の死角領域に重畳した状態を示す模式図である。FIG. 17 is a schematic diagram illustrating a state in which the measurement point at the first position (position a) on the first map is superimposed on the blind spot area on the second map in the case of the travel route of FIG. 16. 図16の走行経路の場合において、第1マップ上で選択された計測点(第1計測点)を示す模式図である。It is a schematic diagram which shows the measurement point (1st measurement point) selected on the 1st map in the case of the driving | running route of FIG. 図16の走行経路の場合において、第2マップ上の第2の位置(位置b)における計測点を、第1マップ上の死角領域に重畳した状態を示す模式図である。FIG. 17 is a schematic diagram showing a state where measurement points at a second position (position b) on the second map are superimposed on a blind spot area on the first map in the case of the travel route of FIG. 16. 図16の走行経路の場合において、第2マップ上で選択された計測点(第2計測点)を示す模式図である。It is a schematic diagram which shows the measurement point (2nd measurement point) selected on the 2nd map in the case of the driving | running route of FIG. 図16の走行経路の場合における第1計測点と第2計測点の差分を示す模式図である。It is a schematic diagram which shows the difference of the 1st measurement point and the 2nd measurement point in the case of the driving | running route of FIG.

符号の説明Explanation of symbols

100 移動ロボット
101 レーザレンジセンサ(LRS)
102 検知情報受信部
103 監視カメラ
104 画像情報受信部
105 操作パネル
106 操作パネル制御部
107 スピーカ
108 音声出力制御部
109 現在位置取得部
110 死角領域認識部
111 計測点選択部
112 走行制御部
113 通信部
114 駆動部
115 移動体判定部
701 空領域
702 死角領域
100 Mobile robot 101 Laser range sensor (LRS)
102 Detection information receiving unit 103 Monitoring camera 104 Image information receiving unit 105 Operation panel 106 Operation panel control unit 107 Speaker 108 Audio output control unit 109 Current position acquisition unit 110 Blind spot area recognition unit 111 Measurement point selection unit 112 Travel control unit 113 Communication unit 114 Drive unit 115 Moving object determination unit 701 Empty area 702 Blind spot area

Claims (2)

所定の移動領域を移動可能な移動体検知装置であって、
前記移動体検知装置の第1の位置、および前記第1の位置から前記移動体検知装置の移動後の第2の位置のそれぞれにおいて、障害物の位置を検知する検知手段と、
前記第1の位置および前記第2の位置のそれぞれにおいて、前記移動体検知装置の現在位置を取得する現在位置取得手段と、
前記第1の位置および前記第2の位置のそれぞれに対して、前記移動領域において、前記現在位置と検知された複数の障害物の各位置を直線で結び、前記直線で描かれる領域である空領域以外の領域である死角領域を認識する死角領域認識手段と、
前記第1の位置において検知された前記障害物の位置から前記第2の位置において認識された前記死角領域に含まれる位置を除外することにより第1計測位置を選択し、前記第2の位置において検知された前記障害物の位置から前記第1の位置において認識された前記死角領域に含まれる位置を除外することにより第2計測位置を選択する計測位置選択手段と、
前記第1計測位置と前記第2計測位置とに差分があるか否かを判断し、前記差分がある場合に前記差分の位置の障害物が移動体であると判定する移動体判定手段と、
を備えたことを特徴とする移動体検知装置。
A moving body detection apparatus capable of moving in a predetermined movement area,
Detection means for detecting the position of an obstacle at each of the first position of the mobile body detection device and the second position after the movement of the mobile body detection device from the first position;
Current position acquisition means for acquiring a current position of the mobile body detection device at each of the first position and the second position;
For each of said first position and said second position, in the moving area, the knot of each position of the current plurality of obstacle detected with the position in a straight line, an area drawn by the straight line empty A blind spot area recognition means for recognizing a blind spot area that is an area other than the area ;
The first measurement position is selected by excluding the position included in the blind spot area recognized at the second position from the position of the obstacle detected at the first position, and at the second position Measurement position selection means for selecting a second measurement position by excluding a position included in the blind spot area recognized at the first position from the detected position of the obstacle ;
Wherein it is determined whether there is a difference between the first measurement position and the second measurement position, a moving object determination means obstacle position of the difference is determine the constant to be mobile when there is the difference ,
A moving body detection apparatus comprising:
所定の移動領域を移動可能な移動体検知装置で実行される移動体検知方法あって、
検知手段が、前記移動体検知装置の第1の位置において、障害物の位置を検知する第1検知ステップと、
現在位置取得手段が、前記第1の位置において、前記移動体検知装置の現在位置を取得する第1現在位置取得ステップと、
死角領域認識手段が、前記第1の位置に対して、前記移動領域において、前記現在位置と検知された複数の障害物の各位置を直線で結び、前記直線で描かれる領域である空領域以外の領域である死角領域を認識する第1死角領域認識ステップと、
前記検知手段が、前記第1の位置から前記移動体検知装置の移動後の第2の位置において、前記障害物の位置を検知する第2検知ステップと、
前記現在位置取得手段が、前記第2の位置において、前記移動体検知装置の現在位置を取得する第2現在位置取得ステップと、
死角領域認識手段が、前記第2の位置に対して、前記移動領域において、前記現在位置と検知された複数の障害物の各位置を直線で結び、前記直線で描かれる領域である空領域以外の領域である死角領域を認識する第2死角領域認識ステップと、
計測位置選択手段が、前記第1の位置において検知された前記障害物の位置から前記第2の位置において認識された前記死角領域に含まれる位置を除外することにより第1計測位置を選択し、前記第2の位置において検知された前記障害物の位置から前記第1の位置において認識された前記死角領域に含まれる位置を除外することにより第2計測位置を選択する計測位置選択ステップと、
移動体判定手段が、前記第1計測位置と前記第2計測位置とに差分があるか否かを判断し、前記差分がある場合に前記差分の位置の障害物が移動体であると判定する移動体判定ステップと、
を含むことを特徴とする移動体検知方法。
There is a moving body detection method executed by a moving body detection device capable of moving in a predetermined movement area,
A first detecting step for detecting a position of an obstacle at a first position of the moving body detecting device;
A first current position acquisition step in which a current position acquisition unit acquires a current position of the mobile body detection device at the first position;
Blind spot region recognizing means, for the first position, in the moving area, the knot of each position of the current plurality of obstacle detected with the position in a straight line, non-empty region is a region drawn by the straight line A first blind spot area recognition step for recognizing a blind spot area that is an area of
A second detection step in which the detection means detects the position of the obstacle at a second position after the moving body detection device has moved from the first position;
A second current position acquisition step in which the current position acquisition means acquires the current position of the moving object detection device at the second position;
Blind spot region recognizing means, for the second position, in the moving area, the knot of each position of the current plurality of obstacle detected with the position in a straight line, non-empty region is a region drawn by the straight line A second blind spot area recognition step for recognizing a blind spot area that is an area of
The measurement position selection means selects the first measurement position by excluding the position included in the blind spot area recognized at the second position from the position of the obstacle detected at the first position, A measurement position selection step of selecting a second measurement position by excluding a position included in the blind spot area recognized at the first position from the position of the obstacle detected at the second position;
Moving object determination means, the first measurement position and determines whether there is a difference and the second measurement position, determine the constant obstacle position of the difference is a mobile when there is the difference A moving object determination step,
A moving body detection method comprising:
JP2008305082A 2008-11-28 2008-11-28 Moving body detection device and moving body detection method Active JP5448429B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2008305082A JP5448429B2 (en) 2008-11-28 2008-11-28 Moving body detection device and moving body detection method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2008305082A JP5448429B2 (en) 2008-11-28 2008-11-28 Moving body detection device and moving body detection method

Publications (2)

Publication Number Publication Date
JP2010127849A JP2010127849A (en) 2010-06-10
JP5448429B2 true JP5448429B2 (en) 2014-03-19

Family

ID=42328348

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2008305082A Active JP5448429B2 (en) 2008-11-28 2008-11-28 Moving body detection device and moving body detection method

Country Status (1)

Country Link
JP (1) JP5448429B2 (en)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5723182B2 (en) * 2011-03-08 2015-05-27 綜合警備保障株式会社 Autonomous mobile object, autonomous mobile object orientation correction method, and autonomous mobile object orientation correction program
JP6132659B2 (en) * 2013-02-27 2017-05-24 シャープ株式会社 Ambient environment recognition device, autonomous mobile system using the same, and ambient environment recognition method
CN105115490A (en) * 2015-07-16 2015-12-02 深圳前海达闼科技有限公司 Method for determining indoor active area, and apparatus thereof
JP6767567B2 (en) * 2017-03-28 2020-10-14 株式会社日立産機システム Mapping system and robot system

Family Cites Families (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63124114A (en) * 1986-11-14 1988-05-27 Hitachi Ltd Recognizing device for environment of traveling object
JP3592043B2 (en) * 1997-07-31 2004-11-24 トヨタ自動車株式会社 Intersection warning device
JP4561346B2 (en) * 2004-12-08 2010-10-13 株式会社豊田中央研究所 Vehicle motion estimation device and moving object detection device
JP4517393B2 (en) * 2005-02-16 2010-08-04 株式会社デンソー Driving assistance device
JP2007122508A (en) * 2005-10-28 2007-05-17 Secom Co Ltd Intrusion detection apparatus
JP2008026997A (en) * 2006-07-18 2008-02-07 Denso Corp Pedestrian recognition device and pedestrian recognition method
JP2008158690A (en) * 2006-12-21 2008-07-10 Sogo Keibi Hosho Co Ltd Mobile body detection apparatus, security robot, mobile body detection method, and mobile body detection program
EP3112802B1 (en) * 2007-02-16 2019-10-09 Mitsubishi Electric Corporation Road feature measurement apparatus and road feature measuring method
JP2008252348A (en) * 2007-03-29 2008-10-16 Fujifilm Corp Digital camera, and control method of digital camera
JP2008250905A (en) * 2007-03-30 2008-10-16 Sogo Keibi Hosho Co Ltd Mobile robot, self-location correction method and self-location correction program
JP2008250906A (en) * 2007-03-30 2008-10-16 Sogo Keibi Hosho Co Ltd Mobile robot, and self-location correction method and program
JP2009086788A (en) * 2007-09-28 2009-04-23 Hitachi Ltd Vehicle surrounding monitoring device

Also Published As

Publication number Publication date
JP2010127849A (en) 2010-06-10

Similar Documents

Publication Publication Date Title
JP6165440B2 (en) Non-parking area parking assistance apparatus and method
US9081384B2 (en) Autonomous electronic apparatus and navigation method thereof
KR101438941B1 (en) Apparatus and method for controlling parking assistance
JP4464912B2 (en) Robot control apparatus and autonomous mobile robot
KR101152720B1 (en) Apparaus and Method for Detecting Slip of a Mobile Robot
JP5319255B2 (en) Autonomous mobile body and speed control method
US11801602B2 (en) Mobile robot and driving method thereof
KR102500634B1 (en) Guide robot and operating method thereof
JP6750365B2 (en) Parking assistance method and parking assistance device
KR101598385B1 (en) Autonomous driving method and robot using recognition scene based on straight line information
JP2012118909A (en) Travel support device
JP6997880B2 (en) Parking support device
JP2008026253A (en) Device and program for photographing periphery of vehicle and for transmitting
JP2017054475A (en) Teleoperation device, method and program
US20130093887A1 (en) Obstacle Detection System and Obstacle Detection Method Thereof
JP5448429B2 (en) Moving body detection device and moving body detection method
JP2012173843A (en) Travel route generation device and travel route generation method
JPWO2012131947A1 (en) Image processing apparatus and image display apparatus
JP2022133230A (en) Parking support method and parking support device
KR100784125B1 (en) Method for extracting coordinates of landmark of mobile robot with a single camera
KR20180124713A (en) An electronic device and method thereof for estimating shape of road
WO2016009585A1 (en) Autonomous mobile object and method of controlling same
JP4997604B2 (en) Personal mobile vehicle driving support device
JP2009026164A (en) Lane recognition apparatus and navigation apparatus
CN116481541A (en) Vehicle autonomous return control method, device and medium without satellite navigation

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20110621

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20121221

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20130108

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20130308

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20131224

R150 Certificate of patent or registration of utility model

Ref document number: 5448429

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