JP6809913B2 - ロボット、ロボットの制御方法、および地図の生成方法 - Google Patents
ロボット、ロボットの制御方法、および地図の生成方法 Download PDFInfo
- Publication number
- JP6809913B2 JP6809913B2 JP2017012439A JP2017012439A JP6809913B2 JP 6809913 B2 JP6809913 B2 JP 6809913B2 JP 2017012439 A JP2017012439 A JP 2017012439A JP 2017012439 A JP2017012439 A JP 2017012439A JP 6809913 B2 JP6809913 B2 JP 6809913B2
- Authority
- JP
- Japan
- Prior art keywords
- measurement
- map
- robot
- range sensor
- measurement points
- 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
- 238000000034 method Methods 0.000 title claims description 34
- 238000005259 measurement Methods 0.000 claims description 129
- 238000012217 deletion Methods 0.000 claims description 6
- 230000037430 deletion Effects 0.000 claims description 6
- 238000010586 diagram Methods 0.000 description 22
- 230000010354 integration Effects 0.000 description 17
- 230000002093 peripheral effect Effects 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 2
- 230000004927 fusion Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 1
- 230000000052 comparative effect Effects 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/0088—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0234—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
- G05D1/0236—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons in combination with a laser
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y10—TECHNICAL SUBJECTS COVERED BY FORMER USPC
- Y10S—TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y10S901/00—Robots
- Y10S901/01—Mobile robot
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y10—TECHNICAL SUBJECTS COVERED BY FORMER USPC
- Y10S—TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y10S901/00—Robots
- Y10S901/49—Protective device
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Health & Medical Sciences (AREA)
- Business, Economics & Management (AREA)
- Optics & Photonics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Game Theory and Decision Science (AREA)
- Medical Informatics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Description
本発明は、自律移動するロボット、ロボットの制御方法、および地図の生成方法に関する。
屋内で用いられる自律移動ロボットの自己位置認識技術として、事前に作成された地図と、測域センサから得られたデータとを照合する方法が一般的になりつつある。この方法で用いられる地図は、予め自律移動ロボットを手動または自動で走行させ、Simultaneous Localization and Maping（ＳＬＡＭ）という手法を用いて作成されることが一般的である。
一方で、昨今、様々な分野において、オープンソースソフトウェア（以下、ＯＳＳという）の普及が急激に進んでいる。ロボットの分野においても、例えばRobot Operating System（ＲＯＳ）またはＲＴミドルウェア（ＲＴＭ）といったＯＳＳが世界中で急速に普及し始めている。
これらのＯＳＳの中には、ロボットの自律移動に関する技術も含まれている。自社で開発したロボットをそれぞれのＯＳＳに対応させることで、簡単に、そのロボットを屋内において自律移動させることができる。これらのＯＳＳは、１つの測域センサのみがロボットの正面に備えられた汎用的なロボットを前提として製作されている。
しかし、実際にロボットを開発する際には、広範囲にわたる周囲の環境を計測するために測域センサを複数設置しなければならないことが多い。例えば、自律移動ロボットに人が搭乗する場合、そのロボットの正面には人が乗るため、ロボットの左右に測域センサを取り付けることが多い。この場合において、ＯＳＳを利用して地図を作成する際には、左右の測域センサで得られた各データを、ロボットの正面に備えられた１つの仮想の測域センサ（以下、仮想センサという）から得られたデータのように統合する必要がある。
左右の測域センサで得られた各データを統合する方法としては、従来、各測域センサで得られた各データを１つの仮想センサの座標を基準としたデータに変換し、各測域センサで得られた各データをそのまま統合するといった手法が提案されている（例えば、特許文献１参照）。
ここで、図１２を用いて、特許文献１に係る地図の作成方法について説明する。図１２は、特許文献１の移動ロボットが、複数の測域センサを備えており、各測位センサで得られたデータを基に地図の生成を行う場合の概要を示す図である。
図１２に示すように、移動ロボット２０には、測域センサとして、超音波センサ２１ａ、２１ｂ、２１ｃが異なる高さに備えられている。
図１２に示す周辺地図２２ａ、２２ｂ、２２ｃは、それぞれ、超音波センサ２１ａ、２１ｂ、２１ｃで得られたデータに基づいて作成された地図である。周辺地図２２ａ〜２２ｃの世界座標は、融合される融合地図２３の世界座標と同一である。そのため、融合地図２３は、周辺地図２２ａ、２２ｂ、２２ｃをそのまま座標を合わせながら重ねることにより作成できる。
しかしながら、上記特許文献１では、ＯＳＳを用いる場合を想定していない。そのため、ＯＳＳを用いてロボットの自律移動を制御する場合、誤った地図の生成が行われ、その地図に基づいて移動するロボットが障害物に衝突してしまうといった問題がある。
本発明の目的は、ＯＳＳを用いてロボットの自律移動を制御する場合に、ロボットが障害物に衝突することを防止できるようにすることである。
本発明に係るロボットの制御方法は、複数の測域センサを備え、前記複数の測域センサの計測データを用いて作成された地図に基づいて自律移動するロボットの制御方法であって、前記複数の測域センサの計測点を含む前記計測データにおいて、仮想測域センサの測域範囲を複数の測定エリアに分割し、分割した前記複数の測定エリアのそれぞれにおいて、複数の前記計測点が含まれる場合に選択した１つの計測点以外の計測点を削除し、削除後に残った計測点に基づき前記地図を作成する。
本発明に係るロボットは、上記本発明のロボットの制御方法を用いて制御を行う制御部を備えている。
本発明に係る地図の生成方法は、複数の測域センサの計測データを用いて作成する地図の生成方法であって、前記複数の測域センサの計測点を含む前記計測データにおいて、仮想測域センサの測域範囲を複数の測定エリアに分割し、分割した前記複数の測定エリアのそれぞれにおいて、複数の前記計測点が含まれる場合に選択した１つの計測点以外の計測点を削除し、削除後に残った計測点に基づき前記地図を作成する。
本発明に係る地図の生成方法は、複数の測域センサの計測データを用いて作成する地図の生成方法であって、前記複数の測域センサの計測点を含む前記計測データにおいて、仮想測域センサの測域範囲を複数の測定エリアに分割し、分割した前記複数の測定エリアのそれぞれにおいて、複数の前記計測点が含まれる場合に選択した１つの計測点以外の計測点を削除し、削除後に残った計測点に基づき前記地図を作成する。
本発明によれば、ＯＳＳを用いてロボットの自律移動を制御する場合に、ロボットが障害物に衝突することを防止できる。
以下、本発明の実施の形態について、図面を参照して説明する。
まず、本発明の実施の形態に係る移動ロボット１００の構成について、図１を用いて説明する。図１は、本実施の形態に係る移動ロボット１００の外観、および、その移動ロボット１００が備える制御部１７の構成を示す図である。
図１に示すように、移動ロボット１００は、移動ロボット本体３と、移動ロボット本体３に設けられた一対の駆動輪１（図１では片側の駆動輪１のみ図示している）と、移動ロボット本体３に設けられた１つの準輪２と、移動ロボット本体３に設けられたレーザ測域センサ４Ｒ、４Ｌと、制御部１７と、を有する。
また、図１に示すように、制御部１７は、センサ統合部１１と、地図部１２と、目的地設定部１３と、自己位置推定部１４と、知能部１５と、駆動輪制御部１６と、を有する。
センサ統合部１１は、レーザ測域センサ４Ｒで計測された計測データと、レーザ測域センサ４Ｌで計測された計測データとを統合する。統合された計測データを、以下「統合計測データ」という。
地図部１２は、移動ロボット１００が移動する領域（空間）の地図を作成し、記憶（以下、管理ともいう）する。
目的地設定部１３は、地図における特定の位置の座標を、移動ロボット１００の移動先（目的地）として設定する。設定された移動先の座標を、以下「目標座標」という。
自己位置推定部１４は、統合計測データと、地図とに基づいて、移動ロボット１００の現在位置（自己位置）を推定する。推定された位置の座標を、以下「現在位置座標」という。
知能部１５は、統合計測データと、目標座標と、現在位置座標とに基づいて、移動ロボットが移動する経路の生成、および、経路上における障害物の認識を行う。
駆動輪制御部１６は、移動ロボット１００が知能部１５で生成された経路を移動（走行）するように、駆動輪１を制御する。
移動ロボット１００は、一対の駆動輪１を図１の矢印ａの方向に回転させることによって、図１の矢印ｂの方向に走行（前進）する。この矢印ｂが示す方向を、移動ロボット１００の進行方向（前進方向）とする。
また、移動ロボット１００は、一対の駆動輪１を矢印ａとは逆方向に回転させることによって、矢印ｂの方向とは逆方向にも走行可能（後進可能）である。
また、一対の駆動輪１は、個別に回転可能に構成されている。よって、一対の駆動輪１を互いに逆回転させることで、移動ロボット１００は超信地旋回を行うことができる。
レーザ測域センサ４Ｒは、移動ロボット１００の進行方向に対して右側に設けられており、レーザ測域センサ４Ｌは、移動ロボット１００の進行方向に対して左側に設けられている。レーザ測域センサ４Ｒ、４Ｌはともに、図１に示すように、移動ロボット本体３の最前方に設けられることが望ましい。
以上、移動ロボット１００の構成について説明した。
次に、地図部１２が作成し、記憶する地図の一例について、図２を用いて説明する。図２は、ＲＯＳまたはＲＴＭ等のＯＳＳ（自律移動ソフトウェア）に用いられる占有格子地図２００の概要図である。図２の（ａ）は、占有格子地図２００の一部を拡大した図である。
占有格子地図２００は、図２の（ａ）に示すように、移動ロボット１００が移動する領域が格子状に区切られている。占有格子地図２００に含まれる各格子は、レーザ側域センサ４Ｒ、４Ｌによって検出されていない未知領域６、障害物が含まれている障害物領域７、または、移動ロボット１００が移動することができる移動可能領域８のいずれかに属する。
次に、図２に示した占有格子地図２００の作成方法について、図３を用いて説明する。図３は、所定の時刻ｔにおける占有格子地図の作成方法を示した概要図である。
図３（ａ）は、所定の時刻ｔのときに、障害物９をレーザ測域センサ（図示略）が計測した計測データを、レーザ測域センサの原点１０ａを中心に描写した図である。
図３（ａ）において、レーザ測域センサから発光されたレーザ光が障害物９と交わった点を、レーザ測域センサの計測点１０ｂとする。
また、図３（ａ）において、各レーザ測域センサの計測点１０ｂと原点１０ａとを結ぶ線分（図中の点線）を、線分データ１０ｃとする。
なお、レーザ測域センサ１０から発光されたレーザ光がある一定の距離まで障害物９と交わらなかった場合は、レーザ測域センサ計測点１０ｂおよび線分データ１０ｃは存在しないものとする。
図３（ｂ）は、レーザ測域センサが計測した計測データから作成された占有格子地図２００を示した図である。
占有格子地図２００に含まれる全ての格子は、最初、未知領域６に属している。そして、地図部１２は、線分データ１０ｃが通過する格子を移動可能領域８に変更し、レーザ測域センサ計測点１０ｂが含まれる格子を障害物領域７に変更する。地図部１２は、この処理を、ｔ、ｔ＋Δｔ、ｔ＋Δｔ＋１というように連続時間的に行う。これによって、占有格子地図２００が作成されていく。
次に、移動ロボット１００の移動時の動作の流れについて、図４を用いて説明する。図４は、移動ロボット１００の移動時の動作の流れを示すフローチャートである。
ステップＳ１において、目的地設定部１３は、地図部１２が管理している占有格子地図２００において、移動ロボット１００の目的地（目標座標）を設定する。
具体的には、目的地設定部１３は、占有格子地図２００を構成する格子のうちのいずれかを、目的地に設定する。このときに設定される格子は、移動可能領域８に属する格子でなくてはならない。
ステップＳ２において、知能部１５は、自己位置推定部１４で推定された移動ロボット１００の現在位置（現在位置座標）を、地図部１２が管理している占有格子地図２００において特定し、移動ロボット１００の現在位置からステップＳ１で設定された移動ロボット１００の目的地までの経路を算出する。
具体的には、知能部１５は、占有格子地図２００を構成する格子の中から現在位置に該当する格子を検索し、検索された格子を現在位置に設定する。そして、知能部１５は、占有格子地図２００上において、現在位置に設定された格子から、目的地に設定された格子までの経路を計算する。この経路の計算（生成）では、例えば、公知のＡ*（A-star,エースター）アルゴリズムが用いられるが、これに限定されず、その他の公知技術が用いられてもよい。
ステップＳ３において、駆動輪制御部１６は、生成された経路に沿って移動ロボット１００が移動（走行）するように、駆動輪１を制御する。これにより、移動ロボット１００は、目的地へ向けて移動する。
この移動中において、自己位置推定部１４は、随時、移動ロボット１００の現在位置を推定し、知能部１５は、随時、その現在位置と、設定された目的地との間の距離を算出し、その距離が予め設定された一定距離以下になったか否かの判定を行う。
ステップＳ４において、知能部１５は、現在位置と目的地との間の距離が一定距離以下になった場合、目的地に到着したと判断する。そして、駆動輪制御部１６は、駆動輪１の駆動を停止し、移動ロボット１００の移動を停止させる。
次に、センサ統合部１１が、レーザ測域センサ４Ｒで得られた計測データとレーザ側域センサ４Ｌで得られた計測データとを、実際に設置されているレーザ測域センサの数（例えば、２つ）よりも少ない数（例えば、１つ）の仮想センサで得られたように統合する方法について、図５を用いて説明する。
図５は、各レーザ測域センサの原点、障害物９、および移動ロボット本体３の位置関係を示した概要図である。
図５において、４Ｒａは、図１に示したレーザ測域センサ４Ｒの原点であり、４Ｌａは、図１に示したレーザ測域センサ４Ｌの原点である。また、５ａは、仮想のレーザ測域センサ（図示略）の原点である。この場合において、仮想のレーザ測域センサの原点５ａは、レーザ測域センサ４Ｒの原点４Ｒａとレーザ測域センサ４Ｌの原点４Ｌａとを結ぶ線分上にあるものとする。なお、その線分上であれば、仮想のレーザ測域センサの原点５ａは、どの位置にあってもよい。
次に、計測データの統合方法の流れについて、図６を用いて説明する。図６は、計測データの統合方法の流れを示すフローチャートである。
ステップＳ１１において、センサ統合部１１は、レーザ測域センサ４Ｒ、４Ｌのそれぞれから得られるレーザ測域センサの計測点４Ｒｂ、４Ｌｂを全て２次元座標にプロットする。この２次元座標は、仮想のレーザ測域センサの２次元座標である。
ステップＳ１２において、センサ統合部１１は、２次元座標上の仮想のレーザ測域センサの測域範囲を、複数の扇形に分割する。この具体例について、図７、図８を用いて説明する。
図７において、仮想のレーザ測域センサの測域範囲３００は、原点５ａを中心とし、半径Ｌの円である。センサ統合部１１は、この側域範囲３００を、同形の扇形に分割する。図７の（ａ）は、分割された１つの扇形の拡大図である。図７の（ａ）に示すように、１つの扇形は、原点５ａを中心とし、中心角がΔθであり、半径Ｌの扇形である。この１つの扇形を測定エリア５ｄとする。
測定エリア５ｄには、図８に示すように、レーザ測域センサの計測点４Ｒｂ、４Ｌｂが含まれることがある。
ステップＳ１３において、センサ統合部１１は、１つの扇形（測定エリア５ｄ）に複数のレーザ側域センサの計測点が含まれている場合、複数の計測点の中から、１つの計測点を選定する。
例えば、図８の（ａ）に示すように、１つの測定エリア５ｄに複数のレーザ測域センサの計測点４Ｒｂまたは４Ｌｂが含まれている場合、センサ統合部１１は、原点５ａから各計測点４Ｒｂ、４Ｌｂまでの距離をそれぞれ算出する。
そして、センサ統合部１１は、原点５ａからの距離が最も短い計測点を統合用処理データ（統合の対象となる計測データ）に選定する。このとき、選定された計測点以外の計測点は、削除される。その理由は、１つの測定エリアに計測点が複数存在したまま計測データの統合が行われると、選定される計測点以外は、本来仮想のレーザ側域センサの位置からでは計測することができない計測点であるにもかかわらず、計測データの統合後に存在するといった矛盾を生じさせるためである。
上述したステップＳ１３の処理は、１つの測定エリア５ｄに複数のレーザ側域センサの計測点が含まれている場合のみ行われる。
ステップＳ１４において、センサ統合部１１は、測定エリア５ｄのそれぞれに含まれているレーザ側域センサの計測点（ステップＳ１３で選定された計測点）を、仮想のレーザ測域センサの計測点に変更（決定）する。
その後、変更された仮想のレーザ側域センサの計測点に基づいて、占有格子地図が作成され、その占有格子地図に基づいて移動ロボット１００の自律移動の制御が行われる。
次に、図９および図１０を用いて比較例を説明し、その後、本実施の形態の作用効果について図１１を用いて説明する。
図９は、所定の時刻ｔのときに、レーザ測域センサ４Ｒ、４Ｌの計測データを統合せずに占有格子地図２００を作成した場合を示す概要図である。
図９（ａ）は、所定の時刻ｔのときに、障害物９を計測したレーザ測域センサ４Ｒ、４Ｌの計測データを、レーザ測域センサの原点４Ｒａ、４Ｌａを中心に描写した図である。図９（ａ）において、４Ｒｂ、４Ｌｂは、それぞれ、レーザ測域センサ４Ｒ、４Ｌの計測点を示している。また、図９（ａ）において、４Ｒｃ、４Ｌｃは、それぞれ、原点４Ｒａと計測点４Ｒｂとを結ぶ線分データ、原点４Ｌａと計測点４Ｌｂとを結ぶ線分データを示している。
図９（ｂ）は、レーザ測域センサ４Ｒ、４Ｌが計測したレーザ測域センサの計測点４Ｒｂ、４Ｌｂと、線分データ４Ｒｃ、４Ｌｃとに基づいて作成された占有格子地図２００を示した図である。レーザ測域センサ４Ｒ、４Ｌと障害物９とが、例えば図５で説明した位置関係である場合、正しい占有格子地図は、図９（ｂ）に示す占有格子地図２００となる。
一方、図１０は、所定の時刻ｔのときに、レーザ測域センサ４Ｒ、４Ｌの計測データを特段の処理を行わずにそのまま統合し、占有格子地図２００を作成した場合を示す概要図である。
図１０（ａ）は、所定の時刻ｔのときに、障害物９を計測したレーザ測域センサ４Ｒ、４Ｌのレーザ測域センサの計測点４Ｒｂ、４Ｌｂ全てが、仮想のレーザ測域センサの原点５ａから得られたレーザ測域センサの計測点５ｂと同一であると仮定した場合の概要を示した図である。
図１０（ａ）において、各レーザ測域センサの計測点５ｂの座標は、図９（ａ）に示した全てのレーザ測域センサの計測点４Ｒｂ、４Ｌｂの座標と同一である。線分データ５ｃは、レーザ測域センサの計測点５ｂと仮想のレーザ測域センサの原点５ａとを結んだ線分である。
図１０（ａ）に示すように、一部の線分データ５ｃが障害物９と交差してしまっている。このことから、レーザ測域センサの計測点５ｂの中には、矛盾を生じさせるレーザ測域センサの計測点５ｂがいくつか存在していることがわかる。
図１０（ａ）に示すように、一部の線分データ５ｃが障害物９と交差してしまっている。このことから、レーザ測域センサの計測点５ｂの中には、矛盾を生じさせるレーザ測域センサの計測点５ｂがいくつか存在していることがわかる。
図１０（ｂ）は、上述した矛盾を含んだまま作成された占有格子地図２００を示す図である。図１０（ｂ）において、枠線ａで囲まれている領域が、図９（ｂ）に示した占有格子地図２００と異なっていることがわかる。
本来、移動ロボットは、障害物９の内側に進入することはできないが、図１０（ｂ）に示した占有格子地図２００では、枠線ａ内（障害物９内に相当）に移動可能領域８があるため、移動ロボットが障害物９内に進入できるようになっている。よって、この図１０（ｂ）に示した占有格子地図を用いて実際に移動ロボットの自律移動を行った場合は、移動ロボットが障害物９に衝突するといった問題が発生する。
図１１は、図６のステップＳ１３で説明したとおり、１つの計測点５ｂを選定した（他の計測点５ｂを削除した）後に、占有格子地図２００を作成した場合を示す概要図である。上述したとおり、１つの測定エリアに計測点が複数存在したまま計測データの統合が行われると、選定される計測点以外は、本来仮想のレーザ側域センサの位置からでは計測することができない計測点であるにもかかわらず、計測データの統合後に存在するといった矛盾を生じさせるため、削除される。
図１１（ａ）は、上記矛盾を生じさせるレーザ測域センサの計測点５ｂを削除した後の、仮想のレーザ測域センサが計測したレーザ測域センサの計測点５ｂと、線分データ５ｃとの概要を示した図である。
図１１（ｂ）は、レーザ測域センサの計測点５ｂと線分データ５ｃとに基づいて作成された占有格子地図２００を示す図である。
図１１（ｂ）に示した占有格子地図２００では、図１０（ｂ）に示した占有格子地図２００のように、障害物９の内部に移動可能領域８が存在していない（すなわち、上記矛盾が生じていない）。図１１（ｂ）に示した占有格子地図２００は、図９（ｂ）に示した占有格子地図２００よりも未知領域６が多いが、移動ロボット１００が移動するほど、計測データが取得されて地図が更新されていくので、最終的には、矛盾なく、かつ、精度の高い地図となる。
なお、上述した実施の形態では、測域センサとして、レーザ測域センサ（レーザレンジファインダ）を用いる場合を例に挙げて説明したが、測域センサは、超音波センサ、光学式センサ、またはカメラセンサであってもよい。これにより、移動ロボットの自律移動の性能が向上する。
また、上述した図６の統合方法は、自律移動ロボット用の地図の生成を行う場合だけではなく、自己位置推定部１４が移動ロボット１００の現在位置を推定する際にも活用することができる。
以上、詳述したように、本実施の形態では、移動ロボットに備えられた複数のレーザ測域センサの計測データを用いて地図を作成し、その地図に基づいて自律移動する場合において、複数の測域センサの計測データの一部を削除し、削除後に残った計測データを統合し、統合された計測データを、複数の測域センサの数よりも少ない数の仮想測域センサの計測データに決定（変更）することを特徴とする。
これにより、ＯＳＳを用いて移動ロボットの自律移動を制御する場合でも、正確な地図を生成できるため、移動ロボットが誤って障害物に衝突することを防止できる。
本発明は、上記実施の形態の説明に限定されず、その趣旨を逸脱しない範囲において種々の変形が可能である。
本発明は、移動体の自律移動または自動運転の分野で活用することができる。
１ 駆動輪
２ 準輪
３ 移動ロボット本体
４Ｒ、４Ｌ レーザ測域センサ
４Ｒａ、４Ｌａ、１０ａ レーザ測域センサの原点
４Ｒｂ、４Ｌｂ、１０ｂ レーザ測域センサの計測点
４Ｒｃ、４Ｌｃ、１０ｃ 線分データ
５ａ 仮想のレーザ測域センサの原点
５ｂ 仮想のレーザ測域センサの計測点
５ｃ 仮想の測域センサの線分データ
５ｄ 測定エリア
６ 未知領域
７ 障害物領域
８ 移動可能領域
９ 障害物
１１ センサ統合部
１２ 地図部
１３ 目的地設定部
１４ 自己位置推定部
１５ 知能部
１６ 駆動輪制御部
１７ 制御部
２０、１００ 移動ロボット
２１ａ、２１ｂ、２１ｃ 超音波センサ
２２ａ、２２ｂ、２２ｃ 周辺地図
２３ 融合地図
２ 準輪
３ 移動ロボット本体
４Ｒ、４Ｌ レーザ測域センサ
４Ｒａ、４Ｌａ、１０ａ レーザ測域センサの原点
４Ｒｂ、４Ｌｂ、１０ｂ レーザ測域センサの計測点
４Ｒｃ、４Ｌｃ、１０ｃ 線分データ
５ａ 仮想のレーザ測域センサの原点
５ｂ 仮想のレーザ測域センサの計測点
５ｃ 仮想の測域センサの線分データ
５ｄ 測定エリア
６ 未知領域
７ 障害物領域
８ 移動可能領域
９ 障害物
１１ センサ統合部
１２ 地図部
１３ 目的地設定部
１４ 自己位置推定部
１５ 知能部
１６ 駆動輪制御部
１７ 制御部
２０、１００ 移動ロボット
２１ａ、２１ｂ、２１ｃ 超音波センサ
２２ａ、２２ｂ、２２ｃ 周辺地図
２３ 融合地図
Claims (9)
- 複数の測域センサを備え、前記複数の測域センサの計測データを用いて作成された地図に基づいて自律移動するロボットの制御方法であって、
前記複数の測域センサの計測点を含む前記計測データにおいて、仮想測域センサの測域範囲を複数の測定エリアに分割し、
分割した前記複数の測定エリアのそれぞれにおいて、複数の前記計測点が含まれる場合に選択した１つの計測点以外の計測点を削除し、
削除後に残った計測点に基づき前記地図を作成する、
ロボットの制御方法。 - 前記削除した計測点は、前記仮想測域センサの位置で計測できないデータである、
請求項１に記載のロボットの制御方法。 - 前記選択した計測点は、分割した前記複数の測定エリアのそれぞれに含まれる複数の前記計測点のうち、前記仮想測域センサの位置からの距離が最短である計測点である、
請求項１に記載のロボットの制御方法。 - 前記仮想測域センサの測域範囲は、
円形であり、
前記仮想測域センサの位置を中心として、所定の角度毎に等分される、
請求項３に記載のロボットの制御方法。 - 前記測定エリアの形状は、中心角度が前記所定の角度の扇形である、
請求項４に記載のロボットの制御方法。 - 前記削除後に残った計測点を用いて、前記ロボットの移動に用いられる地図を生成する、
請求項１から５いずれか記載のロボットの制御方法。 - 前記削除後に残った計測点を用いて、前記ロボットの現在位置を推定する、
請求項１から５いずれか記載のロボットの制御方法。 - 請求項１から７のいずれか１項に記載のロボットの制御方法を用いて制御を行う制御部を備えたロボット。
- 複数の測域センサの計測データを用いて作成する地図の生成方法であって、
前記複数の測域センサの計測点を含む前記計測データにおいて、仮想測域センサの測域範囲を複数の測定エリアに分割し、
分割した前記複数の測定エリアのそれぞれにおいて、複数の前記計測点が含まれる場合に選択した１つの計測点以外の計測点を削除し、
削除後に残った計測点に基づき前記地図を作成する、
地図の生成方法。
Priority Applications (3)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2017012439A JP6809913B2 (ja) | 2017-01-26 | 2017-01-26 | ロボット、ロボットの制御方法、および地図の生成方法 |
| US15/878,968 US10976749B2 (en) | 2017-01-26 | 2018-01-24 | Robot and method for controlling the same |
| CN201810075295.7A CN108363391B (zh) | 2017-01-26 | 2018-01-25 | 机器人及其控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2017012439A JP6809913B2 (ja) | 2017-01-26 | 2017-01-26 | ロボット、ロボットの制御方法、および地図の生成方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2018120482A JP2018120482A (ja) | 2018-08-02 |
| JP6809913B2 true JP6809913B2 (ja) | 2021-01-06 |
Family
ID=62905869
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2017012439A Active JP6809913B2 (ja) | 2017-01-26 | 2017-01-26 | ロボット、ロボットの制御方法、および地図の生成方法 |
Country Status (3)
| Country | Link |
|---|---|
| US (1) | US10976749B2 (ja) |
| JP (1) | JP6809913B2 (ja) |
| CN (1) | CN108363391B (ja) |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR102324099B1 (ko) * | 2019-12-26 | 2021-11-10 | 주식회사 트위니 | 실내 이동체의 경로 계획 방법, 이를 구현하기 위한 프로그램이 저장된 기록매체 및 이를 구현하기 위해 매체에 저장된 컴퓨터프로그램 |
| JP2022069057A (ja) * | 2020-10-23 | 2022-05-11 | パナソニックホールディングス株式会社 | 位置推定システム |
| JP7511504B2 (ja) | 2021-02-16 | 2024-07-05 | 三菱重工業株式会社 | 移動体、移動制御システム、移動体の制御方法及びプログラム |
Family Cites Families (19)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2000234908A (ja) * | 1999-02-16 | 2000-08-29 | Toshiba Corp | 距離計 |
| US7398481B2 (en) * | 2002-12-10 | 2008-07-08 | Science Applications International Corporation (Saic) | Virtual environment capture |
| JP4256812B2 (ja) | 2004-04-26 | 2009-04-22 | 三菱重工業株式会社 | 移動体の障害物回避方法及び該移動体 |
| JP4464893B2 (ja) * | 2004-09-13 | 2010-05-19 | パナソニック株式会社 | 移動ロボット |
| CN100449444C (zh) * | 2006-09-29 | 2009-01-07 | 浙江大学 | 移动机器人在未知环境中同时定位与地图构建的方法 |
| US7826969B2 (en) * | 2006-12-21 | 2010-11-02 | Deere & Company | Determining position of a vehicle with reference to a landmark |
| US20090018712A1 (en) * | 2007-07-13 | 2009-01-15 | Jerry Richard Duncan | Method and system for remotely monitoring and controlling a vehicle via a virtual environment |
| RU2010123016A (ru) * | 2007-11-06 | 2011-12-20 | Теле Атлас Норт Америка Инк. (Us) | Способ и система для использования данных измерений от множества транспортных средств для детектирования изменений реального мира для использования при обновления карты |
| KR101202695B1 (ko) * | 2008-10-01 | 2012-11-19 | 무라다기카이가부시끼가이샤 | 자율 이동 장치 |
| JP5216690B2 (ja) * | 2009-06-01 | 2013-06-19 | 株式会社日立製作所 | ロボット管理システム、ロボット管理端末、ロボット管理方法およびプログラム |
| JP2011128899A (ja) * | 2009-12-17 | 2011-06-30 | Murata Machinery Ltd | 自律移動装置 |
| GB2489179B (en) * | 2010-02-05 | 2017-08-02 | Trimble Navigation Ltd | Systems and methods for processing mapping and modeling data |
| CN102062587B (zh) * | 2010-12-13 | 2013-02-20 | 上海克来机电自动化工程有限公司 | 基于激光传感器的多移动机器人位姿测定方法 |
| US8863256B1 (en) * | 2011-01-14 | 2014-10-14 | Cisco Technology, Inc. | System and method for enabling secure transactions using flexible identity management in a vehicular environment |
| US9020637B2 (en) * | 2012-11-02 | 2015-04-28 | Irobot Corporation | Simultaneous localization and mapping for a mobile robot |
| JP6132659B2 (ja) * | 2013-02-27 | 2017-05-24 | シャープ株式会社 | 周囲環境認識装置、それを用いた自律移動システムおよび周囲環境認識方法 |
| CN103198751B (zh) * | 2013-03-06 | 2015-03-04 | 南京邮电大学 | 一种移动机器人基于激光测距仪的线特征地图创建方法 |
| JP2015055606A (ja) * | 2013-09-13 | 2015-03-23 | 株式会社オートネットワーク技術研究所 | 距離計測システム及び３次元画像生成システム |
| JP6450273B2 (ja) * | 2015-07-08 | 2019-01-09 | 本田技研工業株式会社 | 移動ロボットの動作環境情報生成装置 |
-
2017
- 2017-01-26 JP JP2017012439A patent/JP6809913B2/ja active Active
-
2018
- 2018-01-24 US US15/878,968 patent/US10976749B2/en active Active
- 2018-01-25 CN CN201810075295.7A patent/CN108363391B/zh active Active
Also Published As
| Publication number | Publication date |
|---|---|
| US20180210455A1 (en) | 2018-07-26 |
| CN108363391B (zh) | 2022-04-15 |
| CN108363391A (zh) | 2018-08-03 |
| JP2018120482A (ja) | 2018-08-02 |
| US10976749B2 (en) | 2021-04-13 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP7352318B2 (ja) | ロボット汎用の充電台帰還充電制御方法、チップ及びロボット | |
| US10705528B2 (en) | Autonomous visual navigation | |
| JP4682973B2 (ja) | 移動経路作成方法、自律移動体および自律移動体制御システム | |
| US10345821B2 (en) | Floor-treatment apparatus and navigation system therefor | |
| US20210141389A1 (en) | Autonomous Map Traversal with Waypoint Matching | |
| US11829147B2 (en) | Path planning | |
| JP2022542807A (ja) | 中間ウェイポイント生成器 | |
| JP4670807B2 (ja) | 移動経路作成方法、自律移動体および自律移動体制御システム | |
| CN113156956B (zh) | 机器人的导航方法、芯片及机器人 | |
| JP6771588B2 (ja) | 移動体および移動体の制御方法 | |
| CN107179082B (zh) | 基于拓扑地图和度量地图融合的自主探索方法和导航方法 | |
| JP6809913B2 (ja) | ロボット、ロボットの制御方法、および地図の生成方法 | |
| US9599987B2 (en) | Autonomous mobile robot and method for operating the same | |
| EP2870513A1 (en) | Autonomous mobile robot and method for operating the same | |
| WO2023130766A1 (zh) | 机器人的路径规划方法、电子设备及计算机可读存储介质 | |
| CN113110497A (zh) | 基于导航路径的沿边绕障路径选择方法、芯片及机器人 | |
| Karkowski et al. | Real-time footstep planning using a geometric approach | |
| JP2011141663A (ja) | 無人搬送車、および、その走行制御方法 | |
| CN112363491B (zh) | 机器人掉头控制方法及装置 | |
| CN114136318A (zh) | 一种机器智能导航方法和装置 | |
| KR101635585B1 (ko) | 무인 이동체 원격 제어 장치 | |
| US20240142992A1 (en) | Map generation device and map generation system | |
| EP4409372A1 (en) | Electronic system for indoor navigation control of one or more robots | |
| KR101619350B1 (ko) | 위치 기반 무인 이동체 원격 제어 방법 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| RD02 | Notification of acceptance of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7422 Effective date: 20190718 |
|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20190829 |
|
| RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20191121 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20200624 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20200707 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20200827 |
|
| 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: 20201208 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20201210 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 6809913 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |