JP2017117094A - Autonomous moving robot - Google Patents
Autonomous moving robot Download PDFInfo
- Publication number
- JP2017117094A JP2017117094A JP2015250127A JP2015250127A JP2017117094A JP 2017117094 A JP2017117094 A JP 2017117094A JP 2015250127 A JP2015250127 A JP 2015250127A JP 2015250127 A JP2015250127 A JP 2015250127A JP 2017117094 A JP2017117094 A JP 2017117094A
- Authority
- JP
- Japan
- Prior art keywords
- current position
- mobile robot
- base station
- autonomous mobile
- base
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000012937 correction Methods 0.000 claims abstract description 43
- 238000009434 installation Methods 0.000 claims abstract description 9
- 238000005259 measurement Methods 0.000 claims description 5
- 238000000034 method Methods 0.000 abstract description 34
- 230000000737 periodic effect Effects 0.000 abstract 1
- 238000004891 communication Methods 0.000 description 5
- 238000012545 processing Methods 0.000 description 5
- 238000013500 data storage Methods 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 230000001133 acceleration Effects 0.000 description 3
- 238000013473 artificial intelligence Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 230000007246 mechanism Effects 0.000 description 3
- 230000001186 cumulative effect Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000005856 abnormality Effects 0.000 description 1
- 238000009825 accumulation Methods 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 230000003466 anti-cipated effect Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000004397 blinking Effects 0.000 description 1
- 238000004140 cleaning Methods 0.000 description 1
- 238000012790 confirmation Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 239000003550 marker Substances 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000005236 sound signal Effects 0.000 description 1
- 230000007480 spreading Effects 0.000 description 1
Images
Landscapes
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
本願発明は、位置を計測しながら移動するロボットに関するものであり、より具体的には、移動に伴って累積する誤差を解消するため計測値を正規の位置に補正しながら移動するロボットに関するものである。 The present invention relates to a robot that moves while measuring a position, and more specifically, to a robot that moves while correcting a measurement value to a normal position in order to eliminate errors accumulated with movement. is there.
今後、労働人口の減少が予想される中、労働力不足を補うロボットや人工知能が期待されている。実際、ロボットや人工知能の技術進歩は著しく、10〜20年以内には現在の仕事の半分近くがロボットや人工知能で代替可能になるという研究結果を発表した者もいる。 In the future, as the labor force is expected to decline, robots and artificial intelligence that make up for labor shortages are expected. In fact, the technological progress of robots and artificial intelligence is remarkable, and some have announced the results of research that nearly half of their current work can be replaced by robots and artificial intelligence within 10 to 20 years.
JIS(日本工業規格)では産業用ロボットを、「自動制御によるマニピュレーション機能または移動機能をもち、各種の作業をプログラムにより実行でき、産業に使用される機械」と定義しており、工場のラインの一部としてその場で所定の作業を行うロボットや、掃除機のように移動しながら所定の作業を行うロボットが対象とされている。このうち移動するロボットは、人が遠隔操作を行うことで移動するものと、ロボット自身で移動する(以下、「自律移動」という。)ものに大別することができる。 JIS (Japanese Industrial Standards) defines industrial robots as “machines that have manipulation functions or movement functions by automatic control and that can perform various operations by programs and are used in industry.” As a part, a robot that performs a predetermined operation on the spot and a robot that performs a predetermined operation while moving like a vacuum cleaner are targeted. Among these, the moving robots can be broadly classified into those that move when a person performs a remote operation and those that move by the robot itself (hereinafter referred to as “autonomous movement”).
自律移動するロボット(以下、「自律移動ロボット」という。)は、人のように2足歩行する方式や、車輪(タイヤ)やキャタピラ(登録商標)によって走行する方式など、目的に応じて様々な移動手法が採用され、また、移動に当たってはナビゲーションシステムが利用されることもある。このナビゲーションシステムは、自身の現在位置をリアルタイムで計測するとともに、施設や経路を含む地図情報と照らし合わせることで、例えば目的地との相対的な位置関係を把握し、あるいは目的地までの経路を探索するものである。いわゆるカーナビはその代表例であるが、昨今ではスマートフォンなど携帯型端末機の普及に伴い、歩行者を案内するナビゲーションシステムも急速に広まっている。 Robots that move autonomously (hereinafter referred to as “autonomous mobile robots”) have various methods depending on the purpose, such as a method of walking with two legs like a person and a method of traveling with wheels (tires) or Caterpillar (registered trademark). A movement method is adopted, and a navigation system may be used for movement. This navigation system measures its current location in real time and compares it with map information including facilities and routes, for example, to grasp the relative positional relationship with the destination or to determine the route to the destination. To explore. A so-called car navigation system is a representative example, but recently, with the spread of portable terminals such as smartphones, navigation systems for guiding pedestrians are rapidly spreading.
このようにナビゲーションシステムが普及した背景には、測位技術の進歩とその普及がある。1900年代、それまで軍事用としてのみ利用されていたGPS(Global Positioning System)が民生用として利用されるようになり、さらに2000年には「意図的に精度を落とす仕組み(SA:Selective Availability)」も撤廃され、容易かつ高精度に、しかもリアルタイムで現在位置を計測できるようになった。 The background to the spread of navigation systems in this way is the advancement and popularization of positioning technology. In the 1900s, GPS (Global Positioning System), which had been used only for military use until now, was used for civilian use. In 2000, “Mechanism for deliberately reducing accuracy (SA: Selective Availability)” Has been abolished, and the current position can be measured easily and accurately in real time.
GPSに代表される衛星測位システム(GNSS:Global Navigation Satellite System)は、衛星からの電波を受信することで測位する手法であり、電波の届く範囲であれば地球上あらゆる場所で測位できるが、建物の中など衛星からの電波が届かない場所では当然ながら測位することができない。自律移動ロボットの場合、屋外に限らず屋内で移動することも多く、衛星測位システムのみの測位では十分ではない。自律移動ロボットや歩行者用のナビゲーションの需要の高まりから、近年、種々の屋内測位技術の開発が進められている。例えば、無線LANのアクセスポイントを利用する測位方法、室内に電波発信機を配置して測位するIMES(Indoor Messaging System)、LEDの高速点滅を信号として伝送する可視光通信を利用した測位方法、赤外線通信を利用した測位方法などが挙げられる。 A satellite positioning system (GNSS: Global Navigation Satellite System) represented by GPS is a method of positioning by receiving radio waves from a satellite, and can be measured anywhere on the earth as long as radio waves reach it. Of course, positioning is not possible in places where radio waves from satellites do not reach. In the case of an autonomous mobile robot, it is often moved indoors as well as outdoors, and positioning using only a satellite positioning system is not sufficient. In recent years, development of various indoor positioning technologies has been promoted due to the growing demand for autonomous mobile robots and navigation for pedestrians. For example, a positioning method using a wireless LAN access point, an IMES (Indoor Messaging System) in which a radio wave transmitter is placed in a room, a positioning method using visible light communication that transmits a fast blinking LED as a signal, an infrared ray A positioning method using communication is mentioned.
上記例示した屋内測位技術や衛星測位システムなどのように信号の送受信を伴う測位手法のほか、他との通信を必要としない自律航法(Dead Reckoning:DR)も注目されている。自律航法は、与えられた初期位置と、その後の移動距離及び移動方向に基づいて、移動後の位置を求める手法であり、例えばカーナビの場合、トンネルや地下道など衛星からの電波が届かない場所を補完する目的で利用されている。今後は、加速度センサを備えたスマートフォンの普及、さらには眼鏡型ウェアラブル端末の登場により、自律航法を用いた歩行者用のナビゲーション(PDR:Pedestrian Dead Reckoning)が多用されることも予想され、さらには自律移動ロボットのナビゲーションにも有効に利用されることが期待される。 In addition to positioning methods that involve transmission and reception of signals, such as the indoor positioning technology and satellite positioning system exemplified above, Autonomous Navigation (Dead Reckoning: DR) that does not require communication with others is also attracting attention. Autonomous navigation is a method for obtaining a position after movement based on a given initial position and the distance and direction of movement thereafter.For example, in the case of car navigation, a place where radio waves from satellites such as tunnels and underpasses do not reach. It is used for supplementary purposes. In the future, with the spread of smartphones equipped with acceleration sensors and the appearance of glasses-type wearable terminals, it is expected that navigation for pedestrians (PDR: Pedestrian Dead Reckoning) using autonomous navigation will be frequently used. It is expected to be used effectively for navigation of autonomous mobile robots.
自律航法は、他機器との通信を必要としないため、屋内・屋外を問わず採用できるのが一つの特徴である。しかしながら、現状の技術水準では解決し難い問題点も抱えている。すなわち自律航法システムは、過去の位置に基づく逐次計算によって現在位置を算出するものであり、センサ誤差および演算誤差の累積により位置精度が徐々に劣化していくことが知られている。また、自律航法において欠かせない移動距離や移動方向の取得は、ジャイロセンサや加速度センサを用いるのが主流となっているが、ジャイロセンサや加速度センサは動作環境によってその計測が不安定になることがあり(例えば磁気センサは、強い磁場で用いると正しい結果が得られない)、この点でも精度上の問題を指摘することができる。 One feature of autonomous navigation is that it can be used indoors and outdoors because it does not require communication with other devices. However, there are problems that are difficult to solve with the current technical level. That is, the autonomous navigation system calculates the current position by sequential calculation based on past positions, and it is known that the position accuracy gradually deteriorates due to accumulation of sensor errors and calculation errors. In addition, gyro sensors and accelerometers are mainly used to acquire travel distances and directions indispensable in autonomous navigation, but the measurement of gyro sensors and accelerometers may become unstable depending on the operating environment. (For example, when a magnetic sensor is used in a strong magnetic field, a correct result cannot be obtained). In this respect as well, a problem in accuracy can be pointed out.
そこで、自律航法による測位精度を向上させるため、経路途中の要所で位置補正を行う技術が種々提案されている。例えば特許文献1では、走行距離が一定距離以上になると座標既知点(マーカ)まで移動し、これまでの誤差を把握した上で補正を行うという技術を提案している。
In order to improve the positioning accuracy by autonomous navigation, various techniques for position correction at key points along the route have been proposed. For example,
特許文献1のように、ある限られた範囲(例えば、掃除を行う室内)を対象とする場合であれば、定期的(一定距離以上の走行のたび)に所定のポイントまでいわば寄り道することはそれほど問題とはならないが、例えば目的の店舗に向かうケースを考えると定期的に寄り道するようでは実用的な技術とは言えない。
If it is a case where a certain limited range (for example, a room where cleaning is performed) is targeted as in
自律航法による測位精度を向上させる手段として、特許文献1に開示される技術のほか、経路上の要所に情報発信機を設置し、そのポイントを通過するたびに位置情報を補正するという試みも行われている。しかしながら、「そのポイントを通過する」という判断を自動的(機械的)に行うことは、必ずしも容易ではない。図8は、自律航法によって自律移動ロボットの位置を計測する状況を示す平面図である。この図では、あらかじめ壁面に設置された情報発信機Wから信号が送られており、その信号を検知したとき、自律移動ロボットの現在位置が情報発信機Wの設置位置(x,y)に補正される仕組みとなっている。この仕組みによれば、自律移動ロボットR1のように実際の移動経路と測位結果が大きく相違しているようなケースでは極めて有効となる。情報発信機Wからの信号を受信したタイミングで現在位置が補正され、つまりそれまでに生じた累積誤差が解消され、その結果、以降は正しい位置計測が期待できるわけである。
In addition to the technique disclosed in
ところが、図8に示す自律移動ロボットR2のようなケースでは、実際の移動経路と測位結果が概ね一致しているにもかかわらず、情報発信機Wからの信号を受信することで、かえって誤った位置に補正されてしまうことになる。このような不具合は、信号強度の閾値を設定することである程度は解消できるものの、閾値を極端に高く設定すると補正される範囲(情報発信機Wからの距離)が極めて限定的となり、実用性に欠けることとなる。また、適当な信号強度の閾値を設定したとしても、運用環境によっては想定した距離を超えて受信したとして判断されることもあり、自律移動ロボットR2のケースのように誤った補正が行われるおそれもある。 However, in the case of the autonomous mobile robot R2 shown in FIG. 8, the actual movement route and the positioning result almost coincide with each other, but the signal from the information transmitter W is received, which is wrong. It will be corrected to the position. Although such a problem can be solved to some extent by setting a threshold value for signal strength, the range to be corrected (distance from the information transmitter W) becomes extremely limited when the threshold value is set extremely high, which makes it practical. It will be lacking. Even if an appropriate signal strength threshold is set, it may be determined that the signal has been received beyond the assumed distance depending on the operating environment, and erroneous correction may occur as in the case of the autonomous mobile robot R2. There is also.
本願発明の課題は、上記問題を解決することであり、すなわち自律航法のように移動しながら現在位置を計測する手法において、定期的な寄り道を必要とせず、適宜正しい位置情報に補正することでより正確な測位の継続を図るとともに、あらかじめ補正される領域を限定し、誤った位置への補正を防止し得る自律移動ロボットを提供することである。 The subject of the present invention is to solve the above-mentioned problem, that is, in a method of measuring the current position while moving like autonomous navigation, without requiring a regular detour and correcting to the correct position information as appropriate. It is intended to provide an autonomous mobile robot capable of continuing more accurate positioning, limiting an area to be corrected in advance, and preventing correction to an incorrect position.
本願発明は、自律移動しながらの測位結果を補正するにあたって、誤った位置への補正を防止すべく、あらかじめ補正すべき領域を設定するという点に着目したものであり、従来にはなかった発想に基づいてなされた発明である。 The present invention pays attention to the fact that, in correcting the positioning result while autonomously moving, in order to prevent correction to an incorrect position, an area to be corrected in advance is set. It is an invention made based on this.
本願発明の自律移動ロボットは、現在位置を把握しながら自律移動するロボットであり、移動手段と、測位手段、受信手段、補正手段を備えたものである。このうち測位手段は、移動途中における現在位置を計測するものであり、受信手段は、所定位置に設置された拠点局から発信される信号を受信するもので、補正手段は、測位手段で計測された現在位置を補正するものである。なお補正手段は、現在位置が拠点領域(拠点局の設置位置を基準に設定される領域)内にあって、且つこの拠点領域に対応する拠点局から受信手段が所定強度(閾値)以上の信号を受信したときに、現在位置を基準点(拠点領域内であらかじめ定められた地点)に補正する。 The autonomous mobile robot of the present invention is a robot that moves autonomously while grasping the current position, and includes a moving means, a positioning means, a receiving means, and a correcting means. Among them, the positioning means measures the current position during the movement, the receiving means receives a signal transmitted from the base station installed at a predetermined position, and the correction means is measured by the positioning means. The current position is corrected. The correction means is a signal whose current position is within the base area (area set based on the base station installation position) and the receiving means from the base station corresponding to this base area has a predetermined intensity (threshold) or more. Is received, the current position is corrected to a reference point (a predetermined point in the base area).
本願発明の自律移動ロボットは、代表信号強度に基づいて補正判断を行うものとすることもできる。ここで代表信号強度とは、現在位置を含む拠点領域に対応する拠点局から受信した受信履歴(過去の複数の受信信号)に基づいて設定されるもので、複数の受信信号の信号強度を代表する値である。この場合、制御手段は、代表信号強度が所定強度(閾値)以上であるときに現在位置を補正するとして補正手段に指令する。 The autonomous mobile robot of the present invention can also make a correction determination based on the representative signal strength. Here, the representative signal strength is set based on the reception history (a plurality of past received signals) received from the base station corresponding to the base region including the current position, and represents the signal strength of the plurality of received signals. The value to be In this case, the control means instructs the correction means to correct the current position when the representative signal intensity is equal to or greater than a predetermined intensity (threshold value).
本願発明の自律移動ロボットは、自律航法を用いた計測を行う測位手段を備えたものとすることもできる。ここで自律航法とは、現在位置を起点とし、移動者等の移動距離及び移動方向に基づいて次の現在位置を推定する計測手法である。 The autonomous mobile robot of the present invention can also include positioning means for performing measurement using autonomous navigation. Here, the autonomous navigation is a measurement method in which the current position is the starting point and the next current position is estimated based on the moving distance and moving direction of the moving person or the like.
本願発明の自律移動ロボットは、ひとつの拠点局に対して、2以上の拠点領域が設定され、これら2以上の拠点領域ごとに基準点が設定された方法とすることもできる。 The autonomous mobile robot of the present invention may be a method in which two or more base areas are set for one base station, and a reference point is set for each of the two or more base areas.
本願発明の自律移動ロボットは、補正手段が現在位置を基準点に補正した後、所定期間は補正後の位置を維持し、当該期間中は条件にかかわらず現在位置を補正しないものとすることもできる。 The autonomous mobile robot of the present invention may maintain the corrected position for a predetermined period after the correction unit corrects the current position as a reference point, and may not correct the current position during the period regardless of the conditions. it can.
本願発明の自律移動ロボットは、現在位置が拠点領域内にあって、且つ現在位置と基準点との距離が最小基準値以上であって、しかも受信手段が所定強度以上の信号を受信したときに、現在位置を基準点に補正する補正手段を備えたものとすることもできる。 In the autonomous mobile robot of the present invention, when the current position is within the base area and the distance between the current position and the reference point is not less than the minimum reference value, and the receiving means receives a signal having a predetermined intensity or more, Further, a correction means for correcting the current position to the reference point may be provided.
本願発明の自律移動ロボットには、次のような効果がある。
(1)自律航法は、移動しながらの測位であり累積誤差を生じやすいが、要所で正しい位置に補正するため、比較的正確な測位を継続することができる。
(2)あらかじめ補正すべき領域を設定するため、誤った位置への補正を防止することができる。
(3)衛星測位システムや特別な屋内測位システムに依存しないため、屋内・屋外を問わず広く実施することができる。
The autonomous mobile robot of the present invention has the following effects.
(1) Autonomous navigation is positioning while moving and is likely to cause cumulative errors. However, since it is corrected to a correct position at a key point, relatively accurate positioning can be continued.
(2) Since an area to be corrected is set in advance, correction to an incorrect position can be prevented.
(3) Since it does not depend on a satellite positioning system or a special indoor positioning system, it can be widely implemented both indoors and outdoors.
本願発明の自律移動ロボットの実施形態の一例を、図に基づいて説明する。 An example of an embodiment of the autonomous mobile robot of the present invention will be described with reference to the drawings.
1.全体概要
図1は、本願発明の主な処理の流れを示すフロー図であり、中央の列に実施する処理を示し、左列にはその処理に必要な入力情報を、右列にはその処理から生まれる出力情報を示している。まずはこのフロー図を参考に、本願発明の全体概要について説明する。
1. Overall Overview FIG. 1 is a flowchart showing the main processing flow of the present invention, showing the processing to be performed in the center column, the input information necessary for the processing in the left column, and the processing in the right column. The output information born from is shown. First, the general outline of the present invention will be described with reference to this flowchart.
自律移動ロボットが自律移動を開始すると、随時、自律移動ロボットの現在位置を計測する(Step10)。この測位方法は、前記例示した屋内測位技術や衛星測位システムなど、種々の手法を採用することができるが、本願発明が累積誤差を解消するものであることを考えれば、自律航法を採用するとより効果的となる。自律航法で測位した場合、定期的、断続的、あるいは連続的に自律移動ロボットの現在位置が取得され、そして測位するたびに「暫定的な現在位置」として出力される。ここで「暫定的」としたのは、後述するように位置を補正する可能性を残しているためである。 When the autonomous mobile robot starts autonomous movement, the current position of the autonomous mobile robot is measured at any time (Step 10). As this positioning method, various methods such as the indoor positioning technique and satellite positioning system exemplified above can be adopted. However, considering that the present invention eliminates the accumulated error, it is more preferable to adopt autonomous navigation. Become effective. When positioning is performed by autonomous navigation, the current position of the autonomous mobile robot is acquired periodically, intermittently, or continuously, and is output as a “temporary current position” each time positioning is performed. Here, “provisional” is used because the possibility of correcting the position remains as will be described later.
予想される移動範囲内には、あらかじめ数箇所の拠点局が設置され、さらにこの拠点局の設置位置を基準として拠点領域が設定されている。暫定的な現在位置が得られると、その位置座標が拠点領域内にあるか否か判断される(Step20)。ここで、拠点領域内にはないと判断されれば、補正されることなくそのまま現在位置として確定され(Step50)、暫定的な現在位置が拠点領域内にあると判断されれば、受信信号の強度に基づいて補正の是非を判断する(Step30)。 Within the anticipated movement range, several base stations are installed in advance, and a base area is set based on the installation position of the base station. When the provisional current position is obtained, it is determined whether or not the position coordinates are within the base area (Step 20). If it is determined that the current position is not within the base area, the current position is determined without correction (Step 50). If it is determined that the temporary current position is within the base area, the received signal The right or wrong of the correction is determined based on the intensity (Step 30).
受信信号とは、拠点局から発信された信号を、自律移動ロボットが備える受信手段が受信したものである。自律移動ロボットが受信した信号強度が、あらかじめ設定した閾値より大きい(強い)場合は、補正することとし(Step40)、閾値より小さい(弱い)場合は補正せずそのまま確定させる(Step50)。暫定的な現在位置が拠点領域にあることで自律移動ロボットが拠点局に近づいたことは予測できるが、自律航法の累積誤差を考えればこの段階で確定することはやや危険である。受信した信号強度の強弱によって、すなわち拠点局からの距離を推測することによって、自律移動ロボットが拠点局に近づいたことの確証を得るわけである。 The received signal is a signal received from a base station and received by a receiving means included in the autonomous mobile robot. If the signal strength received by the autonomous mobile robot is larger (stronger) than a preset threshold value, correction is made (Step 40), and if it is smaller (weaker) than the threshold value, it is determined without correction (Step 50). Although it can be predicted that the autonomous mobile robot has approached the base station because the provisional current position is in the base area, it is somewhat dangerous to determine at this stage considering the cumulative error of autonomous navigation. By confirming the strength of the received signal, that is, by estimating the distance from the base station, confirmation that the autonomous mobile robot has approached the base station is obtained.
暫定的な現在位置が拠点領域内にあると判断され、しかも受信した信号強度が設定した閾値より大きい場合は、暫定位置は補正される(Step40)。具体的には、暫定的な現在位置の座標が、あらかじめ設定された基準点の座標に変更される。この基準点は、現地の状況や用途等に応じて適宜設定することができ、例えば、拠点局の設置位置、拠点領域内の中心点、あるいは拠点領域内の任意点などを示すことができる。補正された現在位置は、そのまま確定した現在位置として記憶される(Step50)。 If it is determined that the provisional current position is within the base area and the received signal strength is greater than the set threshold, the provisional position is corrected (Step 40). Specifically, the coordinates of the provisional current position are changed to the coordinates of the reference point set in advance. This reference point can be set as appropriate according to the local situation, application, etc., and can indicate, for example, the installation position of the base station, the center point in the base area, or an arbitrary point in the base area. The corrected current position is stored as the determined current position as it is (Step 50).
確定した現在位置は、自律移動ロボットとは別に用意される表示手段に表示させることができる。この場合、予想される自律移動ロボットの移動範囲を地図として表示し、その上に確定した現在位置を表示すると、自律移動ロボットを監視する者(以下、「ロボット管理者」という。)が地図上で現在位置を把握できるとともに、目的地までの経路や位置関係なども予測できる。以上、Step10〜Step60の処理が、目的地に到達するまで繰り返される。
The determined current position can be displayed on display means prepared separately from the autonomous mobile robot. In this case, when the expected movement range of the autonomous mobile robot is displayed as a map and the current position determined on the map is displayed, a person who monitors the autonomous mobile robot (hereinafter referred to as “robot manager”) is displayed on the map. In addition to grasping the current position, the route to the destination and the positional relationship can also be predicted. As described above, the processing of
次に、本願発明の自律移動ロボットの主な構成について説明する。図2は、本願発明の自律移動ロボット100を説明するブロック図である。この図に示すように自律移動ロボット100は、移動手段101と、測位手段102、受信手段104、補正手段108を備えており、さらに現在位置記憶手段103や、信号データ記憶手段105、制御手段106、条件記憶手段107、基準点記憶手段109を備えることもできる。なお、現在位置記憶手段103や、信号データ記憶手段105、制御手段106、条件記憶手段107、基準点記憶手段109は外部に設置し、通信手段によって自律移動ロボット100と情報を伝達する仕組みとしてもよい。
Next, the main configuration of the autonomous mobile robot of the present invention will be described. FIG. 2 is a block diagram illustrating the autonomous
この図に示すうち移動手段101は、自律移動ロボット100が移動するための手段であり、人のように2足歩行する方式や、車輪(タイヤ)やキャタピラ(登録商標)によって走行する方式など、目的に応じて様々な移動方式を採用することができる。また測位手段102は、自律航法等によって移動中の自律移動ロボット100の現在地を随時計測するもので、ここで取得された現在位置はひとまず「暫定的な現在位置」として現在位置記憶手段103に記憶される。要所に設置された拠点局200から発信される信号を受けるのが受信手段104であり、定期的、断続的、あるいは連続的に拠点局200から信号を受信し、受信した記録は信号データ記憶手段105に記憶される。
The moving means 101 shown in this figure is a means for the autonomous
制御手段106は、種々の判断や指令を行うものである。まず制御手段106は、暫定的な現在位置が現在位置記憶手段102に記憶されると、拠点局200を基礎とする拠点領域内に暫定的な現在位置があるか否かを判断する。ここで暫定的な現在位置が拠点領域内にあると判断されれば、制御手段106は、いくつかの拠点局200の中からその拠点領域に紐づく拠点局200を特定するとともに、補正すべきか否かの判断を行う。具体的には、特定した拠点局200から受信した信号強度が、条件記憶手段107から読み出した信号強度の閾値以上であれば「補正する」と、そうでない場合は「補正しない」と判断する。一方、暫定的な現在位置が拠点領域内にないとされた場合も「補正しない」と判断する。そして、補正しないと判断されたとき制御手段106は、暫定的な現在位置を「確定した現在位置」として現在位置記憶手段102に記憶させる。
The control means 106 performs various judgments and commands. First, when the temporary current position is stored in the current position storage means 102, the control means 106 determines whether or not there is a temporary current position in the base area based on the
制御手段106の指令によって補正を行うのが補正手段108である。補正手段108は、制御手段106によって特定された拠点局200に紐づく基準点を、基準点記憶手段109から読み出す。そして、暫定的な現在位置を基準点に変更し、「確定した現在位置」として現在位置記憶手段102に記憶させる。確定した現在位置が記憶されると、地図および地図上における確定した現在位置は、自律移動ロボット100とは別に設けられる表示手段300に表示される。
The correction means 108 performs correction according to the command of the control means 106. The
以下、本願発明の自律移動ロボット100を構成する主な要素ごとに詳述する。
Hereinafter, each main element constituting the autonomous
2.測位手段
既述のとおり本願発明は、屋内測位技術や衛星測位システムなど様々な手法の測位手段102を用いることができるが、自律航法による測位手段102とするとより効果が顕著となる。自律航法は、移動する自律移動ロボット100が通過する地点の位置座標を逐次計測して記録するもので、過去の通過点(起点)座標に基づいて移動後の座標を求める手法である。したがって測位手段102には、自律移動ロボット100が移動した距離と方向(方位)を取得するための軌跡計測手段と、座標を求めるための座標演算手段が必要である。
2. Positioning means As described above, the present invention can use the positioning means 102 of various methods such as the indoor positioning technique and the satellite positioning system, but the effect becomes more remarkable when the positioning means 102 is based on autonomous navigation. Autonomous navigation is a method of sequentially measuring and recording the position coordinates of a point through which the moving autonomous
軌跡計測手段は、移動しながら距離を計測するもの(以下、「距離計測器」という。)と、移動しながら方向(方位)を計測するもの(以下、「方位計測器」という。)を具備する。例えば、距離計測器としては、加速度を計る加速度センサや、車輪(タイヤ)の回転から距離を計測するDMI(Distance Measuring Indicator)といったものが例示できる。一方、方位計測器としては、角速度を計るジャイロセンサや、地磁気を検知する地磁気センサ(例えば、電子コンパス)などを例示することができる。なお、距離計測器と方位計測器は、それぞれ別体として用意することもできるし、両者を搭載した一体型のものを利用することもできる。座標演算手段は、コンピュータによって実行されるプログラムを用いるとよい。 The trajectory measuring means includes one that measures a distance while moving (hereinafter referred to as “distance measuring instrument”) and one that measures a direction (azimuth) while moving (hereinafter referred to as “azimuth measuring instrument”). To do. For example, examples of the distance measuring device include an acceleration sensor that measures acceleration, and a DMI (Distance Measuring Indicator) that measures distance from rotation of a wheel (tire). On the other hand, examples of the azimuth measuring device include a gyro sensor that measures angular velocity and a geomagnetic sensor (for example, an electronic compass) that detects geomagnetism. In addition, a distance measuring device and a direction measuring device can be prepared as separate bodies, respectively, or an integrated device equipped with both can be used. The coordinate calculation means may be a program executed by a computer.
3.拠点局
拠点局200は、自律移動ロボット100が移動すると想定される経路の要所に設置されるものであり、例えば図3では壁面に4箇所(103A〜103D)設置されている。なお図3は、本願発明の自律移動ロボット100が自律移動した例であり、現在位置を把握しながら目的地まで到達する状況を示す平面図で、自律移動ロボット100の軌跡を破線で示している。
3. Base Station The
拠点局200は信号を発信するもので、例えば、GPSや、IMES、WiFi(登録商標)、Bluetooth(登録商標)、BLE(Bluetooth Low Energy)等で利用される電波信号、可視光や赤外線といった光信号、そのほか超音波などの音波信号を発信するものが、拠点局200として例示できる。なお、この信号には、その信号を発信した拠点局200の情報が埋め込まれている。その手法としては、例えば、無線LANで多用されているSSID(Service Set Identifier)といった技術が利用できる。図3の例のように複数の拠点局200が設置されている場合、異なる拠点局200から同時に信号を受信することも考えられるが、後述するように、どの拠点局200からの信号かを識別する必要があり、そのため信号に拠点局情報を埋め込むわけである。
The
図3に示すように、拠点局200の周囲には拠点領域201が設定される。拠点領域201は、自律移動ロボット100が拠点局200に近づいたことを推定するための範囲であり、拠点局200の設置位置を基準に設定される。例えば、拠点局200の設置位置を中心とする円形や、長円、矩形、他の多角形など、現地状況に合わせて任意の形状で設定することができる。また、拠点領域201は、平面形状(2次元領域)に限らず、直方体や球形といった立体形状(3次元領域)とすることもできる。さらに、受信手段104の機種や受信時刻に応じて、拠点領域201の大きさ(面積や容積)や形状を動的に変更することもできる。
As shown in FIG. 3, a base area 201 is set around the
当然ながら拠点領域201は拠点局200ごとに設定され、図3では拠点局200Aに対して拠点領域201Aが、拠点局200Bに対して拠点領域201Bが、拠点局200Cに対して拠点領域201Cが、拠点局200Dに対して拠点領域201Dが、それぞれ設定されている。なお、図3のようにひとつの拠点局200に対してひとつの拠点領域201を設定することもできるし、ひとつの拠点局200に対して複数の拠点領域201を設定することもできる。要は、拠点領域201からひとつの拠点局200を特定できればよい。図4では、拠点局200Eに対して、拠点領域201E−1と拠点領域201E−2の2つの拠点領域201が設定されている。
Of course, the base area 201 is set for each
また、拠点領域201には、その領域内を代表する基準点202が設定される。この基準点202は、拠点領域201のうちの任意点とすることも、拠点局200の設置位置とすることもできる。基準点202は、拠点領域201ごとに設定され、図3では拠点領域201Aに対して基準点202Aが、拠点領域201Bに対して基準点202Bが、拠点領域201Cに対して基準点202Cが、拠点領域201Dに対して基準点202Dが、それぞれ設定されている。ひとつの拠点局200に対して複数の拠点領域201が設定されている場合は、それぞれの拠点領域201で基準点202が設定される。図4では、拠点領域201E−1に対して基準点202E−1が、拠点領域201E−2に対して基準点202E−2が、それぞれ設定されている。
In the base area 201, a reference point 202 representing the area is set. The reference point 202 can be an arbitrary point in the base area 201 or can be an installation position of the
4.制御手段
既述のとおり制御手段106は、測位手段102が取得した「暫定的な現在位置」が、拠点領域201内にあるか否かを判断する。暫定的な現在位置が拠点領域201内にある場合、当該拠点領域201に対応する拠点局200を特定するとともに、当該拠点局200からの信号強度があらかじめ設定した閾値以上か否かを判断する。そして、その信号強度が閾値以上であれば「補正する」として補正手段108に指令する。例えば図3の場合、自律移動ロボット100が拠点領域201A内にいると判断され、しかも拠点局200Aから受信した信号強度が閾値以上であれば、制御手段106は「補正する」と判断し、暫定的な現在位置であるA地点が基準点202Aに補正される。あるいは、自律移動ロボット100が拠点領域201C内にいると判断されるものの、拠点局200Cから受信した信号強度が閾値を下回れば、補正せずそのまま現在位置として確定する。なお、受信手段104の機種や受信時刻に応じて、信号強度の閾値を動的に変更することもできる。
4). Control Unit As described above, the
現在位置を補正する決め手となるのは受信手段104で受信された信号強度であるが、信号強度のばらつきを考えると1回の受信信号で補正判断するのはやや危ういともいえる。そこで制御手段106が、過去複数回の受信履歴に基づいて代表的な信号強度(以下、「代表信号強度」という。)を設定し、この代表信号強度と信号強度の閾値を照らし合わせて補正判断するとよい。具体的には、暫定的な現在位置を含む拠点領域201に対応する拠点局200を特定し、この拠点局200から受信した所定回数(例えば10回)の受信信号を信号データ記憶手段105から読み出す。このとき最新のものから順に遡って読み出すとよい。そして、所定数(例えば10個)の信号データに基づいて、代表信号強度を設定する。例えば、所定数の信号データ(信号強度)の平均値や中央値、最大値や最小値、あるいは上位n番目の値、など種々の方法で代表信号強度を設定する。この代表信号強度が閾値以上であれば「補正する」こととし、そうでなければ補正せずにそのまま現在位置として確定するわけである。
The decisive factor for correcting the current position is the signal strength received by the receiving means 104. However, it can be said that it is somewhat dangerous to make correction judgment with a single received signal in consideration of variations in signal strength. Therefore, the control means 106 sets a representative signal strength (hereinafter referred to as “representative signal strength”) based on a plurality of past reception histories, and makes a correction judgment by comparing the representative signal strength with a threshold value of the signal strength. Good. Specifically, the
制御手段106は、拠点領域201内の有無と受信した信号強度の組み合わせからなる補正条件のほか、種々の補正条件によって補正の是非を判断することができる。例えば、図5に示すように、現在位置を補正した後、一定の時間が経過していなければ、たとえ補正条件が整っていたとしても補正せずそのまま現在位置として確定することもできる。繰り返し同じ基準点202に補正すると、かえって誤った現在位置を確定することになるからである。したがって、補正しない「一定の時間」は、おおよそ自律移動ロボット100が拠点領域201から出て行くまでにかかる時間とするのがよい。
The control means 106 can determine whether the correction is appropriate or not based on various correction conditions in addition to the correction conditions including the combination of the presence / absence in the base area 201 and the received signal strength. For example, as shown in FIG. 5, if a predetermined time has not elapsed after the current position is corrected, the current position can be determined as it is without correction even if the correction condition is satisfied. This is because if the same reference point 202 is repeatedly corrected, an erroneous current position is determined. Therefore, the “certain time” that is not corrected is preferably the time that it takes for the autonomous
図6は、基準点202からの距離を考慮した条件を用いて、補正の判断を行うフロー図である。この図では、測位手段102が取得した「暫定的な現在位置」が、著しく基準点202に近づいている場合は、補正せずそのまま現在位置として確定することとしている。つまり、基準点202に近いということは測位手段102の測位精度が相当程度であると考えられるからである。具体的には、暫定的な現在位置と基準点202との離れ(距離)を計算し、その距離が閾値以上のときは補正するが、閾値を下回るときは補正せずそのまま現在位置として確定する。 FIG. 6 is a flowchart for determining correction using conditions that take into account the distance from the reference point 202. In this figure, when the “provisional current position” acquired by the positioning means 102 is extremely close to the reference point 202, the current position is determined without correction. That is, the fact that it is close to the reference point 202 is considered that the positioning accuracy of the positioning means 102 is considerable. Specifically, the distance (distance) between the provisional current position and the reference point 202 is calculated, and is corrected when the distance is greater than or equal to the threshold value, but when the distance is less than the threshold value, it is determined as the current position without correction. .
図7は、測位手段102が取得した「暫定的な現在位置」の位置精度が著しく低下している場合、その旨警告する処理を示すフロー図である。この図に示すように、測位手段102が取得した「暫定的な現在位置」が拠点領域201の範囲外であるにもかかわらず、当該拠点領域201に対応する拠点局200からの受信信号が閾値を超える場合、異常を伝える処理を行う。受信信号の情報が正しいとすれば、測位した位置が拠点領域201を外れているのは異常な状態であると考え、その旨をロボット管理者に通知して対処を促すわけである。もちろん、測位手段102が取得した「暫定的な現在位置」が拠点領域201の範囲外であり、当該拠点領域201に対応する拠点局200からの受信信号が閾値を下回る場合は、そのまま確定した現在位置として記憶する。
FIG. 7 is a flowchart showing a process of giving a warning to the effect that the position accuracy of the “provisional current position” acquired by the positioning means 102 is significantly lowered. As shown in this figure, the received signal from the
本願発明の自律移動ロボット100は、屋内に限らず屋外の広い範囲でも利用可能であり、工場や、学校、病院など、様々な施設内で効果的に利用することができる。
The autonomous
100 測位システム
101 移動手段
102 測位手段
103 現在位置記憶手段
104 受信手段
105 信号データ記憶手段
106 制御手段
107 条件記憶手段
108 補正手段
109 基準点記憶手段
200 拠点局
201 拠点領域
202 基準点
300 表示手段
100
Claims (6)
移動手段と、
現在位置を計測する測位手段と、
所定位置に設置された拠点局から発信される信号を受信する受信手段と、
前記拠点局の設置位置を基準に設定される拠点領域に基づいて、前記測位手段で計測された前記現在位置を補正する補正手段と、を備え、
前記補正手段は、前記現在位置が前記拠点領域内にあって、且つ該拠点領域に対応する前記拠点局から所定強度以上の信号を受信したとき、前記現在位置を、前記拠点領域内であらかじめ定められた基準点に補正する、ことを特徴とする自律移動ロボット。 In a robot that moves autonomously while grasping the current position,
Transportation means;
A positioning means for measuring the current position;
Receiving means for receiving a signal transmitted from a base station installed at a predetermined position;
Correction means for correcting the current position measured by the positioning means based on the base area set with reference to the installation position of the base station,
When the current position is within the base area and a signal having a predetermined strength or higher is received from the base station corresponding to the base area, the correction means determines the current position in the base area in advance. The autonomous mobile robot is characterized in that the reference point is corrected.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015250127A JP6699034B2 (en) | 2015-12-22 | 2015-12-22 | Autonomous mobile robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015250127A JP6699034B2 (en) | 2015-12-22 | 2015-12-22 | Autonomous mobile robot |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2017117094A true JP2017117094A (en) | 2017-06-29 |
JP6699034B2 JP6699034B2 (en) | 2020-05-27 |
Family
ID=59234430
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2015250127A Active JP6699034B2 (en) | 2015-12-22 | 2015-12-22 | Autonomous mobile robot |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6699034B2 (en) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110142763A (en) * | 2019-05-12 | 2019-08-20 | 深圳市普渡科技有限公司 | Robot cover parking scheme |
JPWO2021005685A1 (en) * | 2019-07-08 | 2021-01-14 | ||
JP7047958B1 (en) | 2021-03-25 | 2022-04-05 | 三菱電機株式会社 | Mobile management system |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004139265A (en) * | 2002-10-16 | 2004-05-13 | Toshiba Tec Corp | Autonomous traveling robot |
JP2005063184A (en) * | 2003-08-13 | 2005-03-10 | Toshiba Corp | Self-propelled moving device and position correction method |
JP2008224657A (en) * | 2007-02-15 | 2008-09-25 | Seiko Epson Corp | Method of estimating current location, positioning method, program, and mobile terminal |
JP2009257763A (en) * | 2006-06-30 | 2009-11-05 | Nec Corp | System, method and program for position estimation for vehicle |
JP2011069748A (en) * | 2009-09-28 | 2011-04-07 | Hitachi Ltd | Location information transmitter, communication terminal, and positioning system |
JP2013253927A (en) * | 2012-06-08 | 2013-12-19 | Hitachi Advanced Syst:Kk | Information processing system, and method for generating seamless indoor and outdoor trajectory |
JP2014096781A (en) * | 2012-10-12 | 2014-05-22 | Ricoh Co Ltd | Information processing device, information processing method and information processing program |
JP2014134464A (en) * | 2013-01-10 | 2014-07-24 | Chugoku Electric Power Co Inc:The | Moving object capable of autonomously moving and control method thereof |
JP6554679B2 (en) * | 2014-07-04 | 2019-08-07 | 国際航業株式会社 | Positioning system |
-
2015
- 2015-12-22 JP JP2015250127A patent/JP6699034B2/en active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004139265A (en) * | 2002-10-16 | 2004-05-13 | Toshiba Tec Corp | Autonomous traveling robot |
JP2005063184A (en) * | 2003-08-13 | 2005-03-10 | Toshiba Corp | Self-propelled moving device and position correction method |
JP2009257763A (en) * | 2006-06-30 | 2009-11-05 | Nec Corp | System, method and program for position estimation for vehicle |
JP2008224657A (en) * | 2007-02-15 | 2008-09-25 | Seiko Epson Corp | Method of estimating current location, positioning method, program, and mobile terminal |
JP2011069748A (en) * | 2009-09-28 | 2011-04-07 | Hitachi Ltd | Location information transmitter, communication terminal, and positioning system |
JP2013253927A (en) * | 2012-06-08 | 2013-12-19 | Hitachi Advanced Syst:Kk | Information processing system, and method for generating seamless indoor and outdoor trajectory |
JP2014096781A (en) * | 2012-10-12 | 2014-05-22 | Ricoh Co Ltd | Information processing device, information processing method and information processing program |
JP2014134464A (en) * | 2013-01-10 | 2014-07-24 | Chugoku Electric Power Co Inc:The | Moving object capable of autonomously moving and control method thereof |
JP6554679B2 (en) * | 2014-07-04 | 2019-08-07 | 国際航業株式会社 | Positioning system |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110142763A (en) * | 2019-05-12 | 2019-08-20 | 深圳市普渡科技有限公司 | Robot cover parking scheme |
JPWO2021005685A1 (en) * | 2019-07-08 | 2021-01-14 | ||
WO2021005685A1 (en) * | 2019-07-08 | 2021-01-14 | 三菱電機株式会社 | Mobile object guidance control device and guidance control system |
CN114026387A (en) * | 2019-07-08 | 2022-02-08 | 三菱电机株式会社 | Guide control device and guide control system for moving body |
JP7040673B2 (en) | 2019-07-08 | 2022-03-23 | 三菱電機株式会社 | Guidance control device and guidance control system for moving objects |
CN114026387B (en) * | 2019-07-08 | 2024-04-30 | 三菱电机株式会社 | Guiding control device and guiding control system for moving body |
JP7047958B1 (en) | 2021-03-25 | 2022-04-05 | 三菱電機株式会社 | Mobile management system |
JP2022149358A (en) * | 2021-03-25 | 2022-10-06 | 三菱電機株式会社 | Mobile body management system |
Also Published As
Publication number | Publication date |
---|---|
JP6699034B2 (en) | 2020-05-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11112505B2 (en) | Navigation for a robotic work tool | |
JP5927735B2 (en) | Map data creation device, autonomous mobile system and autonomous mobile control device | |
JP6554679B2 (en) | Positioning system | |
US8548731B2 (en) | Navigation method, navigation system, navigation device, vehicle provided therewith and group of vehicles | |
CN108303720A (en) | A kind of vehicle positioning method, device and terminal device | |
CN104764461A (en) | Navigation method and navigation device for hospital outpatient service | |
JP6330471B2 (en) | Wireless positioning device | |
CN103207383A (en) | Method for performing two-dimensional wireless positioning on stationary node based on single mobile node | |
CN110597252B (en) | Fusion positioning control method, device and equipment for automatic driving automobile and storage medium | |
JP2011065308A (en) | Autonomous moving system and autonomous mobile device | |
CN104457750A (en) | Emergency rescue personnel location system and emergency rescue personnel location method | |
CN106197406A (en) | A kind of based on inertial navigation with the fusion method of RSSI wireless location | |
US20200124422A1 (en) | Localization using dynamic landmarks | |
KR101638679B1 (en) | The outdoor guide robot with automatic location based guidance and navigation | |
US11169280B2 (en) | Systems and methods for direction estimation in indoor and outdoor locations | |
JP6699034B2 (en) | Autonomous mobile robot | |
US11029415B2 (en) | Systems and methods for estimating initial heading at start-up of navigation | |
US9368032B1 (en) | System and method for locating a vehicle within a parking facility | |
US20210053232A1 (en) | Information processing apparatus, information processing method and program | |
JP2013088348A (en) | Navigation terminal and method for acquiring position of the same | |
JP2016183921A (en) | Server computer, positioning system, positioning method and program | |
CN204228169U (en) | A kind of personnel location system of emergency management and rescue | |
JP2017009363A (en) | Positioning system | |
JP6904172B2 (en) | Information processing equipment, programs, and information processing systems | |
KR101408383B1 (en) | Free-ranging automated guided vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20160106 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20181004 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20190809 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20190828 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20191021 |
|
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: 20200331 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20200407 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6699034 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |