JP2008152714A - 移動装置、ならびにその制御システム、制御プログラムおよび監督システム - Google Patents

Abstract

【課題】人間等の物体の挙動変化を誘発する頻度を抑制しながら、当該物体との接触を回避して移動または行動しうる移動装置等を提供する。
【解決手段】判定面において基準空間要素Ｑ₀に接触する可能性があるという接触条件を満たす第１空間要素Ｑ₁の有無が判定される。基準空間要素Ｑ₀および第１空間要素Ｑ₁のそれぞれはロボット１および物体ｘのそれぞれの現在像を表す。その結果、当該判定面において接触条件を満たす第１空間要素Ｑ₁が存在すると判定された場合、当該判定面において基準空間要素Ｑ₀が第２空間要素Ｑ₂との接触を回避しながら移動しうる経路が新たな「第１行動計画要素」として設定される。
【選択図】 図１

Description

本発明は、行動計画にしたがって自律的に移動する装置、当該移動装置を制御するシステム、当該移動装置に搭載されているコンピュータにその制御機能を付与するプログラム、および当該移動装置を監督するシステムに関する。

ロボットがその高機能化にともなって荷物を運搬したり、あるいは人間を目的地まで誘導したりする等の業務または作業を遂行する機会が増えており、ロボットが人間との接触を回避しながら移動する必要性が高まっている。そこで、ロボットの周囲にある複数の物体（障害物）の移動速度を考慮に入れることにより、当該物体との接触を回避しながらロボットを移動させる技術が提案されている（たとえば、非特許文献１参照）。この技術によれば、ロボットが物体との接触を回避しながら目的地にたどり着くための最適な経路計画生成のため、各物体の動きを予測し、この予測に基づいて接触が起きないような経路を計画するというサイクルが短時間で繰り返される。
日本ロボット学会誌 第１２巻 第７号 第１０２９頁〜第１０３７頁 １９９４ 「平面を移動する複数の移動障害物とその速度を考慮した移動ロボットのプランニングとナビゲーション」

しかし、ロボットが周囲の人間の移動速度（移動方向を含む。）の変化等の挙動変化に応じて挙動をただちに変化させると、その人間または別の人間の挙動変化を誘発し、ロボットと人間との接触可能性がかえって高くなる場合がある。すなわち、たとえばロボットと向かい合っている人間がロボットからみて右に動いたことに応じてロボットがただちに左に動くと、これにつられるようにしてこの人間または他の人間がその向きを変え、これによって両者が接触する可能性が高まる場合がある。このような場合、ロボットおよびその周囲にいる人間が協調しながら移動することが困難となる。

そこで、本発明は、人間等の物体の挙動変化を誘発する頻度を抑制しながら、当該物体との接触を回避して移動または行動しうる移動装置等を提供することを解決課題とする。

第１発明の移動装置は、制御システムを備え、前記制御システムによって動作が制御されることにより移動装置の位置の変化態様を定める第１行動計画要素にしたがって自律的に移動する移動装置であって、前記制御システムが、前記移動装置の現在像、物体の現在像および前記現在像よりも空間的広がりが大きい、前記物体の挙動状態に応じた前記物体の断続的または連続的な未来像を判定面における基準空間要素、第１空間要素および前記第１空間要素よりも空間的広がりが大きい第２空間要素のそれぞれとして認識する第１処理部と、前記第１処理部による認識結果に基づき前記判定面において前記基準空間要素から前記第１空間要素までの距離が長くなるほど高くなるように定義されている移動コストが規定範囲内であるまたは前記移動コストの低さが所定順位以上であるという第１接触条件、および、前記第１行動計画要素としての経路に沿って移動したときの前記基準空間要素と前記第１空間要素との交点または接点があるという第２接触条件のうち一方または両方を満たす前記第１空間要素の有無を判定する第２処理部と、前記第２処理部により前記判定面において前記第１接触条件および前記第２接触条件のうち一方または両方を満たす前記第１空間要素が存在すると判定されたことを要件として、前記第１処理部による認識結果に基づき、前記判定面において前記基準空間要素が前記第２空間要素との接触を回避しうるように前記第１行動計画要素としての前記経路を変更する第３処理部とを備えていることを特徴とする。

第１発明の移動装置によれば、移動装置の現在像、物体の現在像、およびこの物体の挙動状態に応じた物体の断続的または連続的な未来像のそれぞれが判定面における「基準空間要素」「第１空間要素」および「第２空間要素」のそれぞれとして認識される。物体の断続的または連続的な未来像は物体の現在像よりも空間的な広がりが大きいことに応じて、第２空間要素は判定面において第１空間要素よりも空間的な広がりが大きい空間要素として認識される。すなわち、第１空間要素は判定面において第２空間要素よりも空間的な広がりが小さい空間要素として認識される。ここで「判定面」は移動装置等の実空間における位置、形状および広がり（サイズ）を２次元的に認識するために定義された平面または曲面である。「判定面」は「一の判定面」または「判定面群を構成する各判定面」を意味する。判定面における「空間要素」は当該判定面における点、線分、領域、閉曲線（領域の輪郭）等として定義される。なお、移動装置に物体が取り付けられている等、当該物体が移動装置と一体的に移動するような場合、移動装置と物体とがまとめられて各判定面における第１空間要素として認識されうる。

また、判定面において基準空間要素から第１空間要素までの距離が長くなるほど高くなるように定義されている移動コストが規定範囲内であるまたは移動コストの低さが所定順位以上であるという「第１接触条件」、および、第１行動計画要素としての経路に沿って移動したときの基準空間要素と第１空間要素との交点または接点があるという「第２接触条件」のうち一方または両方を満たす第１空間要素の有無が判定される。そして、第１接触条件および第２接触条件のうち一方または両方を満たす第１空間要素が存在すると判定された場合、判定面において基準空間要素が第２空間要素との接触を回避しながら移動しうる経路が新たな「第１行動計画要素」として設定される。すなわち、判定面において基準空間要素および第１空間要素として認識された移動装置および物体のそれぞれの位置、速度、加速度等により特定される挙動状態と、形状、大きさ等の外形特性とに基づき、移動装置が物体との接触を回避する必要性が高い状況で第１行動計画要素としての経路が新たに設定されうる。そして、移動装置が第１行動計画要素としての経路にしたがうことにより、物体との接触を回避しながら移動を継続することができる。

前記のように第１空間要素は判定面において第２空間要素よりも空間的な広がりが小さい空間要素として認識され、第１空間要素のうち接触条件を満たす第１空間要素の存在が新たな第１行動計画要素の設定要件とされている。すなわち、第２空間要素ではなく、第２空間要素よりも空間的な広がりが小さい第１空間要素について第１接触条件および第２接触条件のうち一方または両方を満たすことが経路変更の要件とされている。このため、基準空間要素との接触可能性がある第２空間要素等、第１空間要素よりも広い空間要素の存在が第１行動計画要素の変更要件とされている場合より、第１行動計画要素としての経路の変更頻度およびこれにともなう移動方向等の変更頻度が低く抑制される。そして、物体の挙動変化が移動装置の挙動変化に応じて誘発される可能性を低下させることができる。

また、複数の判定面のそれぞれにおいて各空間要素が認識され、かつ、当該複数の判定面のうちいずれかにおいて基準空間要素と接触可能性がある第１空間要素が存在することが第１行動計画要素の変更要件とされることにより、移動装置および物体のそれぞれの３次元形状が考慮された上で経路が変更されうる。すなわち、移動装置および物体のそれぞれは一般的に前後方向および左右方向のサイズが床面からの高さ等、場所に応じて変化するという立体的外形特性を有している。このため、各判定面において認識された基準空間要素および第１空間要素のそれぞれの形状およびサイズ（一方の空間要素を基準とする他方の空間要素の相対的なサイズも含まれる。）に、移動装置および物体のそれぞれの異なる箇所における形状およびサイズが反映されうる。これにより、移動装置および物体のそれぞれの立体的外形特性、位置および速度等の挙動状態に鑑みて、基準空間要素として認識された移動装置が第１空間要素として認識された物体との接触を回避する観点から必要性が高いまたは適当な状況で第１行動計画要素としての経路が変更されうる。

さらに、前記のように第２空間要素は判定面において第１空間要素よりも空間的な広がりが大きい空間要素として認識され、基準空間要素と第２空間要素との接触が回避されるように第１行動計画要素としての経路が新たに設定される。このため、基準空間要素が第１空間要素等の第２空間要素よりも狭い空間要素との接触を回避しうるような経路が設定される場合よりも、移動装置と物体との接触のより確実な観点から適当な経路および行動計画が設定される。

したがって、移動装置が、人間等の物体の挙動変化を誘発する頻度を低く抑制しながら、当該物体との接触を回避して移動することができる。

なお、本発明の構成空間要素が情報を「認識する」とは、メモリ等の記憶装置から情報を読み取ること、データベースから情報を検索すること、通信機能を利用して情報を受信すること、検索等した基礎情報から必要な情報を測定、推定、算定、設定、予測等すること、測定等した情報をメモリに格納すること等、情報を、これを必要とする情報処理のために準備するあらゆる情報処理を包含する概念である。

第２発明の移動装置は、第１発明の移動装置において、前記第１処理部が前記物体の挙動状態を前記判定面における前記第１空間要素の位置、速度および加速度のうち一部または全部として認識し、かつ、前記基準空間要素を含まないように当該認識結果に応じて断続的または連続的に拡張された該第１空間要素を前記第２空間要素として認識することを特徴とする。

第２発明の移動装置によれば、判定面における第２空間要素の広がりが、物体の挙動状態に応じた当該判定面における第１空間要素の位置、速度および加速度のうち少なくとも１つに応じて定められる。これにより、物体の位置等に基づいて予測される当該物体の未来像の重ね合わせに接触しないように、移動装置が移動または行動することができる。

第３発明の移動装置は、第２発明の移動装置において、前記第１処理部が前記物体の挙動状態を前記判定面における前記第１空間要素の速度、ならびに前記基準空間要素に対する前記第１空間要素の相対位置および相対速度として認識し、かつ、当該認識結果に応じて断続的または連続的に拡張された該第１空間要素を前記第２空間要素として認識することを特徴とする。

第３発明の移動装置によれば、判定面における第２空間要素の広がりが、物体の挙動状態に応じた当該判定面における第１空間要素の速度、ならびに基準空間要素に対する第１空間要素の相対位置および相対速度に応じて定められる。これにより、物体の速度、ならびに移動装置を基準とした物体の相対位置および相対速度に基づいて予測される当該物体の未来像の重ね合わせに接触しないように、移動装置が移動または行動することができる。

第４発明の移動装置は、第１〜第３発明のうちいずれか１つの移動装置において、前記第１処理部が前記判定面において前記移動装置の外形特性に応じて拡張された前記物体の外形特性に応じた領域を前記第１空間要素として認識することを特徴とする。

第４発明の移動装置によれば、移動装置および物体のそれぞれの外形特性が判定面における第１空間要素の外形特性にまとめて反映されうる。このため、当該判定面における基準空間要素の簡易的な取り扱い、ひいては基準空間要素と第１空間要素との接触可能性の有無の判定等の容易化が図られながらも、当該判定精度の向上または維持が図られうる。

第５発明の移動装置は、第４発明の移動装置において、前記第１処理部が前記判定面において、前記移動装置および前記物体のそれぞれの外形特性に応じた２つの領域のミンコフスキー和を前記第１空間要素として認識することを特徴とする。

第５発明の移動装置によれば、移動装置および物体のそれぞれの外形特性が判定面におけるミンコフスキー和としての第１空間要素の外形特性にまとめて反映されうる。このため、当該判定面における基準空間要素の点または微小領域としての簡易的な取り扱い、ひいては基準空間要素と第１空間要素との接触可能性の有無の判定等の容易化が図られながらも、当該判定精度の向上または維持が図られうる。

第６発明の移動装置は、第１発明の移動装置において、前記第２処理部が、前記移動コストが正の下限値を有する前記規定範囲内に含まれていることを前記第１接触条件として、該第１接触条件を満たす前記第１空間要素の有無を判定することを特徴とする。

第６発明の移動装置によれば、物体が移動装置の近くにあるため、移動装置の挙動を変化させると物体の予期せぬ挙動変化を誘発し、かえって両者の接触可能性が高くなる可能性がある状態で行動計画要素が変更される事態が回避されうる。

第７発明の移動装置は、第１〜第６発明のうちいずれか１つの移動装置において、前記第３処理部が前記移動装置の速度の向きおよび大きさのうち一方または両方の変化率を閾値以下とすることを第３行動計画要素として設定することを特徴とする。

第７発明の移動装置によれば、第３行動計画要素の変更による移動装置の過剰な速度変化およびこれにともなう挙動変化が抑制されうる。これにより、物体の予期せぬ挙動変化を誘発し、移動装置と物体との接触可能性をかえって高めるような事態が回避されうる。また、移動装置にその能力を超えた速度変化またはこれにともなう挙動変化を強いる事態が回避されうる。

第８発明の移動装置は、第１〜第７発明のうちいずれか１つの移動装置において、前記第３処理部が前記移動装置の速度の大きさを向きよりも優先的に変更することを第３行動計画要素として設定することを特徴とする。

第８発明の移動装置によれば、移動装置の速度の向き（移動方向）の変化が物体の挙動変化を誘発しやすい傾向があることに鑑みて、移動装置の速度の大きさ（速さ）が向きよりも優先的に変更される。これにより、物体の挙動変化を誘発するような移動装置の挙動変化の頻度が低く抑えられうる。

第９発明の移動装置は、第１〜第８発明のうちいずれか１つの移動装置において、前記制御システムが前記移動装置の搭載機器の動作態様を定める第２行動計画要素にしたがって前記搭載機器の動作を制御し、前記第３処理部が前記移動装置の移動方向を予告するように前記機器を動作させることを前記第２行動計画要素として設定することを特徴とする。

第９発明の移動装置によれば、移動方向を変更する直前等のタイミングで第２行動計画要素にしたがった搭載機器の動作によって、人間等の物体にその移動方向を予告することができる。これにより、移動装置との接触可能性が低くなるような物体の方向転換等の行動を誘起し、移動装置と当該物体との接触可能性を低減させることができる。

第１０発明の移動装置は、第９発明の移動装置において、人間の身体部分に対応する可動部分を動かす駆動機器を前記搭載機器として備え、前記第３処理部が前記駆動機器の動作を伴う前記可動部分の動きにより移動方向を予告するように前記駆動機器を動作させることを前記第２行動計画要素として設定することを特徴とする。

第１０発明の移動装置によれば、頭、腕、脚、胴体等の人間の身体部分に対応している可動部分の動きという人間にとって馴染みやすい行動様式によって物体としての当該人間に違和感を覚えさせることなく明確に移動装置の移動方向を認識させることができる。これにより、前記のように移動装置との接触可能性が低くなるような物体の方向転換等の行動を誘起し、移動装置と当該物体との接触可能性を低減させることができる。

第１１発明の移動装置は、第１０発明の移動装置において、前記可動部分として頭部を備え、前記第３処理部が該頭部の正面を前記移動装置の移動方向に向けさせることを前記第２行動計画要素として設定することを特徴とする。

第１１発明の移動装置によれば、頭部の正面を移動方向に向けるという人間にとって馴染みやすい行動様式によって、物体としての当該人間に違和感を覚えさせることない自然な雰囲気で、かつ、明確に移動装置の移動方向を認識させることができる。これにより、前記のように移動装置との接触可能性が低くなるような物体の方向転換等の行動を誘起し、移動装置と当該物体との接触可能性を低減させることができる。

第１２発明の制御システムは、移動装置の位置の変化態様を定める第１行動計画要素にしたがって自律的に移動する移動装置を制御するシステムであって、前記移動装置の現在像、物体の現在像および前記現在像よりも空間的広がりが大きい、前記物体の挙動状態に応じた前記物体の断続的または連続的な未来像を判定面における基準空間要素、第１空間要素および前記第１空間要素よりも空間的広がりが大きい第２空間要素のそれぞれとして認識する第１処理部と、前記第１処理部による認識結果に基づき前記判定面において前記基準空間要素から前記第１空間要素までの距離が長くなるほど高くなるように定義されている移動コストが規定範囲内であるまたは前記移動コストの低さが所定順位以上であるという第１接触条件、または、前記第１行動計画要素としての経路に沿って移動したときの前記基準空間要素と前記第１空間要素との交点または接点があるという第２接触条件を満たす前記第１空間要素の有無を判定する第２処理部と、前記第２処理部により前記判定面において前記第１接触条件または前記第２接触条件を満たす前記第１空間要素が存在すると判定されたことを要件として、前記第１処理部による認識結果に基づき、前記判定面において前記基準空間要素が前記第２空間要素との接触を回避しうるように前記第１行動計画要素としての前記経路を変更する第３処理部とを備えていることを特徴とする。

第１２発明の制御システムによれば、人間等の物体の挙動変化を誘発する頻度を低く抑制しながら、当該物体との接触を回避して移動するように移動装置を行動させることができる。

第１３発明の制御プログラムは、移動装置の位置の変化態様を定める第１行動計画要素にしたがって自律的に移動する前記移動装置に搭載されているコンピュータを第１２発明の制御システムとして機能させることを特徴とする。

第１３発明の制御プログラムによれば、移動装置に搭載されているコンピュータを、人間等の物体の挙動変化を誘発する頻度を低く抑制しながら、当該物体との接触を回避して移動するように当該移動装置を制御するシステムとして機能させることができる。

第１４発明の監督システムは、移動装置の位置の変化態様を定める第１行動計画要素にしたがって自律的に行動する前記移動装置を監督するシステムであって、第１３発明のプログラムのうち少なくとも一部を移動装置に搭載されているコンピュータに対して配信または放送することを特徴とする。

第１４発明の監督システムによれば、人間等の物体の挙動変化を誘発する頻度を低く抑制しながら、当該物体との接触を回避して移動するように行動しうる移動装置を、当該移動装置に搭載されているコンピュータへのプログラムの任意の時点での配信等によって実現することができる。

本発明の移動装置等の実施形態について図面を用いて説明する。

まず、本発明の移動装置の一実施形態であるロボットの構成について図１を用いて説明する。ロボット１は基体（胴体部）１０と、基体１０の上部に設けられた頭部１１と、基体１０の上部左右両側から延設された左右の腕体１２と、基体１０の下部から下方に延設された左右の脚体１３とを備えている。添字「Ｌ」および「Ｒ」は左右を区別するために付されている。ロボット１は、再表０３／０９０９７８号公報や、再表０３／０９０９７９号公報に開示されているように、アクチュエータ（図示略）から伝達される力によって、人間の肩関節、肘関節、手根関節、股関節、膝関節、足関節等の複数の関節に相当する複数の関節部分において腕体１２や脚体１３を屈伸運動させることができる。ロボット１は、左右の脚体１３のそれぞれの離床および着床を伴う動きによって自律的に移動することができる。基体１０の鉛直方向に対する傾斜角度が調節されることによって、頭部１１の高さが調節されうる。頭部１１には、左右に並んでロボット１の前方に向けられた一対のＣＣＤカメラ２１が内蔵されている。頭部１１がアクチュエータによって基体１０に対して回動、傾動等されることでＣＣＤカメラ２１の撮像範囲が調節されうる。

ロボット１はその歩行または走行動作を制御する制御システム１００を備えている。制御システム１００は、ハードウェアとしてのＥＣＵまたはコンピュータ（ＣＰＵ，ＲＯＭ，ＲＡＭ，Ｉ／Ｏ等により構成されている。）と、ソフトウェアとしての本発明の「制御プログラム」とにより構成されている。制御プログラムはコンピュータのメモリに予め格納されていてもよいが、ロボット１から本発明の「監督システム」を構成するサーバに要求信号が送信されたことに応じて当該サーバによって制御プログラムがネットワークや人工衛星を介して当該コンピュータに配信または放送された上でそのメモリに格納されてもよい。

制御システム１００は第１処理部１１０と、第２処理部１２０と、第３処理部１３０とを備えている。第１処理部１１０はロボット１、その位置および速度（向きおよび長さにより定義される速度ベクトルを意味する。以下同じ。）のそれぞれを、判定面における基準空間要素Ｑ₀、基準位置Ｏおよび基準速度ｖ₀のそれぞれとして認識する。また、第１処理部１１０は人間等の物体、その位置および速度のそれぞれを判定面における第１空間要素Ｑ₁、物体位置ｐおよび物体速度ｖのそれぞれとして認識する。さらに、第１処理部１１０は基準位置Ｏに対する物体位置ｐの相対位置、および基準速度ｖ₀に対する物体速度ｖの相対速度に応じて断続的または連続的に拡張された第１空間要素Ｑ₁を第２空間要素Ｑ₂として認識する。基準空間要素Ｑ₀の判定面における形状およびサイズはメモリ（図示略）から読み取られることで認識される。第２処理部１２０は第１処理部１１０による認識結果に基づき、判定面において基準空間要素Ｑ₀との接触可能性があるという「接触条件」を満たす第１空間要素Ｑ₁の有無を判定する。第３処理部１３０は第２処理部１２０によって判定面において接触条件を満たす第１空間要素Ｑ₁が存在すると判定されたことを要件として、第１処理部１１０により認識結果に基づき、判定面において基準空間要素Ｑ₀が第２空間要素Ｑ₂との接触を回避しうる経路を「第１行動計画要素」として設定する。

続いて、前記構成のロボットの機能について図２〜図９を用いて説明する。ロボット１はたとえば図６に一点鎖線で示されているような予め設定されている、または後述するように第３処理部１３０により設定された第１行動計画要素としての経路Ｒ_kに沿って歩行または走行している。

第１処理部１１０が「第１処理」を実行する（図２／Ｓ１１０）。第１処理部１１０はロボット１、その位置および速度のそれぞれを、判定面における基準空間要素Ｑ₀、ロボット座標系における基準位置Ｏおよび基準速度ｖ₀のそれぞれとして認識する（図２／Ｓ１１２）。たとえば、ロボット１ならびにその位置および速度のそれぞれが図６に示されている判定面における点または微小な領域としての基準空間要素Ｑ₀、基準位置Ｏおよび基準速度ｖ₀として認識される。後述するようにＣＣＤカメラ２１を通じて得られた画像に基づき測定された物体ｘの位置は、ロボット１を基準とする相対位置に該当するので、ロボット１の位置測定は省略される。なお、物体ｘの測定位置が緯度および経度により表されている等、当該相対位置に該当しない場合、ロボット１の位置は当該相対位置の測定のために測定される。ロボット１の位置はそのＧＰＳ機能により得られる緯度および経度を表す信号や、ジャイロスコープから逐次出力されるロボット１の加速度を表す信号に基づいて測定される。ロボット１の速度はロボット１の時系列的な測定位置、ジャイロスコープから出力される信号、または脚体１３の各関節角度および逆動力学モデル等に基づいて測定されうる。

また、第１処理部１１０は人間等の物体、その位置および速度のそれぞれを判定面における第１空間要素Ｑ₁、物体位置ｐおよび物体速度ｖのそれぞれとして認識する（図２／Ｓ１１４）。たとえば、図３に示されているようにロボット１の前方（ＣＣＤカメラ２１の撮像範囲）に物体ｘ₁〜ｘ₄が存在する場合、各物体ｘ₁〜ｘ₄ならびにその位置および速度ベクトルのそれぞれが図６に示されているように判定面における第１空間要素（領域）Ｑ₁₁〜Ｑ₁₄、物体位置ｐ₁〜ｐ₄および物体速度ｖ₁〜ｖ₄として認識される。物体ｘの位置はＣＣＤカメラ２１を通じて得られた当該物体ｘの画像の解析に基づいて測定される。ＣＣＤカメラ２１を通じて得られた画像に基づいて測定された位置は、ロボット１を基準とした相対位置に該当する。

判定面における基準空間要素Ｑ₀の形状およびサイズはメモリ（ロボット１の形状およびサイズが格納されている。）から読み取られることで認識されうる。また、判定面における第１空間要素Ｑ₁の形状およびサイズは、ＣＣＤカメラ２１を通じて得られた画像に基づいて物体ｘの人間、犬（小形動物）等の種類が認識された後、当該認識結果に基づくメモリまたはデータベース（物体の種類、形状およびサイズが関連付けられて格納または管理されている。）の照会によって認識されうる。さらに、物体ｘの位置は、この物体ｘが有する通信装置等から送信された緯度および経度を表す信号が受信された上で、当該信号に基づいて測定または認識されてもよい。また、物体ｘの速度はこの物体ｘの位置の時間変化として測定されうる。判定面は緯度および経度により任意の点が特定される平面または曲面として定義されていてもよいが、ＣＣＤカメラ２１を通じて得られる画像に基づいて認識されるロボット１の周辺における床面の傾斜角度や、段差や凹凸の有無等の形状に基づいて逐次定義されてもよい。

ロボット１がその腕体１２により箱を持っている場合や、基体１０にロボット１に機能を付加するためのオプションとなる機器が取り付けられている場合等、当該箱や機器等の物体がロボット１と一体的に移動している状況では、当該一体的に移動しているロボット１および当該物体の形状およびサイズがロボット１の形状およびサイズとして認識されてもよい。

ロボット１の外形特性（形状およびサイズ）に応じて拡張された、判定面における物体ｘの外形特性に応じた領域が、第１空間要素Ｑ₁として認識される。より具体的には、ロボット１および物体ｘのそれぞれの外形特性に応じた、判定面における外形特性を有する２つの領域のミンコフスキー和が第１領域Ｑ₁として認識される。たとえば、図４（ａ）に示されている判定面においてロボット１および物体ｘのそれぞれが円形状のロボット領域ｑ_robotおよび矩形状の物体領域ｑ_objectとして定義される場合、図４（ｂ）に示されているように角が丸い矩形状の領域として表現される当該２つの領域のミンコフスキー和ｑ_robot＋ｑ_objectが第１空間要素Ｑ₁として認識される。ロボット領域ｑ_robotの中心が物体領域ｑ_objectの輪郭をなぞるようにロボット領域ｑ_robotを物体領域ｑ_objectの周囲で移動させた場合、ロボット領域ｑ_robotのうち物体領域ｑ_objectからはみ出した部分が描く環状の領域と、物体領域ｑ_objectとの和がミンコフスキー和に該当する。ロボット領域ｑ_robotの形状およびサイズはロボット１のサイズ（または形状およびサイズ）に応じてメモリに予め格納されており、当該メモリから読み出されることにより認識される。物体領域ｑ_objectはＣＣＤカメラ２１を通じて得られた画像に基づいて認識される物体ｘのサイズ（または形状およびサイズ）に応じた広がりを有する領域として認識される。なお、物体領域ｑ_objectがそのまま第１空間要素Ｑ₁として認識されてもよく、ミンコフスキー和とは異なる方法によりロボット領域ｑ_robotのサイズ等の外形特性に応じて拡張された物体領域ｑ_objectが第１空間要素Ｑ₁として認識されてもよい。

さらに、第１処理部１１０は基準位置Ｏおよび物体位置ｐ、ならびに基準速度ｖ₀および物体速度ｖに応じて拡張された第１空間要素Ｑ₁を第２空間要素Ｑ₂として認識する（図２／Ｓ１１６）。たとえば図５（ａ）左側に示されている第１空間要素Ｑ₁が基準速度ｖ₀に対する物体速度ｖの相対速度（ベクトル）ｖ−ｖ₀に応じた方向に連続的に引き伸ばされた結果として、図５（ａ）右側に示されているほぼまっすぐな帯状の第２空間要素Ｑ₂が認識される。第１空間要素Ｑ₁の引き伸ばし量は、第１空間要素の速度ｖ、物体位置（相対位置）ｐ（＝ｐ−Ｏ）、および相対速度ｖ−ｖ₀に基づき、次式（１）にしたがって設定される。
（引き伸ばし量）＝｜ｐ｜・｜ｖ｜／｜ｖ−ｖ₀｜‥（１）

また、図５（ｂ）左側に示されている第１空間要素Ｑ₁が相対速度ｖ−ｖ₀にしたがって旋回するように連続的に引き伸ばされた結果として、図５（ｂ）右側に示されている屈曲した帯状の第２空間要素Ｑ₂が認識される。前述した図３に示されている状況において、図６に示されているような第２空間要素Ｑ₂₁〜Ｑ₂₄が認識される。なお、図５（ｃ）左側に示されている第１空間要素Ｑ₁が相対速度ｖ−ｖ₀に応じた方向に断続的に引き伸ばされた結果として、図５（ｃ）右側に示されている分離した空間要素からなる第２空間要素Ｑ₂が認識されてもよい。第１空間要素Ｑ₁の引き伸ばし部分は、物体の挙動状態（位置および速度）に応じて予測される当該物体の未来像に相当する。

続いて、第２処理部１２０が第１処理部１１０により認識された判定面における基準空間要素Ｑ₀と第１空間要素Ｑ₁との接触可能性の有無、すなわち、ロボット１と各物体との接触可能性の有無を判定する「第２処理」を実行する（図２／Ｓ１２０）。第２処理部１２０は、判定面における基準空間要素Ｑ₀からの移動コストに関する「第１接触条件」を満たしている第１空間要素Ｑ₁の有無を判定する（図２／Ｓ１２２）。移動コストは判定面において基準空間要素が第１空間要素に接触するまでの所要時間および移動距離のうち一方または両方の関数として第３処理部１３０により評価される。図６に示されている基準空間要素Ｑ₀と、第１空間要素Ｑ₁₁〜Ｑ₁₄のそれぞれとの直線距離もしくは経路（一点鎖線）に沿った距離ｄ、基準空間要素Ｑ₀および当該第１空間要素Ｑ₁₁〜Ｑ₁₄がそれぞれの基準速度ｖ₀および速度ｖを維持したまま移動し、基準空間要素Ｑ₀および第１空間要素Ｑ₁₁〜Ｑ₁₄のそれぞれに接するまでの所要時間ｔ＝（ｄ／｜ｖ₀−ｖ｜））、または当該距離ｄおよび所要時間ｔのうち一方もしくは両方の増加関数が移動コストとして評価される。たとえば「移動コストが規定範囲｛０，ε₊（＞０）｝にあること」という第１接触条件が採用され、かつ、図６に一点鎖線で示されている経路Ｒ_Kが最新の行動計画に応じて設定されている場合を考察する。この場合、４つの第１空間要素Ｑ₁₁〜Ｑ₁₄のうち、基準空間要素Ｑ₀に近い３つの第１空間要素Ｑ₁₁〜Ｑ₁₃が第１接触条件を満たしていると判定されうる。

第２処理部１２０は第１接触条件を満たす第１空間要素Ｑ₁が存在すると判定した場合（図２／Ｓ１２２‥ＹＥＳ）、当該第１空間要素Ｑ₁のうちロボット１の行動計画に応じた、判定面における基準位置Ｏから目標位置ｐ_dまで延びる基準空間要素Ｑ₀の経路Ｒ_Kとの位置関係に関する「第２接触条件」を満たしている第１空間要素Ｑ₁の有無を判定する（図２／Ｓ１２４）。

たとえば「経路Ｒ_Kと第１空間要素Ｑ₁との交点または接点が存在すること」が第２接触条件として採用され、かつ、図６に一点鎖線で示されている経路Ｒ_Kが第１行動計画要素として設定されている場合を考察する。この場合、前記のように第１接触条件を満たしている３つの第１空間要素Ｑ₁₁〜Ｑ₁₃のうち、経路Ｒ_Kと交わっている第１空間要素Ｑ₁₂が第２接触条件を満たしていると判定される。なお「第１空間要素Ｑ₁までの最短距離またはその経路Ｒ_Kの一部もしくは全部に沿った累積または積分が所定値以下であること」や「基準位置Ｏにおける経路Ｒ_Kの接線（基準空間要素Ｑ₀の移動方向に延びている。）と第１空間要素Ｑ₁との交点または接点が存在すること」等が第２接触条件として採用されてもよい。

前記のように「第１接触条件」および「第２接触条件」の両方を満たす第１空間要素Ｑ₁が存在する場合（図２／Ｓ１２２‥ＹＥＳ，Ｓ１２４‥ＹＥＳ）、基準空間要素Ｑ₀との接触可能性がある第１空間要素Ｑ₁が存在すると判定される。なお、第１接触条件および第２接触条件のうち一方のみを満たす第１空間要素Ｑ₁が存在する場合も、基準空間要素Ｑ₀との接触可能性がある第１空間要素Ｑ₁が存在すると判定されてもよい。

そして、第２処理部１２０によって第２接触条件を満たしている第１空間要素Ｑ₁が存在すると判定された場合（図２／Ｓ１２４‥ＹＥＳ）、第３処理部１３０がすべての第２空間要素Ｑ₂との接触を回避しうるような基準空間要素Ｑ₀の新たな経路を第１行動計画要素として設定する「第３処理」を実行する（図２／Ｓ１３０）。

前記のように図６に示されている例では４つの第１空間要素Ｑ₁₁〜Ｑ₁₄のうち１つの第１空間要素Ｑ₁₂が第１および第２接触条件を満たすので、実線で示されているようにすべての第２空間要素Ｑ₂₁〜Ｑ₂₄と接触しない新たな経路Ｒ_K+1が第１行動計画要素として設定される。これに応じて、ロボット１は先の第１行動計画要素としての図６に一点鎖線で示されている経路Ｒ_Kではなく、新たな第１行動計画要素としての図６に実線で示されている経路Ｒ_K+1にしたがって移動する。

さらに、第３処理部１３０は判定面において基準空間要素Ｑ₀の基準位置Ｏおよび目的位置ｐ_dの距離｜Ｏ−ｐ_d｜が閾値δ以下になったか否か、すなわち、ロボット１画素の目的位置に到達したか否かを判定する（図２／Ｓ１３２）。なお、第２処理部１２０による判定結果が否定的（図２／Ｓ１２２‥ＮＯ，Ｓ１２４‥ＮＯ）であった場合も当該判定が実行される（図２／Ｓ１３２）。

そして、当該判定結果が否定的であった場合（図２／Ｓ１２２‥ＮＯ）、前述の第１処理、第２処理等が再び実行される。たとえば図６に示されている状況から図７に示されている状況に変遷し、４つの第１空間要素Ｑ₁₁〜Ｑ₁₄のうち１つの第１空間要素Ｑ₁₂が再び第１および第２接触条件の両方を満足していると判定された場合、図７において先の第１行動計画要素としての一点鎖線で示されている経路Ｒ_K+1が、新たな第１行動計画要素としての実線で示されている新たな経路Ｒ_K+2に変更される。一方、当該判定結果が肯定的であった場合（図２／Ｓ１３２‥ＹＥＳ）、前述の一連の処理が終了する。

前記機能を発揮するロボット１によれば、次の理由により第１行動計画要素としての経路Ｒ_kの変更頻度が抑制されている。すなわち、判定面において移動コストに関する第１接触条件を満たす第１空間要素Ｑ₁のみが第２接触条件の充当性判定の対象とされている（図２／Ｓ１２２‥ＹＥＳ，Ｓ１２４参照）。これにより、ロボット１から遠くに存在する物体ｘに対応する第１空間要素Ｑ₁については、第２接触条件の充当性判定ひいては経路変更の要否判定の対象からはずされる。このため、すべての第１空間要素Ｑ₁が第２接触条件の充当性判定の対象とされる場合よりも経路Ｒ_kの変更頻度が抑制される。

また、判定面において第１接触条件を満たす第１空間要素Ｑ₁のうち少なくとも１つが、現在経路との位置関係に関する第２接触条件をさらに満たすことが経路Ｒ_kの変更要件とされている（図２／Ｓ１２４‥ＹＥＳ，Ｓ１３０参照）。第１空間要素Ｑ₁は判定面において広がりが比較的小さい空間要素として認識される（図５（ａ）〜図５（ｃ）参照）。このため、第２空間要素Ｑ₂等、第１空間要素Ｑ₁よりも広がりが大きい空間要素を基準として第２接触条件の充足性が判定される場合よりも、第１行動計画要素としての経路Ｒ_kの変更頻度が低く抑制される。

さらに、判定面における第１空間要素Ｑ₁の形状およびサイズがデータベース等への照会により認識されうる。これにより、ＣＣＤカメラ２１等による物体ｘのサイズ（または形状およびサイズ）の測定精度の限界のために物体ｘがその実際のサイズに鑑みて判定面における広がりが過大な第１空間要素Ｑ₁として認識される事態が回避されうる。そして、第１行動計画としての経路の変更頻度およびこれにともなうロボット１の移動方向等の変更頻度が低く抑制される。すなわち、ＣＣＤカメラ２１等を通じた物体ｘの外形特性認識精度の限界のためにロボット１の経路が頻繁に変更される事態が回避される。

前記のように第１行動計画要素としての経路Ｒ_kの変更頻度が抑制される分だけ、ロボット１が移動方向を変化させる等、その挙動を変化させる頻度が抑制される。これにより、ロボット１の挙動変化に応じて人間等の物体ｘの挙動変化が誘発されてしまい、ロボット１と当該物体ｘとが接触する可能性がかえって高まるような事態が回避されうる。さらに、第１行動計画要素としての経路Ｒ_kの変更頻度が抑制される分だけ、当該経路変更に要する情報処理の負荷が軽減されうる。

また、次のような理由によりロボット１が物体ｘとの接触を確実に回避する観点から適当な経路Ｒ_k+1が設定される。すなわち、前記のように判定面において第１接触条件および第２接触条件を満たす第１空間要素Ｑ₁が１つでも存在する場合、基準空間要素Ｑ₀が第２空間要素Ｑ₂との接触を回避しうるような新たな経路Ｒ_k+1が設定される（図２／Ｓ１２２‥ＹＥＳ，Ｓ１２４‥ＹＥＳ，Ｓ１３０、図６〜図７参照）。第２空間要素Ｑ₂は判定面において広がりが比較的大きい空間要素として認識される（図５（ａ）〜図５（ｃ）参照）。このため、基準空間要素Ｑ₀が第１空間要素Ｑ₁等、第２空間要素Ｑ₂よりも広がりが小さい空間要素を基準として新たな経路が設定される場合よりも、ロボット１が物体ｘとの確実な接触回避の観点から適当な経路Ｒ_k+1が設定される。

さらに、判定面における第１空間要素Ｑ₁の形状およびサイズがデータベース等への照会により認識され、第２空間要素Ｑ₂の形状およびサイズが当該第１空間要素Ｑ₁の形状およびサイズに基づいて定められる。これにより、ＣＣＤカメラ２１等による物体ｘのサイズの測定精度の限界のために物体ｘがその実際のサイズに鑑みて判定面における広がりが過大な第２空間要素Ｑ₂として認識される事態が回避されうる。そして、第１行動計画としての経路が、物体ｘとの接触の観点から過剰に変更される事態が回避される。

続いて、一の判定面のみならず、複数の判定面のそれぞれにおいて各空間要素Ｑ₀，Ｑ₁およびＱ₂が認識され、かつ、当該複数の判定面のうちいずれかにおいて第１および第２接触条件を満たす第１空間要素Ｑ₁が存在することが第１行動計画要素の変更要件とされている実施形態について説明する。

例として図８に示されているようにロボット１が、ロボット１よりも背の低い猫や犬などの第１物体ｘ₁と、ロボット１と背の高さが同程度の人間などの第２物体ｘ₂との間をすれ違うように歩行する状況を考える。この状況でロボット１、第１物体ｘ₁および第２物体ｘ₂のそれぞれが１つの判定面Ｐでのみ認識された場合、当該判定面Ｐでは図９（ｃ）に示されているような基準空間要素Ｑ₀ならびに第１空間要素Ｑ₁₁およびＱ₁₂として認識される場合がある。この場合、第１および第２接触条件を満たす第１空間要素Ｑ₁が存在すると判定され、先の経路Ｒ_kが新たな経路Ｒ_k+1に変更されうる（図２／Ｓ１２４‥ＹＥＳ，Ｓ１３０参照）。すなわち、ロボット１等の立体的外形特性が考慮されていないため、第１空間要素Ｑ₁が大きい空間要素として認識され、この分だけロボット１が物体ｘとの接触を回避するための新たな第１行動計画要素が設定される可能性が高くなる。

その一方、複数の判定面のそれぞれにおいて基準空間要素Ｑ₀等が認識されることにより、ロボット１および各物体ｘのそれぞれの立体的形状特性に鑑みて適当な頻度で経路が変更され、かつ、ロボット１および各物体ｘの確実な接触回避の観点から適当な経路が設定されうる。

たとえば前記状況で床面からの高さｈ₁の判定平面Ｐ（ｈ₁）および高さｈ₂（＞ｈ₁）の判定平面Ｐ（ｈ₂）のそれぞれにおいて基準空間要素Ｑ₀等が認識される場合を考える。この場合、判定面Ｐ（ｈ₁）においては第１物体ｘ₁および第２物体ｘ₂のそれぞれが図９（ａ）に示されているような第１空間要素Ｑ₁₁およびＱ₁₂として認識される。また、高さｈ₂（＞ｈ₁）の判定面Ｐ（ｈ₂）においては第２物体ｘ₂のみが図９（ｂ）に示されているような第１空間要素Ｑ₁₂として認識される。判定面Ｐ（ｈ₂）では第１物体ｘ₁は認識されていない。これは、第１物体ｘ₁の背が高さｈ₂に満たないからである。また、第２物体ｘ₂が判定面Ｐ（ｈ₂）では比較的大きい第１空間要素Ｑ₁₂として認識される一方、判定面Ｐ（ｈ₁）では比較的小さい第１空間要素Ｑ₁₂として認識されている。これは、ロボット１の上半身が腕体１２等の存在のため下半身よりもサイズが大きく（図１参照）、第２物体ｘ₂である人間も同様に上半身が下半身よりもサイズが大きいためである。別の言い方をすると、ロボット１および第２物体ｘ₂の上半身にかかる判定面Ｐ（ｈ₂）におけるロボット領域ｑ_robotおよび物体領域ｑ_objectのミンコフスキー和のサイズがロボット１および物体ｘ₂の下半身にかかる判定面Ｐ（ｈ₁）におけるミンコフスキー和ｑ_robot＋ｑ_objectよりも大きくなるからである（図４参照）。これら２つの判定面Ｐ（ｈ₁）およびＰ（ｈ₂）の両方において基準空間要素Ｑ₀から目的位置ｐ_dまで延びる経路Ｒ_kと第１空間要素Ｑ₁とは交わらないので第２接触条件を満たす第１空間要素Ｑ₁が存在しないと判定され、第１行動計画要素としての経路Ｒ_kはそのままに維持される（図２／Ｓ１２４‥ＮＯ参照）。

これにより、ロボット１および物体ｘのそれぞれの３次元形状およびサイズに鑑みた適当な頻度で経路Ｒ_kが変更されうる。すなわち、ロボット１および物体ｘのそれぞれは一般的に形状およびサイズが床面からの高さ等、位置に応じて変化するという外形特性を有している。このため、複数の判定面のそれぞれにおいて認識された第１空間要素Ｑ₁の形状およびサイズに、ロボット１および物体ｘのそれぞれの異なる箇所（高さ）の形状およびサイズが反映されうる。これにより、ロボット１および物体ｘのそれぞれの立体的外形特性、位置および速度等の挙動状態に鑑みて、基準空間要素Ｑ₀として認識されたロボット１が第１空間要素Ｑ₁として認識された物体ｘとの接触を回避する観点から適当な頻度で第１行動計画要素としての経路Ｒ_kが変更されうる。

また、複数の判定面のすべてにおいて基準空間要素Ｑ₀が第２空間要素Ｑ₂との接触を回避する経路Ｒ_k+1が第１行動計画要素として設定される。これにより、ロボット１および物体のそれぞれの３次元的な形状およびサイズに鑑みて、両者の接触回避の観点から適当な経路Ｒ_k+1が設定されうる。したがって、ロボット１が、人間等の物体ｘの挙動変化を誘発する頻度を低く抑制しながら、当該物体ｘとの接触を回避して移動を継続することができる。

また、ロボット１および物体ｘのそれぞれの外形特性に応じた２つの領域ｑ₀およびｑのミンコフスキー和ｑ₀＋ｑが第１空間要素Ｑ₁として認識される。これにより、ロボット１および物体ｘのそれぞれのサイズおよび形状が判定面における第１空間要素Ｑ₁のサイズおよび形状にまとめて反映されうる。このため、判定面における基準空間要素Ｑ₀の点または微小領域としての簡易的な取り扱い、ひいては基準空間要素Ｑ₀との接触可能性がある第１空間要素Ｑ₁の有無の判定等の容易化が図られながらも、当該判定精度の向上または維持が図られうる。

なお、前記制御方法がロボット１のように左右一対の脚体の動作によって移動するロボットのほか、３つ以上の脚体の動作によって移動するロボットや、車輪式移動ロボット（自動車）等、移動機能を有するあらゆる装置に適用されてもよい。

また、移動コストに関する規定範囲の下限値として０ではなく正値が採用された場合、移動コストが当該下限値未満である場合には第１接触条件が満たされず、新たな第１行動計画要素としての経路Ｒ_kは変更されない（図２／Ｓ１２２‥ＮＯ参照）。これにより、物体ｘがロボット１の近くにあるため、ロボット１の挙動を変化させると物体ｘの挙動変化を誘発し、かえって両者の接触可能性が高くなる可能性がある状態で、ロボット１の移動方向が変更される事態が回避されうる。

なお、基準空間要素Ｑ₀ひいてはロボット１の速度の向きおよび大きさのうち一方または両方の変化率が閾値以下とすることが（付加的な）第１行動計画要素として設定されてもよい。これにより、第１行動計画要素の変更によるロボット１の過剰な速度変化およびこれにともなう挙動変化が抑制されうる。また、物体ｘの予期せぬ挙動変化を誘発し、ロボット１と物体ｘとの接触可能性をかえって高めるような事態が回避されうる。さらに、ロボット１にその能力を超えた速度変化またはこれにともなう挙動変化を強いる事態が回避されうる。

また、基準空間要素Ｑ₀ひいてはロボット１の速度の大きさが向きよりも優先的に変更されるように第１行動計画要素が設定されてもよい。この場合、ロボット１の速度の向き（移動方向）の変化が物体の挙動変化を誘発しやすい傾向があることに鑑みて、ロボット１の速度の大きさ（速さ）が向きよりも優先的に変更される。これにより、物体ｘの挙動変化を誘発するようなロボット１の挙動変化の頻度が低く抑えられうる。

さらに、第３処理部１３０がロボット１の移動方向の予告を「第２行動計画要素」として設定し、制御システム１００が第２行動計画にしたがってロボット１の搭載機器の動作を制御してもよい。たとえば、搭載機器としてのアクチュエータの動作が制御されることにより、基体１０、頭部１１、腕部１２および脚部１３等、人間の身体部分に対応する可動部分の第２行動計画要素にしたがった動きによりロボット１の移動方向が予告されてもよい。これにより、頭部１１の正面（顔）の向きを変える、腕部１２の姿勢を変える、基体１０の上部を下部に対してひねる等、人間にとって馴染みやすい行動様式によって当該人間（物体ｘ）に違和感を覚えさせることなくロボット１の移動方向を明確に認識させることができる。そして、物体ｘの方向転換等の行動を誘起し、ロボット１と物体ｘとの接触可能性を低減させることができる。また、ロボット１に方向指示器、光照射装置、または音声出力装置等を搭載機器としてもたせ、第２行動計画要素にしたがって方向指示器の点灯、光照射装置によるビームの照射、音声出力装置による音声の出力が制御されることで、ロボット１の移動方向が予告されてもよい。

本発明の移動装置の構成説明図 本発明の移動装置の機能説明図 本発明の移動装置の機能説明図 本発明の移動装置の機能説明図 本発明の移動装置の機能説明図 本発明の移動装置の機能説明図 本発明の移動装置の機能説明図 本発明の移動装置の機能説明図 本発明の移動装置の機能説明図

符号の説明

１‥ロボット（移動装置）、１００‥制御ユニット、１０２‥状況認識部、１１０‥第１処理部、１２０‥第２処理部、ｘ‥物体、Ｑ₀‥基準空間要素、Ｑ₁‥第１空間要素、Ｑ₂‥第２空間要素

Claims (18)

1. 制御システムを備え、該制御システムによって動作が制御されることにより第１行動計画要素にしたがって自律的に移動する移動装置であって、前記制御システムが、
   前記移動装置の現在像、物体の現在像および該物体の挙動状態に応じた該物体の断続的または連続的な未来像を判定面における基準空間要素、第１空間要素および第２空間要素のそれぞれとして認識する第１処理部と、
   該第１処理部による認識結果に基づき、該判定面において該基準空間要素との接触可能性があるという接触条件を満たす該第１空間要素の有無を判定する第２処理部と、
   該第２処理部により該判定面において該接触条件を満たす該第１空間要素が存在すると判定されたことを要件として、該第１処理部による認識結果に基づき、該判定面において該基準空間要素が該第２空間要素との接触を回避しうる経路を前記第１行動計画要素として設定する第３処理部とを備えていることを特徴とする移動装置。
2. 請求項１記載の移動装置において、
   前記第１処理部が前記物体の挙動状態を前記判定面における前記第１空間要素の位置、速度および加速度のうち一部または全部として認識し、かつ、前記基準空間要素を含まないように当該認識結果に応じて断続的または連続的に拡張された該第１空間要素を前記第２空間要素として認識することを特徴とする移動装置。
3. 請求項２記載の移動装置において、
   前記第１処理部が前記物体の挙動状態を前記判定面における前記第１空間要素の速度、ならびに前記基準空間要素に対する前記第１空間要素の相対位置および相対速度として認識し、かつ、当該認識結果に応じて断続的または連続的に拡張された該第１空間要素を前記第２空間要素として認識することを特徴とする移動装置。
4. 請求項１〜３のうちいずれか１つに記載の移動装置において、
   前記第１処理部が前記判定面において前記移動装置の外形特性に応じて拡張された、前記物体の外形特性に応じた領域を前記第１空間要素として認識することを特徴とする移動装置。
5. 請求項４記載の移動装置において、
   前記第１処理部が前記判定面において、前記移動装置および前記物体のそれぞれの外形特性に応じた２つの領域のミンコフスキー和を前記第１空間要素として認識することを特徴とする移動装置。
6. 請求項１〜５のうちいずれか１つに記載の移動装置において、前記第２処理部が前記第１処理部による認識結果に基づき、前記判定面における前記基準空間要素からの移動コストに関する前記接触条件としての第１接触条件を満たす前記第１空間要素の有無を判定することを特徴とする移動装置。
7. 請求項６記載の移動装置において、
   前記第２処理部が、前記移動コストが規定範囲内であるまたは該移動コストの低さが所定順位以上であることを前記第１接触条件として、該第１接触条件を満たす前記第１空間要素の有無を判定することを特徴とする移動装置。
8. 請求項７記載の移動装置において、
   前記第２処理部が、前記移動コストが正の下限値を有する前記規定範囲内に含まれていることを前記第１接触条件として、該第１接触条件を満たす前記第１空間要素の有無を判定することを特徴とする移動装置。
9. 請求項１〜８のうちいずれか１つに記載の移動装置において、前記第２処理部が前記第１行動計画要素としての前記経路との位置関係に関する前記接触条件としての第２接触条件を満たす前記第１空間要素の有無を判定することを特徴とする移動装置。
10. 請求項９記載の移動装置において、
    前記第２処理部が前記第１行動計画要素としての前記経路に沿って移動したときの前記基準空間要素との交点または接点があることを前記第２接触条件として、該第２接触条件を満たす前記第１空間要素の有無を判定することを特徴とする移動装置。
11. 請求項１〜１０のうちいずれか１つに記載の移動装置において、前記第３処理部が前記移動装置の速度の向きおよび大きさのうち一方または両方の変化率を閾値以下とすることを前記第１行動計画要素として設定することを特徴とする移動装置。
12. 請求項１〜１１のうちいずれか１つに記載の移動装置において、
    前記第３処理部が前記移動装置の速度の大きさを向きよりも優先的に変更することを前記第１行動計画要素として設定することを特徴とする移動装置。
13. 請求項１〜１２のうちいずれか１つに記載の移動装置において、前記制御システムが第２行動計画要素にしたがって前記移動装置の搭載機器の動作を制御し、
    前記第３処理部が該移動装置の移動方向の予告を該第２行動計画要素として設定することを特徴とする移動装置。
14. 請求項１３記載の移動装置において、
    人間の身体部分に対応する可動部分を動かす駆動機器を前記搭載機器として備え、前記第３処理部が該駆動機器の動作による移動方向の予告を前記第２行動計画要素として設定することを特徴とする移動装置。
15. 請求項１４記載の移動装置において、
    前記可動部分として頭部を備え、前記第３処理部が該頭部の正面を前記移動装置の移動方向に向けさせることを前記第２行動計画要素として設定することを特徴とする移動装置。
16. 第１行動計画要素にしたがって自律的に移動する移動装置を制御する方法であって、
    前記移動装置の現在像、物体の現在像および該物体の挙動状態に応じた該物体の断続的または連続的な未来像を判定面における基準空間要素、第１空間要素および第２空間要素のそれぞれとして認識する第１処理と、
    該第１処理における認識結果に基づき、該判定面において該基準空間要素との接触可能性があるという接触条件を満たす該第１空間要素の有無を判定する第２処理と、
    該第２処理において該判定面において該接触条件を満たす該第１空間要素が存在すると判定されたことを要件として、該第１処理における認識結果に基づき、該判定面において該基準空間要素が該第２空間要素との接触を回避しうる経路を前記第１行動計画要素として設定する第３処理とを実行することを特徴とする方法。
17. 第１行動計画要素にしたがって自律的に移動する移動装置に搭載されているコンピュータを、該移動装置の動作を制御するシステムとして機能させるためのプログラムであって、
    前記コンピュータを、
    前記移動装置の現在像、物体の現在像および該物体の挙動状態に応じた該物体の断続的または連続的な未来像を判定面における基準空間要素、第１空間要素および第２空間要素のそれぞれとして認識する第１処理部と、
    該第１処理部による認識結果に基づき、該判定面において該基準空間要素との接触可能性があるという接触条件を満たす該第１空間要素の有無を判定する第２処理部と、
    該第２処理部により該判定面において該接触条件を満たす該第１空間要素が存在すると判定されたことを要件として、該第１処理部による認識結果に基づき、該判定面において該基準空間要素が該第２空間要素との接触を回避しうる経路を前記第１行動計画要素として設定する第３処理部とを備えている制御システムとして機能させることを特徴とするプログラム。
18. 行動計画要素にしたがって自律的に行動する移動装置を監督するシステムであって、
    請求項１７記載のプログラムのうち少なくとも一部を該移動装置に搭載されている前記コンピュータに対して配信または放送することを特徴とする監督システム。
    

Images