JP5361257B2 - Autonomous mobile device - Google Patents

Autonomous mobile device Download PDF

Info

Publication number
JP5361257B2
JP5361257B2 JP2008156598A JP2008156598A JP5361257B2 JP 5361257 B2 JP5361257 B2 JP 5361257B2 JP 2008156598 A JP2008156598 A JP 2008156598A JP 2008156598 A JP2008156598 A JP 2008156598A JP 5361257 B2 JP5361257 B2 JP 5361257B2
Authority
JP
Japan
Prior art keywords
obstacle
position information
mobile device
autonomous mobile
information acquisition
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
JP2008156598A
Other languages
Japanese (ja)
Other versions
JP2009301401A (en
Inventor
亮介 村井
龍雄 酒井
弘幸 上松
愼太郎 木下
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Panasonic Corp
Panasonic Holdings Corp
Original Assignee
Panasonic Corp
Matsushita Electric Industrial 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 Panasonic Corp, Matsushita Electric Industrial Co Ltd filed Critical Panasonic Corp
Priority to JP2008156598A priority Critical patent/JP5361257B2/en
Publication of JP2009301401A publication Critical patent/JP2009301401A/en
Application granted granted Critical
Publication of JP5361257B2 publication Critical patent/JP5361257B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Optics & Photonics (AREA)
  • Electromagnetism (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

<P>PROBLEM TO BE SOLVED: To provide an autonomous mobile device to efficiently move while reliably avoiding an overhung obstacle and a moving obstacle smoothly without generating any hunting phenomenon in a simple configuration. <P>SOLUTION: This device 1 is provided with: a first environment information acquisition means 21 for acquiring obstacle position information from information in a face in parallel with a traveling surface R and a second environment information acquisition means 22 for acquiring obstacle position information from information in a face which is not in parallel with the traveling surface R. Information excluding information within a predetermined range acquired by the first environment information acquisition means 21 among the obstacle position information acquired by the second environment information acquisition means 22 is stored (in the figure, the position of a point b1 is stored for a fixed time, and the position of a point b2 is not stored). A route creation means creates a traveling route based on obstacle position information to be acquired by the first environment information acquisition means 21 and obstacle position information stored in a storage means 4. <P>COPYRIGHT: (C)2010,JPO&amp;INPIT

Description

本発明は、人や台車などの障害物となる移動体が存在する環境において、障害物との衝突を回避しつつ自律的に移動して所望の動作をする自律移動装置に関する。   The present invention relates to an autonomous mobile device that autonomously moves and performs a desired operation while avoiding a collision with an obstacle in an environment where a moving body that becomes an obstacle such as a person or a carriage exists.

従来から、工場や病院、一般建屋内のように人や台車などの障害物となる移動体が存在する環境において、障害物を回避しながら自律的に移動して運搬、配達、警備、掃除などの作業を行う自律移動装置が知られている。このような自律移動装置においては、通常、複数の距離センサを用いて障害物の位置情報を得ると共に、各センサからの出力を組合せて処理することにより、効率的に障害物を回避して移動する工夫がなされている。   Traditionally, in environments where there are moving objects that can be obstacles such as people and trolleys, such as factories, hospitals, and general buildings, they move autonomously while avoiding obstacles, and are transported, delivered, guarded, cleaned, etc. An autonomous mobile device that performs the above-described work is known. In such an autonomous mobile device, usually, position information of an obstacle is obtained using a plurality of distance sensors, and the output from each sensor is combined and processed to efficiently avoid the obstacle and move. The idea to do is made.

例えば、前方斜め下方をスキャンする下方センサと、前方水平面をスキャンする前方センサとを備え、走行中に両センサで取得した計測点の3次元情報を、高さ方向の座標を除いた2次元情報にして比較することにより、オーバハングした形状の障害物、すなわち装置本体の下部は衝突しないが上部の方が衝突するような形状の障害物を検出する自律移動装置が知られている。また、この装置は、下方センサで取得した計測点の3次元情報を、進行方向の座標を除いた左右方向と高さ方向とに関する座標による2次元情報にして記憶し、その2次元情報を移動の前後で比較することにより床面における障害物を検出する(例えば、特許文献1参照)。
特開2005−157689号公報
For example, a two-dimensional information that includes a lower sensor that scans diagonally forward and a front sensor that scans a front horizontal plane, and three-dimensional information of measurement points acquired by both sensors during traveling, excluding coordinates in the height direction. Thus, an autonomous mobile device that detects an overhanging obstacle, that is, an obstacle shaped so that the lower part of the apparatus body does not collide but the upper part collides is known. In addition, this apparatus stores the three-dimensional information of the measurement point acquired by the lower sensor as two-dimensional information based on coordinates in the horizontal direction and the height direction excluding the coordinates in the traveling direction, and moves the two-dimensional information. The obstacle on the floor surface is detected by comparing before and after (see, for example, Patent Document 1).
Japanese Patent Laid-Open No. 2005-157689

しかしながら、上述した特許文献1に示されるような自律移動装置や従来の装置においては、障害物情報の処理や記憶において、なお以下のような問題がある。例えば、自律移動装置が障害物を検知すると、進路を変えるが、進路を変えたことにより障害物が検知されなくなり、自律移動装置は、もとの進路に復帰しようとする。すると、また障害物を検知するので再度進路を変える、という不自然な動作(いわゆるハンチング)に陥る。そこで、このような現象が発生するのを回避するため、障害物の位置が記憶される。ところが、障害物を記憶すると、対象となる障害物が移動物体であった場合、移動した後の地点についても障害物位置を記憶しているので、その地点へ移動することはできなくなる、という問題が発生する。   However, the autonomous mobile device and the conventional device shown in Patent Document 1 described above still have the following problems in the processing and storage of obstacle information. For example, when the autonomous mobile device detects an obstacle, the route is changed, but the obstacle is not detected because the route is changed, and the autonomous mobile device tries to return to the original route. Then, since an obstacle is detected again, an unnatural operation (so-called hunting) of changing the course again is caused. Therefore, in order to avoid such a phenomenon, the position of the obstacle is stored. However, when the obstacle is memorized, if the target obstacle is a moving object, the obstacle position is also memorized for the point after moving, so it is impossible to move to that point Occurs.

本発明は、上記課題を解消するものであって、簡単な構成により、オーバハング形状の障害物に対しても確実に回避動作をし、ハンチング現象を起こさず、移動している障害物に対してもスムーズな回避動作をして効率的に移動できる自律移動装置を提供することを目的とする。   The present invention solves the above-mentioned problems, and with a simple configuration, it can reliably avoid overhanging obstacles, does not cause a hunting phenomenon, and moves against obstacles that are moving. It is another object of the present invention to provide an autonomous mobile device that can move efficiently by performing a smooth avoidance operation.

上記課題を達成するために、請求項1の発明は、自己の周囲空間に存在する障害物の位置情報を取得する環境情報取得手段と、自己の位置を取得する位置情報取得手段と、前記環境情報取得手段により取得される障害物位置情報に基づいて当該障害物を回避するように走行するための走行経路を決定する経路生成手段と、前記経路生成手段により決定された走行経路に沿って自己の位置を移動させる移動手段と、を備える自律移動装置において、前記環境情報取得手段は、障害物位置情報を取得する領域が互いに少なくとも一部異なる第1環境情報取得手段と第2環境情報取得手段とを備え、前記第1環境情報取得手段は、装置の移動の前後において障害物位置情報を取得する領域を一部重複して装置の任意の走行動作中に継続的に障害物位置情報を取得する手段であり、前記第2環境情報取得手段は、装置の移動の前後において重複することなく漸次新たな障害物位置情報を取得する手段であり、前記第2環境情報取得手段によって取得された障害物位置情報のうち前記第1環境情報取得手段によって取得された障害物位置情報の周囲一定範囲内にある情報を除く情報が記憶手段に記憶され、前記経路生成手段は、前記第1環境情報取得手段によって取得される障害物位置情報と、前記記憶手段に記憶された障害物位置情報とに基づいて走行経路を生成するものである。
In order to achieve the above object, the invention of claim 1 is directed to environmental information acquisition means for acquiring position information of an obstacle existing in its surrounding space, position information acquisition means for acquiring its own position, and the environment. Route generating means for determining a travel route for traveling so as to avoid the obstacle based on the obstacle position information acquired by the information acquiring means, and self along the travel route determined by the route generating means An autonomous mobile device comprising: a first environmental information acquisition unit and a second environmental information acquisition unit, wherein the environmental information acquisition unit includes at least partly different areas for acquiring obstacle position information. And the first environment information acquisition means continuously overlaps the obstacle position during any traveling operation of the apparatus by partially overlapping the area for acquiring the obstacle position information before and after the movement of the apparatus. A means for obtaining information, the second environmental information acquisition means is a means for obtaining a gradual new obstacle position information without overlapping before and after the movement of the device, acquired by the second environment information acquisition means Of the obstacle position information thus obtained, information excluding information within a certain fixed range around the obstacle position information acquired by the first environment information acquisition means is stored in the storage means, and the route generation means A travel route is generated based on the obstacle position information acquired by the environment information acquisition means and the obstacle position information stored in the storage means.

請求項2の発明は、請求項1に記載の自律移動装置において、前記記憶手段に記憶していた障害物位置情報は、一定時間後に消去するものである。   According to a second aspect of the present invention, in the autonomous mobile device according to the first aspect, the obstacle position information stored in the storage means is erased after a predetermined time.

請求項3の発明は、請求項1に記載の自律移動装置において、前記記憶手段に記憶していた障害物位置情報は、一定距離移動後に消去するものである。   According to a third aspect of the present invention, in the autonomous mobile device according to the first aspect, the obstacle position information stored in the storage means is erased after a certain distance of movement.

請求項4の発明は、請求項1乃至請求項3のいずれか一項に記載の自律移動装置において、前記第1環境情報取得手段は、走行面に平行な面内の情報より障害物位置情報を取得する手段である。   According to a fourth aspect of the present invention, in the autonomous mobile device according to any one of the first to third aspects, the first environment information acquisition unit is configured to obtain obstacle position information from information in a plane parallel to the traveling surface. It is a means to acquire.

請求項5の発明は、請求項1乃至請求項3のいずれか一項に記載の自律移動装置において、前記第1環境情報取得手段は、走行面に平行な面内の情報より障害物位置情報を取得する手段であり、前記第2環境情報取得手段は、走行面に非平行な面内の情報より障害物位置情報を取得する手段である。   According to a fifth aspect of the present invention, in the autonomous mobile device according to any one of the first to third aspects, the first environment information acquisition unit is configured to obtain obstacle position information from information in a plane parallel to the traveling surface. The second environment information acquisition means is means for acquiring obstacle position information from information in a plane that is not parallel to the traveling surface.

請求項6の発明は、請求項1乃至請求項5のいずれか一項に記載の自律移動装置において、前記第2環境情報取得手段は、上方から下方向または下方から上方向をスキャンするスキャン型のセンサを備えているものである。   A sixth aspect of the present invention is the autonomous mobile device according to any one of the first to fifth aspects, wherein the second environment information acquisition means scans from above to below or from below to above. The sensor is provided.

請求項7の発明は、請求項1乃至請求項6のいずれか一項に記載の自律移動装置において、前記第2環境情報取得手段は、上方から下方向をスキャンする2つのスキャン型のセンサを左右に備えているものである。   According to a seventh aspect of the present invention, in the autonomous mobile device according to any one of the first to sixth aspects, the second environmental information acquisition means includes two scan-type sensors that scan downward from above. It is provided on the left and right.

請求項8の発明は、請求項1乃至請求項7のいずれか一項に記載の自律移動装置において、自律移動装置の後部平面視形状が円形のものである。   The invention of claim 8 is the autonomous mobile device according to any one of claims 1 to 7, wherein the rear plan view shape of the autonomous mobile device is circular.

請求項9の発明は、請求項1乃至請求項8のいずれか一項に記載の自律移動装置において、前記記憶手段は、有限個数のセルから成るグリッド空間に障害物位置情報を記憶するものである。   The invention of claim 9 is the autonomous mobile device according to any one of claims 1 to 8, wherein the storage means stores obstacle position information in a grid space composed of a finite number of cells. is there.

請求項10の発明は、請求項1乃至請求項9のいずれか一項に記載の自律移動装置において、前記グリッド空間は、自律移動装置と共に移動する座標軸によって設定され、前記グリッド空間における各セルには最大1点の障害物位置情報が記憶され、各セルにおける位置情報は自律移動装置と障害物との相対位置の変化に追随するように変換されて記憶されているものである。   The invention according to claim 10 is the autonomous mobile device according to any one of claims 1 to 9, wherein the grid space is set by coordinate axes that move together with the autonomous mobile device, and each cell in the grid space is assigned to each cell. The obstacle position information of one point at maximum is stored, and the position information in each cell is converted and stored so as to follow the change in the relative position between the autonomous mobile device and the obstacle.

請求項11の発明は、請求項1乃至請求項10のいずれか一項に記載の自律移動装置において、前記記憶手段は、障害物位置を水平面に写像した2次元の座標情報として障害物位置情報を記憶するものである。   The invention of claim 11 is the autonomous mobile device according to any one of claims 1 to 10, wherein the storage means is obstacle position information as two-dimensional coordinate information obtained by mapping the obstacle position to a horizontal plane. Is memorized.

請求項12の発明は、請求項1乃至請求項11のいずれか一項に記載の自律移動装置において、前記第2環境情報取得手段によって取得される障害物位置情報のうち、前記第1環境情報取得手段によって取得される障害物位置情報より遠方の情報は、前記記憶手段に記憶されないものである。   A twelfth aspect of the invention is the autonomous mobile device according to any one of the first to eleventh aspects, wherein the first environmental information among the obstacle position information acquired by the second environmental information acquisition means. Information farther from the obstacle position information acquired by the acquisition means is not stored in the storage means.

請求項13の発明は、請求項1乃至請求項12のいずれか一項に記載の自律移動装置において、前記第1環境情報取得手段によって取得した障害物位置情報に係る障害物が移動中であるかどうかを判断する障害物移動判断手段を備え、前記障害物移動判断手段によって当該障害物が移動していると判断されたときは、前記第2環境情報取得手段によって取得された障害物位置情報について記憶しない一定範囲を広げるものである。   According to a thirteenth aspect of the present invention, in the autonomous mobile device according to any one of the first to twelfth aspects, the obstacle according to the obstacle position information acquired by the first environment information acquisition means is moving. Obstacle position determination means for determining whether or not the obstacle movement determination means determines that the obstacle is moving, the obstacle position information acquired by the second environment information acquisition means. A certain range that is not memorized is expanded.

請求項1の発明によれば、経路生成手段が、記憶手段に記憶された過去の情報を参照して走行経路を生成するので、障害物回避と進路復帰を繰り返す不自然ないわゆるハンチング現象を回避できる。すなわち、第2環境情報取得手段によって取得した障害物情報のうち必要なものは記憶するのでハンチング現象を回避できる。また、第2環境情報取得手段によって取得された障害物位置情報のうち、第1環境情報取得手段によって移動の前後において一部重複して継続的に取得される障害物位置情報の周囲一定範囲内にある情報は記憶しないので、移動している障害物に対してもスムーズな回避動作を実現することができる。また、第1環境情報取得手段によって取得される障害物位置情報と、記憶手段に記憶された障害物位置情報とに基づいて走行するので、オーバーハングした形状の障害物であっても確実に回避できる。すなわち、本発明の自律移動装置は、2種類の環境情報取得手段を用いることによりオーバーハングしたような形状の障害物との衝突を回避でき、選択した障害物情報を記憶することによりハンチング現象を起こさず、逆に、選択した障害物情報以外の障害物情報を記憶しないことにより移動している障害物に対してもスムーズな回避動作を行うことができ、従って効率的に移動できる。   According to the first aspect of the present invention, since the route generation unit generates a travel route with reference to past information stored in the storage unit, an unnatural so-called hunting phenomenon that repeats obstacle avoidance and course return is avoided. it can. That is, since necessary information is stored among the obstacle information acquired by the second environment information acquisition means, the hunting phenomenon can be avoided. Further, of the obstacle position information acquired by the second environment information acquisition means, within a certain range around the obstacle position information that is continuously acquired partially before and after the movement by the first environment information acquisition means. Therefore, smooth avoidance operation can be realized even for moving obstacles. In addition, since the vehicle travels based on the obstacle position information acquired by the first environment information acquisition means and the obstacle position information stored in the storage means, even an obstacle with an overhang shape can be surely avoided. it can. That is, the autonomous mobile device of the present invention can avoid a collision with an overhanging obstacle by using two types of environmental information acquisition means, and can store the selected obstacle information to prevent the hunting phenomenon. On the contrary, by not storing the obstacle information other than the selected obstacle information, a smooth avoidance operation can be performed even on the moving obstacle, and the movement can be performed efficiently.

請求項2の発明によれば、記憶していた障害物位置情報を参照することによりハンチング現象を回避できると共に、記憶していた障害物位置情報を一定時間後に消去することにより、障害物が移動した後の場所に移動することが可能となる。また、検出される障害物が移動体であって環境情報取得手段の障害物検出範囲に入出することにより短時間に頻繁に検出情報が変化する場合や、記憶している障害物がノイズ等による誤検出に基づく場合であっても、安定した自然な動作のもとで効率的に移動を継続でき、移動している障害物に対してもスムーズな回避動作をして効率的に移動できる。   According to the invention of claim 2, the hunting phenomenon can be avoided by referring to the stored obstacle position information, and the obstacle moves by erasing the stored obstacle position information after a predetermined time. It becomes possible to move to the place after. Also, when the detected obstacle is a moving object and the detection information changes frequently in a short time by entering and exiting the obstacle detection range of the environmental information acquisition means, or the stored obstacle is due to noise or the like Even if it is based on false detection, the movement can be continued efficiently under a stable and natural movement, and even a moving obstacle can be smoothly moved and efficiently moved.

請求項3の発明によれば、請求項2と同等の効果が得られる。また、自律移動装置から一定距離以上離れた場所にある障害物の情報を記憶しないので、障害物の情報を記憶する記憶容量を小さくできる。   According to the invention of claim 3, the same effect as that of claim 2 can be obtained. In addition, since information on obstacles located at a certain distance or more from the autonomous mobile device is not stored, the storage capacity for storing information on obstacles can be reduced.

請求項4の発明によれば、走行面に平行な面内の障害物位置情報を記憶しないので、記憶容量を少なくできると共に、障害物に対してハンチング現象のないスムーズな回避動作をして効率的に移動できる。すなわち、走行面に平行な面内の障害物位置情報は、走行時に継続して取得される情報であり、このような情報は記憶する必要がない。   According to the invention of claim 4, since the obstacle position information in the plane parallel to the running surface is not stored, the storage capacity can be reduced and the obstacle can be efficiently operated without a hunting phenomenon. Can be moved. That is, the obstacle position information in the plane parallel to the traveling surface is information continuously acquired during traveling, and such information does not need to be stored.

請求項5の発明によれば、請求項4と同等の効果が得られる。また、走行面に非平行な面内の障害物位置情報が記憶されるので、オーバーハングしたような形状の障害物であっても、衝突を回避できる。   According to the invention of claim 5, the same effect as that of claim 4 can be obtained. In addition, since the obstacle position information in the plane that is not parallel to the traveling surface is stored, even if the obstacle has an overhanging shape, a collision can be avoided.

請求項6の発明によれば、簡単な構成により、第2環境情報取得手段を構成できる。自律移動装置は、この第2環境情報取得手段による上方から下方向または下方から上方向のスキャンによってオーバーハングしたような障害物の位置情報を取得でき、そのような障害物との衝突を回避できる。   According to invention of Claim 6, a 2nd environment information acquisition means can be comprised by simple structure. The autonomous mobile device can acquire position information of an obstacle that is overhanged by scanning from above or below from above by the second environment information acquisition means, and can avoid collision with such an obstacle. .

請求項7の発明によれば、最小限のセンサ構成によって障害物の検出を実現でき、スムーズに障害物回避動作をして効率的に移動できる。   According to the seventh aspect of the present invention, obstacle detection can be realized with a minimum sensor configuration, and the obstacle avoiding operation can be performed smoothly and efficiently moved.

請求項8の発明によれば、自律移動装置の旋回動作時に後方における障害物との衝突の可能性を減らすことができるので、後方に関する環境情報取得手段を簡略にしたり、記憶容量を減らしたり、計算量を減らしたりでき、スムーズで効率的に移動できる。なお、後部形状を自己の旋回中心と同心の円形とすると、後方における障害物との衝突を考慮することなく旋回動作ができるので、より好適である。   According to the invention of claim 8, since the possibility of collision with an obstacle in the rear during the turning operation of the autonomous mobile device can be reduced, the environment information acquisition means for the rear can be simplified, the storage capacity can be reduced, You can reduce the amount of calculation, and you can move smoothly and efficiently. Note that it is more preferable that the rear shape is a circle concentric with its own turning center because the turning operation can be performed without considering a collision with an obstacle in the rear.

請求項9の発明によれば、自律移動装置の幅や高さに合わせてグリッド空間を適切に調整して、記憶容量を小さくできる。   According to the invention of claim 9, the storage capacity can be reduced by appropriately adjusting the grid space in accordance with the width and height of the autonomous mobile device.

請求項10の発明によれば、障害物の位置が自律移動装置の移動に伴って座標変換され、セル内およびセル間で移動するので、自律移動装置の周辺の障害物位置の記憶を自律移動装置の移動に合わせて適切に行うことができる。   According to the invention of claim 10, since the position of the obstacle is coordinate-transformed with the movement of the autonomous mobile device and moves within the cell and between the cells, the memory of the obstacle position around the autonomous mobile device is moved autonomously. It can be performed appropriately according to the movement of the apparatus.

請求項11の発明によれば、障害物情報を圧縮することができるので、記憶容量を小さくすることができる。また、扱うデータ量が抑制されることから、少ない演算処理により、スムーズで効率的な障害物回避動作を実現できる。   According to the eleventh aspect of the present invention, since the obstacle information can be compressed, the storage capacity can be reduced. In addition, since the amount of data to be handled is suppressed, a smooth and efficient obstacle avoidance operation can be realized with a small amount of arithmetic processing.

請求項12の発明によれば、移動に必要な障害物位置情報に限定して記憶するので、障害物の情報を記憶する記憶容量を小さくできる。また、記憶しなくても確実に回避できる部分の障害物位置については記憶しないので、回避のための演算処理が簡単になり、移動体などの障害物に対するスムーズな回避動作を実現できる。   According to the twelfth aspect of the present invention, only the obstacle position information necessary for movement is stored, so that the storage capacity for storing the obstacle information can be reduced. In addition, since obstacle positions that can be reliably avoided without being stored are not stored, calculation processing for avoidance is simplified, and smooth avoidance operation for obstacles such as moving objects can be realized.

請求項13の発明によれば、障害物として検出された移動体の周囲には記憶しない領域を広くとるので、その障害物が人のように突出物や起伏のある移動体であっても、そのような障害物位置を記憶することなく、スムーズに回避して移動することができる。   According to the invention of claim 13, since the area that is not stored around the moving object detected as an obstacle is widened, even if the obstacle is a protruding object or a undulating moving object like a person, Without memorizing such an obstacle position, it is possible to smoothly avoid and move.

以下、本発明の実施形態に係る自律移動装置について、図面を参照して説明する。   Hereinafter, an autonomous mobile device according to an embodiment of the present invention will be described with reference to the drawings.

(第1の実施形態)
図1は第1の実施形態に係る自律移動装置についてのブロック構成を示し、図2、図3(a)(b)(c)は同装置の外観を示し、図4は同装置の記憶手段に記憶される障害物位置情報の分布を示す。図1に示した自律移動装置についてのブロック構成は、他の実施形態における自律移動装置についても共通であり、各実施形態で適宜参照される。
(First embodiment)
FIG. 1 shows a block configuration of the autonomous mobile device according to the first embodiment, FIGS. 2, 3A, 3B, and 3C show the appearance of the device, and FIG. 4 shows storage means of the device. The distribution of the obstacle position information stored in is shown. The block configuration of the autonomous mobile device shown in FIG. 1 is common to autonomous mobile devices in other embodiments, and is referred to as appropriate in each embodiment.

自律移動装置1は、図1に示すように、自己の周囲空間に存在する障害物の位置情報を逐次取得する環境情報取得手段2と、自己の位置を取得する位置情報取得手段3と、走行領域の地図情報や走行に必要なパラメータなどを記憶する記憶手段4と、環境情報取得手段2により取得される障害物位置情報に基づいて障害物を回避するように走行するための走行経路を決定する経路生成手段5と、経路生成手段5により決定された走行経路に沿って自己の位置を移動させるように移動手段6を制御する移動制御手段7とを備えている。   As shown in FIG. 1, the autonomous mobile device 1 includes an environment information acquisition unit 2 that sequentially acquires position information of obstacles existing in its surrounding space, a position information acquisition unit 3 that acquires its own position, Based on the obstacle position information acquired by the storage unit 4 for storing the map information of the area and the parameters necessary for driving, and the environment information acquiring unit 2, a travel route for avoiding the obstacle is determined. And a movement control means 7 for controlling the movement means 6 so as to move its own position along the travel route determined by the route generation means 5.

環境情報取得手段2は、互いに環境情報取得の態様の異なる2種類の第1環境情報取得手段21と第2環境情報取得手段22とを備えており、これらは、自律移動装置1の周辺空間における障害物検出エリア内の物体や障害物までの自己位置からの距離と方向を検出する距離センサと、距離センサによって取得した物体表面位置の座標を処理して、壁面や移動物体などの障害物を認識するための演算部を備えている。   The environmental information acquisition means 2 includes two types of first environmental information acquisition means 21 and second environmental information acquisition means 22 that are different from each other in the manner of acquiring environmental information, and these are in the peripheral space of the autonomous mobile device 1. A distance sensor that detects the distance and direction from the self-position to the object in the obstacle detection area and the obstacle, and the coordinates of the object surface position obtained by the distance sensor are processed to detect obstacles such as walls and moving objects. An arithmetic unit for recognition is provided.

位置情報取得手段3は、走行領域の地図情報に含められている特徴的な壁情報などの環境構成物情報や専用に設けられたランドマークなどを実際の走行領域内で検出して地図情報と比較することにより自律移動装置1の自己位置を取得する。また、自己位置取得には、下記の移動手段6からの情報を援用する。位置情報取得手段3によって取得された情報は自己位置情報12として記憶手段4に記憶され、経路生成手段5や移動制御手段7によって参照される。   The position information acquisition means 3 detects environmental component information such as characteristic wall information included in the map information of the travel area and landmarks provided in the actual travel area to detect the map information and The self-position of the autonomous mobile device 1 is acquired by comparison. Moreover, the following information from the moving means 6 is used for self-position acquisition. Information acquired by the position information acquisition unit 3 is stored in the storage unit 4 as self-location information 12 and is referred to by the route generation unit 5 and the movement control unit 7.

移動手段6は、電池BTで駆動されるモータと駆動輪61(図2)とを備えて構成されている。このモータには、その回転数や回転速度を計測するエンコーダが設けられている。自律移動装置1の移動制御手段7は、このエンコーダの出力によって移動距離や移動方向を大略知ることができ、これをもとに、デッドレコニング(dead reckoning推定航法)を行う。   The moving means 6 includes a motor driven by the battery BT and driving wheels 61 (FIG. 2). The motor is provided with an encoder for measuring the rotation speed and rotation speed. The movement control means 7 of the autonomous mobile device 1 can roughly know the movement distance and movement direction from the output of this encoder, and based on this, performs dead reckoning (dead reckoning estimation navigation).

また、環境情報取得手段2の演算部、位置情報取得手段3、記憶手段4、経路生成手段5、および移動制御手段7等は、全体で制御部10を構成している。この制御部10を構成するため、CPUやメモリや外部記憶装置や表示装置や入力装置などを備えた一般的な構成を備えた電子計算機と、その上のプロセスまたは機能の集合を用いることができる。   In addition, the calculation unit, the position information acquisition unit 3, the storage unit 4, the route generation unit 5, the movement control unit 7, and the like of the environment information acquisition unit 2 constitute a control unit 10 as a whole. In order to configure the control unit 10, an electronic computer having a general configuration including a CPU, a memory, an external storage device, a display device, an input device, and the like, and a set of processes or functions thereon can be used. .

次に、上述した2種類の環境情報取得手段2の詳細を説明する。第1環境情報取得手段21は自律移動装置1の移動の前後において一部重複して継続的に障害物位置情報を取得するものであり、第2環境情報取得手段22は自律移動装置1の移動の前後において大略重複することなく漸次新たな障害物位置情報を取得するものである。ここに、例えば、第1環境情報取得手段21は走行面に平行な面内の情報より障害物位置情報を取得するものであり、第2環境情報取得手段22は走行面とは非平行な面内の情報より障害物位置情報を取得するものである。これにより、前者は情報取得のスキャン面Aが自律移動装置1の移動の前後において一部重複し、後者は情報取得のスキャン面Bが移動の前後において重複しないものとなる。   Next, details of the two types of environment information acquisition means 2 described above will be described. The first environment information acquisition unit 21 continuously acquires obstacle position information partially overlapping before and after the movement of the autonomous mobile device 1, and the second environment information acquisition unit 22 moves the autonomous mobile device 1. The obstacle position information is gradually acquired without substantially overlapping before and after. Here, for example, the first environment information acquisition means 21 acquires obstacle position information from information in a plane parallel to the traveling surface, and the second environment information acquisition means 22 is a surface that is not parallel to the traveling surface. The obstacle position information is obtained from the information inside. As a result, the information acquisition scan plane A partially overlaps before and after the movement of the autonomous mobile device 1, and the latter does not overlap the information acquisition scan plane B before and after the movement.

第1環境情報取得手段21が取得する障害物位置情報は、走行面に平行な面内の情報より取得されるので、自律移動装置1が、前進、後進、旋回などの任意の走行動作を行った場合においても、自律移動装置1の走行面(通常は水平面)から一定の高さの位置情報となる。自律移動装置1と共に移動する座標系xyzを、進行方向x、高さ方向zの直交座標系とすると、障害物位置情報におけるz座標値は一定となる。   Since the obstacle position information acquired by the first environment information acquisition means 21 is acquired from information in a plane parallel to the traveling surface, the autonomous mobile device 1 performs any traveling operation such as forward, backward, and turning. Even in such a case, the position information has a certain height from the traveling surface (usually a horizontal surface) of the autonomous mobile device 1. When the coordinate system xyz that moves with the autonomous mobile device 1 is an orthogonal coordinate system of the traveling direction x and the height direction z, the z coordinate value in the obstacle position information is constant.

第2環境情報取得手段22が取得する障害物位置情報は、走行面に非平行な面内の情報より取得されるので、自律移動装置1が走行動作を行うときに、障害物位置情報として得られる座標値のいずれかが一定になるという保証はない。自律移動装置1の移動と関連して、座標値が一定となる特殊な例として、例えば、走行面とは非平行であるが、進行方向に平行な面内の情報より障害物位置情報を取得する第2環境情報取得手段22の場合、自律移動装置1が直進する間は、y座標値が一定の障害物位置情報が取得される。   The obstacle position information acquired by the second environment information acquisition means 22 is acquired from information in a plane that is not parallel to the traveling surface, and therefore obtained as obstacle position information when the autonomous mobile device 1 performs a traveling operation. There is no guarantee that any of the coordinate values obtained will be constant. As a special example in which the coordinate value is constant in relation to the movement of the autonomous mobile device 1, for example, the obstacle position information is obtained from information in a plane that is not parallel to the traveling surface but parallel to the traveling direction. In the case of the second environment information acquisition means 22 that performs this, obstacle position information with a constant y coordinate value is acquired while the autonomous mobile device 1 goes straight.

次に、自律移動装置1の具体例を説明する。本実施形態の自律移動装置1は、図2、図3(a)(b)(c)に示すように、外形が平面視で略円形の車体を有し、車体中央下部の左右に移動手段6としての駆動輪61を備えて進行方向xに示す前方方向に移動する。駆動輪61は、それぞれ独立に駆動可能である。自律移動装置1は駆動輪61を同じ方向に駆動して前進または後退し、互いに逆向きに同じ駆動力で駆動して、その場で回転中心Gの回りに右旋回または左旋回する。旋回時の左右の駆動力が異なれば、自律移動装置1は、前方または後方に進みながら右旋回や左旋回する。なお、駆動輪61の車軸に直交する水平方向が進行方向xとされている。   Next, a specific example of the autonomous mobile device 1 will be described. As shown in FIGS. 2, 3A, 3B, and 3C, the autonomous mobile device 1 according to the present embodiment has a substantially circular vehicle body in a plan view, and moves to the left and right in the lower center of the vehicle body. The driving wheel 61 as 6 is provided and moves in the forward direction indicated by the traveling direction x. The drive wheels 61 can be driven independently. The autonomous mobile device 1 drives the driving wheel 61 in the same direction to move forward or backward, drive in the opposite directions with the same driving force, and turns right or left around the rotation center G on the spot. If the left and right driving forces at the time of turning are different, the autonomous mobile device 1 turns right or left while proceeding forward or backward. The horizontal direction orthogonal to the axle of the drive wheel 61 is the traveling direction x.

第1環境情報取得手段21は、車体の前面下部中央に備えられて前方の水平面内、より一般的には走行面Rに平行な面(スキャン面A)内をスキャンするレーザレーダで構成されている。また、第2環境情報取得手段22は、上方から下方向をスキャンする左右2つのレーザレーダで構成されている。左右の第2環境情報取得手段22が情報を取得する面(スキャン面B)は、走行面Rとは非平行な面であって車体前方で互いに交差する面となっている。これらの3つのレーザレーダは、各スキャン面A,B内で所定一定角度でレーザビームを振って、所定の半径を有する半円形の障害物検出エリアにおいて、物体や障害物までの距離を取得する。   The first environmental information acquisition means 21 is provided with a laser radar that is provided at the center of the lower front portion of the vehicle body and scans the front horizontal plane, more generally the plane parallel to the traveling plane R (scan plane A). Yes. The second environment information acquisition means 22 is composed of two laser radars on the left and right that scan downward from above. The surface (scanning surface B) from which the left and right second environmental information acquisition means 22 acquire information is a surface that is non-parallel to the traveling surface R and intersects each other in front of the vehicle body. These three laser radars oscillate a laser beam at a predetermined constant angle in each of the scan planes A and B, and acquire a distance to an object or an obstacle in a semicircular obstacle detection area having a predetermined radius. .

また、環境情報取得手段2の距離センサとして上述のレーダレーダの他に、超音波受波素子をアレイ状に複数配列して電子的スキャンにより3次元や2次元の距離画像を得る超音波アレイセンサなどを用いることができる。また、各レーザレーダの障害物検出エリアの形状は半円形に限らず、より狭い角度範囲や、より広い角度範囲とすることができる。   In addition to the radar radar described above, an ultrasonic array sensor that obtains a three-dimensional or two-dimensional distance image by electronic scanning by arranging a plurality of ultrasonic receiving elements in an array as the distance sensor of the environmental information acquisition means 2 Can be used. Further, the shape of the obstacle detection area of each laser radar is not limited to a semicircular shape, and can be a narrower angular range or a wider angular range.

第1環境情報取得手段21は、前方の障害物検出エリアにある障害物M1の水平断面外周における点aの位置座標を取得し、第2環境情報取得手段22は、各障害物検出エリアにある障害物M1,M2を斜めに切断した断面外周における点bの位置座標を取得する。   The first environment information acquisition unit 21 acquires the position coordinates of the point a on the outer circumference of the obstacle M1 in the front obstacle detection area, and the second environment information acquisition unit 22 is in each obstacle detection area. The position coordinates of the point b on the outer periphery of the cross section obtained by obliquely cutting the obstacles M1 and M2 are acquired.

第1環境情報取得手段21が検出する点aは、自律移動装置1が小規模の走行動作を行って障害物との相対位置が変化した場合にも同一点として検出され、継続的に追跡して位置情報を取得できる検出点である。   The point a detected by the first environment information acquisition unit 21 is detected as the same point even when the autonomous mobile device 1 performs a small-scale traveling operation and the relative position with the obstacle is changed, and is continuously tracked. Detection points from which position information can be acquired.

ところが、第2環境情報取得手段22が検出する点bは、自律移動装置1が行う走行動作がいくら小規模であっても、障害物との相対位置が変化すると同一点として検出されるとは限らず、継続的に追跡して位置情報を取得することができない測定点である。なお、いずれかのスキャン面Bがその面内で平行に移動するように自律移動装置1が走行動作すると、そのスキャン面B内における点bが追跡可能な状態で検出される。   However, the point b detected by the second environment information acquisition unit 22 is detected as the same point when the relative position with the obstacle changes, no matter how small the traveling operation performed by the autonomous mobile device 1 is. The measurement point is not limited and cannot be obtained by continuously tracking. When the autonomous mobile device 1 travels so that any one of the scan planes B moves in parallel in the plane, the point b in the scan plane B is detected in a traceable state.

次に、上述の第2環境情報取得手段22が取得する障害物位置情報の記憶と、それに基づく走行経路の生成および走行動作について説明する。   Next, storage of the obstacle position information acquired by the second environment information acquisition unit 22 described above, generation of a travel route based on the storage, and travel operation will be described.

第2環境情報取得手段22が取得する障害物位置情報は、全てが記憶されるのではなく、限定された状態で、障害物位置情報11として記憶手段4に記憶される。この障害物位置情報11は、第2環境情報取得手段22によって取得された情報から、第1環境情報取得手段21によって取得された障害物位置情報の周囲一定範囲内にある情報を除いた情報である。   The obstacle position information acquired by the second environment information acquisition unit 22 is not stored entirely, but is stored in the storage unit 4 as the obstacle position information 11 in a limited state. This obstacle position information 11 is information obtained by excluding information within a certain range around the obstacle position information acquired by the first environment information acquisition means 21 from the information acquired by the second environment information acquisition means 22. is there.

すなわち、図4に示すように、座標空間xyz(z軸は省略)において示された測定点bのうち、測定点aから一定距離dの範囲内にある測定点bは記憶手段に記憶されず、測定点aから一定距離dの範囲外の測定点bの位置座標が障害物位置情報11として記憶手段4に記憶される。   That is, as shown in FIG. 4, among the measurement points b shown in the coordinate space xyz (z axis is omitted), the measurement points b that are within a certain distance d from the measurement point a are not stored in the storage means. The position coordinates of the measurement point b outside the range of the fixed distance d from the measurement point a are stored in the storage unit 4 as the obstacle position information 11.

上述の「一定範囲」は、座標空間xyzの各軸方向毎に異なる範囲幅を設定したり、いずれかの軸方向で同じにしたり、測定点aからの半径によって範囲設定したり、任意に設定できる。例えば、図4に示すように、xy平面内では半径dの内部の範囲として設定し、z軸方向については無限大の範囲とすることができる。その一定範囲の大きさは、例えば、距離dとして数cmから数十cmにすればよい。また、この一定範囲は、自律移動装置の寸法(車幅や車高など)や外形形状、自律移動装置1の移動速度や障害物回避動作速度、予め定めた走行領域区分、あるいは走行領域における他の移動体の特徴や存在状況に応じて、静的にまたは動的に広くしたり狭くしたりすればよい。   The above-mentioned “certain range” can be set arbitrarily by setting a different range width for each axial direction of the coordinate space xyz, making it the same in any axial direction, setting a range according to the radius from the measurement point a it can. For example, as shown in FIG. 4, it can be set as a range within the radius d in the xy plane, and can be an infinite range in the z-axis direction. The size of the certain range may be, for example, several cm to several tens cm as the distance d. In addition, this fixed range includes the dimensions (vehicle width, vehicle height, etc.) and outer shape of the autonomous mobile device, the moving speed and obstacle avoiding operation speed of the autonomous mobile device 1, a predetermined travel area classification, or other in the travel area. Depending on the characteristics and presence of the moving body, it may be widened or narrowed statically or dynamically.

図2に示す状況では、障害物M1における全ての点bに関する障害物位置情報は記憶されない。また、障害物M2が第1環境情報取得手段21によって検出されていないので、障害物M2における全ての点bに関する障害物位置情報は障害物位置情報11として記憶される。また、いったん記憶された障害物位置情報であっても、その後その障害物位置情報が第1環境情報取得手段で取得された障害物位置の一定範囲内であった場合は、その障害物位置情報は消去され記憶から除かれる。   In the situation shown in FIG. 2, the obstacle position information regarding all points b in the obstacle M1 is not stored. Further, since the obstacle M2 is not detected by the first environment information acquisition unit 21, the obstacle position information regarding all points b in the obstacle M2 is stored as the obstacle position information 11. Further, even if the obstacle position information is stored once, if the obstacle position information is within a certain range of the obstacle position acquired by the first environment information acquisition means, the obstacle position information is stored. Is erased and removed from memory.

そして、経路生成手段5は、第1環境情報取得手段21によって逐次取得される障害物位置情報(逐次情報)と、記憶手段4に記憶された障害物位置情報11(記憶情報)と、に基づいて走行経路を生成する。   Then, the route generation unit 5 is based on the obstacle position information (sequential information) sequentially acquired by the first environment information acquisition unit 21 and the obstacle position information 11 (storage information) stored in the storage unit 4. To generate a travel route.

自律移動体1は、経路生成手段5によって走行経路を生成しつつ、移動制御手段7によって障害物を回避しながら所定の目的地へと移動する。なお、障害物位置情報(本例の場合上記逐次情報と記憶情報)に基づいて障害物との衝突を回避しながら行う自律移動は、例えば、特許第3648604号に開示された方法や装置に基づいて行うことができる。   The autonomous mobile body 1 moves to a predetermined destination while generating a travel route by the route generation means 5 and avoiding an obstacle by the movement control means 7. The autonomous movement performed while avoiding the collision with the obstacle based on the obstacle position information (in the case of this example, the sequential information and the stored information) is based on, for example, the method and apparatus disclosed in Japanese Patent No. 3648604. Can be done.

本実施形態の自律移動装置1によれば、障害物位置情報11として記憶手段4に記憶される情報が、第2環境情報取得手段22によって取得された情報から、第1環境情報取得手段21によって取得された障害物位置情報の周囲一定範囲内にある情報を除いた情報であり、2種類の環境情報取得手段を用いることによりオーバーハングしたような形状の障害物との衝突を回避でき、選択した障害物情報を記憶することによりハンチング現象を起こさず、逆に、選択した障害物情報以外の障害物情報を記憶しないことにより移動している障害物に対してもスムーズな回避動作を行うことができ、従って効率的に移動できる。また、障害物位置情報を記憶させる記憶容量をより少なくできる。   According to the autonomous mobile device 1 of the present embodiment, the information stored in the storage unit 4 as the obstacle position information 11 is obtained by the first environment information acquisition unit 21 from the information acquired by the second environment information acquisition unit 22. This is information that excludes information that is within a certain range around the acquired obstacle position information. By using two types of environmental information acquisition means, collision with an overhanging obstacle can be avoided and selected. Hunting phenomenon is not caused by memorizing the obstruction information, and conversely, smooth avoidance action is also performed for moving obstacles by not memorizing obstruction information other than the selected obstacle information. And can therefore be moved efficiently. Further, the storage capacity for storing the obstacle position information can be reduced.

また、経路生成手段5が、第1環境情報取得手段21によって逐次取得される障害物位置情報と、記憶手段4に記憶された障害物位置情報11と、に基づいて走行経路を生成するので、障害物回避と進路復帰とを繰り返す不自然な、いわゆるハンチング現象を回避できる。   Moreover, since the route generation means 5 generates a travel route based on the obstacle position information sequentially acquired by the first environment information acquisition means 21 and the obstacle position information 11 stored in the storage means 4, It is possible to avoid an unnatural so-called hunting phenomenon that repeats obstacle avoidance and course return.

また、第2環境情報取得手段22が、上方から下方向をスキャンする左右2つのレーザレーダで構成されているので、少ないセンサ数によって第2環境情報取得手段22を構成でき、自律移動装置1がスムーズに障害物回避動作をして効率的に移動できる。自律移動装置1の左右におけるオーバーハングしたような障害物や、左右から接近する移動体の障害物位置情報を取得できる。   Further, since the second environment information acquisition means 22 is composed of two left and right laser radars that scan downward from above, the second environment information acquisition means 22 can be configured with a small number of sensors, and the autonomous mobile device 1 It can move efficiently by performing obstacle avoidance smoothly. Obstacles such as overhangs on the left and right of the autonomous mobile device 1 and obstacle position information of a moving body approaching from the left and right can be acquired.

また、自律移動装置1の後部形状が平面視で円形であるので(図3(a)参照)、自律移動装置1の旋回動作時に後方における障害物との衝突の可能性を減らすことができ、後方に関する環境情報取得手段を簡略にしたり、記憶容量を減らしたり、計算量を減らしたりでき、スムーズで効率的に移動できる。すなわち、本実施形態では、2つのスキャン面Bが主に自律移動装置1の前方に集中する構成として後方に関する環境情報取得手段を簡略にしている。   In addition, since the rear shape of the autonomous mobile device 1 is circular in plan view (see FIG. 3A), it is possible to reduce the possibility of a collision with an obstacle behind the turning operation of the autonomous mobile device 1, It is possible to simplify the environment information acquisition means for the rear, reduce the storage capacity, reduce the amount of calculation, and move smoothly and efficiently. That is, in this embodiment, the environment information acquisition means regarding the back is simplified as a configuration in which the two scan planes B are mainly concentrated in front of the autonomous mobile device 1.

なお、後方には第1環境情報取得手段21(スキャン面A)も備えていないが、自律移動装置1がその場回転すれば後方を向くことができるので、この点についても問題はない。また、後部形状を自己の旋回中心Gと同心の円形とすると、旋回時における後方における障害物との衝突を全く考慮することなく旋回動作ができるので、より好適である。   In addition, although the 1st environmental information acquisition means 21 (scanning surface A) is not provided in back, since the autonomous mobile device 1 can face back if it rotates on the spot, there is no problem also about this point. Further, if the rear shape is a circle concentric with its own turning center G, it is more preferable because the turning operation can be performed without considering any collision with an obstacle behind the turning.

(第2の実施形態)
図5は第2の実施形態に係る自律移動装置の外観を示し、図6(a)(b)は同装置によって取得される障害物上の障害物位置情報すなわち検出点とその障害物を示す。本実施形態は、第1の実施形態における自律移動装置1がオーバーハングした形状の障害物を検出したときの動作を説明するものである。
(Second Embodiment)
FIG. 5 shows the appearance of the autonomous mobile device according to the second embodiment, and FIGS. 6A and 6B show the obstacle position information on the obstacle acquired by the device, that is, the detection point and the obstacle. . In the present embodiment, the operation when the autonomous mobile device 1 in the first embodiment detects an overhung obstacle is described.

障害物M1,M2は、自律移動装置1の下部は衝突しないが上部の方が衝突するような形状の、いわゆるオーバハングした形状の障害物を構成している。障害物M2が、障害物M1の上に乗っており、障害物M2が下の障害物M1よりも外部に出っ張っているので、自律移動装置1は、障害物M1に衝突しなくても、障害物M2に衝突することがある。   The obstacles M1 and M2 constitute so-called overhanging obstacles in which the lower part of the autonomous mobile device 1 does not collide but the upper part collides. Since the obstacle M2 is on the obstacle M1, and the obstacle M2 protrudes to the outside of the obstacle M1 below, the autonomous mobile device 1 does not collide with the obstacle M1. It may collide with the object M2.

第1環境情報取得手段21は、前方の障害物検出エリアにある障害物M1の水平断面外周における点a,aの位置座標を取得し、第2環境情報取得手段22は、障害物検出エリアにある障害物M1,M2を斜めに切断した断面外周における点b1,b2の位置座標を取得する。点b1は、障害物M1上の点であり、点b2は、障害物M2上の点である。点b1の位置は点aから一定範囲内にあると判断され、点b2の位置は点aから一定範囲内にないとされる。そこで、点b2の位置情報だけが、障害物位置情報11として記憶手段4には記憶される。経路生成手段5は、第1環境情報取得手段21によって取得される障害物M1の位置情報と、記憶手段4に記憶された障害物M2の障害物位置情報11とに基づいて走行経路を生成するので、自律移動装置1は、障害物M1,M2との衝突を回避して走行移動することができる。   The first environment information acquisition unit 21 acquires the position coordinates of the points a and a on the outer periphery of the obstacle M1 in the front obstacle detection area, and the second environment information acquisition unit 22 enters the obstacle detection area. The position coordinates of the points b1 and b2 on the outer periphery of the cross section obtained by obliquely cutting an obstacle M1 and M2 are acquired. The point b1 is a point on the obstacle M1, and the point b2 is a point on the obstacle M2. It is determined that the position of the point b1 is within a certain range from the point a, and the position of the point b2 is not within the certain range from the point a. Therefore, only the position information of the point b2 is stored in the storage unit 4 as the obstacle position information 11. The route generation means 5 generates a travel route based on the position information of the obstacle M1 acquired by the first environment information acquisition means 21 and the obstacle position information 11 of the obstacle M2 stored in the storage means 4. Therefore, the autonomous mobile device 1 can travel and avoid collision with the obstacles M1 and M2.

自律移動装置1は、上述のように、障害物位置情報を取得するための第1環境情報取得手段21と第2環境情報取得手段22とを備えているので、オーバハングした形状の障害物を適切に検出でき、また、障害物位置情報が記憶手段に記憶されるので、いわゆるハンチングのような不自然な動作をすることなく、スムーズに効率良く走行移動をすることができる。なお、記憶手段4に記憶された障害物位置情報は、それぞれ時間管理されており、所定時間経過後に適宜消去される。   As described above, the autonomous mobile device 1 includes the first environment information acquisition unit 21 and the second environment information acquisition unit 22 for acquiring the obstacle position information. Since the obstacle position information is stored in the storage means, it is possible to smoothly and efficiently travel without performing an unnatural operation such as so-called hunting. The obstacle position information stored in the storage unit 4 is time-controlled, and is appropriately deleted after a predetermined time has elapsed.

(第3の実施形態)
図7、図8(a)(b)(c)は第3の実施形態に係る自律移動装置の外観を示し、図9(a)(b)は同上装置による障害物位置情報取得の様子を示す。本実施形態の自律移動装置1は、車体外形が略長方形である点、および、第2環境情報取得手段22のスキャン面Bが進行方向xに平行である点を除いて、上述の第1の実施形態の自律移動装置1と同様である。
(Third embodiment)
7, 8 (a), 8 (b), and (c) show the appearance of the autonomous mobile device according to the third embodiment, and FIGS. 9 (a) and 9 (b) show how obstacle position information is acquired by the same device. Show. The autonomous mobile device 1 of the present embodiment has the above-described first configuration except that the outer shape of the vehicle body is substantially rectangular and the scan plane B of the second environment information acquisition unit 22 is parallel to the traveling direction x. It is the same as the autonomous mobile device 1 of the embodiment.

第2環境情報取得手段22のスキャン面Bは、左右後方まで伸びており、第1環境情報取得手段21および第2環境情報取得手段22により、自律移動装置1の真後ろ以外の周辺領域空間の障害物情報を取得することができる。   The scan plane B of the second environment information acquisition unit 22 extends to the left and right rear, and the first environment information acquisition unit 21 and the second environment information acquisition unit 22 cause an obstacle in the peripheral area space other than the back of the autonomous mobile device 1. Object information can be acquired.

第2環境情報取得手段22は、自律移動装置1が進行方向xに沿って直進する限り、障害物検出エリア内に存在する障害物上の同一点を継続して追跡、すなわち障害物位置情報の取得をすることができる。また、自律移動装置1が旋回動作をすると、図9(a)(b)に示すように、障害物Mの位置情報が非継続的に取得される(すなわち、同一点ではない点の情報が取得される)。左右後方まで検出することができるので、自律移動装置1の形状が矩形形状であっても、左右後方の障害物に対しても衝突することなく移動することができる。   As long as the autonomous mobile device 1 moves straight along the traveling direction x, the second environment information acquisition unit 22 continues to track the same point on the obstacle existing in the obstacle detection area, that is, the obstacle position information You can get it. Further, when the autonomous mobile device 1 performs a turning motion, as shown in FIGS. 9A and 9B, the position information of the obstacle M is acquired discontinuously (that is, information on points that are not the same point). Acquired). Since it can be detected to the left and right rear, even if the shape of the autonomous mobile device 1 is rectangular, it can move without colliding with the obstacles on the left and right rear.

(第4の実施形態)
図10、図11は第4の実施形態に係る自律移動装置を示す。本実施形態は、第2環境情報取得手段22が、走行面に非平行な面内において下方から上方向をスキャンするスキャン型のセンサを備えているものを示し、スキャン面Bが自律移動装置1の下方から上方向に広がっている。この第2環境情報取得手段22による下方から上方向のスキャンによって、上方からオーバーハングして垂れ下がったような障害物の位置情報を取得でき、衝突を回避できる。
(Fourth embodiment)
10 and 11 show an autonomous mobile device according to the fourth embodiment. In the present embodiment, the second environment information acquisition unit 22 includes a scanning sensor that scans upward from below in a plane that is not parallel to the traveling surface, and the scanning surface B is the autonomous mobile device 1. It spreads upward from below. By the upward scanning from the lower side by the second environment information acquisition means 22, it is possible to acquire the position information of the obstacle that is overhanging from the upper side and hangs down, thereby avoiding a collision.

本実施形態で示した自律移動装置1は、第1環境情報取得手段21および第2環境情報取得手段22の配置構成が、上述した第1および第3の実施形態における自律移動装置とは異なっているが、記憶手段4に記憶される障害物位置情報11の設定や、経路生成手段5による走行経路の生成方法などは同様である。   The autonomous mobile device 1 shown in the present embodiment is different from the autonomous mobile devices in the first and third embodiments described above in the arrangement configuration of the first environment information acquisition means 21 and the second environment information acquisition means 22. However, the setting of the obstacle position information 11 stored in the storage unit 4 and the generation method of the travel route by the route generation unit 5 are the same.

(第5の実施形態)
図12は第5の実施形態に係る自律移動装置とその回りのグリッド空間を示す。本実施形態における記憶手段4は、有限個数のセルCLから成るグリッド空間GRに対応させて障害物位置情報11を記憶するように構成されている。このグリッド空間GRに関する構成以外の構成は、第1の実施形態の自律移動装置1と同様である。グリッド空間GRは、自律移動装置1の前後左右の周辺空間、および第2環境情報取得手段22による障害物位置情報取得可能な高さ以下の空間をカバーするように設けられている。
(Fifth embodiment)
FIG. 12 shows an autonomous mobile device according to the fifth embodiment and a grid space around it. The storage means 4 in the present embodiment is configured to store the obstacle position information 11 corresponding to the grid space GR composed of a finite number of cells CL. The configuration other than the configuration related to the grid space GR is the same as that of the autonomous mobile device 1 of the first embodiment. The grid space GR is provided so as to cover the front, rear, left and right peripheral spaces of the autonomous mobile device 1 and a space below the height at which obstacle position information can be acquired by the second environment information acquisition means 22.

グリッド空間GRは、自律移動装置1と共に移動する座標系xyzによって設定され、グリッド空間GRにおける各セルCLには最大1点の障害物位置情報が記憶される。各セルCLにおける位置情報は、自律移動装置1と障害物との相対位置の変化に追随するように、各セルCL内、および各セルCL間における位置が変換されて記憶される。   The grid space GR is set by a coordinate system xyz that moves with the autonomous mobile device 1, and at most one obstacle position information is stored in each cell CL in the grid space GR. The position information in each cell CL is converted and stored in each cell CL and between each cell CL so as to follow a change in the relative position between the autonomous mobile device 1 and the obstacle.

グリッド空間GRは、一般には3次元構成とされるが、記憶すべきデータ量を圧縮するため、高さ位置を無視した2次元のグリッド空間GR、すなわち、障害物位置を水平面に写像した2次元の座標情報として障害物位置情報11を記憶するようにしてもよい。   In general, the grid space GR has a three-dimensional configuration. However, in order to compress the amount of data to be stored, the two-dimensional grid space GR in which the height position is ignored, that is, the two-dimensional map of the obstacle position on the horizontal plane. The obstacle position information 11 may be stored as the coordinate information.

図13(a)(b)(c)は、2次元のグリッド空間GRが自律移動装置1の移動と共に移動するときの、グリッド空間GRと障害物位置情報11との関係を示す。自律移動装置1は、走行領域に固定された固定座標系XYにおける位置1aから位置1bへと前進と旋回をしながら移動している(固定座標系XYから見た図になっている)。   FIGS. 13A, 13 </ b> B, and 13 </ b> C show the relationship between the grid space GR and the obstacle position information 11 when the two-dimensional grid space GR moves with the movement of the autonomous mobile device 1. The autonomous mobile device 1 moves while moving forward and turning from a position 1a to a position 1b in a fixed coordinate system XY fixed in the travel area (shown from the fixed coordinate system XY).

自律移動装置1は、位置1aにおいて、右方に備えた第2環境情報取得手段22のスキャン領域B内に障害物M1,M2を検出して、障害物位置情報11として、点p1,p2,p3の位置情報を取得して、それぞれグリッド空間GRのセル内に記憶している。   The autonomous mobile device 1 detects obstacles M1 and M2 in the scan area B of the second environment information acquisition means 22 provided on the right side at the position 1a, and points p1, p2, as obstacle position information 11 The position information of p3 is acquired and stored in each cell of the grid space GR.

その後、自律移動装置1は、障害物M1,M2との衝突を回避すべく左方前方へと移動してその姿勢を変えて、位置1bに達している。この状態で、障害物M1,M2は第2環境情報取得手段22のスキャン領域B内には存在しないが、グリッド空間GRにおける点p1,p2,p3から、障害物M1,M2が検出されるであろう点q1,q2,q3へと座標変換されて記憶されている。この座標変換は、自律移動装置1の移動情報に基づいて容易に行われる。この状態で、各セル(自律移動装置とともに移動するxy座標系による)内に記憶している障害物位置p1,p2,p3は、自律移動装置1の移動情報(並進移動量、回転移動量)に基づいて座標変換され、新たに障害物位置q1,q2,q3としてセル内に記憶される。この時点でp1,p2,p3は消去される。その後、自律移動装置はq1,q2,q3の障害物位置情報に基づいて回避動作を継続するので、スキャン領域B内には障害物M1,M2は存在しないが、障害物M1,M2を回避しつつ、ハンチングすることなく、走行移動をすることができる。   Thereafter, the autonomous mobile device 1 moves leftward and avoids collision with the obstacles M1 and M2, changes its posture, and reaches the position 1b. In this state, the obstacles M1 and M2 do not exist in the scan area B of the second environment information acquisition unit 22, but the obstacles M1 and M2 are detected from the points p1, p2, and p3 in the grid space GR. Coordinates are converted to stored points q1, q2, and q3 and stored. This coordinate conversion is easily performed based on movement information of the autonomous mobile device 1. In this state, the obstacle positions p1, p2, and p3 stored in each cell (according to the xy coordinate system that moves with the autonomous mobile device) are the movement information (translational movement amount, rotational movement amount) of the autonomous mobile device 1. Are converted into new coordinates and stored as new obstacle positions q1, q2, and q3 in the cell. At this time, p1, p2, and p3 are erased. Thereafter, since the autonomous mobile device continues the avoidance operation based on the obstacle position information of q1, q2, and q3, the obstacles M1 and M2 do not exist in the scan area B, but the obstacles M1 and M2 are avoided. However, it is possible to travel without hunting.

図14(a)(b)は、自律移動装置1の移動前後のグリッド空間GR(移動前がGR1、移動後がGR2)におけるセルc1〜c6内の点の動きを示す(移動座標系xyから見た図になっている)。グリッドGR1内の点p1,p2,p3は、自律移動装置1、従ってグリッド空間の移動にともなって座標変換されて移動される(言い換えると、置き去りされる)。   14A and 14B show the movement of points in cells c1 to c6 in the grid space GR before and after the movement of the autonomous mobile device 1 (GR1 before movement, GR2 after movement) (from the movement coordinate system xy). This is what you see). The points p1, p2, and p3 in the grid GR1 are coordinate-transformed and moved (in other words, left behind) as the autonomous mobile device 1, and thus the grid space moves.

ところが、1つのセルには最大1点の障害物位置情報しか記憶させないので、点p1,p2,p3の移動先のセルが、複数の点によって競合する場合には、所定の優先順位に従って、1つの点に絞られる。例えば、点p3は、点p1と競合してセルc5に移動しようとするが、例えば、移動距離が短い方を優先するという優先順位に従って、消去される。なお、優先順位の設定は、例えば、単純にセルの並びに沿って座標変換を行うときに、先に処理される点を優先させたり、後から上書きして後に処理された点を優先させたりできる。   However, since at most one obstacle position information is stored in one cell, when the cells to which the points p1, p2, and p3 move are competing for a plurality of points, 1 cell according to a predetermined priority order. Focused on one point. For example, the point p3 competes with the point p1 and tries to move to the cell c5. For example, the point p3 is erased in accordance with the priority order in which the shorter moving distance is given priority. The priority order can be set such that, for example, when coordinate conversion is simply performed along a sequence of cells, a point that is processed first is prioritized, or a point that is later overwritten is prioritized. .

本実施形態の自律移動装置1によれば、自律移動装置1の幅や高さに合わせてグリッド空間GRを適切に調整して、記憶手段4の記憶容量を小さくできる。また、障害物の位置が自律移動装置1の移動に伴って座標変換され、セルCL内およびセルCL間で移動するので、自律移動装置1の周辺の障害物位置の記憶を自律移動装置1の移動に合わせて適切に行うことができる。また、2次元のグリッド空間とすることにより、障害物情報を圧縮することができるので、記憶手段4の記憶容量を小さくすることができる。さらに、自律移動装置1は、扱うデータ量が抑制されるので、少ない演算処理によりスムーズで効率的な障害物回避動作を実現できる。なお、本実施形態では自律移動装置の周囲にグリッド空間を作成したが、グローバル空間上にグリッドを作成し、その中を自律移動装置が移動するように設計してもよい。   According to the autonomous mobile device 1 of the present embodiment, the storage capacity of the storage unit 4 can be reduced by appropriately adjusting the grid space GR according to the width and height of the autonomous mobile device 1. In addition, since the position of the obstacle is coordinate-transformed with the movement of the autonomous mobile device 1 and moves within the cell CL and between the cells CL, the location of the obstacle around the autonomous mobile device 1 is stored in the autonomous mobile device 1. It can be done appropriately according to the movement. In addition, since the obstacle information can be compressed by using the two-dimensional grid space, the storage capacity of the storage unit 4 can be reduced. Furthermore, since the autonomous mobile device 1 suppresses the amount of data to be handled, it can realize a smooth and efficient obstacle avoidance operation with a small amount of arithmetic processing. In this embodiment, the grid space is created around the autonomous mobile device. However, a grid may be created in the global space, and the autonomous mobile device may be designed to move in the grid.

(第6の実施形態)
図15は第6の実施形態に係る自律移動装置の移動動作のフローチャートを示す。本実施形態は、第1の実施形態や上述の第5の実施形態で説明した自律移動装置1が、障害物を検出して回避しながら移動する一連の処理を説明するものである。自律移動装置1は、走行移動を開始すると、デッドレコニング等により自己位置を認識しつつ移動し、過去自己位置と現在自己位置を比較して移動量を計算する(S1)。
(Sixth embodiment)
FIG. 15 shows a flowchart of the movement operation of the autonomous mobile device according to the sixth embodiment. This embodiment describes a series of processes in which the autonomous mobile device 1 described in the first embodiment and the fifth embodiment described above moves while detecting and avoiding an obstacle. When the autonomous mobile device 1 starts traveling, the autonomous mobile device 1 moves while recognizing its own position by dead reckoning or the like, and compares the past self position with the current self position to calculate a movement amount (S1).

次に、算出した移動量に基づいてグリッドGRに登録(記憶)している障害物位置を、前述の図14(a)(b)で説明したように、移動前の座標から移動後の座標に座標変換する(S2)。次に、第2環境情報取得手段22によって取得した障害物位置情報を、グリッドGRに障害物位置情報11として登録する(S3)。このとき、第2環境情報取得手段22によって取得された障害物位置情報は、第2環境情報取得手段22に固有の座標系から、自律移動装置1の共通の座標系xyzへと座標変換される。   Next, the obstacle position registered (stored) in the grid GR based on the calculated movement amount is changed from the coordinates before the movement to the coordinates after the movement, as described above with reference to FIGS. The coordinates are converted to (S2). Next, the obstacle position information acquired by the second environment information acquisition means 22 is registered as the obstacle position information 11 in the grid GR (S3). At this time, the obstacle position information acquired by the second environment information acquisition unit 22 is coordinate-converted from a coordinate system unique to the second environment information acquisition unit 22 to a common coordinate system xyz of the autonomous mobile device 1. .

次に、第1環境情報取得手段21によって取得した障害物位置情報を、上記同様に自律移動装置1の共通の座標系xyzに変換し、その障害物位置情報の周囲一定範囲内のグリッドGRに存在する障害物位置情報はグリッドGRから消去する(S4)。この状態での障害物位置情報が、記憶手段4に記憶された本来の障害物位置情報11となる。   Next, the obstacle position information acquired by the first environment information acquisition means 21 is converted into the common coordinate system xyz of the autonomous mobile device 1 in the same manner as described above, and the grid GR within the fixed range around the obstacle position information is converted. The existing obstacle position information is deleted from the grid GR (S4). The obstacle position information in this state becomes the original obstacle position information 11 stored in the storage unit 4.

次に、経路生成手段5によって、グリッドGRに登録されている障害物位置情報11と、第1環境情報取得手段21によって取得した障害物位置情報(逐次情報)と、を用いて障害物を回避するように走行経路を生成する。自律移動装置1は、移動制御手段7によって移動手段6を制御して、走行経路に沿って移動する(S6)。その後、自律移動装置1は、目的地に到達したり、他から停止の指示を受けたりしてシステム終了となっているかどうかを判断し(S7)、終了でないなら(S7でNo)、上記処理をステップS1から、所定の制御周期に従って繰り返す。   Next, the path generation means 5 avoids the obstacle using the obstacle position information 11 registered in the grid GR and the obstacle position information (sequential information) acquired by the first environment information acquisition means 21. A travel route is generated as follows. The autonomous mobile device 1 controls the moving means 6 by the movement control means 7 and moves along the travel route (S6). Thereafter, the autonomous mobile device 1 determines whether the system has been terminated by reaching the destination or receiving a stop instruction from another (S7). If not (No in S7), the above processing is performed. Is repeated from step S1 according to a predetermined control cycle.

(第7の実施形態)
図16は第7の実施形態に係る自律移動装置が障害物を検出しつつ移動する際の障害物位置情報処理のフローチャートを示し、図17(a)(c)は移動前と移動後のグリッド空間と障害物位置情報との関係を示し、図17(b)は障害物位置情報を座標変換する際に用いる計算用グリッド空間を示す。本実施形態は、第1の実施形態や上述の第5の実施形態で説明した自律移動装置1が、記憶手段4に記憶した障害物位置情報11を、新たに記憶されるべき障害物位置情報が前記第2環境情報取得手段によって取得されなくなってから一定時間後に消去する処理に関する。
(Seventh embodiment)
FIG. 16 is a flowchart of obstacle position information processing when the autonomous mobile device according to the seventh embodiment moves while detecting an obstacle, and FIGS. 17A and 17C are grids before and after the movement. The relationship between the space and the obstacle position information is shown, and FIG. 17B shows a calculation grid space used when the obstacle position information is coordinate-transformed. In this embodiment, the autonomous mobile device 1 described in the first embodiment and the above-described fifth embodiment stores the obstacle position information 11 stored in the storage unit 4 as obstacle position information to be newly stored. This is related to a process of erasing data after a predetermined time since it is no longer acquired by the second environment information acquisition means.

