JP2017129681A - 地図作成方法 - Google Patents
地図作成方法 Download PDFInfo
- Publication number
- JP2017129681A JP2017129681A JP2016008224A JP2016008224A JP2017129681A JP 2017129681 A JP2017129681 A JP 2017129681A JP 2016008224 A JP2016008224 A JP 2016008224A JP 2016008224 A JP2016008224 A JP 2016008224A JP 2017129681 A JP2017129681 A JP 2017129681A
- Authority
- JP
- Japan
- Prior art keywords
- map
- road surface
- height
- trajectory
- dimensional
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 20
- 238000013507 mapping Methods 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 8
- 238000005259 measurement Methods 0.000 description 5
- 244000025254 Cannabis sativa Species 0.000 description 4
- 230000010365 information processing Effects 0.000 description 4
- 239000000284 extract Substances 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 230000006866 deterioration Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 238000007637 random forest analysis Methods 0.000 description 1
Images
Landscapes
- Instructional Devices (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
【課題】路面をより正確に反映した地図を作成することができる地図作成方法を提供することを目的とする。【解決手段】本発明の一態様に係る地図作成方法は、自律移動ロボットの地図作成方法であって、不特定の人の注目点の高さ方向の軌跡を取得し、取得した軌跡から路面の高さを推定し、推定された高さを、二次元平面を表す地図と関連付ける地図作成方法である。移動している人における注目点の高さの移動軌跡は、実際に自律移動ロボットが走行する路面の高さに対応している蓋然性が高い。したがって、このような方法によれば、距離センサ等により路面が認識できない場合であっても、実際の路面の高さを取得することができる。【選択図】図6
Description
本発明は地図作成方法に関し、特に自律移動ロボットの地図作成方法に関する。
地図を用いて自律的に移動する自律移動ロボットが知られている。例えば、特許文献1では、次のような地図作成方法について開示している。この方法では、起伏がある地形において距離センサにより地形の3次元位置計測点群を収集し、得られた計測点を、平面を表すパラメータ空間に、例えば3次元ハフ変換により写像し、その計測点の含有数が多い順に平面を算出する。そして、この算出された平面から含有している計測点に対応する地形に相当する領域を抽出し、抽出された領域を組合せて経路計画用の勾配地図を作成する。
関連技術においては、距離センサなどにより認識される地表面が路面であるとして地図が作成される。このため、距離センサで路面を認識できない場合には、地図に表される3次元位置が、実際に自律移動ロボット走行する路面とは異なることがあり、経路計画の精度の劣化を招く。つまり、距離センサなどにより認識される地表面と実際の路面とが異なっている場合には、正しい路面情報を用いた経路計画を行うことが困難となる。例えば、地面に草が生えている場合には、草の表面の位置が路面であるとして地図が作成されてしまうが、実際に走行する路面は、草の表面の位置ではなく草の根元付近の位置である。
本発明は、このような問題を解決するためになされたものであり、路面をより正確に反映した地図を作成することができる地図作成方法を提供することを目的とする。
本発明の一態様に係る地図作成方法は、自律移動ロボットの地図作成方法であって、不特定の人の注目点の高さ方向の軌跡を取得し、取得した軌跡から路面の高さを推定し、推定された高さを、二次元平面を表す地図と関連付ける、方法である。
移動している人における注目点の高さの移動軌跡は、実際に自律移動ロボットが走行する路面の高さに対応している蓋然性が高い。したがって、このような方法によれば、距離センサ等により路面が認識できない場合であっても、実際の路面の高さを取得することができる。
移動している人における注目点の高さの移動軌跡は、実際に自律移動ロボットが走行する路面の高さに対応している蓋然性が高い。したがって、このような方法によれば、距離センサ等により路面が認識できない場合であっても、実際の路面の高さを取得することができる。
本発明によれば、路面をより正確に反映した地図を作成することができる地図作成方法を提供することができる。
以下、図面を参照して本発明の実施の形態について具体的に説明する。図1は、実施の形態に係る地図作成装置1の構成を示すブロック図である。
地図作成装置1は、情報処理装置10と、環境情報取得装置11と備えている。情報処理装置10は、図示しないCPU(Central Processing Unit)及びメモリなどを有し、コンピュータとしての機能を備えている。また、情報処理装置10は、地図情報記憶部12と、3次元軌跡取得部13と、路面高さ推定部14と、勾配地図作成部15とを有する。なお、3次元軌跡取得部13、路面高さ推定部14、及び勾配地図作成部15は、例えば、CPUの制御によって、プログラムが実行されることによって実現できる。より具体的には、例えば図示しないメモリ等の記憶装置に格納されたプログラムを、CPUの制御によって実行して実現する。また、これら各構成要素は、プログラムによるソフトウェアで実現することに限ることなく、ハードウェア、ファームウェア、及びソフトウェアのうちのいずれかの組み合わせ等により実現してもよい。地図情報記憶部12は、例えばメモリ等の記憶装置により実現される。
環境情報取得装置11は、人における注目点の3次元軌跡を取得するために用いられる計測装置又は観測装置であり、環境内の物体に関する情報を取得する。ここで、人における注目点とは、人の体の所定の部分であり、例えば、頭部、足部などの任意の部分が該当する。環境情報取得装置11は、例えば環境内又は自律移動ロボットなどに設置されている。環境情報取得装置11は、任意の認識手法を用いて注目点を検出及び追跡するために、環境内の物体に関する情報を取得する。環境情報取得装置11は、具体的には、例えば、RGB−Dカメラ、ステレオカメラ、レーザー測域センサ、又はモーションキャプチャなどである。
地図情報記憶部12は、2次元地図情報、及び、この2次地図情報を用いて後述する勾配地図作成部15により作成又は更新された勾配地図情報を記憶する。2次元地図情報は、自律移動ロボットの自己位置推定や経路計画に用いられる平面地図データであり、具体的には、例えば、レーザー測域センサなどを用いて予め作成された、自律移動ロボットの移動対象エリアに存在する障害や壁などの領域情報を蓄積した2次元地図データである。
3次元軌跡取得部13は、環境情報取得装置11により取得された環境情報に基づいて、地図情報記憶部12が記憶する2次元地図情報と関連付けられた3次元軌跡を取得する。この3次元軌跡は、具体的には、上述の注目点の軌跡群である。3次元軌跡取得部13は、具体的には、例えば、環境情報取得装置11により取得される点群データなどに対し、ランダムフォレストによる人物姿勢推定やパーティクルフィルタによるトラッキングなどの処理を行うことで、環境情報取得装置11により取得されるデータから、人の動作に対応するデータを抽出する。また、3次元軌跡取得部13は、抽出されたデータにおいて予め定められた注目点(例えば、人の頭部の重心)を特定し、抽出されたデータに基づいて注目点の軌跡を求める。図2は、3次元軌跡取得部13による軌跡の取得について説明する模式図である。また、図3は、2次元地図上での注目点の軌跡例を示す模式図である。なお、図2及び図3では、人50が壁91、92の間の通路を移動した際の注目点51の軌跡52が示されている。また、図3では、平面上の軌跡、すなわちx方向及びy方向の軌跡が示されている。ここで、図2に示されるように、環境情報取得装置11により取得された情報から得られた軌跡は、環境情報取得装置11の基準座標系で表された軌跡であるため、3次元軌跡取得部13は、2次元地図上における環境情報取得装置11の位置姿勢を予め固定又は検知することにより、この軌跡を2次元地図の基準座標系で表された軌跡へと変換する。すなわち、図2及び図3に示されるように、3次元軌跡取得部13は、環境情報取得装置11の基準座標系で表された軌跡の座標(Xt,Yt,Zt)を、2次元地図の基準座標系で表された軌跡の座標(X’t,Y’t,Z’t)に変換する。
路面高さ推定部14は、3次元軌跡取得部13により取得された軌跡群から勾配地図の作成又は更新に用いる軌跡を順番に抽出し路面の高さを推定する。路面高さ推定部14は、高さ方向をZ軸とした場合、人の歩行において、人の接地時と、軌跡のZ値の負方向のピーク時とが対応しているとの仮定をし、このピーク時のZ値に所定値を減算した値を路面の高さと推定する。なお、この所定値は、人50の足裏から注目点51までの距離(高さ)に相当する。図4は、3次元軌跡取得部13により取得された軌跡の高さ方向(Z軸方向)の変化を示すグラフである。路面高さ推定部14は、負方向のピーク時のZ値であるZ1、Z2、Z3、Z4、Z5、Z6、Z7を、路面の高さの推定に用いる。
勾配地図作成部15は、路面高さ推定部14により推定された路面の高さを用いて、地図情報記憶部12が記憶する2次元地図に対応する勾配地図を作成又は更新する。図5は、勾配地図作成部15による勾配地図の作成について説明する模式図であり、図5上部には平面上の軌跡及び推定された路面の高さが示されており、図5下部には作成された勾配地図が示されている。勾配地図作成部15は、例えば、2次元地図で表される平面を一定幅で区切ったグリッドマップ60を作成し、軌跡に対して推定された路面の高さの値を、グリッドマップ60の各グリッドのうちこの軌跡のX及びY座標値が属するグリッドに割り当てることにより、高さ情報を設定した勾配地図を作成する。また、勾配地図作成部15は、3次元軌跡取得部13により取得された一連の軌跡が通過する各グリッドのうち、高さの値が割り当てられないグリッドについては、高さの値が割り当てられた前後のグリッドの高さの値の中間値を高さ情報として設定する。
次に、地図作成装置1の動作の流れについて説明する。図6は、地図作成装置1の動作の流れについて示すフローチャートである。以下、図6に沿って動作を説明する。
ステップ10(S10)において、3次元軌跡取得部13は、環境情報取得装置11により取得された情報に基づいて人の3次元軌跡群を取得する。次に、ステップ11(S11)において、3次元軌跡取得部13は、取得された軌跡群の中から今回新たに取得された軌跡群を抽出する。すなわち、既に勾配地図が作成済みである場合に、本フローチャートでこの勾配地図を更新する際は、更新分の軌跡群のみが抽出されることとなる。
ステップ10(S10)において、3次元軌跡取得部13は、環境情報取得装置11により取得された情報に基づいて人の3次元軌跡群を取得する。次に、ステップ11(S11)において、3次元軌跡取得部13は、取得された軌跡群の中から今回新たに取得された軌跡群を抽出する。すなわち、既に勾配地図が作成済みである場合に、本フローチャートでこの勾配地図を更新する際は、更新分の軌跡群のみが抽出されることとなる。
次に、ステップ12(S12)において、ステップ11で抽出された全ての軌跡に対して後述の所定の処理が既に完了しているかを判定する。全ての軌跡に対して処理が既に完了していない場合、処理がなされていない軌跡について、以下のステップ13乃至15の処理が行われ、再び、ステップ12の判定が行われる。これに対し、ステップ11で抽出された全ての軌跡に対して処理が既に完了していると判定された場合、勾配地図の作成または更新が完了したとして、一連の処理が終了する。
ステップ13(S13)では、路面高さ推定部14が、ステップ11で得られた軌跡群から勾配地図の作成又は更新に用いる軌跡を取り出す。次に、ステップ14(S14)において、路面高さ推定部14が、上述のようにして地面の高さ情報を推定する。そして、ステップ15(S15)において、勾配地図作成部15は、軌跡の2次元地図上における位置に、推定された高さ情報を関連付けることにより、勾配地図を作成又は更新する。
すなわち、地図作成装置1によれば、自律移動ロボットの地図作成方法であって、不特定の人の注目点の高さ方向の軌跡を取得し(ステップ10)、取得した軌跡から路面の高さを推定し(ステップ14)、推定された高さを、二次元平面を表す地図と関連付ける(ステップ15)、地図作成方法が提供される。
上記実施の形態にかかる地図作成装置1によれば、移動している人における注目点の高さの移動軌跡から、路面の高さを推定している。したがって、地図作成装置1によれば、距離センサ等により路面が認識できない場合であっても、実際の路面の高さを取得することができる。よって、路面をより正確に反映した地図を作成することができる。そして、このような地図の作成は、自律移動ロボットにおける地図を用いた経路計画の精度の向上に寄与する。
また、上記実施の形態にかかる地図作成装置1によれば、次のような利点も提供される。例えば、起伏がある地形において、自律移動ロボットは、自律移動ロボットに搭載された距離センサなどで3次元点を計測し、計測結果に基づいて地形を推定することで、経路計画用の勾配地図を作成することができる。しかし、環境内には、障害物などによって遮られた死角領域や降坂による死角領域が存在する。このため、本実施の形態にかかる地図作成方法によらない方法では、現在の地点からは認識できない領域であるものの経路計画に用いたい領域の勾配地図を作成したい場合には、死角領域を補間するために、自律移動ロボットは、距離センサの位置及び姿勢を変更する必要がある。これに対し、本実施の形態にかかる地図作成装置1を搭載した自律移動ロボットにおいては、注目点の高さの移動軌跡から路面の高さを推定している。このため、自律移動ロボットは、経路計画時は現在の位置姿勢から移動せずとも、搭載した距離センサなどで直接認識できない死角領域の勾配情報を含んだ勾配地図を得ることが可能となる。
なお、本発明は上記実施の形態に限られたものではなく、趣旨を逸脱しない範囲で適宜変更することが可能である。
1 地図作成装置
10 情報処理装置
11 環境情報取得装置
12 地図情報記憶部
13 3次元軌跡取得部
14 路面高さ推定部
15 勾配地図作成部
50 人
51 注目点
52 軌跡
60 グリッドマップ
91、92 壁
10 情報処理装置
11 環境情報取得装置
12 地図情報記憶部
13 3次元軌跡取得部
14 路面高さ推定部
15 勾配地図作成部
50 人
51 注目点
52 軌跡
60 グリッドマップ
91、92 壁
Claims (1)
- 自律移動ロボットの地図作成方法であって、
不特定の人の注目点の高さ方向の軌跡を取得し、
取得した軌跡から路面の高さを推定し、
推定された高さを、二次元平面を表す地図と関連付ける
地図作成方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016008224A JP2017129681A (ja) | 2016-01-19 | 2016-01-19 | 地図作成方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016008224A JP2017129681A (ja) | 2016-01-19 | 2016-01-19 | 地図作成方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2017129681A true JP2017129681A (ja) | 2017-07-27 |
Family
ID=59396173
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2016008224A Pending JP2017129681A (ja) | 2016-01-19 | 2016-01-19 | 地図作成方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2017129681A (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109375618A (zh) * | 2018-09-27 | 2019-02-22 | 深圳乐动机器人有限公司 | 清洁机器人的导航避障方法及终端设备 |
JP2020034354A (ja) * | 2018-08-28 | 2020-03-05 | ヤンマー株式会社 | 障害物検知システム |
-
2016
- 2016-01-19 JP JP2016008224A patent/JP2017129681A/ja active Pending
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2020034354A (ja) * | 2018-08-28 | 2020-03-05 | ヤンマー株式会社 | 障害物検知システム |
JP7181026B2 (ja) | 2018-08-28 | 2022-11-30 | ヤンマーパワーテクノロジー株式会社 | 障害物検知システム |
CN109375618A (zh) * | 2018-09-27 | 2019-02-22 | 深圳乐动机器人有限公司 | 清洁机器人的导航避障方法及终端设备 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6445995B2 (ja) | センサデータの空間的集約を用いる適応マッピング | |
KR101778028B1 (ko) | 로봇 및 로봇의 경로 생성 방법 | |
KR101739996B1 (ko) | 이동 로봇 및 이동 로봇의 위치 인식 및 지도 작성 방법 | |
KR101776622B1 (ko) | 다이렉트 트래킹을 이용하여 이동 로봇의 위치를 인식하기 위한 장치 및 그 방법 | |
KR101776621B1 (ko) | 에지 기반 재조정을 이용하여 이동 로봇의 위치를 인식하기 위한 장치 및 그 방법 | |
KR101976241B1 (ko) | 다중로봇의 자기위치인식에 기반한 지도작성 시스템 및 그 방법 | |
KR20180079428A (ko) | 자동 로컬리제이션을 위한 장치 및 방법 | |
JP5728815B2 (ja) | 物体検出装置 | |
JP2018017826A (ja) | 自律移動体と環境地図更新装置 | |
JP2013025401A (ja) | 自己位置推定装置、自己位置推定方法およびプログラム | |
JP2017129681A (ja) | 地図作成方法 | |
KR101242253B1 (ko) | 지형분류 기반 고도 지도 작성 방법 | |
CN114911223B (zh) | 一种机器人导航方法、装置、机器人及存储介质 | |
KR101639264B1 (ko) | 무인 단말기 제어 방법 및 장치 | |
CN113340310A (zh) | 一种移动机器人台阶地形识别定位方法及相关装置 | |
CN117991293A (zh) | 一种障碍物高度属性的检测方法及电子设备 | |
CN118329008A (zh) | 一种双足机器人导航过程中的局部地形地图构建方法 | |
CN117629219A (zh) | 充电定位引导方法和自动充电机器人 | |
Urcola et al. | On-line trajectory planning for autonomous spraying vehicles |