JP7649955B2 - Map generation method, program, map generation system, and mobile robot equipped with the same - Google Patents
Map generation method, program, map generation system, and mobile robot equipped with the same Download PDFInfo
- Publication number
- JP7649955B2 JP7649955B2 JP2022023164A JP2022023164A JP7649955B2 JP 7649955 B2 JP7649955 B2 JP 7649955B2 JP 2022023164 A JP2022023164 A JP 2022023164A JP 2022023164 A JP2022023164 A JP 2022023164A JP 7649955 B2 JP7649955 B2 JP 7649955B2
- Authority
- JP
- Japan
- Prior art keywords
- map
- partial
- mobile robot
- unit
- area
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
本開示は、地図生成方法、プログラム、地図生成システム、及びそれを備える移動ロボットに関する。より詳細には、本開示は、移動ロボットが移動する移動領域の全体地図を生成する地図生成方法、プログラム、地図生成システム、及びそれを備える移動ロボットに関する。 The present disclosure relates to a map generation method, a program, a map generation system, and a mobile robot equipped with the same. More specifically, the present disclosure relates to a map generation method, a program, a map generation system, and a mobile robot equipped with the same, which generate an overall map of a moving area in which a mobile robot moves.
特許文献1は、ロボットが未知の環境である部屋の内部を探索走行して、部屋の地図を作成するシステムを開示する。探索走行中、ロボットは環境内を自律走行しながら、環境内に存在する物体(例えば壁等)を検出する処理を実行する。ロボットは、環境内で物体を検出すると、検出した物体を地図データとして保存する。
上記のシステムで作成される地図を利用してロボットの移動を制御する場合、例えば、地図上に設定した2つの直交軸(例えばX軸及びY軸)で表される二次元直交座標系の座標でロボットの位置を指定する。ここで、地図上のX軸又はY軸が部屋の壁と平行になっていない場合、壁に沿ってロボットを移動させるためには、X軸及びY軸に対してそれぞれ斜めに交差する方向にロボットが移動するように、ロボットの移動ルートを設定する必要がある。そのため、ロボット(移動ロボット)が移動する移動ルートの設計が難しくなるという問題がある。 When controlling the movement of a robot using a map created by the above system, the position of the robot is specified, for example, by the coordinates of a two-dimensional Cartesian coordinate system represented by two orthogonal axes (e.g., the X-axis and the Y-axis) set on the map. Here, if the X-axis or the Y-axis on the map is not parallel to the wall of the room, in order to move the robot along the wall, it is necessary to set the movement route of the robot so that the robot moves in a direction that intersects diagonally with the X-axis and the Y-axis, respectively. This poses the problem that it becomes difficult to design the movement route for the robot (mobile robot).
本開示の目的は、移動ロボットが移動する移動ルートの設計が容易な地図を生成できる地図生成方法、プログラム、地図生成システム、及びそれを備える移動ロボットを提供することにある。 The objective of the present disclosure is to provide a map generation method, program, and map generation system that can generate a map that makes it easy to design a route for a mobile robot to travel, and a mobile robot equipped with the same.
本開示の一態様の地図生成方法は、移動ロボットが移動する移動領域の全体地図を生成する地図生成方法である。前記地図生成方法は、部分地図生成工程と、地図合成工程と、選択工程と、補正工程と、を含む。前記部分地図生成工程では、前記移動領域内の複数の部分領域にそれぞれ対応する複数の部分地図を生成する。前記地図合成工程では、前記複数の部分地図を合成して前記全体地図を生成する。前記選択工程では、前記複数の部分地図から、方向を特定するための方向要素が存在する代表地図を選択する。前記補正工程では、前記代表地図に存在する前記方向要素に基づいて前記地図合成工程で生成された前記全体地図の向きを補正する。 A map generation method according to one aspect of the present disclosure is a map generation method for generating an overall map of a moving area in which a mobile robot moves. The map generation method includes a partial map generation process, a map synthesis process, a selection process, and a correction process. In the partial map generation process, a plurality of partial maps corresponding to a plurality of partial areas in the moving area are generated. In the map synthesis process, the plurality of partial maps are synthesized to generate the overall map. In the selection process, a representative map having a direction element for identifying a direction is selected from the plurality of partial maps. In the correction process, the orientation of the overall map generated in the map synthesis process is corrected based on the direction element present in the representative map.
本開示の一態様のプログラムは、コンピュータシステムに、前記地図生成方法を、実行させるためのプログラムである。 A program according to one aspect of the present disclosure is a program for causing a computer system to execute the map generation method.
本開示の一態様の地図生成システムは、移動ロボットが移動する移動領域の全体地図を生成する。地図生成システムは、部分地図生成部と、地図合成部と、選択部と、補正部と、を含む。前記部分地図生成部は、前記移動領域内の複数の部分領域にそれぞれ対応する複数の部分地図を生成する。前記地図合成部は、前記複数の部分地図を合成して前記全体地図を生成する。前記選択部は、前記複数の部分地図から、方向を特定するための方向要素が存在する代表地図を選択する。前記補正部は、前記代表地図に存在する前記方向要素に基づいて前記地図合成部で生成された前記全体地図の向きを補正する。 A map generation system according to one aspect of the present disclosure generates an overall map of a moving area in which a mobile robot moves. The map generation system includes a partial map generation unit, a map synthesis unit, a selection unit, and a correction unit. The partial map generation unit generates a plurality of partial maps each corresponding to a plurality of partial areas in the moving area. The map synthesis unit synthesizes the plurality of partial maps to generate the overall map. The selection unit selects, from the plurality of partial maps, a representative map having a direction element for identifying a direction. The correction unit corrects the orientation of the overall map generated by the map synthesis unit based on the direction element present in the representative map.
本開示の一態様の移動ロボットは、移動体と、前記移動体の移動を制御する移動制御部と、前記移動体の周囲に存在する対象物を検出する測域センサと、前記地図生成システム と、を備える。 A mobile robot according to one embodiment of the present disclosure includes a mobile body, a movement control unit that controls the movement of the mobile body, a range sensor that detects objects present around the mobile body, and the map generation system.
本開示によれば、移動ロボットが移動する移動ルートの設計が容易な地図を生成することができる。 According to the present disclosure, it is possible to generate a map that makes it easy to design a route for a mobile robot to travel.
(実施形態)
(1)概要
本実施形態に係る地図生成方法、そのプログラム、地図生成方法を実行する地図生成システム、及びそれを備える移動ロボットについて図1~図20に基づいて説明する。以下の実施形態において説明する各図は、模式的な図であり、各図中の各構成要素の大きさ及び厚さそれぞれの比が、必ずしも実際の寸法比を反映しているとは限らない。
(Embodiment)
(1) Overview A map generation method according to this embodiment, a program therefor, a map generation system that executes the map generation method, and a mobile robot equipped with the same will be described with reference to Figures 1 to 20. Each figure described in the following embodiment is a schematic diagram, and the ratio of sizes and thicknesses of each component in each figure does not necessarily reflect the actual dimensional ratio.
図1は、地図生成システム7を備えた移動ロボット3を含むロボットシステム1の概略的なシステム構成図である。ロボットシステム1は、所定の移動領域A1(図2参照)内で移動する移動ロボット3を制御するためのシステムである。ロボットシステム1は、図1に示すように、移動ロボット3と、移動ロボット3を制御する制御システム2と、を含む。
Figure 1 is a schematic system configuration diagram of a
地図生成システム7は、移動ロボット3が移動する移動領域A1の全体地図MP1(図12参照)を生成する。地図生成システム7は、部分地図生成部71と、地図合成部72と、選択部73と、補正部74と、を含む。
The
部分地図生成部71は、移動領域A1内の複数の部分領域にそれぞれ対応する複数の部分地図MP21~MP28(図3~図10参照)を生成する。
The partial
地図合成部72は、複数の部分地図MP21~MP28を合成して全体地図MP1(図12参照)を生成する。
The
選択部73は、複数の部分地図MP21~MP28から、方向を特定するための方向要素が存在する代表地図を選択する。
The
補正部74は、代表地図に存在する方向要素に基づいて地図合成部72で生成された全体地図MP1の向きを補正する。
The
本開示でいう「移動ロボット」は、無人搬送車(AGV:Automated Guided Vehicle)、及びドローン等を含む。本開示でいう「移動ロボット」は、例えば、車輪型、クローラ型又は脚型(歩行型を含む)のロボットである。移動ロボット3は、地図生成システム7によって生成された全体地図MP1のデータを地図生成システム7から取得した後は、例えば、制御システム2から受信した制御指示に基づいて、移動経路に沿って自律的に移動する。つまり、制御システム2は、移動ロボット3に対して制御指示を出力することで、移動ロボット3の移動を間接的に制御している。なお、移動ロボット3は、所定の移動領域A1内を移動するだけでなく、例えば、搬送、ピッキング、溶接、実装、陳列、接客、警備、組立及び検査等の様々な作業を実行する機能を有していてもよい。以下の実施形態では、移動ロボット3が、例えばショッピングモールのような施設内の移動領域A1を移動することによって、対象物を搬送する作業を行うAGVである場合を例に説明する。なお、地図生成システム7によって移動領域A1の全体地図MP1が生成される前の状態では、移動ロボット3は、全体地図MP1のデータを有していない。そのため、移動ロボット3に制御指示を入力するためのコントローラを接続し、ユーザがコントローラを操作して一連の動作を指示する1つ又は複数の制御指示(例えば複数回の直進移動、或いは、複数回の旋回移動を指示する制御指示等)を手動で入力することによって、移動ロボット3に1つ又は複数の制御指示を入力する。移動ロボット3は、コントローラから入力された1つ又は複数の制御指示に基づいて移動領域A1内で一連の動作(一連の直進動作又は一連の旋回動作)を行い、部分地図生成部71は、移動ロボット3が一連の動作を行った領域を含む部分領域の部分地図を生成するのである。なお、コントローラと移動ロボット3との間での通信は有線通信でもよいし、無線通信でもよい。
The "mobile robot" in this disclosure includes an automated guided vehicle (AGV) and a drone. The "mobile robot" in this disclosure is, for example, a wheeled, crawler, or legged (including walking) robot. After acquiring data of the overall map MP1 generated by the
本開示でいう「移動領域」は、1台以上の移動ロボット3が配備された空間であって、移動ロボット3は、制御システム2からの制御指示を受けて、この移動領域A1内を移動する。移動領域A1は、一例として、店舗(例えばショッピングモール等)、倉庫、工場、建設現場、物流センタ、事務所、公園、住宅、学校、病院、駅、空港又は駐車場等である。さらに、例えば、船舶、電車又は飛行機の内部等、乗り物の内部に移動ロボット3が配備されている場合、乗り物の内部が移動領域A1となる。以下の実施形態では、移動領域A1が、ショッピングモールのような店舗である場合を例に説明を行う。
The "mobile area" in this disclosure is a space in which one or more
全体地図MP1は、移動領域A1の全体を表す地図である。なお、移動ロボット3が施設の内部を移動する場合、移動領域A1は施設の内部の全体でもよいし、施設の内部において移動ロボット3が移動する領域のみでもよい。複数の部分地図MP21~MP28は、移動領域A1内の複数の部分領域にそれぞれ対応する地図である。複数の部分地図MP21~MP28がそれぞれ表す複数の部分領域は部分的に重なっていてもよいし、全く重なっていなくてもよい。地図合成部72は複数の部分地図を合成することによって全体地図MP1を生成する。例えば、地図合成部72は、移動領域A1の全体を表す地図領域に、複数の部分地図MP21~MP28を重ねて配置することで、複数の部分地図MP21~MP28を合成した全体地図MP1を生成する。なお、全体地図MP1の大きさは、複数の部分地図MP21~MP28を合成してできる地図の大きさに合わせて設定されるのが好ましい。
The overall map MP1 is a map that represents the entire moving area A1. When the
「方向要素」とは、代表地図に表示される要素のうち、代表地図の方向を特定可能な要素である。方向要素は、代表地図の方向を特定できるように、ある程度の長さを有する直線部分を有する要素であることが好ましい。方向要素は、例えば移動領域A1に存在する、ある程度の長さを有する壁又はキャビネット等を表す直線要素を含み得る。言い換えると方向要素は、例えば代表地図に存在する長さが第1閾値以上の直線要素を含む。第1閾値は、例えば移動ロボット3の全長の数倍程度の長さであることが好ましく、第1閾値の長さは移動ロボット3の大きさ、移動領域A1の広さ等に応じて適宜変更が可能である。また、方向要素は、例えば、移動領域A1に存在する直線的な通路を表す直線移動領域を含み得る。言い換えると、方向要素は、移動ロボット3が直線移動可能な領域であって、長さが第2閾値以上である直線移動領域を含み得る。直線移動領域の幅は、移動ロボット3の幅以上であればよく、移動ロボット3が対象物を搬送する場合、移動ロボット3及び対象物の最大幅以上であればよい。また、第2閾値は、例えば移動ロボット3の全長の数倍程度の長さであることが好ましく、第2閾値の長さは移動ロボット3の大きさ、移動領域A1の広さ等に応じて適宜変更が可能である。
A "directional element" is an element that can identify the direction of the representative map among the elements displayed on the representative map. The directional element is preferably an element that has a straight line portion with a certain length so that the direction of the representative map can be identified. The directional element may include, for example, a straight line element that represents a wall or cabinet with a certain length that exists in the movement area A1. In other words, the directional element may include, for example, a straight line element that exists in the representative map and has a length equal to or greater than a first threshold. The first threshold is preferably, for example, a length several times the total length of the
補正部74は、代表地図に存在する方向要素に基づいて全体地図MP1の向きを補正しており、例えば全体地図MP1に設定される2つの直交軸の一方が、方向要素の向きと平行になるように全体地図MP1の向きを補正できる。これにより、方向要素に沿って移動ロボット3を移動させる場合、全体地図MP1に設定される直交軸に沿って移動ロボット3を移動させればよい。したがって、本実施形態の地図生成システム7では、移動ロボット3が移動する移動ルートの設計が容易な全体地図MP1を生成することができる。
The
また、本実施形態の移動ロボット3は、上述のように、地図生成システム7を備えている。また、移動ロボット3は、移動体30(図2参照)と、移動制御部37と、測域センサ33と、を備えている。
As described above, the
移動制御部37は、移動体30の移動を制御する。
The
測域センサ33は、移動体30の周囲に存在する対象物(例えば移動領域A1である部屋の壁等)を検出する。
The
移動ロボット3は地図生成システム7を備えているので、移動ロボット3が備える地図生成システム7によって、移動ロボット3が移動する移動ルートの設計が容易な全体地図MP1を生成することができる。
The
(2)詳細
以下、本実施形態に係る地図生成方法を実行する地図生成システム7、及びそれを備える移動ロボット3、並びに、移動ロボット3を含むロボットシステム1について図1~図20に基づいて説明する。
(2) Details Below, a
上述のように、ロボットシステム1は、移動ロボット3と、移動ロボット3の移動を制御する制御システム2と、を備える。また、ロボットシステム1は、移動領域A1において移動ロボット3が移動可能な経路を設定するためのアプリケーションソフトがインストールされた作成支援システム4を更に備える。また、ロボットシステム1は、移動ロボット3の動作状態をモニタしたり、移動ロボット3に対する移動の指示を制御システム2に入力したりするためのアプリケーションソフトがインストールされた操作用端末5,6を更に備える。操作用端末5は、例えば、ノート型のパーソナルコンピュータであり、操作用端末6は、例えば、タブレット型のコンピュータである。なお、移動領域A1には、移動ロボット3と制御システム2との間の通信を中継する1又は複数の無線アクセスポイントAP1が設置されている。
As described above, the
(2.1)移動ロボット
移動ロボット3は、上述のように、移動体30と、移動制御部37と、測域センサ33と、地図生成システム7と、を備えている。また、移動ロボット3は、移動制御部37及び地図生成システム7の機能を有する第2制御部36と、第2通信部31と、第2記憶部32と、位置推定部34と、走行システム35と、を備える。
(2.1) Mobile Robot As described above, the
移動ロボット3は、例えば、移動領域A1となる施設の床面を車輪で走行するロボットである。走行システム35は、複数の駆動輪の回転方向及び回転速度を制御することによって、移動領域A1となる施設の床面の上を所望の方向に所望の速度で走行させる。
The
第2通信部31は、制御システム2と無線通信を行う。具体的には、第2通信部31は、無線アクセスポイントAP1及びネットワークNT1を介して、制御システム2等と通信する。第2通信部31と無線アクセスポイントAP1との間の通信方式としては、無線通信又は有線通信の適宜の通信方式が採用される。
The
第2記憶部32は、RAM(Random Access Memory)及びROM(Read Only Memory)の少なくとも一方のメモリを有する。第2記憶部32は、地図生成システム7が作成した複数の部分地図及び移動領域A1の全体の全体地図MP1を含む地図情報を少なくとも記憶する。また、第2記憶部32は、移動ロボット3に割り当てられた識別情報等を更に記憶する。
The
測域センサ33は、測域センサ33を中心とする測定範囲内に存在する対象物を検知する。測域センサ33は、例えば、LiDAR(Light Detection and Ranging)のようなセンサを含む。LiDARは、光(レーザ光)を周囲に照射して、移動ロボット3の周囲に存在する物体での反射光に基づいて物体までの距離及び物体の方向を測定する。なお、測域センサ33は、LiDARに限定されず、レーダ(RADAR:Radio Detection and Ranging)、ソナーセンサ、及びイメージセンサ(カメラ)等のセンサを含んでもよい。レーダは、マイクロ波等の電磁波(電波)を用いて、移動ロボット3の周囲に存在する物体での反射波に基づいて物体までの距離及び物体の方向を測定するセンサである。
The
位置推定部34は、地図生成システム7によって全体地図MP1が生成された状態では、第2記憶部32が保持する全体地図MP1に基づいて、移動領域A1における移動ロボット3の位置(現在位置)を推定する。位置推定部34は、例えば、測域センサ33による周囲の物体(例えば移動領域A1に存在する壁、棚、設備等)の検出情報と、全体地図MP1とに基づいて、移動領域A1における現在位置の位置座標を推定する。なお、位置推定部34は、全体地図MP1が生成されておらず、部分地図生成部71が部分地図を生成している状態では、生成途中の部分地図に基づいて、移動ロボット3の位置(現在位置)を推定する。
When the overall map MP1 has been generated by the
なお、位置推定部34は、電波ビーコンを用いたLPS(Local Positioning System)を利用して、移動領域A1における移動ロボット3の現在位置の位置座標を推定してもよい。位置推定部34は、例えば、移動領域A1の上方(施設の天井等)に設置された複数の送信機からそれぞれ送信されるビーコン信号を、移動ロボット3に設けられた受信機で受信したときの電波強度と、各送信機の設置位置とに基づいて現在位置を推定してもよい。また、位置推定部34は、例えば、GPS(Global Positioning System)等の全球衛星測位システム(GNSS:Global Navigation Satellite System)を利用して、移動ロボット3の現在位置の位置座標を推定してもよい。
The
第2制御部36は、移動ロボット3の全体的な動作を制御する。第2制御部36は、例えば、1以上のプロセッサ及びメモリを有するコンピュータシステムを主構成とする。コンピュータシステムのメモリに記録されたプログラムを、コンピュータシステムのプロセッサが実行することにより、第2制御部36の機能、例えば移動制御部37及び地図生成システム7の機能が実現される。プログラムは、メモリに記録されていてもよいし、インターネット等の電気通信回線を通して提供されてもよく、メモリカード等の非一時的記録媒体に記録されて提供されてもよい。
The
第2制御部36は、所定の更新周期(例えば0.1秒)が経過するごとに、位置推定部34に現在位置を推定する動作を行わせ、移動ロボット3の現在位置の推定結果を更新する。そして、第2制御部36は、現在位置の推定結果を移動ロボット3の識別情報とともに第2通信部31から移動ロボット3に送信させる。
The
移動制御部37は、地図生成システム7によって生成された全体地図MP1のデータを地図生成システム7から取得した状態では、例えば、第2通信部31が受信した制御システム2からの制御指示に基づいて移動ロボット3を移動させる。制御システム2からの制御指示には、移動ロボット3を第1地点から第2地点まで移動させる移動経路に関する情報が含まれており、例えば第1地点に対応するノード、第2地点に対応するノードの座標等が含まれている。なお、制御指示には、第1地点から第2地点に到達するまでの間に移動ロボット3が通過する1又は複数の第3地点に対応するノードの座標等が含まれていてもよい。
When the
移動制御部37は、制御システム2からの制御指示を受信すると、位置推定部34が推定した位置(現在位置)と、移動領域A1の地図情報と、制御指示とに基づいて走行システム35を制御し、移動ロボット3を移動経路に沿って移動させる。
When the
地図生成システム7は、上述のように、部分地図生成部71と、地図合成部72と、選択部73と、補正部74と、を備えている。地図生成システム7は、ノイズ除去部75を更に備えている。
As described above, the
地図生成システム7は、移動領域A1の全体を表す全体地図MP1を生成するためのシステムである。全体地図MP1を生成する場合、移動ロボット3に移動領域A1内を巡回させ、巡回中に測域センサ33が検知した物体の情報に基づいて地図生成システム7が移動領域A1の全体地図MP1を生成する。
The
ここで、全体地図MP1を生成するために移動ロボット3が移動領域A1内を巡回する巡回ルートは、移動ロボット3が一連の動作をそれぞれ行う複数の区間に分割される。一連の動作とは、移動ロボット3が一方向に直進する一連の直進動作と、移動ロボット3が一方向に旋回する一連の旋回動作とを含む。したがって、複数の区間は、一連の直進動作を行う1又は複数の直進区間と、一連の旋回動作を行う1又は複数の旋回区間とを含む。ここにおいて、「一連の直進動作」は、移動ロボット3が真っ直ぐに前進する動作に限定されず、移動ロボット3が直進する動作と、所定の許容角度以下で旋回する動作と、を含んでもよい。すなわち、一連の直進動作は、移動ロボット3が直進する方向と直交する方向において所定の許容範囲内で、横方向に移動しながら前進するような動作を含んでもよい。また、「一連の旋回動作」は、直進動作を含まずに、その場で旋回(信地旋回)する動作を含む。「一連の旋回動作」は、1回の旋回動作、又は、連続的に行う複数回の旋回動作を含み、合計の旋回角度が許容角度を超えるような旋回動作である。
Here, the patrol route that the
図2は全体地図を作成するために移動ロボット3が巡回する巡回ルートの一例を複数の矢印で示している。図2に示す巡回ルートは、例えば7つの直進区間(第1~第7直進区間M1~M7)と、例えば6つの旋回区間(第1~第6旋回区間R1~R6)とを含んでいる。
Figure 2 shows an example of a patrol route that the
部分地図生成部71は、移動領域A1内の複数の部分領域にそれぞれ対応する複数の部分地図MP21~MP28(図3~図10参照)を生成する。部分地図生成部71は、複数の部分領域のうち作成対象の部分領域を移動ロボット3が移動する間に、移動ロボット3が備える測域センサ33が測定範囲内に存在する対象物の位置を測定することによって、作成対象の部分領域に対応する部分地図を生成する。
The partial
本実施形態では、移動ロボット3が、巡回ルートを巡回する間に、一連の直進動作又は一連の旋回動作を行うごとに、測域センサ33によって測定された対象物の位置に基づいて部分地図を作成する。より具体的には、移動ロボット3は、例えばユーザがコントローラを用いて手動で入力した制御指示に基づいて一連の動作(一連の直進動作、又は、一連の旋回動作)を実行する。移動ロボット3が制御指示に基づく一連の動作を終了すると、ユーザは移動ロボット3に対して次の制御指示を手動で入力し、移動ロボット3に制御指示に基づく一連の動作を実行させる。このように、移動ロボット3に対してユーザが複数の制御指示を順番に入力することで、移動ロボット3が複数の制御指示に基づく複数の動作を順番に実行し、巡回ルートにしたがって移動する。
In this embodiment, each time the
ここで、部分地図生成部71は、移動ロボット3が制御指示に基づく一連の動作(例えば、一連の直進動作、又は、一連の旋回動作)を行うごとに、一連の動作を行う間に移動した部分領域の部分地図を生成する。言い換えると、移動ロボット3に入力する制御指示、又は、移動ロボット3が実行する制御指示が切り替わるタイミングで、部分地図生成部71は、移動ロボット3が制御指示に基づく一連の動作を行う間に移動した部分領域の部分地図を生成するのである。したがって、図2に示すような巡回ルートを移動ロボット3が移動(直進移動又は旋回移動)する場合、移動ロボット3が第1~第7直進区間M1~M7及び第1~第6旋回区間R1~R6をそれぞれ移動するごとに、部分地図生成部71が部分地図を生成する。ここで、部分地図のサイズは、移動ロボット3が移動(直進移動又は旋回移動)する間に測定が可能な領域の大きさとなる。したがって、複数の区間(第1~第7直進区間M1~M7、第1~第6旋回区間R1~R6)を移動ロボット3が移動する間にそれぞれ作成される複数の部分地図のサイズは、各区間での移動量(移動距離又は移動角度)に応じたサイズとなる。また、複数の区間の各々を移動ロボット3が移動することによって生成される部分地図が表す領域が部分領域となる。なお、複数の区間のうち、隣接する2つの区間に対応する2つの部分領域は部分的に重なっているが、別々の領域であってもよい。
Here, the partial
地図合成部72は、複数の部分地図を合成して全体地図MP1を生成する。具体的には、地図合成部72は、巡回ルートに含まれる複数の区間を移動ロボット3が走行して生成した複数の部分地図(例えば部分地図MP21~MP28)を、移動領域A1の全体を表す地図領域に重ね合わせることで全体地図MP1を生成する。図11では、説明の便宜上、複数の部分地図MP21~MP28の枠をそれぞれ一点鎖線で表示してあるが、地図合成部72によって生成される全体地図MP1は、図12に示すように複数の部分地図MP21~MP28の枠がない地図となる。なお、図11及び図12には、全体地図MP1内に設定される2つの直交軸(X軸及びY軸)を表す矢印を表示しているが、X軸及びY軸を表す矢印は説明の便宜上表示しているに過ぎず、実際には存在しない。
The
選択部73は、部分地図生成部71が生成した複数の部分地図MP21~MP28の中から、方向を特定するための方向要素(例えば直線要素、直線移動領域等)が存在する代表地図を選択する。例えば部屋の内部を表す地図の方向は、部屋の壁、部屋内に存在するキャビネット、又は、部屋内で移動ロボット3が直進可能な通路の方向によって特定することができる。したがって、選択部73は、複数の部分地図MP21~MP28から、壁又はキャビネット等の直線要素、及び、移動ロボット3が直進可能な通路等を表す直線移動領域の少なくとも一方を含む方向要素が存在する部分地図を、代表地図として選択することが好ましい。
The
本発明者らは、移動ロボット3が直進移動する距離が長い直進区間の部分地図には、直進移動する距離が短い直進区間の部分地図に比べて、直線要素、又は、直線移動領域等の方向要素が存在する可能性が高いと推定した。そこで、選択部73は、部分地図を生成する部分地図生成工程において、地図生成のために移動ロボットが直線移動した移動距離が最も長い部分領域の部分地図を代表地図として選択する。なお、選択部73が選択した代表地図に方向要素が検出できなかった場合、選択部73は、直線移動する距離が次に長い直進区間を移動ロボット3が移動する間に生成した部分地図を代表地図として選択すればよい。補正部74は、選択部73が選択した代表地図から方向要素を検出して全体地図MP1の方向を補正しており、複数の部分地図MP21~MP28の全てについて方向要素を検出する処理を行う場合に比べて、方向要素を検出するための処理を低減できる。
The inventors have estimated that a partial map of a straight section where the
また、選択部73は、直線移動する移動距離が第3閾値以上である2以上の直進区間を移動ロボット3が移動する間に生成した2以上の部分地図を選択し、補正部74が、2以上の部分地図から方向要素を検出して補正処理を行ってもよい。言い換えると、選択部73は、部分地図生成工程において、地図生成のために移動ロボット3が直線移動した移動距離が第3閾値以上である2以上の部分地図を代表地図として順番に選択すればよい。そして、補正部74は、代表地図として選択された2以上の部分地図に存在する方向要素に基づいて地図合成部72で生成された全体地図MP1の向きを補正すればよい。ここで、第3閾値は、所定の長さの距離(絶対値)として設定されてもよいし、直進移動する距離が最も長い区間での直進移動距離に対する相対値(例えば90%の値)として設定されてもよい。選択部73は、2以上の部分地図の中から所定の順番にしたがって1つの部分地図を代表地図として選択する。代表地図を選択する順番は、例えば直線移動する移動距離が長い順番である。補正部74が、代表地図として選択された部分地図から方向要素を検出すると、選択部73は代表地図を切り替える処理を終了し、補正部74は、方向要素に基づいて全体地図MP1の向きを補正する。このように、移動距離が第3閾値以上である2以上の部分地図から方向要素を検出することで、複数の部分地図の全てから方向要素を検出する処理を行う場合に比べて、方向要素を検出する処理を低減できる。
The
補正部74は、選択部73が選択した代表地図に存在する方向要素に基づいて、地図合成部72で生成された全体地図MP1の向きを補正する。全体地図MP1には、移動ロボット3の位置を特定するために、2つの直交軸(X軸及びY軸)で作られる二次元直交座標系が設定されている。全体地図MP1は例えば横長の矩形の地図であり、全体地図MP1の長手方向をX軸方向とし、全体地図MP1の短手方向をY軸方向としている。補正部74は、方向要素の向きが、X軸方向又はY軸方向と平行になるように、全体地図MP1の向きを補正する。換言すると、補正部74は、方向要素の向きが全体地図MP1のX軸方向又はY軸方向と平行になるように、全体地図MP1に表示される全ての要素の向きを補正する。
The
なお、補正部74は、代表地図に存在する方向要素に基づいて、合成前の複数の部分地図MP21~MP28の向きを補正してもよい。つまり、補正部74は、向きを補正した後の複数の部分地図MP21~MP28を地図合成部72で合成させることによって、向きが補正された全体地図MP1を生成してもよい。ここで、複数の部分地図MP21~MP28の各々で方向要素を検出可能であれば、補正部74は、複数の部分地図MP21~MP28の各々で検出された方向要素に基づいて、複数の部分地図MP21~MP28の各々の向きを補正してもよい。そして、地図合成部72は、補正部74によって向きが補正された後の複数の部分地図MP21~MP28を合成して全体地図MP1を生成すればよい。
The
ノイズ除去部75は、複数の部分地図MP21~MP28及び全体地図MP1の少なくとも一方において、部分地図生成工程で地図生成のために移動ロボット3が移動した移動ルート上に位置する物体を除去するノイズ除去工程を実行する。部分地図MP21~MP28を生成する場合に、移動ロボット3の移動ルート(上記の巡回ルート)上に移動ロボット3が通る前又は移動ロボット3が通った後に人或いは物等が存在すると、移動ルート上に物体が存在するような部分地図が生成される可能性がある。移動ルート上に物体が存在すると、この移動ルートを移動ロボット3が移動する経路として利用できなくなる。しかしながら、移動ルートは、部分地図MP21~MP28を生成するために移動ロボット3が移動したルートであるから、移動ロボット3が問題無く通行可能なルートであると考えられる。そこで、ノイズ除去部75は、複数の部分地図MP21~MP28において、移動ルート上に位置する物体を地図上で除去しており、移動ロボット3の移動の障害となる物体が移動ルート上に存在しないような部分地図MP21~MP28を生成できる。なお、ノイズ除去部75は、地図合成部72が合成した後の全体地図MP1において、移動ルート上に位置する物体を地図上で除去してもよく、移動ロボット3の移動の障害となる物体が移動ルート上に存在しないような全体地図MP1を生成できる。
The
(2.2)作成支援システム
作成支援システム4は、例えば、コンピュータシステムにより実現されている。作成支援システム4は、移動ロボット3が作成した全体地図MP1のデータを、例えば制御システム2を介して取得する。作成支援システム4は、移動領域A1内で移動ロボット3が移動可能な経路を全体地図MP1上に設定した地図情報を作成する作業を支援する。作成支援システム4が作成した地図情報は、制御システム2及び移動ロボット3によって保持される。制御システム2は、この地図情報に基づいて移動ロボット3の移動を制御する。なお、作成支援システム4は施設の内部にあってもよいし、施設の外部にあってもよい。
(2.2) Creation Support System The
作成支援システム4は、第3通信部41と、第3記憶部42と、UI部43と、経路作成部44と、を備える。
The
第3通信部41は、ネットワークNT1を介して、制御システム2等と通信する。第3通信部41と制御システム2との間の通信方式としては、無線通信又は有線通信の適宜の通信方式が採用される。
The
第3記憶部42は、RAM及びROMの少なくとも一方のメモリを有する。第3記憶部42は、移動ロボット3が作成した全体地図MP1、及び、経路作成部44が作成した地図情報等を記憶する。
The
UI部43は、ユーザの操作を受け付ける入力部(例えばキーボード、マウス、ポインティングデバイス、タッチパネル等)と、地図情報を作成するための画面等を表示するディスプレイ装置と、を有する。UI部43は、ユーザが入力部を用いて入力した情報を経路作成部44に出力する。
The
経路作成部44は、移動ロボット3が作成した全体地図MP1と、UI部43から入力される移動ロボット3が移動可能な経路の情報とに基づいて、地図情報を作成する。ユーザは、UI部43を用いて、全体地図MP1上で移動ロボット3が移動可能な複数のノードと、任意の2つのノードの間で移動ロボット3が移動可能な区間を示す1又は複数のリンクと、を設定する。ここにおいて、移動ロボット3が移動可能な経路は、複数のノードと、任意の2つのノードの間をつなぐ1又は複数のリンクとで構成される。経路作成部44は、UI部43からノード及びリンクの設定情報が入力されると、全体地図MP1に、移動ロボット3が移動可能な経路に関する設定情報を付加した地図情報を作成する。
The route creation unit 44 creates map information based on the overall map MP1 created by the
経路作成部44は、地図情報の作成作業が終了すると、作成した地図情報のデータを第3記憶部42に記憶させ、第3通信部41から制御システム2に送信させる。制御システム2は、作成支援システム4から受信した地図情報のデータを第1記憶部22に記憶する。
When the route creation unit 44 finishes creating the map information, it stores the created map information data in the
(2.3)制御システム
制御システム2は、例えば、コンピュータシステムにより実現されている。制御システム2は、移動ロボット3を移動させる指示、及び、移動ロボット3に対象物を搬送させる指示の少なくとも一方を含む制御指示を出力する。この制御システム2は、移動領域A1が含む施設の内部にあってもよいし、施設の外部にあってもよい。
(2.3) Control System The
制御システム2は、第1通信部21と、第1記憶部22と、経路探索部23と、第1制御部24と、を備える。
The
第1通信部21は、ネットワークNT1及び無線アクセスポイントAP1を介して、移動ロボット3と通信する。また、第1通信部21は、ネットワークNT1を介して、作成支援システム4及び操作用端末5,6と通信する。なお、第1通信部21は、ネットワークNT1及び無線アクセスポイントAP1を介して、操作用端末5,6と通信してもよい。無線アクセスポイントAP1、作成支援システム4、及び操作用端末5,6と、第1通信部21との間の通信方式としては、無線通信又は有線通信の適宜の通信方式が採用される。
The first communication unit 21 communicates with the
第1記憶部22は、RAM及びROMの少なくとも一方のメモリを有する。第1記憶部22は、移動領域A1の地図に関する第1地図情報、及び、経路探索部23によって探索された移動ロボット3の移動経路を示す経路情報、等を記憶する。
The
経路探索部23は、第1地図情報と、移動ロボット3から受信した移動ロボット3の現在位置に関する現在位置情報と、操作用端末5又は6から受信した搬送指示情報とに基づいて、移動ロボット3が移動する移動経路を探索する。経路探索部23は、第1地図情報と搬送指示情報とに基づいて、例えば移動ロボット3を現在位置から対象物の存在位置まで移動させた後、対象物を搬送して搬送先の位置まで移動する移動経路を探索する。
The
なお、経路探索部23は、第1地図情報に設定された複数のノードの中から、出発地点となる第1ノード及び到着地点となる第2ノードが指定されると、第1ノードから第2ノードに到着する移動経路を探索する。ここで、経路探索部23は、第1ノードと第2ノードとの間を移動ロボット3が移動する移動距離又は移動時間がより短くなるようなルートを移動経路として探索すればよい。
When a first node serving as a starting point and a second node serving as a destination point are specified from among the multiple nodes set in the first map information, the
また、経路探索部23は、第1地図情報に設定された複数のノードの中から、出発地点となる第1ノード、中継地点となる第3ノード、及び到着地点となる第2ノードが指定されると、第1ノードから第3ノードを通って第2ノードに到着する移動経路を探索する。ここで、経路探索部23は、第1ノードと第3ノードとの間を移動ロボット3が移動する移動距離又は移動時間がより短くなり、第3ノードと第2ノードとの間を移動ロボット3が移動する移動距離又は移動時間がより短くなるようなルートを移動経路として探索すればよい。
When a first node serving as a starting point, a third node serving as a relay point, and a second node serving as a destination point are specified from among the multiple nodes set in the first map information, the
第1制御部24は、移動ロボット3から受信した現在位置情報と、操作用端末5又は6から受信した搬送指示と、第1地図情報とに基づいて移動ロボット3の移動経路を経路探索部23に探索させる。第1制御部24は、経路探索部23が探索した経路情報に基づいて、移動ロボット3を移動経路に沿って移動させる制御指示を作成し、制御指示を第1通信部21から移動ロボット3に送信させる。
The
(2.4)操作用端末
操作用端末5,6は、例えば、コンピュータシステムにより実現されている。操作用端末5,6は、例えば、対象物の搬送を指示する搬送指示を制御システム2に入力するために用いられる。
(2.4) Operation Terminal The
操作用端末5又は6は、ユーザの操作を受け付けるUI部と、ネットワークNT1等を介して制御システム2と通信する第4通信部と、を備えている。なお、第4通信部は、無線アクセスポイントAP1及びネットワークNT1等を介して制御システム2と通信してもよい。
The
ユーザが例えば操作用端末5のUI部を用いて移動領域A1内にある対象物を所望の搬送先に搬送する搬送指示を入力すると、操作用端末5は、ユーザが入力した搬送指示に基づく搬送指示情報を、ネットワークNT1等を介して制御システム2に送信する。搬送指示情報は、例えば、搬送対象の対象物に関する情報と、対象物の存在位置に関する情報と、対象物の搬送先の位置に関する情報と、を少なくとも含む。
When a user inputs a transport instruction to transport an object in the movement area A1 to a desired destination using, for example, the UI section of the
(3)動作説明
本実施形態の地図生成システム7の動作を図2~図20に基づいて説明する。なお、図20に示すフローチャートは、本実施形態に係る地図生成方法の一例に過ぎず、処理の順序が適宜変更されてもよいし、処理が適宜追加又は省略されてもよい。
(3) Description of Operation The operation of the
地図生成システム7により移動領域A1の全体地図MP1を生成させる場合、移動ロボット3は、例えば制御システム2からの制御指示に基づいて、移動領域A1を巡回する巡回コース(図2に矢印で示す経路)に沿って移動し、部分地図生成部71が部分地図を生成する。ここで、図2に示す巡回コースは、複数の部分領域にそれぞれ対応する複数の区間を含んでいる。複数の区間は、移動ロボット3が直進移動する複数の直進区間M1~M7と、移動ロボット3が旋回移動する複数の旋回区間R1~R6と、を含んでる。
When the
ユーザは、移動ロボット3を巡回コースに沿って移動させるために、各区間の出発地点に移動ロボット3が存在する状態で、コントローラを操作して各区間を移動させるための制御指示を入力する。
To move the
移動ロボット3が、コントローラから入力された制御指示に基づいて、ある区間を移動すると(ステップS1)、移動中に測域センサ33が測定した測定結果に基づいて、部分地図生成部71が当該区間を含む部分領域を表わす部分地図を生成する(ステップS2)。
When the
ここで、図2に示す巡回コースを移動ロボット3が移動することによって生成される複数の部分地図について図3~図10を参照して説明する。
Here, we will explain the multiple partial maps that are generated by the
まず、移動ロボット3は、巡回コースの出発地点である点P1から任意の向きに10m直進して点P2まで移動する。点P1から点P2までの区間を第1直進区間M1という。部分地図生成部71は、第1直進区間M1に対応する部分領域の部分地図MP21(図3参照)を生成する。全体地図MP1の生成を開始した時点では、部分地図MP21の座標系は定まっていない。そこで、部分地図生成部71は、出発地点である点P1の座標を(0,0)、第1直進区間M1において移動ロボット3が前進する方向をX軸方向、X軸方向と直交する方向をY軸方向と仮決めして部分地図MP21を作成する。なお、第1直進区間M1において、移動ロボット3が前進する方向をX軸方向の負の向き、移動ロボット3から見て右方向をY軸方向の正の向きと仮決めする。第1直進区間M1では移動ロボット3が10m前進するので、点P2の座標は(-10,0)となる。
First, the
移動ロボット3は、点P2を中心に時計回りに90度旋回する。点P2を中心に旋回移動する区間を第1旋回区間R1という。部分地図生成部71は、第1旋回区間R1に対応する部分領域の部分地図MP22(図4参照)を生成する。
The
移動ロボット3は、点P2からY軸方向の正の向きに1m直進して点P3(-10,1)に移動する。点P2から点P3までの区間を第2直進区間M2という。部分地図生成部71は、第2直進区間M2に対応する部分領域の部分地図MP23(図5参照)を生成する。
The
移動ロボット3は、点P3を中心に反時計回りに90度旋回する。点P3を中心に旋回移動する区間を第2旋回区間R2という。部分地図生成部71は、点P3の周りの第2旋回区間R2に対応する部分領域の部分地図を生成する。なお、第2旋回区間R2以降の旋回区間で生成される部分地図については図示を省略している。
The
移動ロボット3は、点P3からX軸方向の負の向きに3m直進して点P4(-13,1)まで移動する。点P3から点P4までの区間を第3直進区間M3という。部分地図生成部71は、第3直進区間M3に対応する部分領域の部分地図MP24(図6参照)を生成する。
The
移動ロボット3は、点P4を中心に時計回りに90度旋回する。点P4を中心に旋回移動する区間を第3旋回区間R3という。部分地図生成部71は、点P4の周りの第3旋回区間R3に対応する部分領域の部分地図を生成する。
The
移動ロボット3は、点P4からY軸方向の正の向きに7m直進して点P5(-13,8)まで移動する。点P4から点P5までの区間を第4直進区間M4という。部分地図生成部71は、第4直進区間M4に対応する部分領域の部分地図MP25(図7参照)を生成する。なお、第4直進区間M4には障害物が存在するため、移動ロボット3は、点P4から点P5まで真っ直ぐに移動することはできず、点P4から点P5まで、直進動作と所定の許容角度以下の旋回動作とを含む一連の直進動作を行って直進移動している。
The
移動ロボット3は、点P5を中心に時計回りに約45度旋回する。点P5を中心に旋回移動する区間を第4旋回区間R4という。部分地図生成部71は、点P5の周りの第4旋回区間R4に対応する部分領域の部分地図を生成する。
The
移動ロボット3は、点P5からX軸方向の正の向きに5m直進して点P6(-8,8)まで移動する。点P5から点P6までの区間を第5直進区間M5という。部分地図生成部71は、第5直進区間M5に対応する部分領域の部分地図MP26(図8参照)を生成する。
The
移動ロボット3は、点P6を中心に時計回りに約90度旋回する。点P6を中心に旋回移動する区間を第5旋回区間R5という。部分地図生成部71は、点P6の周りの第5旋回区間R5に対応する部分領域の部分地図を生成する。
The
移動ロボット3は、点P6からY軸方向の負の向きに8m直進して点P7(0,8)まで移動する。点P6から点P7までの区間を第6直進区間M6という。部分地図生成部71は、第6直進区間M6に対応する部分領域の部分地図MP27(図9参照)を生成する。
The
移動ロボット3は、点P7を中心に反時計回りに約90度旋回する。点P7を中心に旋回移動する区間を第6旋回区間R6という。部分地図生成部71は、点P7の周りの第6旋回区間R6に対応する部分領域の部分地図を生成する。
The
移動ロボット3は、点P7からX軸方向の正の向きに8m直進して点P8(0,0)まで移動する。点P8は出発地点P1と同じ点である。点P7から点P8(点P1)までの区間を第7直進区間M7という。部分地図生成部71は、第7直進区間M7に対応する部分領域の部分地図MP28(図10参照)を生成する。
The
移動ロボット3が巡回ルートの移動を終了すると、巡回ルートに含まれる複数の区間(つまり複数の部分領域)の全てで部分地図の生成が完了する。部分地図生成部71が全ての部分地図の生成を完了する、又は、移動ロボット3が全ての部分領域の走行を完了すると(ステップS3:Yes)、選択部73は、複数の部分地図から代表地図を選択する(ステップS4)。例えば、選択部73は、複数の部分地図のうち、移動ロボット3が直進移動する距離が最も長い部分領域に対応する部分地図を代表地図として選択する。下記の表1は、第1~第7直進区間M1~M7においてそれぞれ生成される部分地図MP21,MP23~MP28と、第1~第7直進区間M1~M7での直進移動の距離との関係を示している。表1の例では、選択部73は、移動ロボット3が直進移動する距離が最も長い部分地図MP21を、代表地図として選択する。
When the
代表地図が選択されると、補正部74は、代表地図から方向要素(直線要素又は直線移動領域)を検出する処理を行う。まず、補正部74は、代表地図として選択された部分地図MP21に直線要素が存在する否かを判定する(ステップS5)。補正部74は、代表地図から一方向に伸びる直線要素を検出する処理を行い、検出した直線要素の長さが第1閾値以上であるか否かを判定する。補正部74は、代表地図に長さが第1閾値以上の直線要素が存在する場合(ステップS5:Yes)、長さが第1閾値以上の直線要素を直線要素として検出し、直線要素とX軸とが交差する角度を推定する(ステップS6)。
When the representative map is selected, the
一方、代表地図に長さが第1閾値以上の直線要素が存在しない場合(ステップS5:No)、補正部74は、代表地図として選択された部分地図MP21に直線移動領域が存在する否かを判定する(ステップS7)。
On the other hand, if the representative map does not contain a straight line element whose length is equal to or greater than the first threshold (step S5: No), the
図14は直線移動領域DE2が存在する部分地図MP30の一例を示しており、この部分地図M30を例に直線移動領域DE2を検出する処理について説明する。 Figure 14 shows an example of a partial map MP30 in which a linear movement area DE2 exists, and the process of detecting the linear movement area DE2 will be explained using this partial map MP30 as an example.
補正部74は、図15に示すように、部分地図M30の空白部分に、複数本の線分L1,L2がX軸方向と平行に等間隔に並ぶように描画する。ここで、実線の線分L1は長さが第2閾値以上の線分であり、点線の線分L2は長さが第2閾値未満の線分である。図15の例では長さが第2閾値以上の線分L1は1本である。
As shown in FIG. 15, the
補正部74は、部分地図M30の空白部分に、複数本の線分L1,L2とX軸方向(X軸方向と平行な線分L4)との交差角θ1を所定の角度ずつ(例えば1度ずつ)増やして、複数本の線分L1,L2を描画する。図16は交差角θ1が1度の場合の複数本の線分L1,L2の描画例、図17は交差角θ1が3度の場合の複数本の線分L1,L2の描画例、図18は交差角θ1が5度の場合の複数本の線分L1,L2の描画例をそれぞれ示している。ここで、補正部74は、長さが第2閾値以上である線分L1の本数が最大となるときに、複数本の線分L1が配置される領域を直線移動領域DE2として検出する。言い換えると、補正部74は、長さが第2閾値以上である複数本の線分L1を等間隔に平行配置したときに線分L1の本数が最大となる領域を直線移動領域DE2として検出する。図16~図18に示す例では、交差角θ1が3度となるように複数本の線分L1,L2を描画した場合に、線分L1の本数が最大の7本となる。したがって、補正部74は、交差角θ1が3度である場合に、複数本の線分L1が等間隔に7本平行配置された領域を直線移動領域DE2として検出する(ステップS7:Yes)。また、補正部74は、線分L1の本数が最大となるときの交差角θ1を、直線移動領域DE2とX軸とが交差する角度として推定する(ステップS8)。
The
一方、代表地図に直線移動領域が存在しない場合(ステップS7:No)、選択部73は、代表地図として選択されていない1又は複数の部分地図から新たな代表地図を選択する(ステップS9)。そして、補正部74は、ステップS5に戻り、新たな代表地図から方向要素(直線要素又は直線移動領域)を検出する処理を行う。
On the other hand, if the representative map does not include a linear movement area (step S7: No), the
補正部74が代表地図から方向要素を検出して、方向要素の角度を推定すると(ステップS6,S8)、地図合成部72は、複数の部分画像を合成して全体地図MP1(図11、図12参照)を生成する(ステップS10)。
When the
その後、補正部74が、代表地図から検出した方向要素の向きに基づいて、全体地図MP1の向きを補正する(ステップS11)。図3は代表地図として検出された部分地図MP21の一例であり、図3の例では部分地図MP21に存在する直線要素DE1の向きはX軸方向と平行であるので、補正部74は、全体地図MP1の向きの補正は行わない。一方、図13に示すように、部分地図MP21に存在する直線要素DE1と、X軸に平行な線分L3との交差角がθ2である場合、補正部74は、全体地図MP1を角度(―θ2)だけ回転させることによって、全体地図MP1の向きを補正する。向きが補正された全体地図MP1では、直線要素DE1が表わす部屋の壁などがX軸方向に対して平行になる。
Then, the
また、図17に示すように、部分地図MP30に存在する直線移動領域と、X軸に平行な線分L4との交差角がθ1である場合、補正部74は、全体地図MP1を角度(―θ1)だけ回転させることによって、全体地図MP1の向きを補正する。図19は、部分地図MP30を角度(―θ1)だけ回転させた状態を示しており、向きが補正された部分地図MP30では、直線移動領域の延びる方向がX軸方向に対して平行になる。
Also, as shown in Figure 17, when the intersection angle between the linear movement area present in the partial map MP30 and a line segment L4 parallel to the X-axis is θ1, the
このように、補正部74が、方向要素(直線要素又は直線移動領域)の向きに基づいて、全体地図MP1の向きを補正することで、方向要素の向きがX軸方向及びY軸方向のいずれかと平行になるような全体地図MP1を生成できる。すなわち、全体地図MP1において、方向要素である直線要素が表わす壁又はキャビネット、或いは、直線移動領域が表わす直線的な通路が、X軸方向及びY軸方向のいずれかと平行に配置される。
In this way, the
例えば、方向要素が表わす壁がX軸方向と平行になるように全体地図MP1が生成されている場合、制御システム2は、移動ロボット3を壁と平行に移動させるのであれば、座標(X1,Y1)から座標(X2,Y1)に移動させる制御指示を移動ロボット3に与えればよい。また、制御システム2は、移動ロボット3を壁と直交する方向に移動させるのであれば、座標(X1,Y1)から座標(X1,Y2)に移動させる制御指示を移動ロボット3に与えればよい。よって、移動ロボット3に対して、X座標及びY座標の一方を変化させるような制御指示を与えればよいから、移動先の座標の指定が容易になり、移動ロボット3が移動する移動ルートの設計が容易な地図を生成することができる。
For example, if the overall map MP1 is generated so that the wall represented by the directional element is parallel to the X-axis direction, then the
ステップS11の補正処理が終了すると、ノイズ除去部75が、全体地図MP1において、部分地図生成工程(ステップS2)で地図生成のために移動ロボット3が移動した移動ルート(上述の巡回ルート)上に位置する物体を除去するノイズ除去工程を行う(ステップS12)。部分地図には、移動ロボット3が通過する前、又は、移動ロボット3が通過した後に移動ルート上に一時的に存在する人又は物体が表示される可能性があるが、移動ルートは移動ロボット3が通行した実績のあるルートである。したがって、ノイズ除去部75が、全体地図MP1において移動ルート(上述の巡回ルート)上に位置する物体を除去することで、制御システム2は、移動ルートを移動ロボット3が移動可能な経路として使用できる。なお、ノイズ除去部75は、複数の部分地図において、移動ルート上に位置する物体を除去するノイズ除去工程を行ってもよく、ノイズ除去後の部分地図を合成して全体地図MP1を生成してもよい。
When the correction process of step S11 is completed, the
なお、図20のフローチャートでは、地図生成システム7は、代表地図から直線要素を検出し、直線要素を検出できなかった場合に直線移動領域を検出しているが、検出の順番は逆でもよい。すなわち、地図生成システム7は、代表地図から直線移動領域を検出し、直線移動領域を検出できなかった場合に直線要素を検出してもよい。また、地図生成システム7は、代表地図から直線要素を検出する処理と、代表地図から直線移動領域を検出する処理とを両方ともに行い、直線要素又は直線移動領域に基づいて全体地図MP1の向きを補正すればよい。なお、代表地図から直線要素と直線移動領域の両方が検出された場合、直線移動領域に比べて直線要素の方が方向を特定しやすいので、補正部74は、直線要素に基づいて全体地図MP1の向きを補正することが好ましい。
In the flowchart of FIG. 20, the
(4)変形例
上記実施形態は、本開示の様々な実施形態の一つに過ぎない。上記実施形態は、本開示の目的を達成できれば、設計等に応じて種々の変更が可能である。また、地図生成システム7と同様の機能は、地図生成方法、コンピュータプログラム、又はプログラムを記録した非一時的な記録媒体等で具現化されてもよい。一態様に係る地図生成方法は、移動ロボット3が移動する移動領域A1の全体地図MP1を生成する方法である。地図生成方法は、地図生成工程と、地図合成工程と、選択工程と、補正工程と、を含む。部分地図生成工程では、移動領域A1内の複数の部分領域にそれぞれ対応する複数の部分地図を生成する。地図合成工程では、複数の部分地図を合成して全体地図MP1を生成する。選択工程では、複数の部分地図から、方向を特定するための方向要素が存在する代表地図を選択する。補正工程では、代表地図に存在する方向要素に基づいて、地図合成工程で生成された全体地図MP1の向きを補正する。一態様に係る(コンピュータ)プログラムは、コンピュータシステムに、上記の地図生成方法を実行させるためのプログラムである。
(4) Modifications The above embodiment is merely one of various embodiments of the present disclosure. The above embodiment can be modified in various ways depending on the design and the like as long as the object of the present disclosure can be achieved. In addition, the same function as the
以下、上記の実施形態の変形例を列挙する。以下に説明する変形例は、適宜組み合わせて適用可能である。 Below, we will list some variations of the above embodiment. The variations described below can be applied in appropriate combinations.
本開示における地図生成システム7又は地図生成方法の実行主体は、コンピュータシステムを含んでいる。コンピュータシステムは、ハードウェアとしてのプロセッサ及びメモリを主構成とする。コンピュータシステムのメモリに記録されたプログラムをプロセッサが実行することによって、本開示における地図生成システム7又は地図生成方法の実行主体としての機能が実現される。プログラムは、コンピュータシステムのメモリに予め記録されてもよく、電気通信回線を通じて提供されてもよく、コンピュータシステムで読み取り可能なメモリカード、光学ディスク、ハードディスクドライブ等の非一時的記録媒体に記録されて提供されてもよい。コンピュータシステムのプロセッサは、半導体集積回路(IC)又は大規模集積回路(LSI)を含む1又は複数の電子回路で構成される。ここでいうIC又はLSI等の集積回路は、集積の度合いによって呼び方が異なっており、システムLSI、VLSI(Very Large Scale Integration)、又はULSI(Ultra Large Scale Integration)と呼ばれる集積回路を含む。さらに、LSIの製造後にプログラムされる、FPGA(Field-Programmable Gate Array)、又はLSI内部の接合関係の再構成若しくはLSI内部の回路区画の再構成が可能な論理デバイスについても、プロセッサとして採用することができる。複数の電子回路は、1つのチップに集約されていてもよいし、複数のチップに分散して設けられていてもよい。複数のチップは、1つの装置に集約されていてもよいし、複数の装置に分散して設けられていてもよい。ここでいうコンピュータシステムは、1以上のプロセッサ及び1以上のメモリを有するマイクロコントローラを含む。したがって、マイクロコントローラについても、半導体集積回路又は大規模集積回路を含む1又は複数の電子回路で構成される。
The executing entity of the
また、地図生成システム7における複数の機能が、1つの筐体内に集約されていることは地図生成システム7に必須の構成ではなく、地図生成システム7の構成要素は、複数の筐体に分散して設けられていてもよい。さらに、地図生成システム7の少なくとも一部の機能がクラウド(クラウドコンピューティング)等によって実現されてもよい。
In addition, it is not essential for the
また、上記のロボットシステム1では、制御システム2と、作成支援システム4と、操作用端末5,6とが、別々のコンピュータシステムで実現されているが、制御システム2が操作用端末5,6の機能を備えていてもよいし、作成支援システム4が操作用端末5,6の機能を備えていてもよい。また、操作用端末5,6と制御システム2と作成支援システム4とが一つのコンピュータシステムで実現されていてもよい。すなわち、上記のロボットシステム1では、制御システム2と、作成支援システム4と、操作用端末5,6とが、複数の装置に分散されているが、制御システム2、作成支援システム4、及び操作用端末5,6の少なくとも一部の機能が、1つの筐体内に集約されていてもよい。
In addition, in the
上記実施形態では地図生成システム7が移動ロボット3に備えられているが、地図生成システム7が移動ロボット3に備えられていることは必須ではなく、地図生成システム7は、移動ロボット3の外部に設けられていてもよい。
In the above embodiment, the
上記実施形態で説明したロボットシステム1では移動ロボット3の台数が1台であるが、ロボットシステム1は、複数台の移動ロボット3を備えていてもよい。なお、ロボットシステム1が複数台の移動ロボット3を備える場合でも、複数台の移動ロボット3のうちの1台が地図生成システム7を備えていればよく、1台の移動ロボット3が備える地図生成システム7が移動領域A1の全体地図を生成すればよい。また、全体地図を生成するために用いられる複数の部分地図は1台の移動ロボット3が生成してもよいし,複数台の移動ロボット3が分担して生成してもよい。そして、そのうちの1台の移動ロボット3が備える地図合成部72が、複数台の移動ロボット3で生成された複数の部分地図を合成して全体地図を生成してもよい。また、複数の移動ロボット3と通信可能なサーバが地図合成部72を備え、サーバが備える地図合成部72が、複数台の移動ロボット3で生成された複数の部分地図を合成して全体地図を生成してもよい。
In the
また、移動ロボット3はAGVに限定されず、運転が自動化されたトラック、又は、フォークリフトのようなマテリアルハンドリング機器等でもよい。
In addition, the
また、移動ロボット3が対象物を搬送する搬送ロボットである場合、移動ロボット3が搬送する対象物は、物品、又は、物品を載せるためのパレット或いは台車等である。移動ロボット3が工場内で用いられる場合、移動ロボット3が搬送する対象物の物品は、製造装置に供給する部品又は材料、製造装置によって製造された完成品又は半完成品を含んでもよいし、製造装置に部品を供給する部品供給装置を含んでもよい。
In addition, when the
(まとめ)
以上説明したように、第1の態様の地図生成方法は、移動ロボット(3)が移動する移動領域(A1)の全体地図(MP1)を生成する地図生成方法である。地図生成方法は、部分地図生成工程と、地図合成工程と、選択工程と、補正工程と、を含む。部分地図生成工程では、移動領域(A1)内の複数の部分領域にそれぞれ対応する複数の部分地図(MP21~MP28)を生成する。地図合成工程では、複数の部分地図(MP21~MP28)を合成して全体地図(MP1)を生成する。選択工程では、複数の部分地図(MP21~MP28)から、方向を特定するための方向要素(DE1,DE2)が存在する代表地図を選択する。補正工程では、代表地図に存在する方向要素(DE1,DE2)に基づいて地図合成工程で生成された全体地図(MP1)の向きを補正する。
(summary)
As described above, the map generation method of the first aspect is a map generation method for generating an overall map (MP1) of a moving area (A1) in which a mobile robot (3) moves. The map generation method includes a partial map generation step, a map synthesis step, a selection step, and a correction step. In the partial map generation step, a plurality of partial maps (MP21 to MP28) corresponding to a plurality of partial areas in the moving area (A1) are generated. In the map synthesis step, the plurality of partial maps (MP21 to MP28) are synthesized to generate an overall map (MP1). In the selection step, a representative map having direction elements (DE1, DE2) for specifying a direction is selected from the plurality of partial maps (MP21 to MP28). In the correction step, the orientation of the overall map (MP1) generated in the map synthesis step is corrected based on the direction elements (DE1, DE2) present in the representative map.
この態様によれば、補正工程では、代表地図に存在する方向要素(DE1,DE2)に基づいて全体地図(MP1)の向きを補正しており、例えば全体地図(MP1)に設定される2つの直交軸の一方が、方向要素(DE1,DE2)の向きと平行になるように全体地図(MP1)の向きを補正できる。これにより、全体地図(MP1)に存在する方向要素に沿って移動ロボット(3)を移動させる場合、全体地図(MP1)に設定される直交軸に沿って移動ロボット(3)を移動させればよい。したがって、第1の態様の地図生成方法によれば、移動ロボット(3)が移動する移動ルートの設計が容易な全体地図(MP1)を生成することができる。 According to this aspect, in the correction process, the orientation of the overall map (MP1) is corrected based on the directional elements (DE1, DE2) present in the representative map, and the orientation of the overall map (MP1) can be corrected so that, for example, one of the two orthogonal axes set in the overall map (MP1) is parallel to the orientation of the directional elements (DE1, DE2). As a result, when moving the mobile robot (3) along the directional elements present in the overall map (MP1), it is sufficient to move the mobile robot (3) along the orthogonal axis set in the overall map (MP1). Therefore, according to the map generation method of the first aspect, it is possible to generate an overall map (MP1) that makes it easy to design a movement route for the mobile robot (3) to move.
第2の態様の地図生成方法では、第1の態様において、方向要素は、代表地図に存在する長さが第1閾値以上の直線要素(DE1)を含む。 In the map generation method of the second aspect, in the first aspect, the directional elements include straight line elements (DE1) that exist in the representative map and whose length is equal to or greater than a first threshold value.
この態様によれば、代表地図に存在する直線要素(DE1)に基づいて、全体地図(MP1)の向きを補正することができる。 According to this aspect, the orientation of the overall map (MP1) can be corrected based on the straight line element (DE1) present in the representative map.
第3の態様の地図生成方法では、第1又は2の態様において、方向要素は、代表地図に存在する直線移動領域(DE2)を含む。直線移動領域(DE2)の向きは、移動ロボット(3)が直線移動可能で領域であって、長さが第2閾値以上である。 In the map generation method of the third aspect, in the first or second aspect, the directional element includes a linear movement area (DE2) that exists in the representative map. The direction of the linear movement area (DE2) is an area in which the mobile robot (3) can move linearly, and the length is equal to or greater than the second threshold.
この態様によれば、代表地図に存在する直線移動領域(DE2)の向きに基づいて、全体地図(MP1)の向きを補正することができる。 According to this aspect, the orientation of the overall map (MP1) can be corrected based on the orientation of the linear movement area (DE2) present in the representative map.
第4の態様の地図生成方法では、第3の態様において、補正工程では、代表地図から、長さが第2閾値以上である複数本の線分(LN1)を等間隔に平行配置したときに、線分(LN1)の本数が最大となる領域を直線移動領域(DE2)として検出する。 In the fourth aspect of the map generation method, in the third aspect, the correction step detects, from the representative map, an area in which the number of line segments (LN1) is maximum when multiple line segments (LN1) whose length is equal to or greater than a second threshold are arranged in parallel at equal intervals, as the linear movement area (DE2).
この態様によれば、代表地図に存在する直線移動領域(DE2)の向きに基づいて、全体地図(MP1)の向きを補正することができる。 According to this aspect, the orientation of the overall map (MP1) can be corrected based on the orientation of the linear movement area (DE2) present in the representative map.
第5の態様の地図生成方法では、第1~4のいずれかの態様において、部分地図生成工程では、複数の部分領域のうち作成対象の部分領域を移動ロボット(3)が移動する間に、移動ロボット(3)が備える測域センサ(33)が測定範囲内に存在する対象物の位置を測定することによって、作成対象の部分領域に対応する部分地図(MP21~MP28)を生成する。 In the map generation method of the fifth aspect, in any of the first to fourth aspects, in the partial map generation step, while the mobile robot (3) moves through a partial area to be generated among a plurality of partial areas, the range sensor (33) equipped on the mobile robot (3) measures the positions of objects present within the measurement range, thereby generating partial maps (MP21 to MP28) corresponding to the partial area to be generated.
この態様によれば、移動ロボット(3)が部分領域を移動する間に測域センサ(33)が測定した測定結果に基づいて部分地図(MP21~MP28)を生成することができる。 According to this embodiment, partial maps (MP21 to MP28) can be generated based on the measurement results obtained by the range sensor (33) while the mobile robot (3) moves through the partial area.
第6の態様の地図生成方法は、第1~5のいずれかの態様において、部分地図生成工程では、移動ロボット(3)が制御指示に基づく一連の動作を行うごとに、一連の動作を行う間に移動した部分領域の部分地図(MP21~MP28)を生成する。 The sixth aspect of the map generation method is any one of the first to fifth aspects, in which, in the partial map generation step, each time the mobile robot (3) performs a series of actions based on the control instructions, a partial map (MP21 to MP28) of the partial area traveled during the series of actions is generated.
この態様によれば、制御指示に基づく一連の動作が終わったタイミング、言い換えると制御指示が切り替わるタイミングで、部分地図(MP21~MP28)を生成することができる。 According to this embodiment, partial maps (MP21 to MP28) can be generated when a series of operations based on a control instruction is completed, in other words, when the control instruction is switched.
第7の態様の地図生成方法は、第5又は6の態様において、ノイズ除去工程を含む。ノイズ除去工程では、複数の部分地図(MP21~MP28)及び全体地図(MP1)の少なくとも一方において、部分地図生成工程で地図生成のために移動ロボット(3)が移動した移動ルート上に位置する物体を除去する。 The map generation method of the seventh aspect is the fifth or sixth aspect and includes a noise removal step. In the noise removal step, objects located on the route traveled by the mobile robot (3) for map generation in the partial map generation step are removed from at least one of the plurality of partial maps (MP21 to MP28) and the overall map (MP1).
この態様によれば、移動ルート上に物体が存在しない全体地図(MP1)を生成することができる。 According to this aspect, it is possible to generate an overall map (MP1) in which no objects exist on the travel route.
第8の態様の地図生成方法では、第5~7のいずれかの態様において、選択工程では、部分地図生成工程において、地図生成のために移動ロボット(3)が直線移動した移動距離が最も長い部分領域の部分地図(MP21~MP28)を代表地図として選択する。 In the map generation method of the eighth aspect, in any of the fifth to seventh aspects, in the selection step, the partial map (MP21 to MP28) of the partial area in which the mobile robot (3) has traveled the longest linear distance for map generation in the partial map generation step is selected as the representative map.
この態様によれば、直線要素又は直線移動領域が存在する可能性が高い部分地図(MP21~MP28)を代表地図として選択することができる。 According to this aspect, partial maps (MP21 to MP28) in which straight line elements or straight line movement areas are likely to exist can be selected as representative maps.
第9の態様の地図生成方法では、第5~7のいずれかの態様において、選択工程では、部分地図生成工程において、地図生成のために移動ロボット(3)が直線移動した移動距離が第3閾値以上である2以上の部分地図(MP21~MP28)を代表地図として順番に選択する。補正工程では、代表地図として選択された2以上の部分地図(MP21~MP28)に存在する方向要素(DE1,DE2)に基づいて地図合成工程で生成された全体地図(MP1)の向きを補正する。 In the map generation method of the ninth aspect, in any of the fifth to seventh aspects, in the selection step, two or more partial maps (MP21 to MP28) in which the distance traveled in a straight line by the mobile robot (3) for map generation is equal to or greater than a third threshold value in the partial map generation step are selected in order as representative maps. In the correction step, the orientation of the overall map (MP1) generated in the map synthesis step is corrected based on the directional elements (DE1, DE2) present in the two or more partial maps (MP21 to MP28) selected as the representative maps.
この態様によれば、移動距離が第3閾値以上である2以上の部分地図(MP21~MP28)から方向要素を検出するので、複数の部分地図(MP21~MP28)の全てから方向要素を検出する場合に比べて、方向要素を検出する処理を低減できる。 According to this aspect, directional elements are detected from two or more partial maps (MP21 to MP28) in which the travel distance is equal to or greater than the third threshold, so the amount of processing required to detect directional elements can be reduced compared to when directional elements are detected from all of the multiple partial maps (MP21 to MP28).
第10の態様のプログラムは、コンピュータシステムに、第1~9のいずれかの態様の地図生成方法を、実行させるためのプログラムである。 The program of the tenth aspect is a program for causing a computer system to execute the map generation method of any one of the first to ninth aspects.
この態様によれば、移動ロボット(3)が移動する移動ルートの設計が容易な全体地図(MP1)を生成することができる。 According to this aspect, it is possible to generate an overall map (MP1) that makes it easy to design the route along which the mobile robot (3) will move.
第11の態様の地図生成システムは、移動ロボット(3)の移動する移動領域(A1)の全体地図(MP1)を生成する。地図生成システムは、部分地図生成部(71)と、地図合成部(72)と、選択部(73)と、補正部(74)と、を含む。部分地図生成部(71)は、移動領域(A1)内の複数の部分領域にそれぞれ対応する複数の部分地図(MP21~MP28)を生成する。地図合成部(72)は、複数の部分地図(MP21~MP28)を合成して全体地図(MP1)を生成する。選択部(73)は、複数の部分地図(MP21~MP28)から、方向を特定するための方向要素(DE1,DE2)が存在する代表地図を選択する。補正部(74)は、代表地図に存在する方向要素(DE1,DE2)に基づいて地図合成部(72)で生成された全体地図(MP1)の向きを補正する。 The map generation system of the eleventh aspect generates an overall map (MP1) of a moving area (A1) in which a mobile robot (3) moves. The map generation system includes a partial map generation unit (71), a map synthesis unit (72), a selection unit (73), and a correction unit (74). The partial map generation unit (71) generates a plurality of partial maps (MP21 to MP28) corresponding to a plurality of partial areas in the moving area (A1). The map synthesis unit (72) synthesizes the plurality of partial maps (MP21 to MP28) to generate an overall map (MP1). The selection unit (73) selects a representative map having direction elements (DE1, DE2) for specifying a direction from the plurality of partial maps (MP21 to MP28). The correction unit (74) corrects the orientation of the overall map (MP1) generated by the map synthesis unit (72) based on the direction elements (DE1, DE2) present in the representative map.
この態様によれば、補正部(74)は、代表地図に存在する方向要素(DE1,DE2)に基づいて全体地図(MP1)の向きを補正しており、例えば全体地図(MP1)に設定される2つの直交軸の少なくとも一方が、方向要素(DE1,DE2)の向きと平行になるように全体地図(MP1)の向きを補正できる。これにより、全体地図(MP1)に存在する方向要素に沿って移動ロボット(3)を移動させる場合、全体地図(MP1)に設定される直交軸に沿って移動ロボット(3)を移動させればよい。したがって、第11の態様の地図生成システム(7)によれば、移動ロボット(3)が移動する移動ルートの設計が容易な全体地図(MP1)を生成することができる。 According to this aspect, the correction unit (74) corrects the orientation of the overall map (MP1) based on the directional elements (DE1, DE2) present in the representative map, and can correct the orientation of the overall map (MP1) so that, for example, at least one of the two orthogonal axes set in the overall map (MP1) is parallel to the orientation of the directional elements (DE1, DE2). As a result, when moving the mobile robot (3) along the directional elements present in the overall map (MP1), it is sufficient to move the mobile robot (3) along the orthogonal axes set in the overall map (MP1). Therefore, according to the map generation system (7) of the eleventh aspect, it is possible to generate an overall map (MP1) that makes it easy to design a movement route for the mobile robot (3) to move.
第12の態様の移動ロボット(3)は、移動体(30)と、移動体(30)の移動を制御する移動制御部(37)と、移動体(30)の周囲に存在する対象物を検出する測域センサ(33)と、第11の態様の地図生成システム(7)と、を備える。 The mobile robot (3) of the 12th aspect includes a mobile body (30), a movement control unit (37) that controls the movement of the mobile body (30), a range sensor (33) that detects objects present around the mobile body (30), and the map generation system (7) of the 11th aspect.
この態様によれば、移動ロボット(3)が移動する移動ルートの設計が容易な全体地図(MP1)を生成することができる。 According to this aspect, it is possible to generate an overall map (MP1) that makes it easy to design the route along which the mobile robot (3) will move.
上記態様に限らず、上記実施形態に係る地図生成システム(7)の種々の構成(変形例を含む)は、地図生成方法、(コンピュータ)プログラム、又はプログラムを記録した非一時的記録媒体等で具現化可能である。 Not limited to the above aspects, various configurations (including modified examples) of the map generation system (7) according to the above embodiment can be embodied as a map generation method, a (computer) program, or a non-transitory recording medium on which a program is recorded, etc.
第2~第9の態様に係る構成については、地図生成方法に必須の構成ではなく、適宜省略可能である。 The configurations according to the second to ninth aspects are not essential to the map generation method and may be omitted as appropriate.
3 移動ロボット
7 地図生成システム
30 移動体
33 測域センサ
37 移動制御部
71 部分地図生成部
72 地図合成部
73 選択部
74 補正部
A1 移動領域
DE1 直線要素(方向要素)
DE2 直線移動領域(方向要素)
LN1 線分
MP1 全体地図
MP21~MP28 部分地図
3
DE2 Linear movement area (directional element)
LN1 Line segment MP1 Overall map MP21-MP28 Partial maps
Claims (12)
前記移動領域内の複数の部分領域にそれぞれ対応する複数の部分地図を生成する部分地図生成工程と、
前記複数の部分地図を合成して前記全体地図を生成する地図合成工程と、
前記複数の部分地図から、方向を特定するための方向要素が存在する代表地図を選択する選択工程と、
前記代表地図に存在する前記方向要素に基づいて前記地図合成工程で生成された前記全体地図の向きを補正する補正工程と、を含む、
地図生成方法。 A map generation method for generating an overall map of a moving area in which a mobile robot moves, comprising the steps of:
a partial map generating step of generating a plurality of partial maps respectively corresponding to a plurality of partial areas within the moving area;
a map synthesis step of synthesizing the plurality of partial maps to generate the overall map;
a selection step of selecting a representative map having a direction element for specifying a direction from the plurality of partial maps;
and a correction step of correcting the orientation of the entire map generated in the map synthesis step based on the directional element present in the representative map.
Map generation method.
請求項1に記載の地図生成方法。 The directional elements include straight line elements that exist in the representative map and have a length equal to or greater than a first threshold value.
The map generating method of claim 1 .
前記直線移動領域は、前記移動ロボットが直線移動可能で領域であって、長さが第2閾値以上である、
請求項1又は2に記載の地図生成方法。 the direction element includes a linear movement area present in the representative map;
The linear movement area is an area in which the mobile robot can move linearly, and the length of the area is equal to or greater than a second threshold value.
A map generating method according to claim 1 or 2.
請求項3に記載の地図生成方法。 In the correction step, a region in which a number of line segments, each having a length equal to or greater than the second threshold, is maximum when the line segments are arranged in parallel at equal intervals from the representative map is detected as the linear movement region.
The map generating method according to claim 3.
請求項1~4のいずれか1項に記載の地図生成方法。 In the partial map generating step, a range sensor provided in the mobile robot measures positions of objects present within a measurement range while the mobile robot moves through a partial region to be generated among the plurality of partial regions, thereby generating a partial map corresponding to the partial region to be generated.
A map generating method according to any one of claims 1 to 4.
請求項1~5のいずれか1項に記載の地図生成方法。 In the partial map generating step, each time the mobile robot performs a series of operations based on one or a plurality of control instructions, a partial map of a partial area through which the mobile robot has moved while performing the series of operations is generated.
A map generating method according to any one of claims 1 to 5.
請求項5又は6に記載の地図生成方法。 a noise removing step of removing, from at least one of the plurality of partial maps and the overall map, objects located on a route along which the mobile robot has moved for map generation in the partial map generating step,
A map generating method according to claim 5 or 6.
前記部分地図生成工程において、地図生成のために前記移動ロボットが直線移動した移動距離が最も長い部分領域の部分地図を前記代表地図として選択する、
請求項5~7のいずれか1項に記載の地図生成方法。 In the selection step,
In the partial map generating step, a partial map of a partial area in which a linear movement distance traveled by the mobile robot is the longest for map generation is selected as the representative map.
A map generating method according to any one of claims 5 to 7.
前記補正工程では、前記代表地図として選択された前記2以上の部分地図に存在する前記方向要素に基づいて前記地図合成工程で生成された前記全体地図の向きを補正する、
請求項5~7のいずれか1項に記載の地図生成方法。 In the selection step, two or more partial maps in which a linear movement distance traveled by the mobile robot for map generation is equal to or greater than a third threshold are selected in order as the representative map in the partial map generation step,
In the correction step, a direction of the entire map generated in the map synthesis step is corrected based on the direction elements present in the two or more partial maps selected as the representative map.
A map generating method according to any one of claims 5 to 7.
請求項1~9のいずれかに記載の地図生成方法を、実行させるための
プログラム。 In the computer system,
A program for executing the map generating method according to any one of claims 1 to 9.
前記移動領域内の複数の部分領域にそれぞれ対応する複数の部分地図を生成する部分地図生成部と、
前記複数の部分地図を合成して前記全体地図を生成する地図合成部と、
前記複数の部分地図から、方向を特定するための方向要素が存在する代表地図を選択する選択部と、
前記代表地図に存在する前記方向要素に基づいて前記地図合成部で生成された前記全体地図の向きを補正する補正部と、を含む、
地図生成システム。 A map generation system for generating an overall map of a moving area in which a mobile robot moves, comprising:
a partial map generating unit that generates a plurality of partial maps corresponding to a plurality of partial areas within the moving area;
a map synthesis unit that synthesizes the plurality of partial maps to generate the overall map;
a selection unit that selects a representative map having a direction element for specifying a direction from the plurality of partial maps;
A correction unit that corrects the orientation of the entire map generated by the map synthesis unit based on the directional element present in the representative map.
Map generation system.
前記移動体の移動を制御する移動制御部と、
前記移動体の周囲に存在する対象物を検出する測域センサと、
請求項11に記載の地図生成システムと、を備える、
移動ロボット。 A moving body,
A movement control unit that controls the movement of the moving body;
A range sensor that detects an object existing around the moving object;
The map generating system according to claim 11,
Mobile robot.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2022023164A JP7649955B2 (en) | 2022-02-17 | 2022-02-17 | Map generation method, program, map generation system, and mobile robot equipped with the same |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2022023164A JP7649955B2 (en) | 2022-02-17 | 2022-02-17 | Map generation method, program, map generation system, and mobile robot equipped with the same |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2023120005A JP2023120005A (en) | 2023-08-29 |
JP7649955B2 true JP7649955B2 (en) | 2025-03-24 |
Family
ID=87778046
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2022023164A Active JP7649955B2 (en) | 2022-02-17 | 2022-02-17 | Map generation method, program, map generation system, and mobile robot equipped with the same |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP7649955B2 (en) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2019121189A (en) | 2018-01-05 | 2019-07-22 | 東芝ライフスタイル株式会社 | Autonomous travel body |
CN111583308A (en) | 2019-02-18 | 2020-08-25 | 北京奇虎科技有限公司 | Repositioning quality evaluation method and device and computer storage medium |
CN113191412A (en) | 2021-04-25 | 2021-07-30 | 珠海格力电器股份有限公司 | Equipment relocation method and device, computer equipment and storage medium |
CN113219488A (en) | 2021-05-08 | 2021-08-06 | 珠海市一微半导体有限公司 | Robot mapping method |
-
2022
- 2022-02-17 JP JP2022023164A patent/JP7649955B2/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2019121189A (en) | 2018-01-05 | 2019-07-22 | 東芝ライフスタイル株式会社 | Autonomous travel body |
CN111583308A (en) | 2019-02-18 | 2020-08-25 | 北京奇虎科技有限公司 | Repositioning quality evaluation method and device and computer storage medium |
CN113191412A (en) | 2021-04-25 | 2021-07-30 | 珠海格力电器股份有限公司 | Equipment relocation method and device, computer equipment and storage medium |
CN113219488A (en) | 2021-05-08 | 2021-08-06 | 珠海市一微半导体有限公司 | Robot mapping method |
Also Published As
Publication number | Publication date |
---|---|
JP2023120005A (en) | 2023-08-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6937898B2 (en) | Multi-resolution scan matching with exclusion zones | |
CN111511620B (en) | Dynamic window method using optimal interaction collision avoidance cost assessment | |
CA2830730C (en) | Augmented mobile platform localization | |
EP3612906B1 (en) | Method and system for environment map generation and alignment | |
WO2010038353A1 (en) | Autonomous movement device | |
US20180174038A1 (en) | Simultaneous localization and mapping with reinforcement learning | |
US11555704B2 (en) | Systems and methods for updating an electronic map | |
JP6074205B2 (en) | Autonomous mobile | |
US11931900B2 (en) | Method of predicting occupancy of unseen areas for path planning, associated device, and network training method | |
JP6348971B2 (en) | Moving body | |
JP7554988B2 (en) | DESIGN SUPPORT SYSTEM, DESIGN SUPPORT METHOD, AND PROGRAM | |
Van Nam et al. | Fusion consistency for industrial robot navigation: An integrated SLAM framework with multiple 2D LiDAR-visual-inertial sensors | |
JP7649955B2 (en) | Map generation method, program, map generation system, and mobile robot equipped with the same | |
CN115943355A (en) | Route planning system, mobile robot, route planning program, and control program for mobile robot | |
Li et al. | Comparison and evaluation of SLAM algorithms for AGV navigation | |
JP7563455B2 (en) | MOBILE BODY CONTROL SYSTEM, CONTROL DEVICE, AND MOBILE BODY CONTROL METHOD | |
Roesler et al. | Evaluation of slam algorithms for highly dynamic environments | |
Zheng et al. | Indoor Mobile Robot Map Construction Based on Improved Cartographer Algorithm | |
Pol | Navigation Systems of Indoor Automated Guided Vehicle | |
US20240176349A1 (en) | Information processing device, information processing method, and storage medium | |
JP2023102042A (en) | Travel route creation system and program | |
WO2025070595A1 (en) | Map generation device, map generation method, and map generation system | |
WO2021220331A1 (en) | Mobile body system | |
Kudriashov et al. | Multi-agent SLAM-Based Inspection System for Rough Terrain | |
JP2023137739A (en) | Information processing system, information processing device, information processing method and program |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20240610 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20250117 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20250128 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20250221 |