JP2020135560A - Autonomous mobile robot - Google Patents
Autonomous mobile robot Download PDFInfo
- Publication number
- JP2020135560A JP2020135560A JP2019029812A JP2019029812A JP2020135560A JP 2020135560 A JP2020135560 A JP 2020135560A JP 2019029812 A JP2019029812 A JP 2019029812A JP 2019029812 A JP2019029812 A JP 2019029812A JP 2020135560 A JP2020135560 A JP 2020135560A
- Authority
- JP
- Japan
- Prior art keywords
- mobile robot
- autonomous mobile
- controller
- sensor
- obstacle
- 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
- 238000012545 processing Methods 0.000 claims abstract description 15
- 238000000034 method Methods 0.000 claims description 34
- 230000006870 function Effects 0.000 claims description 23
- 230000005855 radiation Effects 0.000 description 9
- 238000013507 mapping Methods 0.000 description 6
- 238000010586 diagram Methods 0.000 description 5
- 230000007774 longterm Effects 0.000 description 4
- 238000001514 detection method Methods 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 230000006399 behavior Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 238000012886 linear function Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011002 quantification Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
本発明は、自律移動ロボットに関する。 The present invention relates to an autonomous mobile robot.
医療施設や介護施設などに代表される施設においては、昼間は多くの職員が施設内を行き来しており、施設内で不具合が発生した対象者を職員が迅速に発見することが可能である。一方、夜間は宿直担当職員が一定時間間隔で施設内を定期巡回することにより不具合の発見に努めている。 In facilities such as medical facilities and long-term care facilities, many staff members come and go in the facility during the daytime, and it is possible for the staff members to quickly find the target person who has a problem in the facility. On the other hand, at night, the staff in charge of night duty patrols the facility at regular intervals to try to find problems.
このような状況を補うために、施設内の所定の位置にカメラを設置し、該カメラが撮像した画像(静止画像又は動画像)を職員が待機している居室に転送するシステムが採用されている。 In order to compensate for this situation, a system has been adopted in which a camera is installed at a predetermined position in the facility and the image (still image or moving image) captured by the camera is transferred to the living room where the staff is waiting. There is.
しかしながら、上述したシステムにおいて、カメラの死角に存在する対象者を画像で発見することは困難である。例えば、宿直担当職員の巡回時間間隔が1時間の場合、巡回直後にカメラの死角で転倒したり徘徊している対象者を発見するのは、次の1時間後になってしまう場合がある。 However, in the above-mentioned system, it is difficult to detect the target person in the blind spot of the camera by an image. For example, if the patrol time interval of the staff in charge of night duty is one hour, it may be one hour later to find the subject who has fallen or wandered in the blind spot of the camera immediately after the patrol.
かかる状況を改善すべく、施設内を自動巡回する自律移動ロボットを利用することができる。自律移動ロボットが施設内を自動巡回する際に、施設内のフロア上に障害物が存在する場合、当該障害物を回避する適切な回避方向を判断しないと、適切に巡回移動することが困難になる。 In order to improve this situation, an autonomous mobile robot that automatically patrols the facility can be used. When an autonomous mobile robot automatically patrols the facility, if there is an obstacle on the floor in the facility, it will be difficult to patrol properly unless an appropriate avoidance direction to avoid the obstacle is determined. Become.
本発明は、上記の問題点に鑑みてなされたものであり、その目的は、施設内の目標に向かって好適に障害物を回避する進行方向を決定する自律移動ロボットを実現することにある。 The present invention has been made in view of the above problems, and an object of the present invention is to realize an autonomous mobile robot that preferably determines a traveling direction for avoiding obstacles toward a target in a facility.
上記の課題を解決するために、本発明の態様1に係る自律移動ロボットは、施設内を自動巡回する自律移動ロボットであって、現在地点から障害物までの距離を方向毎に検知するセンサと、前記センサの出力信号を参照して当該自律移動ロボットを制御するコントローラと、を備え、前記コントローラは、方向毎の重みを与える重み関数であって、自動巡回の目標方向の重みが最大となる重み関数を用いて前記センサの出力信号を補正する処理と、補正後の出力信号に応じて当該自律移動ロボットの進行方向を決定する処理と、を実行する、構成である。 In order to solve the above problems, the autonomous mobile robot according to the first aspect of the present invention is an autonomous mobile robot that automatically patrols the facility, and is a sensor that detects the distance from the current position to an obstacle for each direction. A controller that controls the autonomous mobile robot by referring to the output signal of the sensor is provided, and the controller is a weighting function that gives weights for each direction, and the weight in the target direction of automatic patrol is maximized. It is configured to execute a process of correcting the output signal of the sensor using a weighting function and a process of determining the traveling direction of the autonomous mobile robot according to the corrected output signal.
上記の構成によれば、施設内の目標に向かって好適に障害物を回避する進行方向を決定する自律移動ロボットを実現することができる。 According to the above configuration, it is possible to realize an autonomous mobile robot that preferably determines a traveling direction for avoiding obstacles toward a target in the facility.
本発明の態様2に係る自律移動ロボットは、上記の態様1において、当該自律移動ロボットを移動させる駆動装置を更に備え、前記コントローラは、決定した進行方向に当該自律移動ロボットを移動させるための制御信号を前記駆動装置に供給する、構成としてもよい。 In the above aspect 1, the autonomous mobile robot according to the second aspect of the present invention further includes a drive device for moving the autonomous mobile robot, and the controller controls the autonomous mobile robot to move in a determined traveling direction. The signal may be supplied to the drive device.
上記の構成によれば、施設内の目標に向かって好適に障害物を回避しつつ自律移動する自律移動ロボットを実現することができる。 According to the above configuration, it is possible to realize an autonomous mobile robot that autonomously moves toward a target in the facility while avoiding obstacles.
本発明の態様3に係る自律移動ロボットは、上記の態様1又は2において、前記センサは、レーザを用いて特定の周期で現在地点から障害物までの距離を検知し、前記コントローラは、前記特定の周期で前記各処理を実行する、構成としてもよい。 In the autonomous mobile robot according to the third aspect of the present invention, in the above aspect 1 or 2, the sensor detects the distance from the current position to the obstacle at a specific cycle using a laser, and the controller detects the specific distance. Each process may be executed in the cycle of.
上記の構成によれば、施設内の目標に向かって好適に障害物を回避する進行方向を周期的に決定し自動巡回する自律移動ロボットを実現することができる。 According to the above configuration, it is possible to realize an autonomous mobile robot that periodically determines a traveling direction that preferably avoids obstacles toward a target in the facility and automatically patrols.
本発明の態様4に係る自律移動ロボットは、上記の態様1〜3までの何れか1態様において、前記コントローラは、前記センサの出力信号を取得する少なくとも1つの入力インタフェースと、予め定められたプログラムに従って前記各処理を実行する少なくとも1つのプロセッサと、前記プログラムを格納した少なくとも1つのメモリと、を備えている、構成としてもよい。 The autonomous mobile robot according to the fourth aspect of the present invention has, in any one of the above aspects 1 to 3, the controller has at least one input interface for acquiring the output signal of the sensor and a predetermined program. It may be configured to include at least one processor that executes each of the processes according to the above, and at least one memory that stores the program.
上記の構成によれば、メモリに格納された情報を参照してプロセッサが処理を実行することにより、施設内の目標に向かって好適に障害物を回避しつつ自動巡回する自律移動ロボットを実現することができる。 According to the above configuration, the processor executes the process by referring to the information stored in the memory, thereby realizing an autonomous mobile robot that automatically patrols toward the target in the facility while avoiding obstacles. be able to.
本発明の態様5に係る制御方法は、施設内を自動巡回する自律移動ロボットを制御する制御方法であって、センサを用いて現在地点から障害物までの距離を方向毎に検知する工程と、前記センサの出力信号を参照して当該自律移動ロボットを制御する工程と、を含み、前記制御する工程は、方向毎の重みを与える重み関数であって、自動巡回の目標方向の重みが最大となる重み関数を用いて前記センサの出力信号を補正する処理と、補正後の出力信号に応じて当該自律移動ロボットの進行方向を決定する処理と、を含む、方法である。 The control method according to the fifth aspect of the present invention is a control method for controlling an autonomous mobile robot that automatically patrols the facility, and includes a step of detecting the distance from the current position to an obstacle for each direction using a sensor. The step of controlling the autonomous mobile robot with reference to the output signal of the sensor is included, and the step of controlling is a weighting function that gives weights for each direction, and the weight in the target direction of automatic patrol is maximum. This is a method including a process of correcting the output signal of the sensor using a weighting function, and a process of determining the traveling direction of the autonomous mobile robot according to the corrected output signal.
上記の構成によれば、施設内の目標に向かって好適に障害物を回避する進行方向を決定する自律移動ロボットを制御することができる。 According to the above configuration, it is possible to control an autonomous mobile robot that preferably determines a traveling direction for avoiding obstacles toward a target in the facility.
本発明の態様6に係る自律移動ロボットを制御する制御プログラムであって、前記コントローラに前記各処理を実行させることを特徴とする制御プログラムは、上記の態様1〜4の何れか1項において、請求項1〜4の何れか1項に記載の自律移動ロボットを制御する制御プログラムであって、前記コントローラに前記各処理を実行させる構成としてもよい。 The control program for controlling the autonomous mobile robot according to the sixth aspect of the present invention, wherein the controller executes each of the above processes, is the control program according to any one of the above aspects 1 to 4. The control program for controlling the autonomous mobile robot according to any one of claims 1 to 4 may be configured to cause the controller to execute each of the above processes.
上記の構成によれば、前記制御方法と同様の効果を奏する。 According to the above configuration, the same effect as that of the control method is obtained.
本発明の一態様によれば、施設内の目標に向かって好適に障害物を回避する進行方向を決定する自律移動ロボットを実現することができるという効果を奏する。 According to one aspect of the present invention, it is possible to realize an autonomous mobile robot that preferably determines a traveling direction for avoiding obstacles toward a target in the facility.
〔実施形態1〕
本発明の一実施形態に係る自律移動ロボット10について、図1〜図11を参照して説明する。自律移動ロボット10は、医療施設や介護施設などの職員に代わって施設内の見回りを実施する介護医療用の自律移動ロボットであって、障害物を回避しつつ目標方向に向かって巡回移動する自走式の自律移動ロボットである。
[Embodiment 1]
The autonomous
(自律移動ロボット10の主要構成)
図1は、自律移動ロボット10の主なハードウェア構成を示したブロック図である。図1に示すように、自律移動ロボット10は、少なくともコントローラ11と、測域センサ12と、駆動装置13と、エンコーダ14とを備えている。
(Main configuration of autonomous mobile robot 10)
FIG. 1 is a block diagram showing a main hardware configuration of the autonomous
コントローラ11は、少なくとも受信部15と、マップ情報入力部16と、順路情報生成部17と、出力部18と、位置情報生成部19とを有する。図1では、コントローラ11を機能ブロック図を用いて機能的に示しているが、後述する図11では、コントローラ11のハードウェア構成を示す。
The
好ましい実施形態では、受信部15は、測域センサ12から測域センサデータを取得する。マップ情報入力部16は、後述する施設内のブロック地図情報を取得する。位置情報生成部19は、エンコーダ14を介して自律移動ロボット10の施設内における現在位置情報を生成する。順路情報生成部17は、当該生成された自律移動ロボット10の施設内における現在位置情報と、ブロック地図情報と、測域センサデータとに基づいて、自律移動ロボット10が施設内を巡回移動する順路情報を生成する。出力部18は、当該生成された順路情報に応じた出力情報を駆動装置13に出力する。当該出力情報に基づいて駆動装置13により自律移動ロボット10が巡回移動する。自律移動ロボット10が施設内を巡回移動するための駆動装置13の移動量に基づいてエンコーダ14は、自律移動ロボット10の走行距離と移動方向の情報を生成する。
In a preferred embodiment, the
(ブロック地図情報)
上述のとおり、マップ情報入力部16は、施設内のブロック地図情報を取得する。本発明においてブロック地図とは、施設内のフロア情報を簡略化してブロック化した地図のことをいう。
(Block map information)
As described above, the map
図2は、本発明の一実施形態に係るブロック地図を模式的に示した概略平面図である。ブロック地図の設定の一例について以下に説明する。好ましい実施形態では、医療施設や介護施設などの施設のフロア図から自律移動ロボット10が通ってよい場所を設定する。次いで、1つの部屋の前の廊下が1つのブロック(21a、21b、21c、21d)となるようにブロック分けをする。ここで大きなブロックは1〜2mを目安に分割することが好ましい。各ブロックの中心点(22b、22c、22d)を設定する。自律移動ロボット10が現時点で存在するブロック(図2ではブロック21a)には中心点を設定する必要はない。各ブロックの中心点を目標地点に設定する。図2では、ブロック21aに存在している自律移動ロボット10を出発点として、自律移動ロボット10の現在位置から自律移動ロボット10が存在しているブロックの次のブロックの中心点を点線矢印で結線し、最終ブロック21dまで移動する経路を示している。図2のブロック21b中の23bは、障害物を示す。各ブロックの中心点を目標地点に設定することにより、自律移動ロボット10のおおまかな移動方向情報を生成することができる。好ましい実施形態では、当該移動方向情報を組み合わせた移動ブロック経路の生成を人為的に設定することができるが、目標地点(最終ブロックの中心点)を設定することにより最短経路を生成するアルゴリズムによって自動的に移動ブロック経路を設定することもできる。このように生成したブロック地図の情報をマップ情報入力部16に入力する。
FIG. 2 is a schematic plan view schematically showing a block map according to an embodiment of the present invention. An example of setting a block map will be described below. In a preferred embodiment, a place where the autonomous
(ブロック地図における位置判断)
図3は、障害物を回避しつつ目標方向に自律移動ロボット10を進行させる方法を示すフローチャートである。順路情報生成部17は、マップ情報入力部16に入力されたブロック地図の情報を受信し、以下の処理を実行する。まず最終目標ブロックを設定する(S160)。次いで、自律移動ロボット10が現時点で存在しているブロックから最終目標ブロックまでのブロック経路を生成する(S161)。自律移動ロボット10が現時点で存在しているブロックが最終目標ブロックか否か判断する(S162)。自律移動ロボット10が現時点で存在しているブロックが最終目標ブロックの場合(S162でYES)、処理を終了する。自律移動ロボット10が現時点で存在しているブロックが最終目標ブロックでない場合(S162でNO)、障害物回避を考慮しつつ、次の目標ブロックに向けた速度指令を生成する(S171)。
(Position judgment on block map)
FIG. 3 is a flowchart showing a method of advancing the autonomous
(測域センサによる障害物検知)
上述したとおり、順路情報生成部17は、障害物回避を考慮しつつ、次の目標ブロックに向けた速度指令を生成する(S171)。ここで障害物を回避するために、順路情報生成部17は、測域センサ12により得られた測域センサデータを受信部15を介して取得する。測域センサ12は、自律移動ロボット10の筐体の表面に露出した様態で配置することが好ましい。測域センサ12は、自律移動ロボット10の筐体の表面の任意の場所に配置されることができるが、自律移動ロボット10の前進方向正面に配置されていることが好ましい。測域センサ12は、例えば、北陽電機株式会社製のUST−10LXのようなレーザ方式の測域センサを採用することができる。
(Obstacle detection by range sensor)
As described above, the route information generation unit 17 generates a speed command for the next target block while considering obstacle avoidance (S171). Here, in order to avoid obstacles, the route information generation unit 17 acquires the range sensor data obtained by the
図4は、測域センサ12により検知された障害物をマッピングした様子を模式的に示す概略平面図である。自律移動ロボット10の筐体に搭載された測域センサ12の位置を原点とし、自律移動ロボット10の前進方向をx軸とし、x軸に直交する方向をy軸とした。図4において、障害物は小さな丸印によって表示されている。図4に示すように、測域センサ12の走査角度を±θ°で示す。好ましい実施形態では、測域センサ12は、±θ=±115度の範囲で障害物を検知する。また、0.06m〜10m程度の検出距離であることが好ましい。走査時間は25msであることが好ましい。角度分解能は0.25度程度が好ましい。これらの値に限定されることなく、測域センサ12は、任意の検出距離、走査角度、走査時間、角度分解能を有することができる。
FIG. 4 is a schematic plan view schematically showing a state in which obstacles detected by the
(測域センサデータの加工)
順路情報生成部17は、図4に示した、測域センサ12により検知された障害物マッピング情報に基づいて障害物を回避する方向を判断する。当該判断処理に伴う計算量を低減させるため、順路情報生成部17は、測域センサ12により検知された障害物マッピング情報を離散化する。
(Processing of range sensor data)
The route information generation unit 17 determines the direction to avoid the obstacle based on the obstacle mapping information detected by the
図5の(a)は、測域センサ12により検知された障害物マッピング情報を離散化したグリッドマップの一例を示す。好ましい実施形態では、図5の(a)に示すようにx軸方向4m×y軸方向5mの障害物マッピング情報について、0.1m×0.1mのグリッドに離散化することができる。
FIG. 5A shows an example of a grid map in which the obstacle mapping information detected by the
図5の(b)は、図5の(a)のグリッドマップをモフォロジー処理した一例を示す。順路情報生成部17は、障害物を回避する方向を判断する際に、自律移動ロボット10を点として取り扱う。そのため、順路情報生成部17は、図5の(a)のグリッドマップに対して障害物領域を自律移動ロボット10のフットプリントの半径分だけ膨張させるモフォロジー処理を施す。かかる膨張モフォロジー処理を施した後のグリッドマップ(図5の(b))において、グリッドが1マスでも空いていれば自律移動ロボット10は、障害物の間を通過することができる。
FIG. 5B shows an example in which the grid map of FIG. 5A is morphologically processed. The route information generation unit 17 treats the autonomous
(障害物回避方向の数値化)
図5の(b)に示すような膨張モフォロジー処理を施した後のグリッドマップを用いて、順路情報生成部17は、障害物回避方向の数値化処理を行う。
(Quantification of obstacle avoidance direction)
Using the grid map after the expansion morphology processing as shown in FIG. 5B, the route information generation unit 17 performs the numerical processing in the obstacle avoidance direction.
図6は、障害物回避方向の数値化処理を模式的に示した概略図である。膨張モフォロジー処理を施した後のグリッドマップにおいて、自律移動ロボット10の現在位置を中心に±θ°の走査角度範囲内において一定の角度を隔てた放射線を設定する。好ましい実施形態では、放射線間の間隔角度は5度である。図6に示した放射線間の間隔角度は10度である。また自律移動ロボット10の現在位置を中心に複数の同心円を設定する。好ましい実施形態では同心円の最大半径は3m程度であり、各同心円の半径は0.1m間隔で設定する。図6に示した同心円の最大半径は2.4mであり、各同心円の半径は0.2m間隔で設定される。
FIG. 6 is a schematic view schematically showing the digitization process in the obstacle avoidance direction. In the grid map after the expansion morphology processing is performed, radiation is set at a constant angle within a scanning angle range of ± θ ° around the current position of the autonomous
当該同心円と放射線との交点のうち、膨張モフォロジー処理を施した障害物に該当しない交点であって、自律移動ロボット10の現在位置と障害物との間に存在する交点の数を放射線ごとにカウントする(点数化する)。図6に示した例では、θ=−100度付近の放射線では、4点とカウントされ、θ=+100度付近の放射線では、5点とカウントされている。θ=+10度付近の放射線では12点とカウントされ、最高得点となっていることが確認できる。これにより自律移動ロボット10の現在位置を中心に障害物までの距離を数値化することができる。
Among the intersections of the concentric circles and radiation, the number of intersections that do not correspond to obstacles that have undergone expansion morphology processing and exist between the current position of the autonomous
順路情報生成部17は、当該最高得点となった放射線の方向を障害物回避方向として設定することができる。図7は、障害物回避方向と目標方向との関係を模式的に示した概略図である。順路情報生成部17は、自律移動ロボット10の現在位置を起点として、次のブロックの中心点を目標位置とし、当該目標位置の方向を目標方向として設定する。図7から明らかなように、障害物回避方向に自律移動ロボット10を移動させると、目標方向とは異なっているため、目標位置に到達できない。
The route information generation unit 17 can set the direction of the radiation having the highest score as the obstacle avoidance direction. FIG. 7 is a schematic view schematically showing the relationship between the obstacle avoidance direction and the target direction. The route information generation unit 17 sets the current position of the autonomous
(障害物回避行動)
上述のように目標位置に到達できない状況を解消するために、順路情報生成部17は、以下のように進行方向を算出する。
(Obstacle avoidance behavior)
In order to solve the situation where the target position cannot be reached as described above, the route information generation unit 17 calculates the traveling direction as follows.
図9の(a)は、膨張モフォロジー処理を施した障害物の間に自律移動ロボット10を配置した位置関係を模式的に示す概略平面図である。測域センサ12を搭載した自律移動ロボット10の正面をx軸正方向とした場合、目標方向は約−20度の方向であることが確認できる。また、障害物までの距離はBの方向よりもAの方向の方が長いことも確認できる。
FIG. 9A is a schematic plan view schematically showing a positional relationship in which the autonomous
図8の(a)は、図9の(a)に示した位置関係において、自律移動ロボット10の正面に搭載された測域センサ12の走査角度に対する障害物までの距離を表したグラフである。より具体的には、図8の(a)は、自律移動ロボット10が配置された位置を原点として測域センサ12により走査角度±θ=約±115度の範囲で障害物を検知し、各走査角度における障害物までの距離をプロットしたグラフである。当該グラフの縦軸は、障害物までの距離を正規化した値を用いて表したものである。当該縦軸の値により障害物回避方向を数値化した結果を示す。図9の(a)に示した位置関係に基づいて、約−20度の方向が目標方向である旨を明記している。図8の(a)のグラフからも、自律移動ロボット10から障害物までの距離はBの方向よりもAの方向の方が長いことが確認できる。
FIG. 8A is a graph showing the distance to an obstacle with respect to the scanning angle of the
図8の(b)は、重み関数の一例を示したグラフである。COS関数、ガウス関数、放物線関数などのように目標方向の重みが最大となる任意の重み関数を用いることができる。どのような重み関数を適用するかは、フロア構成/ブロック地図構成に依存するパラメータであり、オフラインで設定することが好ましい。本実施形態では、目標方向の重みを最大(=1)とした1次関数(ただし、目標方向より正方向では傾きが負となり、目標方向より負方向では傾きが正となる)を採用した。図8の(a)のグラフに当該重み関数を重畳した結果を図9の(b)に示す。 FIG. 8B is a graph showing an example of the weighting function. Any weight function that maximizes the weight in the target direction, such as the COS function, Gaussian function, and parabolic function, can be used. What kind of weighting function is applied is a parameter that depends on the floor configuration / block map configuration, and is preferably set offline. In this embodiment, a linear function in which the weight in the target direction is maximized (= 1) (however, the slope is negative in the positive direction from the target direction and the slope is positive in the negative direction from the target direction) is adopted. The result of superimposing the weighting function on the graph of FIG. 8A is shown in FIG. 9B.
図9の(b)の結果から、目標方向の影響を考慮した重み関数を適用すると、自律移動ロボット10から障害物までの距離はAの方向よりもBの方向の方が長いことが確認できる。したがって、順路情報生成部17は、進行方向をBの方向と決定する。かかる順路情報生成部17の判断により、目標方向に一番近い障害物回避方向を選択することができる。
From the result of (b) of FIG. 9, it can be confirmed that the distance from the autonomous
図10は、このような一連の障害物回避方向選択処理に用いた条件を平面図に表した模式図である。iはブロックを表し、iiは障害物までの距離を表し、iiiは障害物回避方向を表し、ivは目標方向を表し、vは重み関数を表し、viは重み関数を重畳した後の障害物までの距離を表し、viiは進行方向を表す。 FIG. 10 is a schematic view showing the conditions used in such a series of obstacle avoidance direction selection processes in a plan view. i represents the block, ii represents the distance to the obstacle, iii represents the obstacle avoidance direction, iv represents the target direction, v represents the weight function, and vi represents the obstacle after superimposing the weight function. Represents the distance to, and vii represents the direction of travel.
(駆動装置の駆動)
上述したとおり、順路情報生成部17は、障害物回避方向を選択して、次の目標ブロックに向けた速度指令を生成する(S171)。駆動速度は、予め設定した速度を用いることが好ましい。順路情報生成部17にて決定された障害物回避方向に所定の駆動速度で駆動させる出力情報を、出力部18は駆動装置13に出力する。好ましい実施形態では、駆動装置13は少なくとも左右2つのモーターから構成される。左右のモーターの回転数を制御することにより、自律移動ロボット10を障害物回避方向へ移動させることができる(S181)。
(Drive of drive device)
As described above, the route information generation unit 17 selects the obstacle avoidance direction and generates a speed command for the next target block (S171). It is preferable to use a preset speed as the driving speed. The
(位置情報生成)
エンコーダ14は、左右のモーターのシャフトの回転運動から、走行距離と移動方向の情報を生成することができる。エンコーダ14により生成された当該走行距離と移動方向の情報に基づいて、位置情報生成部19は自律移動ロボット10の位置情報を生成し、ブロック地図における自己位置を推定する(S191)。
(Location information generation)
The
位置情報生成部19により生成された移動後の位置情報に基づいて、自律移動ロボット10が現時点で存在しているブロックが最終目標ブロックか否か判断する(S162)。
Based on the post-movement position information generated by the position
当該ループ処理のための重み関数の適用周期は、25msであることが好ましい。 The application period of the weight function for the loop processing is preferably 25 ms.
(コントローラのハードウェア構成)
図11は、本発明の一実施形態に係る自律移動ロボット10が備えている主要なハードウェア構成を模式的に示す概略図である。図11に示すように、自律移動ロボット10は、少なくとも1つのコントローラ130を有する。コントローラ130は、図1のコントローラ11に相当するハードウェア構成である。図1のコントローラ11は、当該コントローラ11の構成要素を機能的に表現したものであり、一つのコントローラ11のみを記載した。一方、ハードウェア構成としてのコントローラ130は、情報処理の対象によって複数のコントローラ130を備えていてもよい。
(Hardware configuration of controller)
FIG. 11 is a schematic view schematically showing a main hardware configuration included in the autonomous
コントローラ130は、少なくとも入力インタフェース133、出力インタフェース114、プロセッサ135、メモリ136を備える。
The
例えば、コントローラ130は、現在地点から障害物までの距離を方向毎に検知する測域センサ12に関する情報を処理する第1のコントローラ130aと、自律移動ロボットを移動させる駆動装置13に関する情報を処理する第2のコントローラ130bとのように複数のコントローラに制御を分担させる構成としてもよい。
For example, the
より具体的には、第1のコントローラ130aは、前記測域センサ12の出力信号を参照して当該自律移動ロボットを制御することができる。具体的には、第1のコントローラ130aは、受信部15、マップ情報入力部16、順路情報生成部17を制御することができる。例えば、方向毎の重みを与える重み関数であって、自動巡回の目標方向の重みが最大となる重み関数を用いて前記センサの出力信号を補正する処理と、補正後の出力信号に応じて当該自律移動ロボットの進行方向を決定する処理と、を実行することができる。
More specifically, the first controller 130a can control the autonomous mobile robot with reference to the output signal of the
第2のコントローラ130bは、決定した進行方向に当該自律移動ロボットを移動させるための制御信号を前記駆動装置13に供給する処理を実行することができる。具体的には、第2のコントローラ130bは、出力部18、位置情報生成部19を制御することができる。
The second controller 130b can execute a process of supplying the
入力インタフェース133から入力された情報の処理を実施するアルゴリズムを実行するプログラムは、メモリ136に格納される。当該メモリ136に格納されたプログラムをプロセッサ135にて実行することにより、入力された情報を処理することができる。当該処理された情報は出力情報として出力インタフェース114から出力される。出力インタフェース114から出力された情報により、駆動装置13を制御することができる。
The program that executes the algorithm that executes the processing of the information input from the
〔実施形態2〕
本発明の他の実施形態について、以下に説明する。なお、説明の便宜上、上記実施形態にて説明した部材と同じ機能を有する部材については、同じ符号を付記し、その説明を繰り返さない。
[Embodiment 2]
Other embodiments of the present invention will be described below. For convenience of explanation, the same reference numerals will be added to the members having the same functions as the members described in the above embodiment, and the description will not be repeated.
実施形態1では、一つのコントローラ11によって、測域センサ12および駆動装置13を制御する構成を示した。別の実施形態では、測域センサ12を制御する第1のコントローラ130aと、駆動装置13を制御する第2のコントローラ130bは異なるコントローラから構成することができる。第1のコントローラ130aにより生成された出力情報を第2のコントローラ130bが受信し、第2のコントローラ130bが当該出力情報に基づいて駆動装置13を制御することができる。
In the first embodiment, the configuration in which the
〔ソフトウェアによる実現例〕
自律移動ロボット10のコントローラ11は、集積回路(ICチップ)等に形成された論理回路(ハードウェア)によって実現してもよいし、ソフトウェアによって実現してもよい。
[Example of realization by software]
The
後者の場合、自律移動ロボット10は、各機能を実現するソフトウェアであるプログラムの命令を実行するコンピュータを備えている。このコンピュータは、例えば1つ以上のプロセッサを備えていると共に、上記プログラムを記憶したコンピュータ読み取り可能な記録媒体を備えている。そして、上記コンピュータにおいて、上記プロセッサが上記プログラムを上記記録媒体から読み取って実行することにより、本発明の目的が達成される。上記プロセッサとしては、例えばCPU(Central Processing Unit)を用いることができる。上記記録媒体としては、「一時的でない有形の媒体」、例えば、ROM(Read Only Memory)等の他、テープ、ディスク、カード、半導体メモリ、プログラマブルな論理回路などを用いることができる。また、上記プログラムを展開するRAM(Random Access Memory)などをさらに備えていてもよい。また、上記プログラムは、該プログラムを伝送可能な任意の伝送媒体(通信ネットワークや放送波等)を介して上記コンピュータに供給されてもよい。なお、本発明の一態様は、上記プログラムが電子的な伝送によって具現化された、搬送波に埋め込まれたデータ信号の形態でも実現され得る。
In the latter case, the autonomous
本発明は上述した各実施形態に限定されるものではなく、請求項に示した範囲で種々の変更が可能であり、異なる実施形態にそれぞれ開示された技術的手段を適宜組み合わせて得られる実施形態についても本発明の技術的範囲に含まれる。 The present invention is not limited to the above-described embodiments, and various modifications can be made within the scope of the claims, and the embodiments obtained by appropriately combining the technical means disclosed in the different embodiments. Is also included in the technical scope of the present invention.
10 自律移動ロボット
11 コントローラ
12 測域センサ
13 駆動装置
14 エンコーダ
15 受信部
16 マップ情報入力部
17 順路情報生成部
18 出力部
19 位置情報生成部
21a、21b ブロック
21d 最終ブロック
22d 中心点
114 出力インタフェース
130 コントローラ
130a 第1のコントローラ
130b 第2のコントローラ
133 入力インタフェース
135 プロセッサ
136 メモリ
10 Autonomous
Claims (6)
現在地点から障害物までの距離を方向毎に検知するセンサと、
前記センサの出力信号を参照して当該自律移動ロボットを制御するコントローラと、を備え、
前記コントローラは、
方向毎の重みを与える重み関数であって、自動巡回の目標方向の重みが最大となる重み関数を用いて前記センサの出力信号を補正する処理と、
補正後の出力信号に応じて当該自律移動ロボットの進行方向を決定する処理と、を実行する、
ことを特徴とする自律移動ロボット。 An autonomous mobile robot that automatically patrols the facility
A sensor that detects the distance from the current position to an obstacle in each direction,
A controller that controls the autonomous mobile robot by referring to the output signal of the sensor is provided.
The controller
A processing that corrects the output signal of the sensor by using a weighting function that gives a weight for each direction and maximizes the weight in the target direction of automatic patrol.
The process of determining the traveling direction of the autonomous mobile robot according to the corrected output signal is executed.
An autonomous mobile robot characterized by this.
前記コントローラは、決定した進行方向に当該自律移動ロボットを移動させるための制御信号を前記駆動装置に供給する、
ことを特徴とする請求項1に記載の自律移動ロボット。 Further equipped with a drive device for moving the autonomous mobile robot,
The controller supplies a control signal for moving the autonomous mobile robot in a determined traveling direction to the driving device.
The autonomous mobile robot according to claim 1, wherein the robot is characterized by the above.
前記コントローラは、前記特定の周期で前記各処理を実行する、
ことを特徴とする請求項1又は2に記載の自律移動ロボット。 The sensor uses a laser to detect the distance from the current position to an obstacle at a specific cycle.
The controller executes each of the processes in the specific cycle.
The autonomous mobile robot according to claim 1 or 2.
前記センサの出力信号を取得する少なくとも1つの入力インタフェースと、
予め定められたプログラムに従って前記各処理を実行する少なくとも1つのプロセッサと、
前記プログラムを格納した少なくとも1つのメモリと、を備えている、
ことを特徴とする請求項1〜3までの何れか1項に記載の自律移動ロボット。 The controller
With at least one input interface that acquires the output signal of the sensor,
At least one processor that executes each of the above processes according to a predetermined program, and
It comprises at least one memory that stores the program.
The autonomous mobile robot according to any one of claims 1 to 3.
センサを用いて現在地点から障害物までの距離を方向毎に検知する工程と、
前記センサの出力信号を参照して当該自律移動ロボットを制御する工程と、を含み、
前記制御する工程は、
方向毎の重みを与える重み関数であって、自動巡回の目標方向の重みが最大となる重み関数を用いて前記センサの出力信号を補正する処理と、
補正後の出力信号に応じて当該自律移動ロボットの進行方向を決定する処理と、を含む、
ことを特徴とする制御方法。 It is a control method that controls an autonomous mobile robot that automatically patrols the facility.
The process of detecting the distance from the current position to the obstacle in each direction using a sensor,
Including a step of controlling the autonomous mobile robot with reference to the output signal of the sensor.
The control step is
A processing that corrects the output signal of the sensor by using a weighting function that gives a weight for each direction and maximizes the weight in the target direction of automatic patrol.
Including a process of determining the traveling direction of the autonomous mobile robot according to the corrected output signal,
A control method characterized by that.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019029812A JP7120071B2 (en) | 2019-02-21 | 2019-02-21 | autonomous mobile robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019029812A JP7120071B2 (en) | 2019-02-21 | 2019-02-21 | autonomous mobile robot |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2020135560A true JP2020135560A (en) | 2020-08-31 |
JP7120071B2 JP7120071B2 (en) | 2022-08-17 |
Family
ID=72278710
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019029812A Active JP7120071B2 (en) | 2019-02-21 | 2019-02-21 | autonomous mobile robot |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP7120071B2 (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116540747A (en) * | 2023-07-06 | 2023-08-04 | 中国科学技术大学 | Mobile robot motion planning and obstacle avoidance decision method with priority of avoidance and stop |
JP7517251B2 (en) | 2021-06-03 | 2024-07-17 | 株式会社豊田自動織機 | Route Generation Device |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001344596A (en) * | 2000-05-31 | 2001-12-14 | Nippon Signal Co Ltd:The | Image processor and traveling object traveling controller using the same |
JP2010282443A (en) * | 2009-06-04 | 2010-12-16 | Panasonic Electric Works Co Ltd | Autonomous mobile device |
JP2011008313A (en) * | 2009-06-23 | 2011-01-13 | Yamaha Motor Co Ltd | Traveling direction control device and traveling object |
US20160188977A1 (en) * | 2014-12-24 | 2016-06-30 | Irobot Corporation | Mobile Security Robot |
CN108873915A (en) * | 2018-10-12 | 2018-11-23 | 湖南万为智能机器人技术有限公司 | Dynamic obstacle avoidance method and its omnidirectional's security robot |
-
2019
- 2019-02-21 JP JP2019029812A patent/JP7120071B2/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001344596A (en) * | 2000-05-31 | 2001-12-14 | Nippon Signal Co Ltd:The | Image processor and traveling object traveling controller using the same |
JP2010282443A (en) * | 2009-06-04 | 2010-12-16 | Panasonic Electric Works Co Ltd | Autonomous mobile device |
JP2011008313A (en) * | 2009-06-23 | 2011-01-13 | Yamaha Motor Co Ltd | Traveling direction control device and traveling object |
US20160188977A1 (en) * | 2014-12-24 | 2016-06-30 | Irobot Corporation | Mobile Security Robot |
CN108873915A (en) * | 2018-10-12 | 2018-11-23 | 湖南万为智能机器人技术有限公司 | Dynamic obstacle avoidance method and its omnidirectional's security robot |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7517251B2 (en) | 2021-06-03 | 2024-07-17 | 株式会社豊田自動織機 | Route Generation Device |
CN116540747A (en) * | 2023-07-06 | 2023-08-04 | 中国科学技术大学 | Mobile robot motion planning and obstacle avoidance decision method with priority of avoidance and stop |
CN116540747B (en) * | 2023-07-06 | 2023-10-20 | 中国科学技术大学 | Mobile robot motion planning and obstacle avoidance decision method with priority of avoidance and stop |
Also Published As
Publication number | Publication date |
---|---|
JP7120071B2 (en) | 2022-08-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2020506478A (en) | Angle correction method of mobile robot in work area and mobile robot | |
US20170157783A1 (en) | Method and system for controlling robot | |
US10948907B2 (en) | Self-driving mobile robots using human-robot interactions | |
CN111860295B (en) | Obstacle detection method, device and equipment based on unmanned vehicle and storage medium | |
CN111949027B (en) | Self-adaptive robot navigation method and device | |
CN111474930B (en) | Tracking control method, device, equipment and medium based on visual positioning | |
WO2020143576A1 (en) | Method and apparatus for adjusting main detection direction of airborne radar, and unmanned aerial vehicle | |
JP2020135560A (en) | Autonomous mobile robot | |
US20080310682A1 (en) | System and Method for Real-Time Calculating Location | |
JP6895911B2 (en) | Object tracking device, object tracking method and computer program for object tracking | |
US11782447B2 (en) | Autonomous work machine, method of controlling the same, and storage medium | |
US20190286159A1 (en) | Position estimation system, position detection method, and program | |
US20240231377A1 (en) | Robot control method, robot, and storage medium | |
JP2022035904A (en) | Method and system for controlling movement of robot and non-transient computer readable recording medium | |
CN113311844B (en) | Servo control method and device, computer equipment and storage medium | |
US8014900B2 (en) | System and method for detecting traveling state | |
JP7147624B2 (en) | autonomous mobile robot | |
Bertrand et al. | Embedded event-based visual odometry | |
JP2009176031A (en) | Autonomous mobile body, autonomous mobile body control system and self-position estimation method for autonomous mobile body | |
CN109917413B (en) | Accurate navigation positioning method of intelligent transfer bed | |
CN115373406B (en) | Obstacle crossing method and system for crawling robot | |
CN111759230A (en) | Walking control method and device for mobile robot, floor washing machine and storage medium | |
JP7188232B2 (en) | autonomous mobile robot | |
JP2020135561A (en) | Autonomous mobile robot | |
Yu et al. | Indoor Localization Based on Fusion of AprilTag and Adaptive Monte Carlo |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20210513 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20220317 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220329 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20220526 |
|
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: 20220705 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20220718 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7120071 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |