JP2021018485A - 移動体の制御装置及び移動体 - Google Patents
移動体の制御装置及び移動体 Download PDFInfo
- Publication number
- JP2021018485A JP2021018485A JP2019132158A JP2019132158A JP2021018485A JP 2021018485 A JP2021018485 A JP 2021018485A JP 2019132158 A JP2019132158 A JP 2019132158A JP 2019132158 A JP2019132158 A JP 2019132158A JP 2021018485 A JP2021018485 A JP 2021018485A
- Authority
- JP
- Japan
- Prior art keywords
- moving body
- moving
- unit
- posture
- information
- 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
- 238000012545 processing Methods 0.000 description 25
- 238000000034 method Methods 0.000 description 19
- 230000010365 information processing Effects 0.000 description 14
- 238000004891 communication Methods 0.000 description 13
- 230000008569 process Effects 0.000 description 9
- 230000008859 change Effects 0.000 description 8
- 238000010586 diagram Methods 0.000 description 5
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000012544 monitoring process Methods 0.000 description 3
- 239000004065 semiconductor Substances 0.000 description 3
- 238000012546 transfer Methods 0.000 description 3
- 230000001174 ascending effect Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000015654 memory Effects 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 235000009434 Actinidia chinensis Nutrition 0.000 description 1
- 244000298697 Actinidia deliciosa Species 0.000 description 1
- 235000009436 Actinidia deliciosa Nutrition 0.000 description 1
- 241000699670 Mus sp. Species 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 239000003638 chemical reducing agent Substances 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 239000000758 substrate Substances 0.000 description 1
Images
Classifications
-
- 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
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/72—Electric energy management in electromobility
Landscapes
- Handcart (AREA)
- Electric Propulsion And Braking For Vehicles (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
【課題】移動体の構造にかかわらず、複数のオムニホイールを有する移動体の段差乗り越え性能を向上させることができる移動体の制御装置及び移動体を提供する。【解決手段】制御装置2は、複数のオムニホイール6を有し、複数のオムニホイール6の1つ以上を回転させながら移動する移動体1の制御を行う。制御装置2は、移動体1の移動方向における段差の有無を判断する判断部55と、判断部55により移動体1の移動方向において段差があると判断された場合に、複数のオムニホイール6の全てを回転させて移動方向に移動体1を移動させ、移動体1を段差に進入させる回転制御部57とを備える。制御装置2により、移動体1の構造にかかわらず移動体1の段差乗り越え性能を向上させることができる。【選択図】図2
Description
本発明は、複数のオムニホイールを備える移動体の制御装置及び移動体に関するものである。
従来、複数のオムニホイールを備える移動体がある(例えば、特許文献1参照)。
この種の移動体においては、移動体が移動する路面上に段差があると、段差進入時の移動体の姿勢によっては、オムニホイールの段差への引っかかりが生じることがある。このような問題点に関し、オムニホイールの外側に段差乗り越え用のガードを設けた構造を有する自走式搬送台車がある(例えば、特許文献2参照)。また、移動台車が走行する床面の段差を検出し、段差を乗り越えられるようにオムニホイールを垂直軸周りに旋回させる走行制御方法がある(例えば、特許文献3参照)。
なお、下記特許文献4には、自律移動体において、進行方向に段差があると認識した場合に駆動輪が従動キャスタよりも先に段差に接触するように基体の向きを変更することが開示されている。
しかしながら、上述の特許文献2や特許文献3に記載されているような、オムニホイールの外側にガードを設けた構造や、オムニホイールを垂直軸周りに旋回させる構造を採用すると、移動体の構造が複雑になるという問題がある。
この発明はそのような問題点を解決するためになされたものであり、移動体の構造にかかわらず、複数のオムニホイールを有する移動体の段差乗り越え性能を向上させることができる移動体の制御装置及び移動体を提供することを目的とする。
本第一の発明の制御装置は、複数のオムニホイールを有し、複数のオムニホイールの1つ以上を回転させながら移動する移動体の制御装置であって、移動体の移動方向における段差の有無を判断する判断部と、判断部により移動体の移動方向において段差があると判断された場合に、複数のオムニホイールの全てを回転させて移動方向に移動体を移動させ、移動体を段差に進入させる回転制御部とを備える、制御装置である。
かかる構成により、移動体の構造にかかわらず、複数のオムニホイールを有する移動体の段差乗り越え性能を向上させることができる。
また、本第二の発明の制御装置は、第一の発明に対して、移動体の移動経路を取得する移動経路取得部をさらに備え、判断部は、移動経路取得部により取得された移動経路に基づいて、移動体の移動方向における段差の有無を判断する、制御装置である。
かかる構成により、段差の有無について高精度な判断を行うことができる。
また、本第三の発明の制御装置は、第一又は二の発明に対して、移動体に設けられているセンサにより検知された移動体の移動方向における周囲の状況に関するセンサ情報を取得するセンサ情報取得部をさらに備え、判断部は、センサ情報取得部により取得されたセンサ情報に基づいて、移動体の移動方向における段差の有無を判断する、制御装置である。
かかる構成により、実際の移動体の周囲の状況に基づいて段差の有無に関する判断を行うことができる。
また、本第四の発明の制御装置は、第一から三のいずれか1つの発明に対して、回転制御部は、判断部により移動体の移動方向において段差があると判断された場合に、複数のオムニホイールの全てが回転することにより移動方向に移動体が移動するように、移動方向に対する移動体の姿勢を設定する姿勢設定部を有し、姿勢設定部により設定された姿勢で移動方向に移動体を移動させ、移動体を段差に進入させる、制御装置である。
かかる構成により、より確実に移動体の段差乗り越え性能を向上させることができる。
また、本第五の発明の制御装置は、第四の発明に対して、姿勢設定部により設定される移動体の姿勢は、複数のオムニホイールのいずれについても、平面視におけるオムニホイールの駆動軸と移動体の移動方向とがなす角度が所定の角度以上になる姿勢である、制御装置である。
かかる構成により、より確実に移動体の段差乗り越え性能を向上させることができる。
また、本第六の発明の移動体は、第一から五のいずれか1つの発明の制御装置と、複数のオムニホイールを有し、制御装置の制御に応じて複数のオムニホイールのそれぞれを回転させる駆動部とを備える、移動体である。
本発明によれば、移動体の構造にかかわらず、複数のオムニホイールを有する移動体の段差乗り越え性能を向上させることができる移動体の制御装置及び移動体を提供することができる。
以下、移動体の制御装置等の実施形態について図面を参照して説明する。なお、実施の形態において同じ符号を付した構成要素は同様の動作を行うので、再度の説明を省略する場合がある。
(実施の形態1)
実施の形態1において、複数のオムニホイールを有する移動体に、移動体の制御装置が設けられている。移動体の制御装置は、移動体の移動方向において段差(ここでは、低い側の路面から高い側の路面に移る際の段差)がある場合に、複数のオムニホイールの全てを回転させて、移動体を移動方向に移動させる。以下、このような移動体の構成について説明する。
なお、移動方向とは、移動体がこれから移動する方向である。換言すると、移動体は、移動方向に向けて移動する。移動体の移動方向において段差があるということは、その後に移動体が移動方向に移動すると移動体が段差に進入することを意味する。
また、移動体の姿勢とは、ここでは、移動体の移動方向に対する移動体自体の向きをいう。
また、移動経路とは、移動体が移動路面上で移動するときの経路である。移動体は、予め設定された移動経路に沿って移動する。なお、これに限られず、移動体は、随時次の移動方向を動的に決定しながら移動するように構成されていてもよい。この場合においても、移動体は、動的に設定された移動経路に沿って移動するということができる。
図1は、本発明の実施の形態1に係る移動体1の概略構成を示す平面図である。
図1に示されるように、本実施の形態において、移動体1は、移動体1が移動する移動路面に接地する3つのオムニホイール6を有しており、3つのオムニホイールの1つ以上を回転させながら移動する。なお、オムニホイール6の数は3つに限られない。また、移動体1は、複数のオムニホイール6を用いて移動するものであれば、どのようなものであってもよい。例えば、移動体1は、台車であってもよく、ロボットであってもよい。ロボットは、例えば、エンターテイメントロボットであってもよく、監視ロボットであってもよく、搬送ロボットであってもよく、その他のロボットであってもよい。
本実施の形態において、移動体1は、例えば、制御装置2と、センサ4と、3つの駆動部5と、3つのオムニホイール6とを備えている。なお、図において、説明の便宜上、移動体1の前面が符号Frで示されている。
駆動部5は、例えば、モータなどで構成されている。駆動部5は、それぞれのオムニホイール6を駆動する。なお、図1では図示していないが、駆動部5の駆動を制御する制御部やドライバ、駆動部5に電力を供給するバッテリー等を移動体1が有していてもよい。また、駆動部5は、オムニホイール6を駆動できるものであれば、どのようなものであってもよい。駆動部5は、減速機を有していてもよいし、減速機を有していなくてもよい。
オムニホイール6は、駆動軸7と、主輪8と、バレル9とを有している。駆動軸7は、駆動部5に接続されている。主輪8は、駆動軸7を中心に、駆動部5の駆動力により回転する。バレル9は、主輪8に対して回転自在となるように、主輪8に支持されている。移動体1が略水平である移動路面上にあるとき、オムニホイール6のそれぞれが移動路面に接地し、駆動軸7は、移動路面に対して略平行となるように配置されている。
本実施の形態では、主輪8は、2つの車輪が同軸に重ねられた形状を有している。それぞれの車輪の外周上には、4つのバレル9が均等な間隔で配置されている。換言すると、主輪8には、主輪8の外周上に周方向に等間隔に並ぶ4つのバレル9が2組設けられている。2組の4つのバレル9は、それぞれのバレル9が周方向において互い違いに位置するように配置されている。すなわち、オムニホイール6は、主輪8が回転する間において、バレル9のいずれかが移動路面に接触するように構成されている。なお、主輪8に含まれる車輪の数やバレル9の数は上記に限られるものではない。
3つのオムニホイール6は、円周R0上に略等間隔に並んでいる。すなわち、オムニホイール6は、平面視(本実施の形態では、移動路面に略垂直な方向(鉛直方向)から見た状態をいう)で、円周R0上に120度間隔で配置されている。また、オムニホイール6の回転面は、円周R0の接線方向となるようにオムニホイール6が配置されている。換言すると、各オムニホイール6は、その駆動軸7の方向が円周R0の半径方向となるように配置されている。
図1で示されるように、3個以上のオムニホイール6を有する移動体1は、各駆動部5により1つ以上のオムニホイール6を同時に駆動させることで、移動路面に略平行である面内のどの方向(水平方向)にも移動できる。
センサ4は、例えば、周囲の画像を撮影するカメラや、周囲の物体との距離を測定可能なレーダ測距センサや、周囲の装置等と無線通信を行うことにより周囲の状況を検知する無線通信装置や、物体との接触を検知する感圧センサなどであるが、これらに限られない。センサ4は、移動体1の移動方向における周囲の状況を検知して、センサ情報を出力する。センサ情報は、例えば、周囲の物体までの距離の測定結果であってもよいし、周囲の画像の撮影結果であってもよいし、周囲の装置等との無線通信の結果や電波強度などであってもよいが、これらに限られない。センサ4として複数種類のセンサが設けられていてもよい。また、センサ4は、移動体1の進行方向前方に存在する物体を検知するように設けられていてもよい。具体的には、移動体1の進行方向前方に、超音波センサやレーザーセンサ、感圧センサ等が設けられていてもよい。
図2は、同移動体1の構成を示すブロック図である。
図2に示されるように、制御装置2は、格納部20と、処理部50と、通信部90とを有する。制御装置2は、例えば、MPUやメモリ等から実現されうる。制御装置2の処理手順は、通常、ソフトウェアで実現され、当該ソフトウェアはROM等の記録媒体に記録されている。但し、ハードウェア(専用回路)で実現してもよい。
制御装置2には、センサ4や、3つの駆動部5が接続されている。制御装置2には、センサ4から出力されたセンサ情報が入力される。また、制御装置2は、各駆動部5の動作を制御する。換言すると、制御装置2は、各駆動部5の動作を制御することにより各オムニホイール6を適宜回転させて、移動体1の動作を制御する。
格納部20は、地図情報格納部21及び段差情報格納部23を備える。格納部20は、不揮発性の記録媒体が好適であるが、揮発性の記録媒体でも実現可能である。格納部20には、例えば後述のような処理部50の各部によって取得された情報や、処理部50の各部によって生成された情報などが格納されるが、これに限られない。格納部20に情報等が記憶される過程は、特定のものに限られない。例えば、記録媒体を介して情報等が格納部20で記憶されるようになっていてもよく、通信回線等を介して送信された情報等が格納部20で記憶されるようになっていてもよく、あるいは、入力デバイスを介して入力された情報等が格納部20で記憶されるようになっていてもよい。
地図情報格納部21には、移動体1が移動する領域に関する地図情報が格納されている。この地図情報は、後述のような移動経路取得部51による経路の取得に用いられるものである。例えば、移動経路取得部51によってノード探索法による経路の演算が行われる場合には、地図情報には、ノード探索で用いられるノードやリンクが含まれていることが好適である。その地図情報は、例えば、カーナビゲーションで用いられるKIWIフォーマットの地図情報であってもよく、ノード探索を行うことができる他のフォーマットの地図情報であってもよい。また、例えば、移動経路取得部51によって状態空間探索法による経路の演算が行われる場合には、地図情報は、移動体1の移動可能領域を示す情報であってもよい。移動可能領域を示す地図情報は、ある領域において移動体1が移動できる領域と、移動できない領域とを区別可能な情報であり、例えば、移動体1の移動領域における障害物の領域を示す情報であってもよく、移動体1の移動領域における移動体1が通行可能な領域を示す情報であってもよい。障害物の領域は、例えば、障害物の位置と大きさとによって示されてもよく、障害物の境界線や輪郭線によって示されてもよい。障害物とは、移動体1が移動する領域に継続的又は一時的に存在する、移動体1の移動の障害となるものであり、例えば、柱や壁、載置物等であってもよい。したがって、その地図情報は、例えば、柱や壁等を示す地図の情報であると考えてもよい。
段差情報格納部23には、移動体1が移動する領域の段差情報が格納されている。段差情報は、移動体1が移動する領域における段差の位置に関する情報を含む。段差情報とは、段差の位置、移動路面からの高さ、幅等を示す形状である。例えば、移動する領域にある地形(高低や傾斜などの情報)であってもよいし、移動体1が乗り越えられるか否か(例えば、所定の閾値未満の高さであるか否か)を示す情報が含まれていてもよい。段差情報として、移動体1が乗り越えられる段差に関する情報のみが含まれていてもよい。
なお、段差を、障害物の一種として捉えることも可能である。すなわち、段差情報は地図情報に含まれるものであってもよい。
処理部50は、移動経路取得部51、センサ情報取得部53、判断部55、及び回転制御部57を備える。回転制御部57は、姿勢設定部58を備える。処理部50は、これらの各部が行う処理のほか、制御装置2及び移動体1の各部の動作を制御する。
なお、取得とは、キーボードやマウス、タッチパネルなどの入力デバイスから入力された情報の受け付け、有線もしくは無線の通信回線を介して送信された情報の受信、光ディスクや磁気ディスク、半導体メモリなどの記録媒体から読み出された情報の受け付けなどにより情報を得ることを含む概念である。取得には、情報処理を行うことにより情報を生成することが含まれていてもよい。
移動経路取得部51は、移動体1の移動経路を取得する。本実施の形態において、移動経路取得部51は、移動体1の移動経路を生成する。例えば、移動経路取得部51は、ユーザから入力された情報に基づいて、移動経路を生成してもよい。移動経路取得部51は、地図情報と、ユーザから入力された移動体1の出発地の位置情報及び目的地の位置情報とに基づいて、移動経路を生成してもよい。出発地の位置情報や目的地の位置情報としては、例えば、外部の装置から送信されたものを用いるようにしてもよいし、所定の条件に基づいて、処理部50がこれらの位置情報を算出するようにしてもよい。また、例えば、移動経路取得部51は、地図情報と、移動体1の現在値の位置情報及び目的地の位置情報とに基づいて、移動経路を生成してもよい。
なお、移動経路取得部51は、例えば、ノード探索法によって移動経路の取得を行ってもよく、状態空間探索法によって移動経路の取得を行ってもよい。ノード探索法によって経路探索を行う場合には、移動経路取得部51は、あらかじめノードやリンクの設定されている地図情報を用いて、種々の公知のアルゴリズムを用いて移動経路の探索を行ってもよい。ノード探索法では、あらかじめ定められたノードをつなげた移動経路が取得されることになる。状態空間探索法によって経路探索を行う場合には、移動経路取得部51は、移動体1の移動可能領域を示す地図情報を用いて、種々の公知のアルゴリズムを用いて移動経路の探索を行ってもよい。状態空間探索法では、あらかじめノード等の設定されていない空間において、障害物を回避するように移動経路が取得されることになる。また、例えば、移動経路取得部51は、移動体1の前方が移動方向を向くように方向情報を含む経路を生成してもよい。また、例えば、移動体1が監視ロボットである場合には、移動経路取得部51は、監視に用いられるセンサ4が監視対象を向くように方向情報を含む移動経路を生成してもよい。なお、移動経路取得部51は、例えば、経路を演算することによって取得してもよいし、経路を演算するサーバ等に経路の演算の指示を送信し、その送信に応じて経路の演算結果を受信することによって経路を取得してもよい。本実施の形態では、前者の場合、すなわち移動経路取得部51によって経路の生成が行われる場合について主に説明する。
センサ情報取得部53は、移動体1に設けられているセンサ4により検知された移動体1の移動方向における周囲の状況に関するセンサ情報を取得する。
判断部55は、移動体1の移動方向における段差の有無を判断する。本実施の形態において、判断部55は、移動経路取得部51により取得された移動経路と、段差情報格納部23に格納されている段差情報とに基づいて、移動体1の移動方向における段差の有無を判断する。例えば、移動経路上に段差がある場合において、移動体1が移動方向に移動すると段差に進入することになるとき、判断部55は、移動体1の移動方向において段差があると判断する。なお、判断部55は、取得された移動経路上において段差があると判断したときに移動体1の移動方向において段差があると判断してもよいし、現実に移動体1が段差に所定距離まで近づいたときに移動体1の移動方向において段差があると判断するようにしてもよい。
なお、判断部55は、センサ情報取得部53により取得されたセンサ情報に基づいて、移動体1の移動方向における段差の有無を判断してもよい。例えば、移動体1が移動しているときに取得されたセンサ情報に基づいて、移動体1が移動を続けると進入することになる段差があると判定されたとき、判断部55は、移動体1の移動方向において段差があると判断してもよい。このようなセンサ情報を利用することにより、実際の移動体1の周囲の状況に基づいて段差の有無に関する判断を行うことができる。
回転制御部57は、駆動部5を駆動させてオムニホイール6の回転を制御することにより、移動体1の動作を制御する。本実施の形態において、回転制御部57は、移動体1が移動経路取得部51によって取得された移動経路を移動するように駆動部5を制御する。すなわち、回転制御部57は、移動経路取得部51によって取得された移動経路を移動体1が移動するように、駆動部5を制御する。なお、回転制御部57は、現在位置と移動体1の姿勢とを取得し、動的に移動方向を決定しながら移動体1を移動させるように構成されていてもよい。
本実施の形態において、回転制御部57は、判断部55により移動体1の移動方向において段差があると判断された場合に、3つのオムニホイール6の全てを回転させて移動方向に移動体1を移動させ、移動体1を段差に進入させる。本実施の形態においては、例えば、回転制御部57は、姿勢設定部58により設定された姿勢で移動体1が移動方向に移動するように制御することにより、3つのオムニホイール6の全てを回転させた状態で移動体1を段差に進入させる。
姿勢設定部58は、判断部55により移動体1の移動方向において段差があると判断された場合に、3つのオムニホイール6の全てが回転することにより移動方向に移動体1が移動するように、移動方向に対する移動体1の姿勢を設定する。本実施の形態において、姿勢設定部58は、判断部55により移動体1の移動方向において段差があると判断された場合に、移動体1の姿勢を、オムニホイール6のいずれについても、平面視におけるオムニホイール6の駆動軸7と移動体1の移動方向とがなす角度(すなわち、駆動軸7と平面視において移動方向に平行な直線とがなす角度)がいずれも所定角度以上(例えば、20度以上など、適宜設定可能である)になる姿勢に設定する。より具体的には、本実施の形態においては、移動体1の姿勢は、平面視における各オムニホイール6の駆動軸7と移動体1の移動方向とがなす角度(当該角度と当該角度の補角とのうち、小さい方の角度)のうち最も小さいものが最大となる姿勢(以下、乗越姿勢という)に設定される。
なお、姿勢設定部58により設定された姿勢がそれまでの姿勢と同じであれば、見かけ上は移動体1の姿勢は変わらない。姿勢設定部58により設定された姿勢がそれまでの姿勢とは異なっていれば、移動体1の姿勢がそれまでの姿勢から変更されることとなる。
図3は、同移動体1が段差を乗り越えるときの姿勢の一例を示す平面図である。
図3においては、移動路面に段差Gがあり、低い側(紙面において下側)から上側(紙面において上側)に向いた移動方向MDに移動体1が移動する場面が示されている。
移動体1の移動方向MDにおいて段差Gがあると判断されたとき、姿勢設定部58により、移動体1の姿勢が、図3に示される乗越姿勢に設定される。そうすると、回転制御部57の制御に基づいてオムニホイール6が回転し、移動体1が乗越姿勢となる。乗越姿勢は、例えば、3つのオムニホイール6のそれぞれの駆動軸7と移動体1の移動方向MDとがなす角度が、小さい順に、30度、30度、及び90度となる姿勢である。乗越姿勢で移動方向MDに移動体1が移動するとき、各オムニホイール6の回転量(又は回転速度)の最小値が、最も大きくなる。
なお、姿勢設定部58が設定する姿勢はこれに限られず、各オムニホイール6の駆動軸7と移動体1の移動方向MDとがなす角度が0度でなければよい。すなわち、各オムニホイール6の駆動軸7と移動体1の移動方向MDとがなす角度が0度でなければ、移動方向MDに移動体1が移動するとき、3つのオムニホイール6の全てが回転する。
通信部90は、移動体1をネットワークに接続し、ネットワークに接続されている他の装置との間での通信を行えるように制御する。これにより、移動体1は、例えば外部機器との間で情報の送受信を行うことができる。
図4は、同移動体1の制御装置2の動作の一例を示すフローチャートである。
以上のように構成された移動体1の制御装置2は、例えば、以下のように動作する。
(ステップS111)まず、移動経路取得部51は、出発地の位置情報、目的地の位置情報、地図情報、及び段差情報を取得する。
(ステップS112)移動経路取得部51は、取得した出発地の位置情報、目的地の位置情報、地図情報、及び段差情報に基づいて、移動経路を生成(取得)する。
(ステップS113)取得された移動経路に基づいて、移動体1の移動が開始される。すなわち、回転制御部57は、生成された移動経路に基づいて、これから移動する移動方向を決定する。
(ステップS114)判断部55は、段差情報等に基づいて、移動体1の移動方向において段差があるか否かを判断する。段差があると判断した場合にはステップS115に進み、そうでない場合にはステップS116に進む。
(ステップS115)姿勢設定部58は、移動体1の姿勢を、3つのオムニホイール6の全てが回転することにより移動方向に移動体1が移動する姿勢に設定する。移動体1の姿勢は、例えば、所定の乗越姿勢に設定されてもよい。
(ステップS116)回転制御部57は、決定した移動方向に向けて移動体が移動するように各駆動部5を駆動させ、各オムニホイール6を回転させる。これにより、移動体1が移動方向に向けて移動する。ここで、移動体1の移動方向において段差があると判断された場合には、姿勢設定部58により設定された姿勢で、移動体1が移動方向に移動する。これにより、3つのオムニホイール6が駆動されている状態で移動体1が段差Gに進入する。
(ステップS117)処理部50は、移動体1が目的地(終点)まで到達したか否かを判断する。移動体1が目的地まで到達したらステップS118に進み、そうでない場合にはステップS113に戻る。
(ステップS118)処理部50は、移動体1を待機させる。一連の処理が終了する。
その後、例えば、移動体1の移動に関する指示等が行われると、その度にこのような処理が行われる。
図5は、同移動体1の移動例を説明する図である。
図5に示されるように、2箇所の段差Gがある所移動路面M上において、移動体1が、出発地P0から目的地P2まで移動する場合を想定する。以下の説明において、図5に示される座標においてX方向(Xが正となる方向)を右、Y方向(Yが正となる方向)を前と呼ぶ。また、移動体1の前面Frが向く方向と移動方向とが一致している姿勢を、基準の姿勢(移動体1における前と移動方向とのなす角が0度である姿勢)とする。
予め、このような移動路面Mの地図情報や段差Gに関する段差情報が、移動体1の地図情報格納部21及び段差情報格納部23に格納されている。出発地P0の位置情報、目的地P2の位置情報、及び地図情報に基づいて、移動経路取得部51により、図5において破線で示されるような移動経路(ステップS11からステップS14)が生成される。移動経路は、例えば、最も移動経路の長さが短くなるように生成されるが、これに限られるものではなく、種々の要因を考慮して生成されればよい。回転制御部57は、移動経路に沿って移動体1が移動するように、駆動部5の制御を行う。
(ステップS11)移動体1は、出発地P0において、前面Frが前を向くような姿勢で待機している。移動体1は、移動を開始すると、右に移動する。すなわち、移動体1は、移動方向を右として、移動方向に対して反時計周りに90度回転した姿勢で移動する。
(ステップS12)次に、移動体1は、前面Frが前を向くような姿勢で、前に移動する。すなわち、移動体1は、移動方向を前として、移動方向にまっすぐ向かう姿勢で移動する。
(ステップS13)ここで、そのまま前に移動すると、移動経路の途中に段差Gがある。判断部55により移動方向において段差Gがあると判断されると、例えば、その段差Gの手前の位置(段差Gから所定の距離だけ、移動方向から反対方向に離れた位置)P1まで、移動体1は姿勢を維持して移動する。そして、位置P1に到達したとき、回転制御部57は、姿勢設定部58により設定された乗越姿勢に姿勢を変更する。ここでは、例えば、移動方向が前であるので、移動体1が時計回りに30度回転することにより、3つのオムニホイール6のそれぞれの駆動軸7と移動体1の移動方向とがなす角度が、小さい順に、30度、30度、及び90度となる。このような乗越姿勢で、3つのオムニホイールの全てを駆動させながら移動体1が前に移動し、段差Gを乗り越える。
(ステップS14)段差Gを乗り越えると、例えば、移動体1は前面Frが前を向く姿勢に戻り、目的地P2まで移動する。このとき、移動体1は、移動方向を右前(右方向に対して45度の方向)とし、移動方向に対して反時計回りに45度回転した姿勢で移動する。
以上説明したように、実施の形態1においては、移動体1の移動方向において段差があるとき、全てのオムニホイール6が駆動部5により駆動されている状態で、移動体1が段差に進入する。そのため、段差に引っかかるオムニホイール6を発生しにくくすることができ、移動体1の段差乗り越え性能を向上させることができる。オムニホイール6自体の構造やオムニホイール6の移動体1への取付構造として複雑な構造を用いることなく、簡素な構造の移動体1において、高い段差乗り越え性能を確保することができる。
段差に進入する際には、姿勢設定部58により設定された姿勢で移動体1が移動する。したがって、確実に全てのオムニホイール6を回転させた状態で段差に進入することができ、より確実に段差乗り越え性能を向上させることができる。
段差の有無は、移動経路に基づいて判断される。したがって、段差の有無について高精度な判断を行うことができる。
なお、このような移動体1の段差に進入する際の制御は、例えば、移動体1の給電場所や作業場所に段差がある場合において、そのような給電場所や作業場所に移動体1が進入するときに行われると効果的である。また、例えば、移動路面の一部がエレベータ等の昇降機のフロアで構成されている場合において、そのような昇降機のフロアに移動体1が進入するときに行われると効果的である。
図6は、実施の形態1の一変形例における移動体1Bが段差を乗り越えるときの姿勢の一例を示す平面図である。
移動体は、3つのオムニホイール6を有するものに限られず、さらに多くのオムニホイール6を有するものであってもよい。例えば、図6に示されるように、4つのオムニホイール6が円周上に等間隔に(90度間隔で)配置された移動体1Bにおいても、移動方向MDにおいて段差Gがあるときに4つのオムニホイール6の全てを回転させた状態で移動体1Bを段差Gに進入させるようにすることにより、高い段差乗り越え性能を確保することができる。
なお、4つのオムニホイール6を有する移動体1Bにおいては、乗越姿勢を、各オムニホイール6の駆動軸7と移動体1Bの移動方向MDとがなす角度が45度となる姿勢とするのが好ましいが、これに限られるものではない。それぞれのオムニホイール6の駆動軸7と移動方向MDとのなす角度が、いずれも0度でなければよい。
(実施の形態2)
実施の形態2の概要を、上述の実施の形態1とは異なる部分について説明する。実施の形態2では、移動体の制御装置が、移動体と通信可能な情報処理装置に設けられており、移動体が情報処理装置から送信された情報に基づいて動作する点が実施の形態1とは異なっている。すなわち、実施の形態2においては、移動体と、移動体と通信可能な情報処理装置とで、移動体システムが構成されている。
図7は、実施の形態2に係る移動体システム100の構成を示すブロック図である。
図7に示されるように、移動体システム100は、情報処理装置101と、移動体201とを有している。情報処理装置101と移動体201とは、ネットワークを介して互いに通信可能に接続されている。
移動体201は、センサ4、駆動部5、オムニホイール6、移動体制御部202、通信部90を備える。移動体201は、実施の形態1に係る移動体1との違いは、移動体1が制御装置2を有しているのに対し、移動体201は制御装置2に代えて移動体制御部202を有しているという点である。移動体201は、通信部90により、情報処理装置101と通信可能である。
移動体制御部202は、移動シナリオ格納部225を有している。移動シナリオ格納部225には、後述のように情報処理装置101から送信された移動シナリオが格納される。移動シナリオは、移動体201が移動経路に沿って移動するように複数(例えば、3つ)のオムニホイール6の動作を規定するのに用いられる情報である。移動体制御部202は、移動シナリオに基づいて複数のオムニホイール6を動作させ、移動体201を移動シナリオにより対応する移動経路にそって移動させる。
情報処理装置101は、制御装置102と、サーバ通信部190とを備えている。情報処理装置101は、例えば、サーバであるが、これに限られない。移動体201の操作端末として用いられるコンピュータなどであってもよい。
サーバ通信部190は、情報処理装置101をネットワークに接続し、ネットワークに接続されている他の装置との間での通信を行えるように制御する。これにより、情報処理装置101は、移動体201等の外部機器との間で情報の送受信を行うことができる。
制御装置102は、実施の形態1に係る制御装置2と同様に格納部20及び処理部50を備えている。制御装置102は、処理部50において、回転制御部57が移動シナリオ生成部159を有している点と、センサ情報取得部53を有していない点とで、実施の形態1に係る制御装置2とは異なっている。
移動シナリオ生成部159は、移動経路に基づいて、移動シナリオを生成する。回転制御部57は、生成された移動シナリオを移動体201に送信することで、移動体201は、送信された移動シナリオに従って動作する。すなわち、実施の形態2において、回転制御部57は、移動シナリオを移動体201に送信することで、移動体201のオムニホイール6の回転を制御する。
本実施の形態においても、判断部55が、移動経路に基づいて移動体201の移動方向において段差の有無を判断する。なお、実施の形態2において、移動経路上の各地点において移動体201が移動すべき方向を移動方向とすることができる。そして、回転制御部57は、移動方向において段差がある場合には、移動体201の全てのオムニホイール6を回転させて移動体201を移動方向に移動させ、移動体201が段差に進入するように制御を行う。実施の形態2においては、このような制御は、かかる動作を規定した移動シナリオを生成し、移動体201に出力することにより行われる。
図8は、同実施の形態の制御装置102の動作の一例を示すフローチャートである。
(ステップS211)まず、移動経路取得部51は、出発地の位置情報、目的地の位置情報、地図情報、及び段差情報を取得する。
(ステップS212)移動経路取得部51は、取得した出発地の位置情報、目的地の位置情報、地図情報、及び段差情報に基づいて、移動経路を生成(取得)する。
(ステップS213)判断部55は、段差情報等に基づいて、移動体201の移動方向において段差があるか否かを判断する。段差があると判断した場合にはステップS214に進み、そうでない場合にはステップS215に進む。
(ステップS214)姿勢設定部58は、段差に臨む移動体201の姿勢を、複数のオムニホイール6の全てが回転することにより移動方向に移動体201が移動する姿勢に設定する。移動体201の姿勢は、例えば、所定の乗越姿勢に設定されてもよい。移動シナリオ生成部159は、生成する移動シナリオにおいて、段差に臨む際の移動体201の姿勢を姿勢設定部58により設定された姿勢にする姿勢設定動作を追加する。
(ステップS215)移動シナリオ生成部159は、移動経路に基づいて、移動シナリオを生成する。これにより、ステップS214において姿勢設定動作が追加されている場合には、それが含まれる移動シナリオが生成される。
(ステップS216)回転制御部57は、生成された移動シナリオを移動体201に送信する。一連の処理が終了する。
このように、実施の形態2においては、移動経路上に段差があるとき、姿勢設定動作が含まれる移動シナリオが生成される。移動体201は、移動シナリオに従って動作することにより、全てのオムニホイール6が駆動された状態で段差に進入することができる。したがって、複雑な構造を有しない移動体201の段差乗り越え性能を向上させることができる。移動体201自体では段差の有無を判断したり姿勢を設定する制御を行ったりする必要がないので、移動体201において行われる情報処理の量を低減することができる。
なお、移動体制御部202は、移動シナリオに基づいて実際に移動しながらセンサ情報に基づいて移動に関するフィードバック制御や移動シナリオの変更処理等を行い、高精度に移動可能に構成されていてもよい。
(その他)
段差は、低い側の路面から高い側の路面に移る際のものに限られない。例えば、段差が移動路面間に生じた溝(ギャップ)である場合においても、上述の実施の形態のように全てのオムニホイールを駆動させて乗り越えることで、オムニホイールの引っかかりを防止できるという効果が得られる。
制御装置は、移動経路取得部を有し、センサ情報取得部を有していなくてもよい。この場合、移動経路取得部により取得された移動経路に基づいて移動体が移動するようにすればよい。また、制御装置は、センサ情報取得部を有し、移動経路取得部を有していなくてもよい。この場合、移動体は、センサ情報取得部により取得されたセンサ情報に基づいて自律的に移動するようにすればよい。
制御装置の回転制御部においては、必ずしも姿勢設定部が設けられていなくてもよい。判断部により移動方向において段差があると判断されたとき、回転制御部により、段差に対して進入する際に全てのオムニホイールが駆動されるように制御が行われていればよい。例えば、上述の実施の形態1において、判断部により移動方向において段差があると判断されたとき、回転制御部が、移動体1の前面Frが向く方向と移動方向とが一致しているか否か(移動体1における前と移動方向とのなす角が0度であるか否か)を判断し、移動体1の前面Frが向く方向と移動方向とが一致していれば(移動体1における前と移動方向とのなす角が0度であれば)移動方向に対する移動体1の姿勢を変更して移動方向に進み、そうでなければ姿勢を変更せずに移動方向に進むようにしてもよい。
また、移動体は、移動経路に沿って移動するものに限られない。移動体は、例えば、自律的に移動するものであってもよい。その場合であっても、例えば、現在の移動体の位置と予め用意された段差情報とに基づいて判断部が移動方向において段差があると判断すればよい。また、予め用意された段差情報がなくてもよく、その場合であっても、センサ情報に基づいて判断部が移動方向において段差があると判断すればよい。
より具体的には、例えば、上述の実施の形態1において、移動体と通信可能なサーバ上において、移動経路取得部51により移動経路の生成や判断部55による判断などが行われ、サーバから移動体に随時送信される制御情報に基づいて移動体がリアルタイム制御されるように構成されていてもよい。この場合、移動体からサーバにセンサ情報が送信され、サーバにおいて、センサ情報に基づく制御が行われるようにしてもよい。
また、上記各実施の形態において、各処理(各機能)は、単一の装置(システム)によって集中処理されることによって実現されてもよく、あるいは、複数の装置によって分散処理されることによって実現されてもよい(この場合、分散処理を行う複数の装置により構成されるシステム全体を1つの「装置」として把握することが可能である)。
例えば、制御装置は、移動体に設けられている構成要素と外部装置に設けられている構成要素とで実現されてもよい。換言すると、制御装置の一部の構成要素が移動体に設けられており、他の一部の構成要素が移動体と通信可能な外部装置に設けられており、それらの構成要素が連携して制御装置としての動作が行われるようになっていてもよい。
また、上記実施の形態において、各構成要素間で行われる情報の受け渡しは、例えば、その情報の受け渡しを行う2個の構成要素が物理的に異なるものである場合には、一方の構成要素による情報の出力と、他方の構成要素による情報の受け付けとによって行われてもよく、又は、その情報の受け渡しを行う2個の構成要素が物理的に同じものである場合には、一方の構成要素に対応する処理のフェーズから、他方の構成要素に対応する処理のフェーズに移ることによって行われてもよい。
また、上記実施の形態において、各構成要素が実行する処理に関係する情報、例えば、各構成要素が受け付けたり、取得したり、選択したり、生成したり、送信したり、受信したりした情報や、各構成要素が処理で用いる閾値や数式、アドレス等の情報等は、上記説明で明記していなくても、図示しない記録媒体において、一時的に、又は長期にわたって保持されていてもよい。また、その図示しない記録媒体への情報の蓄積を、各構成要素、又は、図示しない蓄積部が行ってもよい。また、その図示しない記録媒体からの情報の読み出しを、各構成要素、又は、図示しない読み出し部が行ってもよい。
また、上記実施の形態において、各構成要素等で用いられる情報、例えば、各構成要素が処理で用いる閾値やアドレス、各種の設定値等の情報がユーザによって変更されてもよい場合には、上記説明で明記していなくても、ユーザが適宜、それらの情報を変更できるようにしてもよく、又は、そうでなくてもよい。それらの情報をユーザが変更可能な場合には、その変更は、例えば、ユーザからの変更指示を受け付ける図示しない受付部と、その変更指示に応じて情報を変更する図示しない変更部とによって実現されてもよい。その図示しない受付部による変更指示の受け付けは、例えば、入力デバイスからの受け付けでもよく、通信回線を介して送信された情報の受信でもよく、所定の記録媒体から読み出された情報の受け付けでもよい。
また、上記実施の形態において、移動体1に含まれる2以上の構成要素が通信デバイスや入力デバイス等を有する場合に、2以上の構成要素が物理的に単一のデバイスを有してもよく、又は、別々のデバイスを有してもよい。
また、上記実施の形態において、各構成要素は専用のハードウェアにより構成されてもよく、又は、ソフトウェアにより実現可能な構成要素については、プログラムを実行することによって実現されてもよい。例えば、ハードディスクや半導体メモリ等の記録媒体に記録されたソフトウェア・プログラムをCPU等のプログラム実行部が読み出して実行することによって、各構成要素が実現されうる。その実行時に、プログラム実行部は、記憶部や記録媒体にアクセスしながらプログラムを実行してもよい。また、そのプログラムは、サーバなどからダウンロードされることによって実行されてもよく、所定の記録媒体(例えば、光ディスクや磁気ディスク、半導体メモリなど)に記録されたプログラムが読み出されることによって実行されてもよい。また、このプログラムは、プログラムプロダクトを構成するプログラムとして用いられてもよい。また、そのプログラムを実行するコンピュータは、単数であってもよく、複数であってもよい。すなわち、集中処理を行ってもよく、又は分散処理を行ってもよい。
本発明は、以上の実施の形態に限定されることなく、種々の変更が可能であり、それらも本発明の範囲内に包含されるものであることはいうまでもない。
上述の複数の実施の形態を適宜組み合わせた実施の形態を構成してもよい。例えば、上述の実施の形態の構成そのものに限られず、上述の実施の形態のそれぞれの構成要素について、適宜、他の実施の形態の構成要素と置換したり組み合わせたりしてもよい。また、上述の実施の形態のうち、一部の構成要素や機能が省略されていてもよい。
以上のように、本発明に係る移動体の制御装置は、移動体の段差乗り越え性能を向上させるという効果を有し、移動体の制御装置等として有用である。
1,201 移動体、2,102 制御装置、4 センサ、6 オムニホイール、7 駆動軸、51 移動経路取得部、53 センサ情報取得部、55 判断部、57 回転制御部、58 姿勢設定部
Claims (6)
- 複数のオムニホイールを有し、前記複数のオムニホイールの1つ以上を回転させながら移動する移動体の制御装置であって、
前記移動体の移動方向における段差の有無を判断する判断部と、
前記判断部により前記移動体の移動方向において段差があると判断された場合に、前記複数のオムニホイールの全てを回転させて前記移動方向に前記移動体を移動させ、前記移動体を前記段差に進入させる回転制御部とを備える、制御装置。 - 前記移動体の移動経路を取得する移動経路取得部をさらに備え、
前記判断部は、前記移動経路取得部により取得された移動経路に基づいて、前記移動体の移動方向における段差の有無を判断する、請求項1に記載の制御装置。 - 前記移動体に設けられているセンサにより検知された前記移動体の移動方向における周囲の状況に関するセンサ情報を取得するセンサ情報取得部をさらに備え、
前記判断部は、前記センサ情報取得部により取得されたセンサ情報に基づいて、前記移動体の移動方向における段差の有無を判断する、請求項1又は2に記載の制御装置。 - 前記回転制御部は、
前記判断部により前記移動体の移動方向において段差があると判断された場合に、前記複数のオムニホイールの全てが回転することにより前記移動方向に前記移動体が移動するように、前記移動方向に対する前記移動体の姿勢を設定する姿勢設定部を有し、
前記姿勢設定部により設定された姿勢で前記移動方向に前記移動体を移動させ、前記移動体を前記段差に進入させる、請求項1から3のいずれか1項に記載の制御装置。 - 前記姿勢設定部により設定される前記移動体の姿勢は、前記複数のオムニホイールのいずれについても、平面視における当該オムニホイールの駆動軸と前記移動体の移動方向とがなす角度が所定の角度以上になる姿勢である、請求項4に記載の制御装置。
- 請求項1から5のいずれか1項に記載の制御装置と、
複数のオムニホイールを有し、前記制御装置の制御に応じて前記複数のオムニホイールのそれぞれを回転させる駆動部とを備える、移動体。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019132158A JP2021018485A (ja) | 2019-07-17 | 2019-07-17 | 移動体の制御装置及び移動体 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019132158A JP2021018485A (ja) | 2019-07-17 | 2019-07-17 | 移動体の制御装置及び移動体 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2021018485A true JP2021018485A (ja) | 2021-02-15 |
Family
ID=74564282
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019132158A Pending JP2021018485A (ja) | 2019-07-17 | 2019-07-17 | 移動体の制御装置及び移動体 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2021018485A (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2022233182A1 (zh) * | 2021-05-06 | 2022-11-10 | 北京石头世纪科技股份有限公司 | 一种智能移动设备及其控制方法、电子设备、存储介质 |
-
2019
- 2019-07-17 JP JP2019132158A patent/JP2021018485A/ja active Pending
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2022233182A1 (zh) * | 2021-05-06 | 2022-11-10 | 北京石头世纪科技股份有限公司 | 一种智能移动设备及其控制方法、电子设备、存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10345821B2 (en) | Floor-treatment apparatus and navigation system therefor | |
JP4464893B2 (ja) | 移動ロボット | |
JP2009093308A (ja) | ロボットシステム | |
JP5310285B2 (ja) | 自己位置推定装置及び自己位置推定方法 | |
KR101771643B1 (ko) | 자율주행로봇 및 이의 네비게이션 방법 | |
JP2022511359A (ja) | ウェイポイントマッチングを用いた自律マップトラバーサル | |
JP2019534516A (ja) | 自律移動ロボットを動作させる方法 | |
JP4670807B2 (ja) | 移動経路作成方法、自律移動体および自律移動体制御システム | |
US11241790B2 (en) | Autonomous moving body and control program for autonomous moving body | |
JP2017227955A (ja) | 移動ロボットの移動経路計画方法 | |
JP2009217333A (ja) | 移動ロボット及びその動作制御方法 | |
CN112631269A (zh) | 自主移动机器人及自主移动机器人的控制程序 | |
JP2021018485A (ja) | 移動体の制御装置及び移動体 | |
JP2013101487A (ja) | 自動搬送システム | |
JP7091733B2 (ja) | 位置推定システム、位置検出方法、およびプログラム | |
JP5439552B2 (ja) | ロボットシステム | |
CN110871440B (zh) | 机器人的行驶控制方法和装置 | |
WO2016072186A1 (ja) | 位置検出装置、制御方法及び自動走行車 | |
WO2019124342A1 (ja) | 移動体 | |
JP6944611B1 (ja) | 自走装置および自走装置の走行システム | |
JP2006155349A (ja) | 追尾方法、追尾装置、追尾システム及び追尾プログラム | |
JP7393217B2 (ja) | ロボットシステムおよびその位置推定方法 | |
JP2019114129A (ja) | 移動体 | |
JP7021929B2 (ja) | 移動体 | |
JP2020107024A (ja) | 移動体、学習器、及び学習器製造方法 |