記憶手段4に記憶される障害物位置情報11は、過去において第2環境情報取得手段22によって取得された障害物の情報を座標変換することにより、現在時点で(障害物検出エリア外となっていることにより)第2環境情報取得手段22によっては取得されないが、その障害物が移動体ではない場合には、存在するであろうと想定される位置に変換して、記憶している情報である。座標変換された行き先が、障害物検出エリア内ということもありえる。   The obstacle position information 11 stored in the storage means 4 is obtained by converting the information of the obstacle acquired by the second environment information acquisition means 22 in the past to the current position (outside the obstacle detection area). This is information that is not acquired by the second environmental information acquisition means 22 but is converted into a position that is assumed to exist if the obstacle is not a moving object and stored. . It is possible that the destination after the coordinate conversion is within the obstacle detection area.

従って、その障害物が人や移動体であって過去に検出した位置から移動してしまうと、障害物位置情報11が無駄な情報となってしまい、最悪の場合には自律移動装置1の移動を制限することになる。そこで、障害物位置情報11を適宜消去する必要がある。   Therefore, if the obstacle is a person or a moving body and moves from a position detected in the past, the obstacle position information 11 becomes useless information, and in the worst case, the movement of the autonomous mobile device 1 Will be limited. Therefore, it is necessary to delete the obstacle position information 11 as appropriate.

障害物位置情報11は、グリッドGRの各セルCL(i)、i=1,・・,mに記憶される。そこで、第2環境情報取得手段22による障害物の検出後の時間経過を監視するために、各セルCL(i)毎にタイマ変数t(i)を設ける。自律移動装置1の移動制御手段7は、移動を開始すると各セルCL(i)毎に設定された全てのタイマ変数t(i)をリセットして、t(i)=0,i=1,・・,mとする(S1)。ここで、mはセル数。   The obstacle position information 11 is stored in each cell CL (i), i = 1,. Therefore, a timer variable t (i) is provided for each cell CL (i) in order to monitor the passage of time after the obstacle is detected by the second environment information acquisition unit 22. When the movement control means 7 of the autonomous mobile device 1 starts moving, it resets all timer variables t (i) set for each cell CL (i) so that t (i) = 0, i = 1, .., M (S1). Here, m is the number of cells.

次に、第2環境情報取得手段22によって取得された障害物位置情報(以下、単にデータともいう)を各セルCL(k)に記憶させ、タイマt(k)をリセットする(S2)。ここで、k=1,・・,nは、取得されたデータの識別符号であり、nはデータ数であり、n≦mである。   Next, the obstacle position information (hereinafter also simply referred to as data) acquired by the second environment information acquisition means 22 is stored in each cell CL (k), and the timer t (k) is reset (S2). Here, k = 1,..., N is an identification code of the acquired data, n is the number of data, and n ≦ m.

次に、第1環境情報取得手段21によって取得された障害物位置の周囲一定範囲(例えば、第1の実施形態において説明した一定距離dの範囲)に存在する障害物位置のデータを、セルCL(p)から消去し、タイマt(p)をリセットする(S3)。ここで、pは、取得されたデータの識別符号であり、データ数だけ、この処理が行われる。   Next, the data of the obstacle position existing in the fixed range around the obstacle position (for example, the range of the fixed distance d described in the first embodiment) acquired by the first environment information acquisition unit 21 is stored in the cell CL. Erase from (p) and reset the timer t (p) (S3). Here, p is an identification code of the acquired data, and this process is performed for the number of data.

次に、経路生成手段5が、記憶手段4に記憶されている障害物位置情報11、および第1環境情報取得手段21によって取得した障害物位置情報に基づいて走行経路を決定し、自律移動装置1は、移動手段6によって走行経路に沿う移動を行い、移動前後の自己位置の変化から移動量(移動前後の並進移動量、回転移動量)を求める(S4)。その後、移動量に基づいて、障害物位置情報11のデータの座標変換を行って、移動前の座標から移動後の座標に座標変換してセル内またはセル間のデータ移動を行って計算用セルDL(j)に記憶させる(S5)。   Next, the route generation means 5 determines the travel route based on the obstacle position information 11 stored in the storage means 4 and the obstacle position information acquired by the first environment information acquisition means 21, and the autonomous mobile device 1 moves along the travel route by the moving means 6 and obtains a movement amount (translational movement amount and rotational movement amount before and after movement) from a change in the self-position before and after movement (S4). After that, based on the amount of movement, the coordinate data of the obstacle position information 11 is converted, the coordinates before the movement are converted to the coordinates after the movement, and the data is moved within the cell or between the cells. It is stored in DL (j) (S5).

図17(a)には、座標変換前のグリッドGRとその中の各セルCL内のデータp1,p2等が示され、図17(b)には座標変換後の計算用グリッドGR0の計算用セルDLにおけるデータg1,g2等が示されている。本例では、座標変換前に別々のセルCLに所属していたデータp1,p2が、座標変換後に同じ計算用セルDLに所属している。このようなデータに対して、ループ処理LP1,LP2によって、1つのセル内に1つのデータとなるように、計算用セルDL(i)内におけるデータが1つに絞られる(S6)。その処理は、最新の障害物位置データを残し、他を消去する方法で行われる。最新かどうかは、各データに付属して記憶されているタイマt(i)の値によって判断される。   FIG. 17A shows a grid GR before coordinate conversion and data p1, p2, etc. in each cell CL therein, and FIG. 17B shows a calculation grid GR0 after coordinate conversion. Data g1, g2, etc. in the cell DL are shown. In this example, data p1 and p2 belonging to different cells CL before coordinate conversion belong to the same calculation cell DL after coordinate conversion. For such data, the loop processing LP1 and LP2 narrows the data in the calculation cell DL (i) to one so as to be one data in one cell (S6). The processing is performed by a method of leaving the latest obstacle position data and deleting others. Whether it is the latest or not is determined by the value of the timer t (i) stored with each data.

最新とされて計算用セルDL(i)に存続することになったデータ(識別符号α)は、そのタイマt(α)が、セルDL(i)の所属として更新され、時間加算されて、t(i)=t(α)+Δtとされる(S7)。   The data (identification code α) that has been updated and continues to exist in the calculation cell DL (i) has its timer t (α) updated as the affiliation of the cell DL (i). t (i) = t (α) + Δt (S7).

ループ処理LP1,LP2が終わると、計算用グリッドGR0の内容が、通常のグリッドGRに置換される(S8)。すなわち、各セルについて、データがDL(i)からCL(i)へと移動され、図17(c)に示す状態となって記憶される。   When the loop processes LP1 and LP2 are completed, the contents of the calculation grid GR0 are replaced with the normal grid GR (S8). That is, for each cell, data is moved from DL (i) to CL (i) and stored in the state shown in FIG.

その後、次のループ処理LP10,LP20によって、第2環境情報取得手段22による障害物検出後の時間経過が、タイマt(i)の値と上限値tmと比較によってチェックされる(S9)。タイマ値が上限値tmを超えてなく、t(i)>tmではない場合は(S9でNo)、現在の変数iをインクリメントした次の変数iについて処理が繰り返される。   Thereafter, the next loop processing LP10, LP20 checks the passage of time after the obstacle detection by the second environment information acquisition means 22 by comparing the value of the timer t (i) with the upper limit value tm (S9). If the timer value does not exceed the upper limit value tm and t (i)> tm is not satisfied (No in S9), the process is repeated for the next variable i incremented from the current variable i.

タイマ値が上限値tmを超えていて、t(i)>tmの場合は(S9でYes)、記憶手段4におけるセルCL(i)に関する障害物位置情報11が消去され、タイマ変数t(i)がリセット、t(i)=0され(S10)、現在の変数iをインクリメントした次の変数iについて処理が繰り返される。上述の処理ループLP10,LP20が終了すると、処理を終了するかどうかが判断され(S11)、終了なら終了し(S11でYes)、終了ではでないなら(S11でNo)、制御はステップS2に戻されて、上述の処理が、所定の制御周期のもとで繰り返される。   If the timer value exceeds the upper limit value tm and t (i)> tm (Yes in S9), the obstacle position information 11 relating to the cell CL (i) in the storage means 4 is deleted, and the timer variable t (i ) Is reset, t (i) = 0 is set (S10), and the process is repeated for the next variable i obtained by incrementing the current variable i. When the above processing loops LP10 and LP20 are finished, it is determined whether or not the processing is to be finished (S11). If finished, the processing is finished (Yes in S11). If not finished (No in S11), the control returns to Step S2. Thus, the above-described processing is repeated under a predetermined control cycle.

上述の一連の処理によると、記憶手段3は、側方障害物情報が取得されなくなった後も、障害物位置情報を保持し、取得されなくなってから一定時間(上限値tm)経過後に、障害物位置情報11を消去する。   According to the series of processes described above, the storage unit 3 retains the obstacle position information even after the side obstacle information is not acquired, and after a certain time (upper limit tm) has elapsed since the acquisition of the obstacle information, The object position information 11 is deleted.

従って、本実施形態の自律移動装置1によれば、記憶していた障害物位置情報11を参照することにより、ハンチング現象を回避できると共に、記憶していた障害物位置情報11を一定時間後に消去することにより、障害物が移動した後の場所に移動することが可能となる。また、検出される障害物が移動体であって環境情報取得手段2の障害物検出範囲に入出することにより短時間に頻繁に検出情報が変化する場合や、記憶している障害物がノイズ等による誤検出に基づく場合であっても、安定した自然な動作のもとで効率的に移動を継続でき、移動している障害物に対してもスムーズな回避動作をして効率的に移動できる。   Therefore, according to the autonomous mobile device 1 of the present embodiment, the hunting phenomenon can be avoided by referring to the stored obstacle position information 11, and the stored obstacle position information 11 is erased after a certain time. By doing so, it becomes possible to move to a place after the obstacle has moved. In addition, when the detected obstacle is a moving object and the detection information frequently changes in a short time by entering or exiting the obstacle detection range of the environmental information acquisition means 2, the stored obstacle is noise or the like Even if it is based on false detection by, you can continue to move efficiently under stable and natural movement, and you can move efficiently by performing smooth avoidance action against moving obstacles .

(第8の実施形態)
図18は第8の実施形態に係る自律移動装置が障害物を検出しつつ移動する際の障害物位置情報処理のフローチャートを示す。本実施形態は、第1の実施形態や上述の第5の実施形態で説明した自律移動装置1が、記憶手段4に記憶した障害物位置情報11を、新たに記憶されるべき障害物位置情報が前記第2環境情報取得手段によって取得されなくなってから一定距離移動後に消去する処理に関する。
(Eighth embodiment)
FIG. 18 shows a flowchart of obstacle position information processing when the autonomous mobile device according to the eighth embodiment moves while detecting an obstacle. In this embodiment, the autonomous mobile device 1 described in the first embodiment and the above-described fifth embodiment stores the obstacle position information 11 stored in the storage unit 4 as obstacle position information to be newly stored. This is related to the process of erasing after moving a certain distance after the second environment information acquisition means is not acquired.

本実施形態のフローチャートによって示す処理は、上述の第7の実施形態のフローチャートにおけるタイマt(i)を用いる代わりに、移動距離d(i)を用いるものである。従って、このフローチャートによる処理は、図16におけるステップS1,S2,S3,S7,S9,S10が、図18におけるステップ#1,#2,#3,#7,#9,#10に変更されたものであり、他のステップは図16に示す第7の実施形態の処理と同様である。また、第7の実施形態と同等の効果が得られる。   The processing shown by the flowchart of the present embodiment uses the moving distance d (i) instead of using the timer t (i) in the flowchart of the seventh embodiment described above. Therefore, in the processing according to this flowchart, steps S1, S2, S3, S7, S9, and S10 in FIG. 16 are changed to steps # 1, # 2, # 3, # 7, # 9, and # 10 in FIG. The other steps are the same as those of the seventh embodiment shown in FIG. Further, the same effect as in the seventh embodiment can be obtained.

