JP7083142B2 - 移動装置、駆動制御方法、及び駆動制御プログラム - Google Patents
移動装置、駆動制御方法、及び駆動制御プログラム Download PDFInfo
- Publication number
- JP7083142B2 JP7083142B2 JP2017119609A JP2017119609A JP7083142B2 JP 7083142 B2 JP7083142 B2 JP 7083142B2 JP 2017119609 A JP2017119609 A JP 2017119609A JP 2017119609 A JP2017119609 A JP 2017119609A JP 7083142 B2 JP7083142 B2 JP 7083142B2
- Authority
- JP
- Japan
- Prior art keywords
- moving device
- region
- unit
- moving
- pass
- 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 36
- 238000001514 detection method Methods 0.000 claims description 28
- 238000003384 imaging method Methods 0.000 claims description 7
- 238000012545 processing Methods 0.000 description 19
- 238000010586 diagram Methods 0.000 description 8
- 230000006870 function Effects 0.000 description 5
- 238000005259 measurement Methods 0.000 description 5
- 230000005540 biological transmission Effects 0.000 description 4
- 230000007246 mechanism Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000004891 communication Methods 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 238000012790 confirmation Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000001678 irradiating effect Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
図1は、本発明に係る移動装置の構成図である。図1に示すように、移動装置1は、例示的に、物体を撮像するカメラ12A(撮像部)と、例えば赤外線レーザー等を含む送信波を照射するレーザーレンジファインダ(以下、LRFという。)12B(照射部)と、カメラ12A及びLRF12Bの少なくとも一方から取得した情報と後述する地図情報とに基づいて移動装置1の移動を制御する中央処理装置10と、移動装置1の移動を実行する駆動部20と、を備える。
<第1実施形態>
第1実施形態においては、移動経路上を自律走行する移動装置において、移動経路に閉扉状態のドアが配置されている場合であって移動装置が、当該ドアが開扉したことを確認したときに当該ドアを通過し自律走行を再開する、移動装置の移動制御処理を説明する。
図3に示す情報取得部41は、図5に示すように移動装置1の出発地A(第1地点)から目的地B(第2地点)までの移動経路Rを示す移動経路情報と、移動経路Rの少なくとも一部を含む所定の範囲に配置された一以上のドアDの配置位置を示す配置位置情報と、を含む地図情報を取得する。
図3に示す経路決定部43は、出発地Aから目的地Bまでの特定の移動経路Rを決定する。例えば、出発地Aから目的地Bまでの移動経路が複数ある場合に最短の移動経路を最適移動経路として決定する。また、出発地Aから目的地Bまでの移動経路が複数ある場合には、最もドアを通過する回数の少ない経路を最適移動経路として決定してもよい。ここで、経路決定部43は、記録部18が予め移動経路情報を記録していない場合は、出発地A及び目的地Bの位置情報に基づいて移動経路Rを生成した上で、最適な移動経路Rを決定するように構成されてもよい。
図5に示す移動装置1は、決定された移動経路Rに沿って移動する。
図2に示すセンサ12は、構造物を検出したか否か判断する。センサ12が、移動経路R上で構造物を検出しない場合(Noの場合)は、ステップS20に進み、自律走行を継続する。他方、センサ12が移動経路Rに配置された構造物としてのドアDを検出する場合(Yesの場合)は、ステップS11に進む。具体的には、図3に示す物体特定部45は、図2に示すカメラ12Aにより人物及び構造物を撮像することにより得られた画像情報(第1画像情報)と、記録部18にあらかじめ記録されている人物及び構造物の画像情報と、を比較することにより、人物及び構造物を特定する。
図5の時間T2に示すように、図2に示す通知部16は、センサ12がドアDを検出した場合であってドアDが閉扉状態であるときに、当該ドアDの開扉をユーザUに要求するために通知を発する。例えば、通知部16は、発光素子を発光させることでユーザUに通知を実行してもよいし、「ドアDを開けてください。」と音声出力により通知を実行してもよい。そして、図5の時間T3に示すように、ユーザUは、移動装置1からの通知に基づいてドアDを開けるためドアDの前まで進行する。
図5の時間T3~T4に示すように、ユーザUがドアDを開ける。移動装置1は、ドアDが開いてドアDが配置されている領域R1を通過可能となるまでその場で待機する。
図3に示す通過可否判断部47は、センサ12の検出結果に基づいてドアDが開いて移動装置1が、ドアDが配置されている領域R1を通過可能か否か判断する。例えば、通過可否判断部47は、図2に示すカメラ12AによりドアDを撮像することにより得られた画像情報(第1画像情報)に基づいて領域R1を通過可能であるか否かを判断する。より具体的には、通過可否判断部47は、図2に示す記録部18があらかじめ記録するドアDの閉扉状態の画像情報及びドアDの開扉状態の画像情報と、カメラ12AによりドアDを撮像することにより得られた画像情報(第1画像情報)と、を比較することにより、現時点でドアDが開扉状態となっており、領域R1を通過可能か否か判断する。
図3に示す駆動制御部51は、移動装置1が領域R1を通過するように移動装置1を駆動する。駆動制御部51は、後述するとおり、距離測定部49が測定する、移動装置1が領域R1を通過可能な距離に基づいて、移動装置1を駆動してもよい。例えば、距離測定部49は、カメラ12AによりドアDを撮像することにより得られた画像情報(第1画像情報)と地図情報とに基づいて、移動装置1からドアDまでの距離、つまり、移動装置1が領域R1を通過するための最低限の距離を測定する。より具体的には、距離測定部49は、カメラ12AがドアDを撮像することにより得られた画像情報に基づくドアDの第1特徴点情報に対して、地図情報として記録部18に予め記録されているドアDの第2特徴点情報と、当該第2特徴点情報を取得する際の撮像距離と、の関係を参照することで、移動装置1からドアDまでの距離を測定する。なお、距離測定部49は、移動装置1からドアDまでの距離ではなく、移動装置1からドアDを通過した(ドアDの後ろの)所定の位置までの距離を測定してもよい。
移動装置1が目的地Bに到着する場合(Yesの場合)、移動制御処理を終了する。他方、移動装置が目的地に到着しない場合(Noの場合)、ステップS5に戻り、引き続き移動経路Rに沿って自律移動を継続する。
第2実施形態においては、移動経路上を、ユーザを先導しながら、又は、ユーザに追従しながら走行する移動装置において、移動経路に閉扉状態のドアが配置されている場合であって移動装置が、当該ドアが開扉したことを確認したときに当該ドアを通過し、移動を再開する、移動装置の移動制御処理を説明する。第2実施形態においては、第1実施形態と異なる点において説明する。特に、図7の説明については、図4と異なる点について主に説明する。
図8の時間T2に示すように、図2に示す通知部16は、図2に示すセンサ12がドアDを検出した場合であってドアDが閉扉状態であるときに、当該ドアDの開扉を先導対象であるユーザUに要求するために通知を発する。そして、図8の時間T3に示すように、ユーザUは、移動装置1からの通知に基づいてドアDを開けるためにドアDの前まで進行する。
先導対象であるユーザUによりドアDが開扉され、移動装置1が、ドアDが配置された領域R1と停止禁止領域R2とを通過する。
図3に示す駆動制御部51は、ドアDの閉扉に邪魔にならない位置で移動装置1が待機するように制御する。このように、移動装置1は、図8の時間T2において、ユーザUを先導するための先導走行を停止し、ユーザUを先導することなく、後述するとおり、ユーザUがドアDを開扉し、移動装置1が、ドアDが配置された領域R1と停止禁止領域R2とを通過し、ドアDの閉扉に邪魔にならない位置まで迅速に移動する。
まず、図8の時間T7~T8に示すように、ユーザUは移動装置1が領域R1及びR2を通過したことを確認すると、ドアDを閉扉し、待機している移動装置1から所定の距離離れた所定の位置(先導走行位置)に移動する。そして、図8の時間T9に示すように、移動装置1は、ユーザUが所定の先導走行位置に到達した場合に、先導移動を再開する。具体的に、移動装置1の距離測定部49は、移動装置1からユーザUまでの距離に基づいて決定される移動装置1の現在位置に対するユーザUの相対位置を決定し、駆動制御部51は、移動装置1が決定されたユーザUの相対位置が、例えば記録部18に記録されている、予め設定された移動物体1に対するユーザUの相対位置と一致するときに、移動装置1の移動を再開する。
図9の時間T2に示すように、図2に示す通知部16は、図2に示すセンサ12がドアDを検出した場合であってドアDが閉扉状態であるときに、当該ドアDの開扉を追従対象であるユーザUに要求するために通知を発する。そして、図9の時間T3に示すように、ユーザUは、移動装置1からの通知に基づいてドアDを開けるためにドアDの前まで進行する。
追従対象であるユーザUによりドアDが開扉され、移動装置1が、ドアDが配置された領域R1と停止禁止領域R2とを通過する。
図3に示す駆動制御部51は、ドアDの閉扉に邪魔にならない位置で移動装置1が待機するように制御する。このように、移動装置1は、図9の時間T2において、ユーザUを追従するための追従走行を停止し、ユーザUを追従することなく、後述するとおり、ユーザUがドアDを開扉し、移動装置1が、ドアDが配置された領域R1と停止禁止領域R2とを通過し、ドアDの閉扉に邪魔にならない位置まで迅速に移動する。
まず、図9の時間T7~T8に示すように、ユーザUは移動装置1が領域R1及びR2を通過したことを確認すると、ドアDを閉扉し、待機している移動装置1から所定の距離離れた所定の位置(追従走行位置)に移動する。そして、図9の時間T9に示すように、移動装置1は、ユーザUが所定の追従走行位置に到達した場合に、追従移動を再開する。また、移動装置1は、ユーザからの移動再開の指示を受け付ける場合に、追従移動を再開してもよい。
以上、本発明の実施形態によれば、移動装置1からドアD(構造物)までの距離を測定し、センサ12の検出結果に基づいて、移動装置1が移動経路RにおけるドアDが配置された領域を通過可能であるか否かを判断し、当該領域を通過可能である場合に、測定された距離に基づいて当該領域を通過するように移動装置1を駆動する。よって、移動経路Rに沿って移動する移動装置1であって構造物が配置された領域の状況に応じて適切に移動することができる。
上記各実施形態は、本発明の理解を容易にするためのものであり、本発明を限定して解釈するものではない。本発明はその趣旨を逸脱することなく、変更/改良(たとえば、各実施形態を組み合わせること、各実施形態の一部の構成を省略すること)され得るとともに、本発明にはその等価物も含まれる。例えば、出発地Aと目的地Bとは、互いに異なる地域や施設に配置されてもよいし、同一施設において異なるフロアや部屋に配置されてもよい。つまり、移動経路Rは、異なる地域や施設に跨って設定されてもよいし、同一施設において異なるフロアや部屋に跨って設定されてもよい。
10:中央処理装置
12:センサ
12A:カメラ
12B:LRF
14:受付部
16:通知部
18:記録部
20:記録部
22:電源部
41:情報取得部
43:経路決定部
45:物体特定部
47:通過可否判断部
49:距離測定部
51:駆動制御部
Claims (10)
- 第1地点から第2地点までの移動経路に沿って移動する移動装置であって、
前記移動経路を示す移動経路情報と、前記移動経路の少なくとも一部を含む所定の範囲に配置された一以上の構造物であって状態が変化する構造物の配置位置を示す配置位置情報と、を含む地図情報を取得する取得部と、
前記移動経路に配置された前記構造物を検出する検出部と、
前記検出部の検出結果に基づいて前記構造物の状態を判断し、判断した前記状態に応じて、前記移動装置が前記移動経路における当該構造物が配置された第1領域を通過可能であるか否かを判断する通過可否判断部と、
前記第1領域を通過可能である場合に、前記第1領域を通過するように前記移動装置を駆動する駆動制御部と、を備え、
前記駆動制御部は、前記移動装置が前記第1領域を通過した後に前記移動経路上の所定の位置に停止している場合であって、前記移動装置からユーザまでの距離に基づいて決定される前記移動装置の現在位置に対する前記ユーザの相対位置が予め設定された前記移動物体に対する前記ユーザの相対位置と一致するときに、前記移動装置の移動を再開する、
移動装置。 - 前記検出部の検出結果と前記地図情報とに基づいて、前記第1領域を通過可能な距離を測定する距離測定部を更に備える、
請求項1に記載の移動装置。 - 前記検出部は、前記構造物を含むように前記移動装置の周囲を撮像する撮像部を備え、
前記通過可否判断部は、前記撮像部により前記構造物を撮像することにより得られた第1画像情報に基づいて前記第1領域を通過可能であるか否かを判断し、
前記距離測定部は、前記第1画像情報と前記地図情報とに基づいて、前記第1領域を通過可能な距離を測定する、
請求項2に記載の移動装置。 - 前記検出部は、前記構造物を含む所定の範囲に対して送信波を照射する照射部を備え、
前記通過可否判断部は、照射された前記送信波の反射波に基づいて前記第1領域を通過可能か否か判断し、
前記距離測定部は、前記反射波と前記地図情報とに基づいて、前記第1領域を通過可能な距離を測定する、
請求項2又は3に記載の移動装置。 - 前記移動経路には前記移動装置が通過することを許容し、且つ、前記移動装置が停止することを禁止する第2領域が設定されている、
請求項1~4のいずれか一項に記載の移動装置。 - 前記第2領域は、前記第1領域に隣接するように設定されている、
請求項5に記載の移動装置。 - ユーザからの指示を受け付ける受付部を更に備え、
前記駆動制御部は、前記移動装置が前記第1領域を通過した後に前記移動経路上の所定の位置に停止している場合であって、前記指示を受け付けるときに前記移動装置の移動を再開する、
請求項1~6のいずれか一項に記載の移動装置。 - 発光素子及び音声出力部の少なくとも一方を含む通知部を更に備え、
前記通知部は、前記検出部が前記構造物を検出したときに前記発光素子の発光及び音声出力の少なくとも一方に基づく通知を実行する、
請求項1~7のいずれか一項に記載の移動装置。 - 第1地点から第2地点までの移動経路に沿って移動する移動装置の駆動を制御する駆動制御方法であって、
前記移動経路を示す移動経路情報と、前記移動経路の少なくとも一部を含む所定の範囲に配置された一以上の構造物であって状態が変化する構造物の配置位置を示す配置位置情報と、を含む地図情報を取得するステップと、
前記移動経路に配置された前記構造物を検出するステップと、
前記検出するステップの検出結果に基づいて前記構造物の状態を判断し、判断した前記状態に応じて、前記移動装置が前記移動経路における当該構造物が配置された第1領域を通過可能であるか否かを判断するステップと、
前記第1領域を通過可能である場合に、前記第1領域を通過するように前記移動装置を駆動するステップと、
を含み、
前記駆動するステップは、前記移動装置が前記第1領域を通過した後に前記移動経路上の所定の位置に停止している場合であって、前記移動装置からユーザまでの距離に基づいて決定される前記移動装置の現在位置に対する前記ユーザの相対位置が予め設定された前記移動物体に対する前記ユーザの相対位置と一致するときに、前記移動装置の移動を再開する、
駆動制御方法。 - 第1地点から第2地点までの移動経路に沿って移動する移動装置の駆動を制御する駆動制御プログラムであって、
コンピュータに、
前記移動経路を示す移動経路情報と、前記移動経路の少なくとも一部を含む所定の範囲に配置された一以上の構造物であって状態が変化する構造物の配置位置を示す配置位置情報と、を含む地図情報を取得する取得部と、
前記移動経路に配置された前記構造物を検出する検出部と、
前記検出部の検出結果に基づいて前記構造物の状態を判断し、判断した前記状態に応じて、前記移動装置が前記移動経路における当該構造物が配置された第1領域を通過可能であるか否かを判断する通過可否判断部と、
前記第1領域を通過可能である場合に、前記第1領域を通過するように前記移動装置を駆動する駆動制御部と、
を実現させ、
前記駆動制御部は、前記移動装置が前記第1領域を通過した後に前記移動経路上の所定の位置に停止している場合であって、前記移動装置からユーザまでの距離に基づいて決定される前記移動装置の現在位置に対する前記ユーザの相対位置が予め設定された前記移動物体に対する前記ユーザの相対位置と一致するときに、前記移動装置の移動を再開する、
駆動制御プログラム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017119609A JP7083142B2 (ja) | 2017-06-19 | 2017-06-19 | 移動装置、駆動制御方法、及び駆動制御プログラム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017119609A JP7083142B2 (ja) | 2017-06-19 | 2017-06-19 | 移動装置、駆動制御方法、及び駆動制御プログラム |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2019003540A JP2019003540A (ja) | 2019-01-10 |
JP7083142B2 true JP7083142B2 (ja) | 2022-06-10 |
Family
ID=65006008
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2017119609A Active JP7083142B2 (ja) | 2017-06-19 | 2017-06-19 | 移動装置、駆動制御方法、及び駆動制御プログラム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP7083142B2 (ja) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11370497B2 (en) | 2016-10-18 | 2022-06-28 | Piaggio Fast Forward, Inc. | Vehicle having non-axial drive and stabilization system |
IT201700114497A1 (it) | 2017-10-11 | 2019-04-11 | Piaggio Fast Forward Inc | Veicolo a due ruote con sistema di stabilizzazione lineare |
CA3098000C (en) | 2018-05-01 | 2021-12-07 | Piaggio Fast Forward, Inc. | Method for determining self-driving vehicle behavior models, a self-driving vehicle, and a method of navigating a self-driving vehicle |
KR20210078498A (ko) | 2018-10-22 | 2021-06-28 | 피아지오 패스트 포워드 인코포레이티드 | 변위 장치 조립체와 이를 구비하는 모바일 캐리어 |
JP7507393B2 (ja) * | 2020-07-31 | 2024-06-28 | パナソニックIpマネジメント株式会社 | 隊列走行システム |
KR20230048072A (ko) | 2020-08-06 | 2023-04-10 | 피아지오 패스트 포워드 인코포레이티드 | 페어 모드 및 스마트 거동 모드를 갖는 에티켓-기반 차량 및 이를 위한 제어 시스템들 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012108756A (ja) | 2010-11-18 | 2012-06-07 | Toyota Motor Corp | 環境地図生成方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006236098A (ja) * | 2005-02-25 | 2006-09-07 | Mitsubishi Heavy Ind Ltd | 移動体の障害物回避方法及び該移動体 |
JP2009169802A (ja) * | 2008-01-18 | 2009-07-30 | Panasonic Corp | 自律走行装置およびプログラム |
JP5614202B2 (ja) * | 2010-09-24 | 2014-10-29 | トヨタ自動車株式会社 | ロボット |
-
2017
- 2017-06-19 JP JP2017119609A patent/JP7083142B2/ja active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012108756A (ja) | 2010-11-18 | 2012-06-07 | Toyota Motor Corp | 環境地図生成方法 |
Also Published As
Publication number | Publication date |
---|---|
JP2019003540A (ja) | 2019-01-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP7083142B2 (ja) | 移動装置、駆動制御方法、及び駆動制御プログラム | |
US11407116B2 (en) | Robot and operation method therefor | |
US11725956B2 (en) | Apparatus for acquiring 3-dimensional maps of a scene | |
US20210260773A1 (en) | Systems and methods to control an autonomous mobile robot | |
KR102142162B1 (ko) | 로봇 위치 선정 시스템 | |
KR102348041B1 (ko) | 복수의 이동 로봇을 포함하는 로봇 시스템의 제어 방법 | |
KR102608046B1 (ko) | 공항용 안내 로봇 및 그의 동작 방법 | |
JP4352034B2 (ja) | 物体位置検出装置、地図作成装置、自律移動装置、物体位置検出方法および物体位置検出プログラム | |
US9563205B2 (en) | Sensor configurations and methods for mobile robot | |
US20160114488A1 (en) | Customer service robot and related systems and methods | |
US20150046018A1 (en) | Autonomous moving body, obstacle sensing method, and obstacle avoiding method | |
Fusco et al. | Indoor localization for visually impaired travelers using computer vision on a smartphone | |
JP6986662B2 (ja) | 通知装置、自動運転車両、通知方法、プログラム、非一時的記録媒体、および通知システム | |
WO2019179443A1 (zh) | 智能设备的持续唤醒方法、装置、智能设备和存储介质 | |
KR102559745B1 (ko) | 공항 로봇 및 그를 포함하는 공항 로봇 시스템 | |
CN107390721A (zh) | 机器人随行控制方法、装置及机器人 | |
JP2004299025A (ja) | 移動ロボット制御装置、移動ロボット制御方法及び移動ロボット制御プログラム | |
JP7476924B2 (ja) | ロボット、コミュニケーション方法及びプログラム | |
KR102648103B1 (ko) | 안내 로봇 | |
JP2008238383A (ja) | ロボット | |
KR102599784B1 (ko) | 공항 로봇 | |
KR20190003124A (ko) | 이동 로봇의 동작 방법 | |
KR20200087361A (ko) | 이동 로봇 및 그 구동 방법 | |
JP2019145039A (ja) | 自走式ロボットおよび自走式ロボットの制御方法 | |
JP6595284B2 (ja) | 自律移動ロボット |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20200616 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20210601 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20210729 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20211215 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20220218 |
|
C60 | Trial request (containing other claim documents, opposition documents) |
Free format text: JAPANESE INTERMEDIATE CODE: C60 Effective date: 20220218 |
|
C11 | Written invitation by the commissioner to file amendments |
Free format text: JAPANESE INTERMEDIATE CODE: C11 Effective date: 20220304 |
|
A911 | Transfer to examiner for re-examination before appeal (zenchi) |
Free format text: JAPANESE INTERMEDIATE CODE: A911 Effective date: 20220322 |
|
C21 | Notice of transfer of a case for reconsideration by examiners before appeal proceedings |
Free format text: JAPANESE INTERMEDIATE CODE: C21 Effective date: 20220323 |
|
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: 20220427 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20220524 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7083142 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |