JP5213655B2 - Autonomous mobile robot - Google Patents

Autonomous mobile robot Download PDF

Info

Publication number
JP5213655B2
JP5213655B2 JP2008295974A JP2008295974A JP5213655B2 JP 5213655 B2 JP5213655 B2 JP 5213655B2 JP 2008295974 A JP2008295974 A JP 2008295974A JP 2008295974 A JP2008295974 A JP 2008295974A JP 5213655 B2 JP5213655 B2 JP 5213655B2
Authority
JP
Japan
Prior art keywords
mobile robot
autonomous mobile
distance
measured
light emitting
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
JP2008295974A
Other languages
Japanese (ja)
Other versions
JP2010122904A (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.)
Hitachi Ltd
Original Assignee
Hitachi 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 Hitachi Ltd filed Critical Hitachi Ltd
Priority to JP2008295974A priority Critical patent/JP5213655B2/en
Publication of JP2010122904A publication Critical patent/JP2010122904A/en
Application granted granted Critical
Publication of JP5213655B2 publication Critical patent/JP5213655B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Description

本発明は、周囲環境をセンシングし自己位置を同定しながら自律的に移動する自律移動ロボットに関する。   The present invention relates to an autonomous mobile robot that moves autonomously while sensing the surrounding environment and identifying its own position.

例えば、下記の特許文献1には、危険な場所を回避しながら目的地への移動を可能とする自律移動ロボットシステムが開示されている。当該自律移動ロボットシステムは、予め定められた位置に設置されている標識を標識検出手段により検出した場合に、得られた自己位置が間違っていると判定し、ロボット本体の移動を一旦停止して危険個所を回避することができる。   For example, Patent Document 1 below discloses an autonomous mobile robot system that enables movement to a destination while avoiding a dangerous place. The autonomous mobile robot system determines that the obtained self-position is wrong when a sign installed at a predetermined position is detected by the sign detection means, and temporarily stops the movement of the robot body. Dangerous parts can be avoided.

特開2005−242409号公報JP 2005-242409 A

ところで、搭載されているセンサが故障したり、外乱の影響でセンサが実環境の情報を正しく取得できなかった場合、自律移動ロボットは、自己位置の特定を正しく行うことができず、障害物にぶつかったり指示した場所とは異なる場所へ移動したりする場合がある。センサからの測定結果が実環境とは異なる場合、そのことを周囲の人間に通知できれば、その通知を受けた人間が自律移動ロボットを緊急停止させる等の対処が可能である。しかし、従来は自律移動ロボットがそのような状況にあることを周囲の人間に伝達しておらず、自律移動ロボットの異常な移動を未然に防ぐことができなかった。   By the way, if the installed sensor breaks down or the sensor cannot correctly acquire real-world information due to the influence of disturbance, the autonomous mobile robot cannot correctly identify its own position, There is a case where it collides or moves to a place different from the designated place. If the measurement result from the sensor is different from the actual environment, if it can be notified to the surrounding people, the person who has received the notification can take measures such as urgently stopping the autonomous mobile robot. However, conventionally, the autonomous mobile robot has not been informed of such a situation to surrounding people, and abnormal movement of the autonomous mobile robot could not be prevented.

本発明は上記事情を鑑みてなされたものであり、本発明の目的は、センサの故障等による自律移動ロボットの異常な移動を未然に防ぐことにある。   The present invention has been made in view of the above circumstances, and an object of the present invention is to prevent an abnormal movement of an autonomous mobile robot due to a sensor failure or the like.

上記課題を解決するために本発明の自律移動ロボットは、センサによって測定された情報と予め設定された実環境の物体の配置を示す情報との比較結果を周囲の人間に通知する。   In order to solve the above problems, the autonomous mobile robot of the present invention notifies surrounding humans of a comparison result between information measured by a sensor and information indicating the arrangement of a real environment object set in advance.

例えば、本発明は、自律移動ロボットであって、
物体の配置を示す地図情報を格納する地図情報格納部と、
前記自律移動ロボット周辺の実環境の情報を取得するセンサと、
前記地図情報内における自律移動ロボットの位置および向きを算出する算出部と、
前記算出部によって算出された前記自律移動ロボットの位置および向きの情報に基づき決定される移動パラメータに従い自律移動ロボットを移動させる移動部と、
前記センサが取得した実環境の情報と前記地図情報とを比較する比較部と、
前記比較部における比較結果を通知する通知部と
を備え
前記センサは、前記自律移動ロボットと自律移動ロボット周辺の物体との間の距離を測定する距離センサを複数有し、
前記地図情報は、前記距離センサが取り付けられている高さにおける実環境の形状を示す2次元地図情報であり、
前記算出部は、複数の前記距離センサが取得した距離を示す距離情報と前記2次元地図情報とを比較して最も一致度が高くなる位置および向きを、前記自律移動ロボットの位置および向きとして算出し、
前記比較部は、
前記算出部によって前記自律移動ロボットの位置が算出された後に、それぞれの前記距離センサが前記自律移動ロボットから前記自律移動ロボット周辺の物体までの距離を測定したそれぞれの方向について、前記距離センサが測定した実測距離と、当該算出された自律移動ロボットの位置から前記2次元地図情報内の物体の位置までの当該方向における地図上の距離との差分を算出し、前記距離センサが前記自律移動ロボットから前記自律移動ロボット周辺の物体までの距離を測定した複数の方向の中に当該差分が所定値以上となる方向が存在する場合に、その方向を比較結果として前記通知部に通知させることを特徴とする自律移動ロボットを提供する。
For example, the present invention is an autonomous mobile robot,
A map information storage unit for storing map information indicating the arrangement of objects;
A sensor for acquiring information on a real environment around the autonomous mobile robot;
A calculation unit for calculating the position and orientation of the autonomous mobile robot in the map information;
A moving unit for moving the autonomous mobile robot according to a movement parameter determined based on the position and orientation information of the autonomous mobile robot calculated by the calculating unit;
A comparison unit that compares the map information with information on the real environment acquired by the sensor;
A notification unit for notifying the comparison result in the comparison unit ,
The sensor has a plurality of distance sensors for measuring a distance between the autonomous mobile robot and an object around the autonomous mobile robot,
The map information is two-dimensional map information indicating a shape of a real environment at a height at which the distance sensor is attached,
The calculation unit compares the distance information indicating the distances acquired by a plurality of the distance sensors and the two-dimensional map information, and calculates the position and direction having the highest degree of coincidence as the position and direction of the autonomous mobile robot. And
The comparison unit includes:
After the position of the autonomous mobile robot is calculated by the calculation unit, the distance sensor measures each direction in which each distance sensor measures a distance from the autonomous mobile robot to an object around the autonomous mobile robot. A difference between the measured distance and the distance on the map in the direction from the calculated position of the autonomous mobile robot to the position of the object in the two-dimensional map information, and the distance sensor from the autonomous mobile robot when the difference in a plurality of directions the distance measured to the object near the autonomous mobile robot is present direction equal to or greater than a predetermined value, characterized Rukoto is notified to the notification unit in that direction as a comparison result An autonomous mobile robot is provided.

本発明の自律移動ロボットによれば、センサの故障等による自律移動ロボットの異常な移動を未然に防ぐことができる。   According to the autonomous mobile robot of the present invention, abnormal movement of the autonomous mobile robot due to a sensor failure or the like can be prevented in advance.

以下、本発明の実施の形態について説明する。   Embodiments of the present invention will be described below.

図1は、本発明の一実施形態に係る自律移動ロボット10の概観の一例を示す斜視図である。自律移動ロボット10は、センサユニット11、計算装置12、および移動装置13を備える。センサユニット11および計算装置12は、移動装置13上に設けられる。   FIG. 1 is a perspective view showing an example of an overview of an autonomous mobile robot 10 according to an embodiment of the present invention. The autonomous mobile robot 10 includes a sensor unit 11, a calculation device 12, and a movement device 13. The sensor unit 11 and the calculation device 12 are provided on the moving device 13.

センサユニット11は、複数の距離センサ14および複数の発光素子15を有する。それぞれの距離センサ14は、例えばレーザ距離センサであり、自律移動ロボット10の周辺の物体までの距離を所定の方向について測定し、測定したセンシングデータを計算装置12に提供する。それぞれの発光素子15は、例えばLED(Light Emitting Diode)であり、1つまたは複数の距離センサ14に対応して1つずつ設けられる。   The sensor unit 11 includes a plurality of distance sensors 14 and a plurality of light emitting elements 15. Each distance sensor 14 is, for example, a laser distance sensor, measures the distance to an object around the autonomous mobile robot 10 in a predetermined direction, and provides the measured sensing data to the calculation device 12. Each light emitting element 15 is, for example, an LED (Light Emitting Diode), and is provided one by one corresponding to one or a plurality of distance sensors 14.

計算装置12は、距離センサ14が配置された高さのxy平面における2次元地図を格納しており、複数の距離センサ14から提供されたそれぞれの方向の物体までのセンシングデータに基づいて、当該センシングデータが測定される2次元地図内の位置および向きを、自律移動ロボット10の位置および向きとして算出する。そして、計算装置12は、予め設定された2次元地図内の経路に沿って移動するよう移動装置13を制御する。 The calculation device 12 stores a two-dimensional map in the xy plane at the height where the distance sensor 14 is arranged, and based on the sensing data up to the object in each direction provided from the plurality of distance sensors 14. The position and orientation in the two-dimensional map where the sensing data is measured are calculated as the position and orientation of the autonomous mobile robot 10. Then, the calculation device 12 controls the moving device 13 so as to move along a route in the preset two-dimensional map.

また、計算装置12は、算出した自律移動ロボット10の2次元地図上の位置および向きにおいて、2次元地図上の物体までの距離と所定値以上異なるセンシングデータが距離センサ14によって測定された場合に、そのセンシングデータを測定した距離センサ14に対応付けられている発光素子15を発光させる。   In addition, the calculation device 12 determines that the distance sensor 14 measures sensing data that differs from the distance to the object on the two-dimensional map by a predetermined value or more in the calculated position and orientation of the autonomous mobile robot 10 on the two-dimensional map. The light emitting element 15 associated with the distance sensor 14 that has measured the sensing data is caused to emit light.

図2は、自律移動ロボット10の機能構成の一例を示すブロック図である。計算装置12は、地図情報格納部120、位置姿勢算出部121、移動制御部122、および発光制御部123を有する。   FIG. 2 is a block diagram illustrating an example of a functional configuration of the autonomous mobile robot 10. The calculation device 12 includes a map information storage unit 120, a position / orientation calculation unit 121, a movement control unit 122, and a light emission control unit 123.

地図情報格納部120は、距離センサ14が配置される高さにおける2次元地図である地図情報を予め格納している。地図情報格納部120は、例えば図3に示すように、物体が存在しない場所を白を示す画素21、物体が存在する場所を黒を示す画素22とするディジタル画像として地図情報を格納している。また、地図情報格納部120には、自律移動ロボット10の移動経路を示す情報が、例えば地図情報上の直線や曲線のデータとして予め格納されている。   The map information storage unit 120 stores in advance map information that is a two-dimensional map at a height at which the distance sensor 14 is disposed. For example, as shown in FIG. 3, the map information storage unit 120 stores map information as a digital image in which a place where an object is not present is a pixel 21 indicating white and a place where an object is present is a pixel 22 indicating black. . Further, the map information storage unit 120 stores in advance information indicating the movement route of the autonomous mobile robot 10 as, for example, straight line or curve data on the map information.

それぞれの距離センサ14は、自律移動ロボット10に対して所定の向きで配置され、例えば図4に示すように、それぞれの距離センサ14の測定可能範囲内(例えば8m以内)において、その方向にある物体23までの距離を測定し、測定した距離データを位置姿勢算出部121に提供する。位置姿勢算出部121は、それぞれの距離センサ14について、自律移動ロボット10に対する相対的な向きを示すデータを保持しており、それぞれの距離センサ14から提供された距離データに、当該距離センサ14の向きを示すデータを対応付けてセンシングデータを生成する。   Each distance sensor 14 is arranged in a predetermined direction with respect to the autonomous mobile robot 10 and is in that direction within the measurable range of each distance sensor 14 (for example, within 8 m), for example, as shown in FIG. The distance to the object 23 is measured, and the measured distance data is provided to the position / orientation calculation unit 121. The position / orientation calculation unit 121 holds data indicating the relative orientation of each distance sensor 14 with respect to the autonomous mobile robot 10, and the distance data provided from each distance sensor 14 includes the distance sensor 14. Sensing data is generated by associating data indicating the direction.

複数のセンシングデータであるセンシングデータ群24を図示すると、例えば図5のようになる。i番目のセンシングデータ25には、距離センサ14から物体までの距離dと(本実施形態では0<d<8m)、自律移動ロボット10の進行方向(図5におけるx軸方向)に対する方向を示す角度φ(本実施形態では−90°<φ<+90°)とが対応付けられている。 A sensing data group 24 which is a plurality of sensing data is illustrated in FIG. 5, for example. The i-th sensing data 25 includes a distance d i from the distance sensor 14 to an object (0 <d i <8 m in the present embodiment), and a direction with respect to the traveling direction of the autonomous mobile robot 10 (x-axis direction in FIG. 5). Is associated with an angle φ i indicating −90 ° <φ i <+ 90 ° in the present embodiment.

本実施形態において、それぞれの距離センサ14は、−90°から+90°まで1°毎に合計181個設けられているものとする。なお、他の形態として、センサユニット11には距離センサ14が1つ設けられ、その距離センサ14が、−90°から+90°まで1°毎に合計181個の方向について物体までの距離を測定するようにしてもよい。   In the present embodiment, it is assumed that a total of 181 distance sensors 14 are provided every 1 ° from −90 ° to + 90 °. As another form, the sensor unit 11 is provided with one distance sensor 14, and the distance sensor 14 measures the distance to the object in a total of 181 directions every 1 ° from −90 ° to + 90 °. You may make it do.

距離センサ14からの距離データに基づいて、例えば図6(a)のセンシングデータ群24を生成した場合、位置姿勢算出部121は、地図情報格納部120内の地図情報上において、当該センシングデータ群24全体の位置および向きを変えながら、センシングデータが地図情報上の物体を示す画素に最も多く一致するセンシングデータ群24の位置および向きを探す。   For example, when the sensing data group 24 of FIG. 6A is generated based on the distance data from the distance sensor 14, the position / orientation calculation unit 121 displays the sensing data group on the map information in the map information storage unit 120. While changing the position and orientation of the whole 24, the position and orientation of the sensing data group 24 whose sensing data most closely matches the pixel indicating the object on the map information are searched.

そして、センシングデータが地図情報上の物体を示す画素に最も多く一致するセンシングデータ群24の位置および向きが、例えば図6(b)の状態である場合、位置姿勢算出部121は、そのときのセンシングデータの中心27を自律移動ロボット10の位置として特定し、そのときのセンシングデータの中心軸28を自律移動ロボット10の向きとして特定する。   When the position and orientation of the sensing data group 24 whose sensing data most closely matches the pixel indicating the object on the map information is in the state of FIG. 6B, for example, the position / orientation calculation unit 121 The center 27 of the sensing data is specified as the position of the autonomous mobile robot 10, and the central axis 28 of the sensing data at that time is specified as the orientation of the autonomous mobile robot 10.

そして、位置姿勢算出部121は、地図情報内で特定した自律移動ロボット10の位置および向きを示すデータと共に、生成したセンシングデータ群を発光制御部123へ送る。また、位置姿勢算出部121は、地図情報格納部120内の移動経路を参照して、自律移動ロボット10の移動量および移動方向を算出し、算出した移動量および移動方向を示す情報を移動制御部122へ送る。   Then, the position and orientation calculation unit 121 sends the generated sensing data group to the light emission control unit 123 together with data indicating the position and orientation of the autonomous mobile robot 10 specified in the map information. In addition, the position / orientation calculation unit 121 calculates the movement amount and movement direction of the autonomous mobile robot 10 with reference to the movement route in the map information storage unit 120, and performs movement control on information indicating the calculated movement amount and movement direction. Send to section 122.

移動制御部122は、位置姿勢算出部121から受け取った移動量および移動方向を示す情報に基づいて移動装置13を制御する制御信号を生成し、生成した制御信号を移動装置13に供給することにより、自律移動ロボット10を移動させる。   The movement control unit 122 generates a control signal for controlling the moving device 13 based on the information indicating the moving amount and moving direction received from the position / orientation calculating unit 121, and supplies the generated control signal to the moving device 13. The autonomous mobile robot 10 is moved.

発光制御部123は、自律移動ロボット10の位置および向きを示すデータと共にセンシングデータ群を位置姿勢算出部121から受け取った場合に、地図情報格納部120内の地図情報を参照し、現在の自律移動ロボット10の位置および向きにおけるそれぞれのセンシングデータが示す方向について、センシングデータが示す距離と、地図情報上における自律移動ロボット10の位置から物体までの距離との差が予め定められた値(例えば1m)以上となるセンシングデータが存在するか否かを判定する。   When the light emission control unit 123 receives a sensing data group from the position and orientation calculation unit 121 together with data indicating the position and orientation of the autonomous mobile robot 10, the light emission control unit 123 refers to the map information in the map information storage unit 120 and performs the current autonomous movement. For the directions indicated by the respective sensing data in the position and orientation of the robot 10, a difference between the distance indicated by the sensing data and the distance from the position of the autonomous mobile robot 10 to the object on the map information is a predetermined value (for example, 1 m ) It is determined whether or not the above sensing data exists.

センシングデータが示す距離と、地図情報上における自律移動ロボット10の位置から物体までの距離との差が予め定められた値以上となるセンシングデータが存在する場合、発光制御部123は、移動制御部122が移動装置13に移動のための制御信号を供給する前に、当該センシングデータを提供した距離センサ14に対応付けられている発光素子15を所定の色および発光強度で発光させる。   When there is sensing data in which the difference between the distance indicated by the sensing data and the distance from the position of the autonomous mobile robot 10 to the object on the map information is equal to or greater than a predetermined value, the light emission control unit 123 Before 122 supplies a control signal for movement to the moving device 13, the light emitting element 15 associated with the distance sensor 14 that has provided the sensing data is caused to emit light with a predetermined color and light emission intensity.

また、発光素子15を発光させる場合、発光制御部123は、当該発光素子15を点滅させたり、点滅の時間間隔を変化させたり、色や発光強度を変化させたり、点滅、色、および発光強度の時間変化を組み合わせたりしてもよい。   When the light emitting element 15 is caused to emit light, the light emission control unit 123 blinks the light emitting element 15, changes the blinking time interval, changes the color or light emission intensity, flashes, color, and light emission intensity. You may combine the time change of.

ここで、例えば図7に示すような実環境内に自律移動ロボット10が位置し、距離センサ14が正しく実環境の物体までの距離を測定することができている場合には、例えば図8に示すセンシングデータ群29が得られ、自律移動ロボット10は、実環境に即した適切な移動が可能となる。   Here, for example, when the autonomous mobile robot 10 is located in the real environment as shown in FIG. 7 and the distance sensor 14 can correctly measure the distance to the object in the real environment, FIG. The sensing data group 29 shown is obtained, and the autonomous mobile robot 10 can move appropriately in accordance with the actual environment.

しかし、図9に示すように、距離センサ14の故障や外乱の影響等により、実環境には存在しない物体までの距離を示すデータが距離センサ14によって測定され、当外距離データに基づいて作成されたセンシングデータ31を含むセンシングデータ群30が得られる場合がある。自律移動ロボット10は、当該センシングデータ31に対応する位置に物体が存在するものと認識し、当該物体が移動経路の近傍に存在する場合には、移動経路を逸脱して当該物体との接触を回避したり、移動を停止したりする等の対処を行う場合がある。   However, as shown in FIG. 9, data indicating the distance to an object that does not exist in the actual environment is measured by the distance sensor 14 due to the failure of the distance sensor 14 or the influence of disturbance, and is created based on the extraordinary distance data In some cases, a sensing data group 30 including the sensed sensing data 31 is obtained. The autonomous mobile robot 10 recognizes that an object exists at a position corresponding to the sensing data 31, and if the object exists in the vicinity of the movement path, the autonomous mobile robot 10 deviates from the movement path and makes contact with the object. There are cases where measures such as avoiding or stopping the movement are taken.

しかし、実際にはセンシングデータ31に対応する位置に物体は存在しないため、自律移動ロボット10は無用な移動を行うことになり、移動経路を逸脱して指示されていない領域へ進入したり、目的地点への到着が遅れてしまう場合がある。   However, since there is actually no object at the position corresponding to the sensing data 31, the autonomous mobile robot 10 moves unnecessarily, and enters an uninstructed area beyond the movement path, Arrival at the point may be delayed.

また、図10に示すように、距離センサ14の故障や外乱の影響等により、実環境内に存在する物体に対して本来測定されるべき距離データが測定されないことにより、生成されるべきセンシングデータ33が存在しないセンシングデータ群32を生成した場合、自律移動ロボット10は、当該センシングデータ33の位置には物体が存在しないものとして移動することにより、当該物体にぶつかってしまう場合がある。   Also, as shown in FIG. 10, sensing data to be generated when distance data that should originally be measured for an object existing in the actual environment is not measured due to the failure of the distance sensor 14 or the influence of disturbance, etc. When the sensing data group 32 in which 33 does not exist is generated, the autonomous mobile robot 10 may collide with the object by moving assuming that the object does not exist at the position of the sensing data 33.

これに対して、本実施形態の自律移動ロボット10は、予め設定された地図情報と異なるセンシングデータが測定された場合には、そのセンシングデータが測定された方向について、予め設定された地図情報と異なるセンシングデータが測定された旨を発光素子15を発光させる等により周囲の人間に通知した後に、測定されたセンシングデータに従って移動する。   On the other hand, when the sensing data different from the preset map information is measured, the autonomous mobile robot 10 of the present embodiment has the preset map information and the direction in which the sensing data is measured. After notifying the surrounding human beings that the different sensing data has been measured by causing the light emitting element 15 to emit light, etc., it moves according to the measured sensing data.

これにより、発光素子15の発光を見た自律移動ロボット10の周囲の人間は、自律移動ロボット10の移動を停止させて、指示されていない領域への自律移動ロボット10の進入や、自律移動ロボット10と物体との衝突等を防止することができる。また、必要であれば、自律移動ロボット10内の地図情報、ならびに、位置姿勢算出部121によって算出された自律移動ロボット10の位置および向きを、実際の環境と見比べることにより、距離センサ14による距離データの測定が正しかったか否かを検証することにより、距離センサ14の故障の有無を判定することも可能となる。   As a result, the humans around the autonomous mobile robot 10 who have seen the light emission of the light emitting element 15 stop the movement of the autonomous mobile robot 10, and the autonomous mobile robot 10 enters the area not designated or the autonomous mobile robot. A collision between the object 10 and the object can be prevented. Further, if necessary, the distance information by the distance sensor 14 is obtained by comparing the map information in the autonomous mobile robot 10 and the position and orientation of the autonomous mobile robot 10 calculated by the position and orientation calculation unit 121 with the actual environment. By verifying whether or not the data measurement is correct, it is possible to determine whether or not the distance sensor 14 has failed.

なお、発光制御部123は、地図情報に存在する物体までの距離よりも、距離センサ14によって測定された距離データの方が所定距離以上短い場合、すなわち、地図情報にない物体の距離データが測定された場合、対応する発光素子15を例えば緑色で発光させ、地図情報に存在する物体までの距離よりも、距離センサ14によって測定された距離データの方が所定距離以上長い場合、すなわち、地図情報に存在する物体の距離データが測定されなかった場合、対応する発光素子15を例えば赤色で発光させることが好ましい。これにより、自律移動ロボット10が物体の存在を認識せずにその物体に衝突する可能性があることを周囲の人間に認識させることができる。   Note that the light emission control unit 123 measures the distance data of the object not included in the map information when the distance data measured by the distance sensor 14 is shorter than the distance to the object present in the map information by a predetermined distance or more. If the distance data measured by the distance sensor 14 is longer than the distance to the object present in the map information by a predetermined distance or more, for example, the map information When the distance data of the object existing in is not measured, it is preferable to cause the corresponding light emitting element 15 to emit light in red, for example. As a result, it is possible to make the surrounding humans recognize that the autonomous mobile robot 10 may collide with the object without recognizing the presence of the object.

図11は、自律移動ロボット10の動作の一例を示すフローチャートである。   FIG. 11 is a flowchart showing an example of the operation of the autonomous mobile robot 10.

まず、位置姿勢算出部121は、それぞれの距離センサ14によって測定された距離データを取得する(S100)。そして、位置姿勢算出部121は、それぞれの距離センサ14から取得した距離データに、当該距離センサ14の向きを示すデータを対応付けてセンシングデータを生成する。   First, the position / orientation calculation unit 121 acquires distance data measured by each distance sensor 14 (S100). The position / orientation calculation unit 121 generates sensing data by associating the distance data acquired from each distance sensor 14 with data indicating the direction of the distance sensor 14.

次に、位置姿勢算出部121は、地図情報格納部120内の地図情報上において、生成したセンシングデータ群全体の位置および向きを変えながら、センシングデータが地図情報上の物体を示す画素に最も多く一致するセンシングデータ群の位置および向きを検索し、センシングデータが地図情報上の物体を示す画素に最も多く一致するセンシングデータ群の中心を自律移動ロボット10の位置として特定し、そのときのセンシングデータ群の中心軸を自律移動ロボット10の向きとして特定する(S101)。   Next, the position / orientation calculation unit 121 changes the position and orientation of the entire generated sensing data group on the map information in the map information storage unit 120, and the sensing data has the largest number of pixels indicating objects on the map information. The position and orientation of the matching sensing data group are searched, the center of the sensing data group whose sensing data most matches the pixel indicating the object on the map information is identified as the position of the autonomous mobile robot 10, and the sensing data at that time The center axis of the group is specified as the direction of the autonomous mobile robot 10 (S101).

そして、位置姿勢算出部121は、特定した自律移動ロボット10の位置および向きを示すデータと共に、生成したセンシングデータ群を発光制御部123へ送る。そして、位置姿勢算出部121は、特定した自律移動ロボット10の位置および向きに基づいて地図情報格納部120内の移動経路を参照し、自律移動ロボット10の移動量および移動方向を算出し、算出した移動量および移動方向を示す情報を移動制御部122へ送る。   Then, the position / orientation calculation unit 121 sends the generated sensing data group to the light emission control unit 123 together with the data indicating the position and orientation of the specified autonomous mobile robot 10. Then, the position / orientation calculation unit 121 refers to the movement path in the map information storage unit 120 based on the identified position and orientation of the autonomous mobile robot 10, calculates the movement amount and movement direction of the autonomous mobile robot 10, and calculates Information indicating the amount and direction of movement is sent to the movement control unit 122.

次に、発光制御部123は、地図情報格納部120内の地図情報を参照し、現在の自律移動ロボット10の位置および向きにおけるそれぞれのセンシングデータが示す方向について、センシングデータが示す距離と、地図情報上における自律移動ロボット10の位置から物体までの距離との差が所定値以上となるセンシングデータが存在するか否かを判定する(S102)。   Next, the light emission control unit 123 refers to the map information in the map information storage unit 120, and for the directions indicated by the respective sensing data in the current position and orientation of the autonomous mobile robot 10, the distance indicated by the sensing data, the map It is determined whether there is sensing data in which the difference between the position of the autonomous mobile robot 10 on the information and the distance from the object is a predetermined value or more (S102).

センシングデータが示す距離と、地図情報上における自律移動ロボット10の位置から物体までの距離との差が所定値以上となるセンシングデータが存在しない場合(S102:No)、位置姿勢算出部121は、再びステップS100に示した処理を実行する。   When there is no sensing data in which the difference between the distance indicated by the sensing data and the distance from the position of the autonomous mobile robot 10 to the object on the map information is a predetermined value or more (S102: No), the position and orientation calculation unit 121 The process shown in step S100 is executed again.

センシングデータが示す距離と、地図情報上における自律移動ロボット10の位置から物体までの距離との差が所定値以上となるセンシングデータが存在する場合(S102:Yes)、発光制御部123は、当該センシングデータを提供した距離センサ14を特定し(S103)、発光パターンを決定する(S104)。   When there is sensing data in which the difference between the distance indicated by the sensing data and the distance from the position of the autonomous mobile robot 10 to the object on the map information is a predetermined value or more (S102: Yes), the light emission control unit 123 The distance sensor 14 that provided the sensing data is specified (S103), and the light emission pattern is determined (S104).

例えば、発光制御部123は、地図情報に存在する物体までの距離よりも、距離センサ14によって測定された距離データの方が所定距離以上短い場合、発光パターンを緑色での点灯と決定し、地図情報に存在する物体までの距離よりも、距離センサ14によって測定された距離データの方が所定距離以上長い場合、発光パターンを赤色での点灯と決定する。   For example, if the distance data measured by the distance sensor 14 is shorter than a predetermined distance than the distance to the object existing in the map information, the light emission control unit 123 determines the light emission pattern to be illuminated in green, and the map When the distance data measured by the distance sensor 14 is longer than the distance to the object existing in the information by a predetermined distance or more, the light emission pattern is determined to be lit in red.

次に、発光制御部123は、ステップS103で特定した距離センサ14に対応付けられている発光素子15を、ステップS104で決定した発光パターンで発光させる(S105)。そして、移動制御部122は、位置姿勢算出部121から受け取った移動量および移動方向を示す情報に基づいて移動装置13を制御する制御信号を生成し、生成した制御信号を移動装置13に供給することにより、自律移動ロボット10を移動経路に沿って移動させ(S106)、位置姿勢算出部121は、再びステップS100に示す処理を実行する。   Next, the light emission control unit 123 causes the light emitting element 15 associated with the distance sensor 14 identified in step S103 to emit light with the light emission pattern determined in step S104 (S105). Then, the movement control unit 122 generates a control signal for controlling the moving device 13 based on the information indicating the moving amount and moving direction received from the position / orientation calculating unit 121, and supplies the generated control signal to the moving device 13. Thus, the autonomous mobile robot 10 is moved along the movement path (S106), and the position / orientation calculation unit 121 executes the process shown in step S100 again.

図12は、計算装置12の機能を実現するコンピュータ40のハードウェア構成の一例を示す図である。コンピュータ40は、CPU(Central Processing Unit)41、RAM(Random Access Memory)42、ROM(Read Only Memory)43、HDD(Hard Disk Drive)44、入力インターフェイス(I/F)45、出力インターフェイス(I/F)46、およびメディアインターフェイス(I/F)47を備える。   FIG. 12 is a diagram illustrating an example of a hardware configuration of the computer 40 that implements the functions of the computing device 12. The computer 40 includes a central processing unit (CPU) 41, a random access memory (RAM) 42, a read only memory (ROM) 43, a hard disk drive (HDD) 44, an input interface (I / F) 45, an output interface (I / F). F) 46 and a media interface (I / F) 47.

CPU41は、ROM43またはHDD44に格納されたプログラムに基づいて動作し、各部の制御を行う。ROM43は、コンピュータ40の起動時にCPU41によって実行されるブートプログラムや、コンピュータ40のハードウェアに依存するプログラム等を格納する。HDD44は、CPU41によって実行されるプログラムを格納する。   The CPU 41 operates based on a program stored in the ROM 43 or the HDD 44 and controls each part. The ROM 43 stores a boot program executed by the CPU 41 when the computer 40 is started up, a program depending on the hardware of the computer 40, and the like. The HDD 44 stores a program executed by the CPU 41.

CPU41は、入力インターフェイス45を介して、距離センサ14を制御し、入力インターフェイス45を介して、距離センサ14からデータを取得する。また、CPU41は、出力インターフェイス46を介して、移動装置13および発光素子15を制御し、生成したデータを、出力インターフェイス46を介して移動装置13または発光素子15へ出力する。   The CPU 41 controls the distance sensor 14 via the input interface 45 and acquires data from the distance sensor 14 via the input interface 45. Further, the CPU 41 controls the moving device 13 and the light emitting element 15 via the output interface 46, and outputs the generated data to the moving device 13 or the light emitting element 15 via the output interface 46.

メディアインターフェイス47は、記録媒体48に格納されたプログラムまたはデータを読み取り、RAM42を介してCPU41に提供する。CPU41は、当該プログラムを、メディアインターフェイス47を介して記録媒体48からRAM42上にロードし、ロードしたプログラムを実行する。記録媒体48は、例えばDVD(Digital Versatile Disk)、PD(Phase change rewritable Disk)等の光学記録媒体、MO(Magneto-Optical disk)等の光磁気記録媒体、テープ媒体、磁気記録媒体、または半導体メモリ等である。   The media interface 47 reads a program or data stored in the recording medium 48 and provides it to the CPU 41 via the RAM 42. The CPU 41 loads the program from the recording medium 48 onto the RAM 42 via the media interface 47 and executes the loaded program. The recording medium 48 is, for example, an optical recording medium such as a DVD (Digital Versatile Disk) or PD (Phase change rewritable disk), a magneto-optical recording medium such as an MO (Magneto-Optical disk), a tape medium, a magnetic recording medium, or a semiconductor memory. Etc.

コンピュータ40のCPU41は、RAM42上にロードされたプログラムを実行することにより、地図情報格納部120、位置姿勢算出部121、移動制御部122、および発光制御部123の各機能を実現する。また、ROM43またはHDD44には、地図情報格納部120内のデータが格納される。コンピュータ40は、これらのプログラムを、記録媒体48から読み取って実行するが、他の例として、コンピュータ40に通信機能を設け、通信媒体を介してこれらのプログラムを取得するようにしてもよい。   The CPU 41 of the computer 40 implements the functions of the map information storage unit 120, the position / orientation calculation unit 121, the movement control unit 122, and the light emission control unit 123 by executing a program loaded on the RAM 42. The ROM 43 or the HDD 44 stores data in the map information storage unit 120. The computer 40 reads these programs from the recording medium 48 and executes them. However, as another example, the computer 40 may be provided with a communication function to acquire these programs via the communication medium.

以上、本発明の実施の形態について説明した。   The embodiment of the present invention has been described above.

上記説明から明らかなように、本実施形態の自律移動ロボット10によれば、距離センサ14の故障等による自律移動ロボット10の異常な移動を未然に防ぐことができる。   As is apparent from the above description, according to the autonomous mobile robot 10 of the present embodiment, abnormal movement of the autonomous mobile robot 10 due to a failure of the distance sensor 14 or the like can be prevented in advance.

なお、本発明は、上記した実施形態に限定されるものではなく、その要旨の範囲内で数々の変形が可能である。   In addition, this invention is not limited to above-described embodiment, Many deformation | transformation are possible within the range of the summary.

例えば、それぞれの距離センサ14に対応付けた発光素子15を、例えば図13に示すように、複数の発光素子151が一列に並ぶ発光ユニット150としてもよい。発光制御部123は、センシングデータが示す距離と、地図情報上における自律移動ロボット10の位置から物体までの距離との差が予め定められた値以上となるセンシングデータが存在する場合に、当該センシングデータを提供した距離センサ14に対応付けられている発光ユニット150において、当該センシングデータが示す距離に対応する数の発光素子151を所定の色および発光強度で発光させる。   For example, the light emitting element 15 associated with each distance sensor 14 may be a light emitting unit 150 in which a plurality of light emitting elements 151 are arranged in a line as shown in FIG. The light emission control unit 123 performs sensing when there is sensing data in which the difference between the distance indicated by the sensing data and the distance from the position of the autonomous mobile robot 10 to the object on the map information is equal to or greater than a predetermined value. In the light emitting unit 150 associated with the distance sensor 14 that provided the data, the number of light emitting elements 151 corresponding to the distance indicated by the sensing data is caused to emit light with a predetermined color and light emission intensity.

図13に示した例では、8mの測定可能距離を1.6m毎に5段階に分け、該当するセンシングデータによって示される距離が3.2m以上4.8m未満の範囲にあることを示している。これにより、それを見た周囲の人間は、発光している発光ユニット150に対応する距離センサ14によって測定されたおおよその距離を迅速に認識することができる。   In the example shown in FIG. 13, the measurable distance of 8 m is divided into five stages every 1.6 m, and the distance indicated by the corresponding sensing data is in the range of 3.2 m or more and less than 4.8 m. . As a result, surrounding people who have seen it can quickly recognize the approximate distance measured by the distance sensor 14 corresponding to the light emitting unit 150 emitting light.

また、発光制御部123は、図14に示すように、センシングデータによって示される距離と、地図情報上の物体までの距離とを、異なる色で表示するように、発光ユニット150内の発光素子151を制御してもよい。例えば、センシングデータによって示される距離を赤、地図情報上の物体までの距離を緑で表示するようにしてもよい。   Further, as shown in FIG. 14, the light emission control unit 123 displays the distance indicated by the sensing data and the distance to the object on the map information in different colors so that the light emitting element 151 in the light emitting unit 150 is displayed. May be controlled. For example, the distance indicated by the sensing data may be displayed in red, and the distance to the object on the map information may be displayed in green.

この場合、例えば図14(a)の状態では、発光素子151−2および発光素子151−3が赤で発光し、発光素子151−4および発光素子151−5が赤と緑が混合して黄色で発光することになる。また、例えば図14(b)の状態では、発光素子151−2および発光素子151−3が緑で発光し、発光素子151−4および発光素子151−5が赤と緑が混合して黄色で発光することになる。   In this case, for example, in the state of FIG. 14A, the light emitting element 151-2 and the light emitting element 151-3 emit light in red, and the light emitting element 151-4 and the light emitting element 151-5 are mixed yellow and red. Will emit light. For example, in the state of FIG. 14B, the light emitting element 151-2 and the light emitting element 151-3 emit light in green, and the light emitting element 151-4 and the light emitting element 151-5 are mixed in red and green and yellow. It will emit light.

これにより、周囲の人間は、距離センサ14が物体との距離をおおよそどの程度と認識し、地図情報には物体までの距離としておおよそどのような値が格納されているのかを、発光ユニット150の表示から迅速に認識することができる。   Thereby, the surrounding human recognizes the distance to the object by the distance sensor 14 and what value is stored as the distance to the object in the map information. It can be recognized quickly from the display.

また、図13または図14の発光ユニット150を、例えば図15に示すように放射状に並べ、例えば図16に示すようにセンサユニット11の上面に配置するようにしてもよい。これにより、自律移動ロボット10の周囲の人間にとって、発光ユニット150が示す距離が測定された方向と、実環境における方向との対応付けが容易になり、発光ユニット150の表示する方向をより迅速に認識することができる。   Further, the light emitting units 150 of FIG. 13 or FIG. 14 may be arranged radially as shown in FIG. 15, for example, and arranged on the upper surface of the sensor unit 11 as shown in FIG. This makes it easy for humans around the autonomous mobile robot 10 to associate the direction in which the distance indicated by the light-emitting unit 150 is measured with the direction in the real environment, and more quickly change the direction displayed by the light-emitting unit 150. Can be recognized.

また、複数の発光ユニット150に代えて、複数の発光素子15を、例えば図17に示すように、センサユニット11の上面に円弧状に配置してもよい。このように複数の発光素子15を配置することでも、自律移動ロボット10の周囲の人間にとって、それぞれの発光素子15に対応付けられた距離センサ14の測定方向と、実環境における方向との対応付けが容易になり、発光素子15の発光により示される距離センサ14の測定方向をより迅速に認識することができる。   Further, instead of the plurality of light emitting units 150, a plurality of light emitting elements 15 may be arranged in an arc shape on the upper surface of the sensor unit 11, as shown in FIG. By arranging a plurality of light emitting elements 15 in this way, it is possible for humans around the autonomous mobile robot 10 to associate the measurement direction of the distance sensor 14 associated with each light emitting element 15 with the direction in the real environment. And the measurement direction of the distance sensor 14 indicated by the light emission of the light emitting element 15 can be recognized more quickly.

また、図13または図14に示したそれぞれの発光ユニット150を、例えば図18に示すように、長手方向が上下方向となるようにセンサユニット11の筐体の側面に配置してもよい。また、図13または図14に示したそれぞれの発光ユニット150を、例えば図19に示すように、長手方向が上下方向となるように移動装置13の筐体の側面に配置してもよい。   Each of the light emitting units 150 shown in FIG. 13 or FIG. 14 may be arranged on the side surface of the housing of the sensor unit 11 so that the longitudinal direction is the vertical direction, for example, as shown in FIG. Each of the light emitting units 150 shown in FIG. 13 or FIG. 14 may be arranged on the side surface of the casing of the moving device 13 so that the longitudinal direction is the vertical direction, for example, as shown in FIG.

また、上記した実施形態において、自律移動ロボット10は、距離センサ14が測定した距離と地図情報格納部120内の地図情報に含まれている物体までの距離とが所定値以上異なる場合に、発光素子15の発光により、その方向を通知したが、他の形態として、自律移動ロボット10は、音声によりその方向を通知するようにしてもよい。また、この場合、自律移動ロボット10は、距離センサ14が測定した距離と地図情報格納部120内の地図情報に含まれている物体までの距離とが所定値以上異なる場合に、その方向について距離センサ14が測定した距離を音声によりさらに通知するようにしてもよい。   In the above-described embodiment, the autonomous mobile robot 10 emits light when the distance measured by the distance sensor 14 and the distance to the object included in the map information in the map information storage unit 120 are different from each other by a predetermined value or more. Although the direction is notified by the light emission of the element 15, as another form, the autonomous mobile robot 10 may notify the direction by voice. In this case, the autonomous mobile robot 10 determines the distance in the direction when the distance measured by the distance sensor 14 and the distance to the object included in the map information in the map information storage unit 120 are different from each other by a predetermined value or more. The distance measured by the sensor 14 may be further notified by voice.

これにより、周囲の人間は、自律移動ロボット10を観察し続けなくとも、音声により距離センサ14が測定した距離と地図情報格納部120内の地図情報に含まれている物体までの距離とが所定値以上異なる旨を認識することができ、より迅速に自律移動ロボット10の異常な移動を防止することができる。   Thus, the surrounding human does not continue to observe the autonomous mobile robot 10, and the distance measured by the distance sensor 14 by voice and the distance to the object included in the map information in the map information storage unit 120 are predetermined. It is possible to recognize that the difference is more than the value, and it is possible to prevent abnormal movement of the autonomous mobile robot 10 more quickly.

また、上記した実施形態において、自律移動ロボット10は、複数の距離センサ14を有するが、他の形態として、自律移動ロボット10は、カメラ等の画像センサを有してもよい。この場合、地図情報格納部120内には、地図上の位置および向きの組み合わせ毎に、その位置および向きにおいて撮像されるべき画像のデータが格納されており、位置姿勢算出部121は、画像センサからの画像データを取得した場合に、地図情報格納部120を参照して、当該画像データに最も近い画像データが対応付けられている位置および向きを、現在の自律移動ロボット10の位置および向きとして特定する。   In the above-described embodiment, the autonomous mobile robot 10 includes the plurality of distance sensors 14, but as another form, the autonomous mobile robot 10 may include an image sensor such as a camera. In this case, the map information storage unit 120 stores image data to be captured at each position and orientation on the map for each combination of the position and orientation on the map. When the image data from is acquired, the map information storage unit 120 is referred to, and the position and orientation associated with the image data closest to the image data is set as the current position and orientation of the autonomous mobile robot 10. Identify.

また、上記した実施形態において、自律移動ロボット10は、距離センサ14が測定した距離と地図情報格納部120内の地図情報に含まれている物体までの距離とが所定値以上異なる場合に、発光素子15の発光によりその方向を通知したが、他の形態として、自律移動ロボット10に無線通信機能を設け、距離センサ14が測定した距離と地図情報格納部120内の地図情報に含まれている物体までの距離とが所定値以上異なる場合に、自律移動ロボット10は、その方向や、その方向について距離センサ14が測定した距離、地図情報格納部120内の地図情報に含まれているその方向の物体までの距離等を自律移動ロボット10の管理者の無線通信端末に通知するようにしてもよい。   In the above-described embodiment, the autonomous mobile robot 10 emits light when the distance measured by the distance sensor 14 and the distance to the object included in the map information in the map information storage unit 120 are different from each other by a predetermined value or more. Although the direction is notified by the light emission of the element 15, as another form, the autonomous mobile robot 10 is provided with a wireless communication function and is included in the distance measured by the distance sensor 14 and the map information in the map information storage unit 120. When the distance to the object differs by a predetermined value or more, the autonomous mobile robot 10 determines the direction, the distance measured by the distance sensor 14 in the direction, and the direction included in the map information in the map information storage unit 120. The distance to the object may be notified to the wireless communication terminal of the manager of the autonomous mobile robot 10.

本発明の一実施形態に係る自律移動ロボット10の概観の一例を示す斜視図である。1 is a perspective view showing an example of an overview of an autonomous mobile robot 10 according to an embodiment of the present invention. 自律移動ロボット10の機能構成の一例を示すブロック図である。2 is a block diagram illustrating an example of a functional configuration of an autonomous mobile robot 10. FIG. 2次元地図20の一例を示す概念図である。2 is a conceptual diagram illustrating an example of a two-dimensional map 20. FIG. 自律移動ロボット10の動作概要を説明するための概念図である。FIG. 3 is a conceptual diagram for explaining an operation outline of the autonomous mobile robot 10. 距離センサ14によって測定されたセンシングデータ群24の一例を示す概念図である。It is a conceptual diagram which shows an example of the sensing data group 24 measured by the distance sensor 14. FIG. 2次元地図20内において自律移動ロボット10の位置および方向を特定する過程を説明するための概念図である。3 is a conceptual diagram for explaining a process of specifying the position and direction of the autonomous mobile robot 10 in the two-dimensional map 20. FIG. 自律移動ロボット10の位置および方向を特定する過程を説明するための概念図である。3 is a conceptual diagram for explaining a process of specifying the position and direction of the autonomous mobile robot 10. FIG. 自律移動ロボット10の位置および方向を特定する過程を説明するための概念図である。3 is a conceptual diagram for explaining a process of specifying the position and direction of the autonomous mobile robot 10. FIG. 自律移動ロボット10の位置および方向を特定する過程を説明するための概念図である。3 is a conceptual diagram for explaining a process of specifying the position and direction of the autonomous mobile robot 10. FIG. 自律移動ロボット10の位置および方向を特定する過程を説明するための概念図である。3 is a conceptual diagram for explaining a process of specifying the position and direction of the autonomous mobile robot 10. FIG. 自律移動ロボット10の動作の一例を示すフローチャートである。4 is a flowchart showing an example of the operation of the autonomous mobile robot 10. 自律移動ロボット10の機能を実現するコンピュータ40のハードウェア構成の一例を示す図である。2 is a diagram illustrating an example of a hardware configuration of a computer 40 that realizes the functions of the autonomous mobile robot 10. FIG. 発光ユニット150の一例を示す概念図である。3 is a conceptual diagram illustrating an example of a light emitting unit 150. FIG. 発光ユニット150の発光方法の一例を示す概念図である。4 is a conceptual diagram illustrating an example of a light emitting method of the light emitting unit 150. FIG. 発光ユニット150の配列の一例を示す概念図である。3 is a conceptual diagram illustrating an example of an arrangement of light emitting units 150. FIG. 発光ユニット150の配置の一例を示す斜視図である。3 is a perspective view illustrating an example of an arrangement of light emitting units 150. FIG. 発光素子15の配置の他の例を示す斜視図である。12 is a perspective view showing another example of the arrangement of the light emitting elements 15. FIG. 発光ユニット150の配置の他の例を示す斜視図である。12 is a perspective view showing another example of the arrangement of the light emitting units 150. FIG. 発光ユニット150の配置のさらなる他の例を示す斜視図である。It is a perspective view which shows the further another example of arrangement | positioning of the light emission unit 150. FIG.

符号の説明Explanation of symbols

10・・・自律移動ロボット、11・・・センサユニット、12・・・計算装置、120・・・地図情報格納部、121・・・位置姿勢算出部、122・・・移動制御部、123・・・発光制御部、13・・・移動装置、14・・・距離センサ、15・・・発光素子、150・・・発光ユニット、151・・・発光素子、40・・・コンピュータ、41・・・CPU、42・・・RAM、43・・・ROM、44・・・HDD、45・・・入力インターフェイス、46・・・出力インターフェイス、47・・・メディアインターフェイス、48・・・記録媒体 DESCRIPTION OF SYMBOLS 10 ... Autonomous mobile robot, 11 ... Sensor unit, 12 ... Calculation apparatus, 120 ... Map information storage part, 121 ... Position and orientation calculation part, 122 ... Movement control part, 123 * ..Light emission control unit, 13 ... moving device, 14 ... distance sensor, 15 ... light emitting element, 150 ... light emitting unit, 151 ... light emitting element, 40 ... computer, 41 ... CPU, 42 ... RAM, 43 ... ROM, 44 ... HDD, 45 ... input interface, 46 ... output interface, 47 ... media interface, 48 ... recording medium

Claims (12)

自律移動ロボットであって、
物体の配置を示す地図情報を格納する地図情報格納部と、
前記自律移動ロボット周辺の実環境の情報を取得するセンサと、
前記地図情報内における自律移動ロボットの位置および向きを算出する算出部と、
前記算出部によって算出された前記自律移動ロボットの位置および向きの情報に基づき決定される移動パラメータに従い自律移動ロボットを移動させる移動部と、
前記センサが取得した実環境の情報と前記地図情報とを比較する比較部と、
前記比較部における比較結果を通知する通知部と
を備え
前記センサは、前記自律移動ロボットと自律移動ロボット周辺の物体との間の距離を測定する距離センサを複数有し、
前記地図情報は、前記距離センサが取り付けられている高さにおける実環境の形状を示す2次元地図情報であり、
前記算出部は、複数の前記距離センサが取得した距離を示す距離情報と前記2次元地図情報とを比較して最も一致度が高くなる位置および向きを、前記自律移動ロボットの位置および向きとして算出し、
前記比較部は、
前記算出部によって前記自律移動ロボットの位置が算出された後に、それぞれの前記距離センサが前記自律移動ロボットから前記自律移動ロボット周辺の物体までの距離を測定したそれぞれの方向について、前記距離センサが測定した実測距離と、当該算出された自律移動ロボットの位置から前記2次元地図情報内の物体の位置までの当該方向における地図上の距離との差分を算出し、前記距離センサが前記自律移動ロボットから前記自律移動ロボット周辺の物体までの距離を測定した複数の方向の中に当該差分が所定値以上となる方向が存在する場合に、その方向を比較結果として前記通知部に通知させることを特徴とする自律移動ロボット。
An autonomous mobile robot,
A map information storage unit for storing map information indicating the arrangement of objects;
A sensor for acquiring information on a real environment around the autonomous mobile robot;
A calculation unit for calculating the position and orientation of the autonomous mobile robot in the map information;
A moving unit for moving the autonomous mobile robot according to a movement parameter determined based on the position and orientation information of the autonomous mobile robot calculated by the calculating unit;
A comparison unit that compares the map information with information on the real environment acquired by the sensor;
A notification unit for notifying the comparison result in the comparison unit ,
The sensor has a plurality of distance sensors for measuring a distance between the autonomous mobile robot and an object around the autonomous mobile robot,
The map information is two-dimensional map information indicating a shape of a real environment at a height at which the distance sensor is attached,
The calculation unit compares the distance information indicating the distances acquired by a plurality of the distance sensors and the two-dimensional map information, and calculates the position and direction having the highest degree of coincidence as the position and direction of the autonomous mobile robot. And
The comparison unit includes:
After the position of the autonomous mobile robot is calculated by the calculation unit, the distance sensor measures each direction in which each distance sensor measures a distance from the autonomous mobile robot to an object around the autonomous mobile robot. A difference between the measured distance and the distance on the map in the direction from the calculated position of the autonomous mobile robot to the position of the object in the two-dimensional map information, and the distance sensor from the autonomous mobile robot when the difference in a plurality of directions the distance measured to the object near the autonomous mobile robot is present direction equal to or greater than a predetermined value, characterized Rukoto is notified to the notification unit in that direction as a comparison result An autonomous mobile robot.
請求項に記載の自律移動ロボットであって、
前記通知部は、それぞれの前記距離センサが測定するそれぞれの方向に対応付けられた発光素子を複数有し、
前記比較部は、それぞれの前記距離センサが前記自律移動ロボットから前記自律移動ロボット周辺の物体までの距離を測定したそれぞれの方向について、前記実測距離と前記地図上の距離との差分を算出し、複数の前記距離センサが前記自律移動ロボットから前記自律移動ロボット周辺の物体までの距離を測定した複数の方向の中に当該差分が所定値以上となる方向が存在する場合に、その方向に対応付けられている発光素子を発光させることにより前記比較結果を前記通知部に通知させることを特徴とする自律移動ロボット。
The autonomous mobile robot according to claim 1 ,
The notification unit includes a plurality of light emitting elements associated with respective directions measured by the respective distance sensors,
The comparison unit calculates a difference between the measured distance and the distance on the map for each direction in which each distance sensor measures a distance from the autonomous mobile robot to an object around the autonomous mobile robot, When there are directions in which the difference is equal to or greater than a predetermined value among a plurality of directions in which the plurality of distance sensors measure the distance from the autonomous mobile robot to an object around the autonomous mobile robot, the direction is associated with the direction An autonomous mobile robot characterized in that the notification unit is notified of the comparison result by causing a light emitting element to emit light.
請求項に記載の自律移動ロボットであって、
それぞれの前記発光素子は、前記自律移動ロボットに搭載され前記距離センサを収容する筐体の上面に円弧状に並べて配置されることを特徴とする自律移動ロボット。
The autonomous mobile robot according to claim 2 ,
Each of the light emitting elements is mounted on the autonomous mobile robot and arranged in an arc shape on an upper surface of a housing that houses the distance sensor.
請求項に記載の自律移動ロボットであって、
それぞれの前記発光素子は、前記自律移動ロボットに搭載され前記距離センサを収容する筐体の側面に、前記距離センサが測定するそれぞれの方向に対応付けて配置されることを特徴とする自律移動ロボット。
The autonomous mobile robot according to claim 2 ,
Each of the light emitting elements is disposed on a side surface of a housing that is mounted on the autonomous mobile robot and accommodates the distance sensor, and is associated with each direction measured by the distance sensor. .
請求項に記載の自律移動ロボットであって、
それぞれの前記距離センサが前記自律移動ロボットから前記自律移動ロボット周辺の物体までの距離を測定するそれぞれの方向には、複数の発光素子が対応付けられており、
前記比較部は、
それぞれの前記距離センサが前記自律移動ロボットから前記自律移動ロボット周辺の物体までの距離を測定したそれぞれの方向について、前記実測距離と前記地図上の距離との差分を算出し、複数の前記距離センサが前記自律移動ロボットから前記自律移動ロボット周辺の物体までの距離を測定した複数の方向の中に当該差分が所定値以上となる方向が存在する場合に、その方向に対応付けられている複数の発光素子を、前記実測距離に対応する数分発光させることにより前記比較結果を前記通知部に通知させることを特徴とする自律移動ロボット。
The autonomous mobile robot according to claim 2 ,
A plurality of light emitting elements are associated with each direction in which each distance sensor measures a distance from the autonomous mobile robot to an object around the autonomous mobile robot,
The comparison unit includes:
For each direction in which each of the distance sensors measures the distance from the autonomous mobile robot to an object around the autonomous mobile robot, the difference between the measured distance and the distance on the map is calculated, and a plurality of the distance sensors If there is a direction in which the difference is a predetermined value or more among a plurality of directions in which the distance from the autonomous mobile robot to objects around the autonomous mobile robot is measured, a plurality of An autonomous mobile robot characterized in that the notification unit is notified of the comparison result by causing a light emitting element to emit light for a number corresponding to the measured distance.
請求項に記載の自律移動ロボットであって、
それぞれの前記距離センサが測定するそれぞれの方向に対応付けられた複数の発光素子は、前記自律移動ロボットに搭載され前記距離センサを収容する筐体の上面に、それぞれの方向について一列に並べて設けられることを特徴とする自律移動ロボット。
The autonomous mobile robot according to claim 5 ,
The plurality of light emitting elements associated with the respective directions measured by the respective distance sensors are arranged in a line in the respective directions on the upper surface of a housing that is mounted on the autonomous mobile robot and accommodates the distance sensor. An autonomous mobile robot characterized by this.
請求項に記載の自律移動ロボットであって、
それぞれの前記距離センサが測定するそれぞれの方向に対応付けられた複数の発光素子は、前記自律移動ロボットに搭載され前記距離センサを収容する筐体の側面に、上下方向に一列に並べて配置されることを特徴とする自律移動ロボット。
The autonomous mobile robot according to claim 5 ,
The plurality of light emitting elements associated with the respective directions measured by the respective distance sensors are arranged in a line in the vertical direction on the side surface of the casing that is mounted on the autonomous mobile robot and accommodates the distance sensor. An autonomous mobile robot characterized by this.
請求項に記載の自律移動ロボットであって、
それぞれの前記距離センサが測定するそれぞれの方向に対応付けられた複数の発光素子は、前記移動部の筐体の側面に、上下方向に一列に並べて配置されることを特徴とする自律移動ロボット。
The autonomous mobile robot according to claim 5 ,
The autonomous mobile robot, wherein the plurality of light emitting elements associated with the respective directions measured by the respective distance sensors are arranged in a line in the vertical direction on the side surface of the casing of the moving unit.
請求項からのいずれか一項に記載の自律移動ロボットであって、
前記比較部は、
それぞれの前記距離センサが前記自律移動ロボットから前記自律移動ロボット周辺の物体までの距離を測定したそれぞれの方向について、前記実測距離と前記地図上の距離との差分を算出し、複数の前記距離センサが前記自律移動ロボットから前記自律移動ロボット周辺の物体までの距離を測定した複数の方向の中に当該差分が所定値以上となる方向が存在する場合に、その方向に対応付けられている複数の発光素子を、前記実測距離に対応する数分第1の色により発光させると共に、前記地図上の距離に対応する数分第2の色により発光させることにより前記比較結果を前記通知部に通知させることを特徴とする自律移動ロボット。
The autonomous mobile robot according to any one of claims 5 to 8 ,
The comparison unit includes:
For each direction in which each of the distance sensors measures the distance from the autonomous mobile robot to an object around the autonomous mobile robot, the difference between the measured distance and the distance on the map is calculated, and a plurality of the distance sensors If there is a direction in which the difference is a predetermined value or more among a plurality of directions in which the distance from the autonomous mobile robot to objects around the autonomous mobile robot is measured, a plurality of The light emitting element emits light with a first color for a number corresponding to the measured distance, and emits light with a second color for a number corresponding to the distance on the map to notify the notification unit of the comparison result. An autonomous mobile robot characterized by this.
請求項からのいずれか一項に記載の自律移動ロボットであって、
前記通知部は、さらに、前記発光素子の点滅、色、発光強度、もしくはこれらの組み合わせ、またはこれらの時間変化の組み合わせにより前記比較結果を通知することを特徴とする自律移動ロボット。
The autonomous mobile robot according to any one of claims 2 to 9 ,
The notifying unit further notifies the comparison result by blinking of the light emitting element, color, light emission intensity, a combination thereof, or a combination of these time changes.
請求項に記載の自律移動ロボットであって、
前記比較部は、それぞれの前記距離センサが前記自律移動ロボットから前記自律移動ロボット周辺の物体までの距離を測定したそれぞれの方向について、前記実測距離と前記地図上の距離との差分を算出し、複数の前記距離センサが前記自律移動ロボットから前記自律移動ロボット周辺の物体までの距離を測定した複数の方向の中に当該差分が所定値以上となる方向が存在する場合に、その方向に地図情報とは異なる物体が存在する旨またはその方向に地図情報にある物体が存在しない旨を音声により前記通知部に通知させることを特徴とする自律移動ロボット。
The autonomous mobile robot according to claim 1 ,
The comparison unit calculates a difference between the measured distance and the distance on the map for each direction in which each distance sensor measures a distance from the autonomous mobile robot to an object around the autonomous mobile robot, If there is a direction in which the difference is equal to or greater than a predetermined value among a plurality of directions in which the plurality of distance sensors measure the distance from the autonomous mobile robot to an object around the autonomous mobile robot, map information is displayed in that direction. An autonomous mobile robot characterized in that the notification unit is notified by voice that there is an object different from the above or that there is no object in the map information in that direction.
請求項11に記載の自律移動ロボットであって、
前記比較部は、それぞれの前記距離センサが前記自律移動ロボットから前記自律移動ロボット周辺の物体までの距離を測定したそれぞれの方向について、前記実測距離と前記地図上の距離との差分を算出し、複数の前記距離センサが前記自律移動ロボットから前記自律移動ロボット周辺の物体までの距離を測定した複数の方向の中に当該差分が所定値以上となる方向が存在する場合に、前記実測距離を、その方向に存在する物体までの距離として前記通知部にさらに通知させることを特徴とする自律移動ロボット。
The autonomous mobile robot according to claim 11 ,
The comparison unit calculates a difference between the measured distance and the distance on the map for each direction in which each distance sensor measures a distance from the autonomous mobile robot to an object around the autonomous mobile robot, When there are directions in which the difference is a predetermined value or more among a plurality of directions in which the plurality of distance sensors measure the distance from the autonomous mobile robot to an object around the autonomous mobile robot, the measured distance is An autonomous mobile robot characterized in that the notification unit is further notified of the distance to an object existing in that direction.
JP2008295974A 2008-11-19 2008-11-19 Autonomous mobile robot Expired - Fee Related JP5213655B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2008295974A JP5213655B2 (en) 2008-11-19 2008-11-19 Autonomous mobile robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2008295974A JP5213655B2 (en) 2008-11-19 2008-11-19 Autonomous mobile robot

Publications (2)

Publication Number Publication Date
JP2010122904A JP2010122904A (en) 2010-06-03
JP5213655B2 true JP5213655B2 (en) 2013-06-19

Family

ID=42324189

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2008295974A Expired - Fee Related JP5213655B2 (en) 2008-11-19 2008-11-19 Autonomous mobile robot

Country Status (1)

Country Link
JP (1) JP5213655B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104677405A (en) * 2013-11-29 2015-06-03 丰田自动车株式会社 Abnormality determination system and determination method thereof

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10265856B2 (en) 2016-07-21 2019-04-23 X Development Llc Reorienting a distance sensor using an adjustable leveler
JP7341652B2 (en) * 2018-01-12 2023-09-11 キヤノン株式会社 Information processing device, information processing method, program, and system
US11597104B2 (en) * 2019-07-31 2023-03-07 X Development Llc Mobile robot sensor configuration
CN111638716B (en) * 2020-05-29 2024-02-23 北京极智嘉科技股份有限公司 Inventory management method and system

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS62184381A (en) * 1986-02-07 1987-08-12 Koito Mfg Co Ltd Radar equipment for automobile
JP4229358B2 (en) * 2001-01-22 2009-02-25 株式会社小松製作所 Driving control device for unmanned vehicles
JP4368317B2 (en) * 2005-03-11 2009-11-18 セコム株式会社 Mobile robot
JP4697127B2 (en) * 2006-11-27 2011-06-08 パナソニック電工株式会社 Self-position recognition method

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104677405A (en) * 2013-11-29 2015-06-03 丰田自动车株式会社 Abnormality determination system and determination method thereof

Also Published As

Publication number Publication date
JP2010122904A (en) 2010-06-03

Similar Documents

Publication Publication Date Title
US20200333789A1 (en) Information processing apparatus, information processing method, and medium
US10452939B2 (en) Monitoring system, monitoring device, and monitoring method
US10769794B2 (en) Multi-sensor object recognition system and method
JP5213655B2 (en) Autonomous mobile robot
JP4396564B2 (en) Object monitoring method and motion tracker using the same
US20180240327A1 (en) Methods and systems for reducing false alarms in a robotic device by sensor fusion
JP4279703B2 (en) Autonomous mobile robot system
US11003188B2 (en) Method, system and apparatus for obstacle handling in navigational path generation
US20210271246A1 (en) Arithmetic device, movement control system, control device, moving object, calculation method, and computer-readable storage medium
US20220073280A1 (en) Smart warehouse, conveyor, and pallet management system
CN105793731A (en) Autonomous moving object
JP2019156641A (en) Image processing device for fork lift and control program
EP3284069B1 (en) A pos terminal
JP2014503376A5 (en)
US11148299B2 (en) Teaching apparatus and teaching method for robots
KR20180112623A (en) Method of identifying obstacle on a driving surface and robot implementing thereof
JP2009512088A (en) System and method for calculating position in real time
US20190220025A1 (en) Method, system for obstacle detection and a sensor subsystem
JP7228944B2 (en) Crane information processing device
US20220019949A1 (en) Safety management assistance system, and control program
US20210004009A1 (en) Traveling control system for transport vehicle and traveling control method for transport vehicle
US20200356094A1 (en) Methods and systems for machine state related visual feedback in a robotic device
US20200222948A1 (en) Parcel determination device, parcel sorting system, and parcel determination method
JPWO2019003689A1 (en) Projection instructing device, luggage sorting system, and projection instructing method
US20200234453A1 (en) Projection instruction device, parcel sorting system, and projection instruction method

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20110613

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20120627

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20120703

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20120829

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20130226

R151 Written notification of patent or utility model registration

Ref document number: 5213655

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20160308

Year of fee payment: 3

LAPS Cancellation because of no payment of annual fees