(第9の実施形態)
図19は第9の実施形態に係る自律移動装置を示す。本実施形態は、第1の実施形態や上述の第5の実施形態で説明した自律移動装置1と同様の構成の自律移動装置1において、第2環境情報取得手段22によって取得される障害物位置情報のうち、第1環境情報取得手段21によって取得される障害物位置情報より遠方の情報は、記憶手段4に記憶されないものである。
(Ninth embodiment)
FIG. 19 shows an autonomous mobile device according to the ninth embodiment. This embodiment is an obstacle position acquired by the second environment information acquisition means 22 in the autonomous mobile device 1 having the same configuration as the autonomous mobile device 1 described in the first embodiment and the fifth embodiment described above. Of the information, information farther from the obstacle position information acquired by the first environment information acquisition unit 21 is not stored in the storage unit 4.

例えば、図19における障害物M1に関する第2環境情報取得手段22による測定点b1は、たとえ第1環境情報取得手段21によって取得された障害物位置情報(点a1)の周囲一定範囲内にない情報であっても、各点a1よりも遠方にあるので、記憶手段4には記憶されない。なお、障害物M2に関する第2環境情報取得手段22による測定点b2は、記憶手段4に記憶される。   For example, the measurement point b1 by the second environment information acquisition unit 22 regarding the obstacle M1 in FIG. 19 is information that is not within a certain range around the obstacle position information (point a1) acquired by the first environment information acquisition unit 21. However, since it is far from each point a1, it is not stored in the storage means 4. Note that the measurement point b2 by the second environment information acquisition unit 22 regarding the obstacle M2 is stored in the storage unit 4.

本実施形態の自律移動装置1によれば、移動に必要な障害物位置情報に限定して記憶するので、障害物の情報を記憶する記憶容量を小さくできる。また、記憶しなくても確実に回避できる部分の障害物位置(点b1等)については記憶しないので、回避のための演算処理が簡単になり、移動体などの障害物に対するスムーズな回避動作を実現できる。   According to the autonomous mobile device 1 of this embodiment, since it stores only the obstacle position information necessary for movement, the storage capacity for storing the obstacle information can be reduced. In addition, since the obstacle positions (points b1 and the like) that can be reliably avoided without being memorized are not memorized, calculation processing for avoidance is simplified, and smooth avoidance operation for obstacles such as moving objects is performed. realizable.

(第10の実施形態)
図20は第10の実施形態に係る自律移動装置についてのブロック構成を示す。本実施形態の自律移動装置1は、第1環境情報取得手段21によって取得した障害物位置情報に係る障害物が移動中であるかどうかを判断する障害物移動判断手段8を備えたものである。従って、本実施形態の自律移動装置1のブロック構成は、第1の実施形態における図1のブロック構成において障害物移動判断手段8を備えたものとなっている。
(Tenth embodiment)
FIG. 20 shows a block configuration of the autonomous mobile device according to the tenth embodiment. The autonomous mobile device 1 according to the present embodiment includes an obstacle movement determination unit 8 that determines whether an obstacle related to the obstacle position information acquired by the first environment information acquisition unit 21 is moving. . Therefore, the block configuration of the autonomous mobile device 1 of the present embodiment includes the obstacle movement determination means 8 in the block configuration of FIG. 1 in the first embodiment.

さらに、本実施形態の自律移動装置1は、障害物移動判断手段8によって障害物が移動していると判断されたときは、第2環境情報取得手段22によって取得された障害物位置情報について記憶しない「周囲一定範囲」を広げるものである。例えば、図4に示した点bが移動体に関するものである場合には、一定距離d(図4参照)がより大きな値とされる。   Furthermore, the autonomous mobile device 1 according to the present embodiment stores the obstacle position information acquired by the second environment information acquisition unit 22 when the obstacle movement determination unit 8 determines that the obstacle is moving. Do not expand the “certain constant range”. For example, when the point b shown in FIG. 4 relates to the moving object, the fixed distance d (see FIG. 4) is set to a larger value.

物体の移動は、位置座標の移動の有無で判断できる。従って、例えば、第1環境情報取得手段21によって取得した障害物位置情報が、時間的に移動しているかどうかを比較することにより、障害物が移動中であるかどうかを判断する障害物移動判断手段8を容易に構成することができる。   The movement of the object can be determined by the presence or absence of movement of the position coordinates. Therefore, for example, the obstacle movement determination for determining whether or not the obstacle is moving by comparing whether or not the obstacle position information acquired by the first environment information acquisition means 21 is moving in time. The means 8 can be easily configured.

本実施形態の自律移動装置1によれば、障害物として検出された移動体の周囲には記憶しない領域を広くとるので、その障害物が、例えば、図21に示した人のように突出物や起伏が時間的に変化する移動体であっても、そのような障害物位置を記憶することなく、スムーズに回避して移動することができる。   According to the autonomous mobile device 1 of the present embodiment, since a region that is not stored around the moving object detected as an obstacle is widened, the obstacle is, for example, a protrusion like a person shown in FIG. Even a mobile object whose undulation changes with time can be smoothly avoided and moved without storing such an obstacle position.

(第11の実施形態)
図22(a)(b)は第11の実施形態に係る自律移動装置の走行時の様子を示す。本実施形における第1環境情報取得手段21と第2環境情報取得手段22とは、自律移動装置1の前方上部に設けられている。
(Eleventh embodiment)
22 (a) and 22 (b) show the traveling state of the autonomous mobile device according to the eleventh embodiment. The first environment information acquisition means 21 and the second environment information acquisition means 22 in the present embodiment are provided in the upper front part of the autonomous mobile device 1.

第1環境情報取得手段21は、超音波距離センサを複数配列して構成されており、前方方向の検出空間Vにおける障害物位置情報を取得する。第2環境情報取得手段22は、レーザレーダを用いて構成され、前方下向き方向のスキャン面Bにおける障害物位置情報を取得する。   The first environment information acquisition means 21 is configured by arranging a plurality of ultrasonic distance sensors, and acquires obstacle position information in the detection space V in the forward direction. The second environment information acquisition unit 22 is configured using a laser radar, and acquires obstacle position information on the scan plane B in the forward and downward direction.

第1環境情報取得手段21は、上述した各実施形態における第1環境情報取得手段21とは異なり、走行面Rに平行な面(例えば、第1の実施形態のスキャン面A、すなわち2次元空間)における障害物位置情報のみを取得するものではなく、所定の立体角で規定される3次元の検出空間Vにおける障害物位置情報を取得する。このような立体角内で取得される情報は、自律移動装置1の走行移動に際して、障害物の特定の表面位置を継続的して検出して得られる情報である。この点は、走行面Rに平行なスキャン面A内において、障害物の特定の表面位置を継続的して検出することができるのと同等である。   Unlike the first environment information acquisition unit 21 in each embodiment described above, the first environment information acquisition unit 21 is a plane parallel to the traveling surface R (for example, the scan plane A of the first embodiment, that is, a two-dimensional space). The obstacle position information in the three-dimensional detection space V defined by a predetermined solid angle is acquired instead of acquiring only the obstacle position information in (). Information acquired within such a solid angle is information obtained by continuously detecting a specific surface position of an obstacle when the autonomous mobile device 1 travels. This is equivalent to the fact that the specific surface position of the obstacle can be continuously detected in the scan plane A parallel to the traveling surface R.

すなわち、本実施形態における第1環境情報取得手段21によって取得される障害物位置情報は、走行時に装置の移動の前後において一部重複して継続的に取得される情報であり、このような情報は記憶する必要がない。しかし、第2環境情報取得手段22によって取得される障害物位置情報は、走行時に装置の移動の前後において重複することなく漸次新たに取得される情報であり、継続して取得されるとは限らない情報である。このような情報は記憶して参照されることにより、移動する障害物に対しても適切な回避動作が可能となり、障害物回避と進路復帰を繰り返す不自然ないわゆるハンチング現象を回避できる。   That is, the obstacle position information acquired by the first environment information acquisition unit 21 in the present embodiment is information that is continuously acquired partially overlapping before and after the movement of the device during traveling. There is no need to remember. However, the obstacle position information acquired by the second environment information acquisition unit 22 is information that is gradually acquired without duplication before and after the movement of the device during traveling, and is not always acquired continuously. There is no information. By storing and referring to such information, an appropriate avoidance operation can be performed even for a moving obstacle, and an unnatural so-called hunting phenomenon in which the obstacle avoidance and the course return are repeated can be avoided.

また、本実施形態において、第2環境情報取得手段22によって取得された障害物位置情報は記憶手段4に記憶されるが、その情報が第1環境情報取得手段21によって取得された障害物位置情報の周囲一定範囲内にある情報である場合には記憶しないようにして、重複する情報の記憶を排除し、記憶手段4の記憶容量を少なくすることができる。   In the present embodiment, the obstacle position information acquired by the second environment information acquisition unit 22 is stored in the storage unit 4, but the information is acquired by the first environment information acquisition unit 21. In the case where the information is within a certain range, the information is not stored, the storage of redundant information can be eliminated, and the storage capacity of the storage means 4 can be reduced.

また、第1環境情報取得手段21は、超音波受波素子をアレイ状に複数配列して電子的スキャンにより距離画像を得る超音波アレイセンサを用いて構成するものでもよい。また、このような超音波アレイセンサを複数備えるようにしてもよい。また、映像を処理して距離画像を得るものでもよい。   The first environment information acquisition unit 21 may be configured by using an ultrasonic array sensor in which a plurality of ultrasonic receiving elements are arranged in an array and a distance image is obtained by electronic scanning. A plurality of such ultrasonic array sensors may be provided. Alternatively, a distance image may be obtained by processing a video.

なお、本発明は、上記各構成に限られることなく種々の変形が可能である。例えば、上述した各実施形態の構成を矛盾のない範囲で互いに組み合わせた構成とすることができる。例えば、上述した各実施形態における第1環境情報取得手段21と前記第2環境情報取得手段22とを各実施形態の間で互いに組み合わせることができる。   The present invention is not limited to the above-described configurations, and various modifications can be made. For example, the configurations of the above-described embodiments can be combined with each other within a consistent range. For example, the first environment information acquisition unit 21 and the second environment information acquisition unit 22 in each embodiment described above can be combined with each other between the embodiments.

本発明の第1の実施形態に係る自律移動装置についてのブロック構成図。The block block diagram about the autonomous mobile apparatus which concerns on the 1st Embodiment of this invention. 同上装置の斜視図。The perspective view of an apparatus same as the above. (a)は同上装置の平面図、(b)は同側面図、(c)は同正面図。(A) is a top view of the same apparatus, (b) is the side view, (c) is the front view. 同上装置の記憶手段に記憶される障害物位置情報を説明する位置情報の分布図。The distribution map of the positional information explaining the obstacle positional information memorize | stored in the memory | storage means of an apparatus same as the above. 第2の実施形態に係る自律移動装置の斜視図。The perspective view of the autonomous mobile device which concerns on 2nd Embodiment. (a)は同上装置から見た障害物の正面図、(b)は同障害物の側面図図。(A) is the front view of the obstruction seen from the apparatus same as the above, (b) is a side view of the obstruction. 第3の実施形態に係る自律移動装置の斜視図。The perspective view of the autonomous mobile device which concerns on 3rd Embodiment. (a)は同上装置の平面図、(b)は同側面図、(c)は同正面図。(A) is a top view of the same apparatus, (b) is the side view, (c) is the front view. (a)(b)は同上装置の障害物位置情報取得の様子を示す平面図。(A) (b) is a top view which shows the mode of obstruction position information acquisition of an apparatus same as the above. 第4の実施形態に係る自律移動装置の側面図。The side view of the autonomous mobile device which concerns on 4th Embodiment. 同上装置の変形例を示す斜視図。The perspective view which shows the modification of an apparatus same as the above. 第5の実施形態に係る自律移動装置とその回りのグリッド空間の斜視図。The perspective view of the autonomous mobile apparatus which concerns on 5th Embodiment, and the grid space around it. (a)は同上グリッド空間の移動と障害物位置情報との関係を示す平面図、(b)は移動前の同グリッド空間の平面図、(c)は移動後の平面図。(A) is a plan view showing the relationship between the movement of the grid space and the obstacle position information, (b) is a plan view of the grid space before the movement, and (c) is a plan view after the movement. 同上グリッド空間を構成する各セルと障害物位置情報との関係を示し、(a)は移動前のセルの平面図、(b)は移動後の平面図。The relationship between each cell which comprises a grid space same as the above and obstacle position information is shown, (a) is a top view of the cell before a movement, (b) is a top view after a movement. 第6の実施形態に係る自律移動装置の移動中の動作を説明するフローチャート。The flowchart explaining operation | movement during movement of the autonomous mobile apparatus which concerns on 6th Embodiment. 第7の実施形態に係る自律移動装置が障害物を検出しつつ移動する際の障害物位置情報処理のフローチャート。The flowchart of the obstacle position information processing at the time of moving while the autonomous mobile device which concerns on 7th Embodiment detects an obstacle. (a)は同上装置が移動前のグリッド空間と障害物位置情報との関係を示す平面図、(b)は障害物位置情報を座標変換する際に用いる計算用グリッド空間の平面図、(c)は移動後のグリッド空間と障害物位置情報との関係を示す平面図。(A) is a plan view showing the relationship between the grid space before the movement and the obstacle position information, (b) is a plan view of a calculation grid space used for coordinate transformation of the obstacle position information, (c) ) Is a plan view showing the relationship between the grid space after movement and the obstacle position information. 第8の実施形態に係る自律移動装置が障害物を検出しつつ移動する際の障害物位置情報処理のフローチャート。The flowchart of the obstacle position information processing when the autonomous mobile device which concerns on 8th Embodiment moves, detecting an obstacle. 第9の実施形態に係る自律移動装置の平面図。The top view of the autonomous mobile device which concerns on 9th Embodiment. 第10の実施形態に係る自律移動装置についてのブロック構成図。The block block diagram about the autonomous mobile apparatus which concerns on 10th Embodiment. 同上装置の動作を説明する側面図。The side view explaining operation | movement of an apparatus same as the above. (a)(b)は第11の実施形態に係る自律移動装置の側面図と平面図。(A) and (b) are the side view and top view of the autonomous mobile device which concern on 11th Embodiment.

符号の説明Explanation of symbols

1 自律移動装置
2 環境情報取得手段
4 記憶手段
5 経路生成手段
6 移動手段
8 障害物移動判断手段
11 障害物位置情報
21 第1環境情報取得手段
22 第2環境情報取得手段
CL,c1〜c6 セル
GR グリッド空間
M,M1,M2 障害物
R 走行面
DESCRIPTION OF SYMBOLS 1 Autonomous mobile device 2 Environment information acquisition means 4 Memory | storage means 5 Route generation means 6 Movement means 8 Obstacle movement judgment means 11 Obstacle position information 21 1st environment information acquisition means 22 2nd environment information acquisition means CL, c1-c6 cell GR Grid space M, M1, M2 Obstacle R Running surface

Claims (13)

自己の周囲空間に存在する障害物の位置情報を取得する環境情報取得手段と、自己の位置を取得する位置情報取得手段と、前記環境情報取得手段により取得される障害物位置情報に基づいて当該障害物を回避するように走行するための走行経路を決定する経路生成手段と、前記経路生成手段により決定された走行経路に沿って自己の位置を移動させる移動手段と、を備える自律移動装置において、
前記環境情報取得手段は、障害物位置情報を取得する領域が互いに少なくとも一部異なる第1環境情報取得手段と第2環境情報取得手段とを備え、
前記第1環境情報取得手段は、装置の移動の前後において障害物位置情報を取得する領域を一部重複して装置の任意の走行動作中に継続的に障害物位置情報を取得する手段であり、
前記第2環境情報取得手段は、装置の移動の前後において重複することなく漸次新たな障害物位置情報を取得する手段であり、
前記第2環境情報取得手段によって取得された障害物位置情報のうち前記第1環境情報取得手段によって取得された障害物位置情報の周囲一定範囲内にある情報を除く情報が記憶手段に記憶され、
前記経路生成手段は、前記第1環境情報取得手段によって取得される障害物位置情報と、前記記憶手段に記憶された障害物位置情報とに基づいて走行経路を生成することを特徴とする自律移動装置。
Environmental information acquisition means for acquiring position information of obstacles existing in the surrounding space of the person, position information acquisition means for acquiring the position of the self, and based on the obstacle position information acquired by the environment information acquisition means In an autonomous mobile device comprising: route generation means for determining a travel route for traveling so as to avoid an obstacle; and movement means for moving the position of the vehicle along the travel route determined by the route generation means. ,
The environmental information acquisition means includes a first environmental information acquisition means and a second environmental information acquisition means that are different from each other in areas where obstacle position information is acquired.
The first environment information acquisition means is means for acquiring obstacle position information continuously during an arbitrary traveling operation of the apparatus by partially overlapping an area for acquiring obstacle position information before and after the movement of the apparatus. ,
The second environment information acquisition means is means for acquiring new obstacle position information gradually without duplication before and after the movement of the device ,
Information excluding information within a certain range around the obstacle position information acquired by the first environment information acquisition means among the obstacle position information acquired by the second environment information acquisition means is stored in the storage means,
The route generation means generates a travel route based on the obstacle position information acquired by the first environment information acquisition means and the obstacle position information stored in the storage means. apparatus.
前記記憶手段に記憶していた障害物位置情報は、一定時間後に消去することを特徴とする請求項1に記載の自律移動装置。   The autonomous mobile device according to claim 1, wherein the obstacle position information stored in the storage means is erased after a predetermined time. 前記記憶手段に記憶していた障害物位置情報は、一定距離移動後に消去することを特徴とする請求項1に記載の自律移動装置。   The autonomous mobile device according to claim 1, wherein the obstacle position information stored in the storage unit is erased after moving a predetermined distance. 前記第1環境情報取得手段は、走行面に平行な面内の情報より障害物位置情報を取得する手段であることを特徴とする請求項1乃至請求項3のいずれか一項に記載の自律移動装置。   The autonomy according to any one of claims 1 to 3, wherein the first environment information acquisition means is means for acquiring obstacle position information from information in a plane parallel to the running surface. Mobile device. 前記第1環境情報取得手段は、走行面に平行な面内の情報より障害物位置情報を取得する手段であり、
前記第2環境情報取得手段は、走行面に非平行な面内の情報より障害物位置情報を取得する手段であることを特徴とする請求項1乃至請求項3のいずれか一項に記載の自律移動装置。
The first environment information acquisition means is means for acquiring obstacle position information from information in a plane parallel to the running surface,
The said 2nd environment information acquisition means is a means to acquire obstacle position information from the information in the surface which is not parallel to a driving | running | working surface, The Claim 1 thru | or 3 characterized by the above-mentioned. Autonomous mobile device.
前記第2環境情報取得手段は、上方から下方向または下方から上方向をスキャンするスキャン型のセンサを備えていることを特徴とする請求項1乃至請求項5のいずれか一項に記載の自律移動装置。   The autonomous system according to any one of claims 1 to 5, wherein the second environment information acquisition unit includes a scan-type sensor that scans from above to below or from below to above. Mobile device. 前記第2環境情報取得手段は、上方から下方向をスキャンする2つのスキャン型のセンサを左右に備えていることを特徴とする請求項1乃至請求項6のいずれか一項に記載の自律移動装置。   The autonomous movement according to any one of claims 1 to 6, wherein the second environment information acquisition unit includes two scan-type sensors that scan downward from above. apparatus. 自律移動装置の後部平面視形状が円形であることを特徴する請求項1乃至請求項7のいずれか一項に記載の自律移動装置。   The autonomous mobile device according to any one of claims 1 to 7, wherein the shape of the rear plan view of the autonomous mobile device is circular. 前記記憶手段は、有限個数のセルから成るグリッド空間に障害物位置情報を記憶することを特徴とする請求項1乃至請求項8のいずれか一項に記載の自律移動装置。   The autonomous mobile device according to any one of claims 1 to 8, wherein the storage unit stores obstacle position information in a grid space including a finite number of cells. 前記グリッド空間は、自律移動装置と共に移動する座標軸によって設定され、前記グリッド空間における各セルには最大1点の障害物位置情報が記憶され、各セルにおける位置情報は自律移動装置と障害物との相対位置の変化に追随するように変換されて記憶されていることを特徴とする請求項9に記載の自律移動装置。   The grid space is set by coordinate axes that move together with the autonomous mobile device, and each cell in the grid space stores obstacle position information of a maximum of one point. The autonomous mobile device according to claim 9, wherein the autonomous mobile device is converted and stored so as to follow a change in relative position. 前記記憶手段は、障害物位置を水平面に写像した2次元の座標情報として障害物位置情報を記憶することを特徴とする請求項1乃至請求項10のいずれか一項に記載の自律移動装置。   11. The autonomous mobile device according to claim 1, wherein the storage unit stores obstacle position information as two-dimensional coordinate information obtained by mapping the obstacle position on a horizontal plane. 前記第2環境情報取得手段によって取得される障害物位置情報のうち、前記第1環境情報取得手段によって取得される障害物位置情報より遠方の情報は、前記記憶手段に記憶されないことを特徴とする請求項1乃至請求項11のいずれか一項に記載の自律移動装置。   Of the obstacle position information acquired by the second environment information acquisition means, information farther than the obstacle position information acquired by the first environment information acquisition means is not stored in the storage means. The autonomous mobile device according to any one of claims 1 to 11. 前記第1環境情報取得手段によって取得した障害物位置情報に係る障害物が移動中であるかどうかを判断する障害物移動判断手段を備え、
前記障害物移動判断手段によって当該障害物が移動していると判断されたときは、前記第2環境情報取得手段によって取得された障害物位置情報について記憶しない一定範囲を広げることを特徴とする請求項1乃至請求項12のいずれか一項に記載の自律移動装置。
An obstacle movement determining means for determining whether or not an obstacle related to the obstacle position information acquired by the first environment information acquiring means is moving;
When the obstacle movement determination means determines that the obstacle is moving, the fixed range not stored for the obstacle position information acquired by the second environment information acquisition means is widened. The autonomous mobile device according to any one of claims 1 to 12.
JP2008156598A 2008-06-16 2008-06-16 Autonomous mobile device Active JP5361257B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2008156598A JP5361257B2 (en) 2008-06-16 2008-06-16 Autonomous mobile device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2008156598A JP5361257B2 (en) 2008-06-16 2008-06-16 Autonomous mobile device

Publications (2)

Publication Number Publication Date
JP2009301401A JP2009301401A (en) 2009-12-24
JP5361257B2 true JP5361257B2 (en) 2013-12-04

Family

ID=41548209

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2008156598A Active JP5361257B2 (en) 2008-06-16 2008-06-16 Autonomous mobile device

Country Status (1)

Country Link
JP (1) JP5361257B2 (en)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5707833B2 (en) * 2010-10-04 2015-04-30 村田機械株式会社 Transport vehicle and transport system
JP2017122634A (en) * 2016-01-07 2017-07-13 シャープ株式会社 Detection device and mobile entity
CN106842187A (en) * 2016-12-12 2017-06-13 西南石油大学 Positioner and its method are merged in a kind of phase-array scanning with Computer Vision
KR102629762B1 (en) * 2017-10-02 2024-01-29 소니그룹주식회사 Environmental information update device, environmental information update method and program
JP7063066B2 (en) 2018-03-30 2022-05-09 トヨタ自動車株式会社 Route planning device, route planning method and program
US20240094738A1 (en) * 2020-12-11 2024-03-21 Dmg Mori Co., Ltd. Autonomous Traveling Apparatus
CN113358110B (en) * 2021-06-15 2024-05-24 云鲸智能(深圳)有限公司 Method and device for constructing robot obstacle map, robot and storage medium
JP2023090308A (en) * 2021-12-17 2023-06-29 日立建機株式会社 Mining machine and autonomous traveling system

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07160335A (en) * 1993-12-10 1995-06-23 Mutoh Ind Ltd Forward obstacle detector of traveling robot

Also Published As

Publication number Publication date
JP2009301401A (en) 2009-12-24

Similar Documents

Publication Publication Date Title
JP5361257B2 (en) Autonomous mobile device
KR101372482B1 (en) Method and apparatus of path planning for a mobile robot
JP4788722B2 (en) Autonomous mobile robot, self-position estimation method, environmental map generation method, environmental map generation device, and environmental map data structure
US5896488A (en) Methods and apparatus for enabling a self-propelled robot to create a map of a work area
EP2821875A2 (en) Route planning method, route planning unit, and autonomous mobile device
JP4682973B2 (en) Travel route creation method, autonomous mobile body, and autonomous mobile body control system
JP5241306B2 (en) Autonomous mobile device
US9599987B2 (en) Autonomous mobile robot and method for operating the same
JP5902275B1 (en) Autonomous mobile device
JP5212939B2 (en) Autonomous mobile device
WO2014048597A1 (en) Autonomous mobile robot and method for operating the same
JP6074205B2 (en) Autonomous mobile
JP2010134742A (en) Movement control device having obstacle avoiding function
CN110849366A (en) Navigation method and system based on fusion of vision and laser radar
JP4925353B2 (en) Autonomous mobile device
EP3892426A1 (en) Autonomously traveling mobile robot and traveling control method therefor
US20230123512A1 (en) Robotic cleaning device with dynamic area coverage
Liao et al. Deploy indoor 2D laser SLAM on a raspberry pi-based mobile robot
JP4462156B2 (en) Autonomous mobile device
CN111736599A (en) AGV navigation obstacle avoidance system, method and equipment based on multiple laser radars
Mao et al. Combined complete coverage path planning for autonomous mobile robot in indoor environment
JP7188207B2 (en) Driving control method for autonomous vehicles
WO2023176328A1 (en) Information processing device, information processing method, and information processing program
Vandorpe et al. Dynamic docking integrated in a navigation architecture for the intelligent mobile robot lias
Kim et al. Fuzzy visual navigation using behavior primitives for small humanoid robot

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20110323

A711 Notification of change in applicant

Free format text: JAPANESE INTERMEDIATE CODE: A712

Effective date: 20120111

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

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20121001

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20130205

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20130402

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20130903

R150 Certificate of patent or registration of utility model

Ref document number: 5361257

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150