JP6348971B2 - 移動体 - Google Patents

Description

本発明は、移動体に関し、自らの位置・姿勢を検知できる装置を搭載した移動体の移動経路における位置・姿勢を推定するシステムを搭載した自律移動体に関する。

特に、本発明は、搬送物を搬送する移動体を提供することができる技術に関し、特に線路パターン環境を自律的に移動することが可能な自律移動体に関する。

本発明は、具体的な実施の形態としては、自律移動ロボットを実施の形態として説明するものであるが、自律移動を行わないロボットにも適用できるものであり、さらには、カメラやＧＰＳを実装した自動車のカーナビ等の移動体への適用も容易なものであり、発明思想の範囲内での当業者が容易になし得る設計変更は発明の技術的範囲として含まれる。

従来から、予め施設されたレールや磁気テープ等の規定の移動経路に沿って移動する移動ロボットは多く開発されていたが、近年になって、規定の移動経路は持たずに、コンピュータ内で設定された移動経路に沿って自律的に移動するロボットが開発されている。このような自律移動ロボットにおいて、自律的な移動を実現するためには、ロボットの現在位置と姿勢を認識する自己位置・姿勢推定機能が不可欠であり、例えば自律移動ロボットが周囲状態を検知し、そのデータを基に自己位置を推定しながら、かつ、同時に地図を生成する方法が提案されている。この方法はＳＬＡＭ（Simultaneous Localization and Mapping）と呼ばれる技術で、得られるセンサ情報の範囲でロボットが自己位置・姿勢を求めると同時に環境地図の生成・更新を行い、これをもとに環境内を自律的に移動する特徴を有している。

このような自律移動ロボットに関して、例えば、特許文献１（特開２００５−３３２２０４号公報）には、ＧＰＳ（Global Positioning System）などの自己位置検知手段と、周囲の物体との距離と方向を検知する物体検知手段と、それらの検知データを基に移動する方向の環境地図を生成する機能を備えた移動制御装置が知られている。この特許文献１の課題は、ＧＰＳ衛星からの電波を受信していなくても目標経路に沿って移動体を正確に移動させ、目標経路上の予期しない障害物を回避するように制御するものである。そして、その解決手段は、予め設定された目標経路情報に従って自律移動する移動体に、その移動を制御する移動制御装置が設けられている。移動制御装置は、移動体の現在位置及び方位を検知する自己位置検知手段と、移動体とその周囲に存在する物体との距離を検知するＡＬＲ（Area Laser Rader）と、自己位置検知手段及びＡＬＲのデータに基づいて移動体の進路を決定するとともに、当該進路に沿って移動体を移動させるように移動体を制御する制御手段とを備えている。制御手段は、移動体の移動に伴い物体の存在を考慮した移動体周囲の環境地図を移動方向に累積的に生成し、目標経路情報及び環境地図に基づいて物体に非干渉となる移動体の進路を決定する。

また、特許文献２（特開２００４−２７６１６８号公報）の移動ロボットは、移動センサと認識手段により、物体間の相対姿勢で表わされる地図情報とロボットの姿勢の同時推定を行うことで、新規地図情報を作成していく方法が示されている。この特許文献２の課題は、精度の高い移動ロボット用地図を作成することができる地図作成システムの提供である。その解決手段のステップでは、まず、移動ロボットにより新規地図情報を作成する。次に、既存地図情報を読み込んで、既存地図のもつ相対姿勢を１つずつ取り出す。そして、同じ相対姿勢が新規地図情報にもあるかを調べる。新規地図情報にも同じ相対姿勢があれば、新規地図情報と既存地図情報が共通に持つ相対姿勢を確率的に融合する。新規地図情報に同じ相対姿勢がなければ、その相対姿勢を新規地図情報に追加する。その後、新規地図情報の相対姿勢集合の中にループを構成するものがある場合には、そのずれを解消するループ解決処理を行う。

さらに、特許文献３（特開２００７−９４７４３号公報）においては、マップデータ生成部と位置推定部が自律移動型ロボット、あるいは、サーバ装置に配置されていることが示されている。この特許文献３の課題は、ユーザが任意に選択した位置情報を容易に教示することができ、かつ、この教示された位置情報に基づいて移動先を指定することで、指定された移動先に自律移動する自律移動型ロボットとそのシステムを提供するものである。その解決手段としては、ユーザからの位置情報及び移動先情報の入力を受ける情報入力部と、情報入力部から入力された位置情報と位置推定部で推定した位置とを関連付けてテーブルに記憶する位置情報記憶部とを備える。そして、情報入力部に対して移動先情報の入力があると、移動経路計画部が、入力された移動先情報と位置情報記憶部に記憶されているテーブルとを対応させ、ロボットの移動空間内の障害物情報であるマップデータを参照して、位置推定部で推定された位置からの移動経路を求め自律移動する。

また、特許文献４（特開２００５−２４２４８９号公報）には、搬送物を搬送する移動体に関する背景技術として、「自律移動体が走行するルートの制約を低減して最短距離のルートを設定可能とし、複数台の自律移動体が同時に走行しても衝突や渋滞が生じないようにする」ものが開示されている。

また、特許文献５（特開２００７−１３３８９１号公報）、特許文献６（特開２００６−２９３９７５号公報）には、壁面に沿って移動する自律移動体に関する発明の開示がある。

特許文献５では、壁面に沿って移動する「壁面追従モード」が記載されているが、これは、「壁面追従、すなわち清掃ロボットの場合には縁端清掃により、部屋の縁端や室内の物体の縁端のみを清掃可能である。」との記載（段落番号００５３）があり、清掃ロボットとして、部屋の縁端や室内の物体の縁端のみを清掃することを狙った動作モードの説明が行われているに過ぎないものである。

また、特許文献６では、「壁面が不連続である場合には壁面からの距離が得られないため、境界に沿った適切な移動が行われないという問題がある」との問題の指摘（段落番号０００３）に対して、「特定領域の境界が離散的に配置されている物体で形成されている場合においても、境界に沿った適切な移動を実現できる自律移動装置を提供することを目的とする」（段落番号０００４）との開示がある。

特開２００５−３３２２０４号公報 特開２００４−２７６１６８号公報 特開２００７−９４７４３号公報 特開２００５−２４２４８９号公報 特開２００７−１３３８９１号公報 特開２００６−２９３９７５号公報

以上のように、従来技術においては、移動体の移動に伴い物体の存在を考慮した移動体周囲の環境地図を移動方向に累積的に生成し、目標経路情報及び環境地図に基づいて物体に非干渉となる移動体の進路を決定する等の技術は開示されている。このような従来技術は、幾何的特徴（凹凸等）が多数ある一般的な環境においては可能なものである。しかしながら、幾何的特徴に乏しい環境が混在する環境においては、ロボットが自位置を周囲の幾何学的特徴から判断することが困難となる。本発明は、正にこのような幾何的特徴に乏しい環境においても自動走行が可能なロボットの実現を課題とするものである。

そこで、本明細書では、工作機械や収納棚等の設備が多数設置された工場や倉庫等のように、自律移動体周辺の環境において凹凸等の幾何的特徴が十分に有ることで、センサデータと地図とのマッチングを行った際に位置・姿勢のすべてのパラメータが一意に求められる環境を「一般環境」と呼ぶものとする。また、通路両側に平坦な壁が続くような幾何的特徴に乏しく、センサデータと地図とのマッチングを行っても、マッチする個所が複数現れ、位置・姿勢のパラメータの解の候補が複数現れてしまう環境を、幾何的特徴のパターンが一様に続くことから「一様パターン環境」と呼ぶものとする。なお、本明細書においては、経路の両側に壁が続くような環境、即ち地図として環境を表現した場合に地図上に平行な二本線が線路のように続く環境については特に線路環境という用語にて説明することがあるが「一様パターン環境」の下位概念の意義である。

本発明の前記ならびにその他の目的と新規な特徴は、本明細書の記述および添付図面から明らかになるであろう。

本願において開示される発明のうち、代表的なものの概要を簡単に説明すれば、次の通りである。

すなわち、代表的な移動体は、自装置と前記自装置の周囲にある障害物との距離を検知する距離センサ部と、前記距離センサ部の検知結果に基づいて前記自装置の位置姿勢を推定して走行を制御するコントローラ部と、前記コントローラ部の制御に基づいて前記自装置を自律的に走行させる移動機構部と、を備える。そして、前記コントローラ部は、走行環境の地図と前記距離センサ部の検知結果である距離データとを用いて前記自装置の位置姿勢を推定して、前記自装置の位置姿勢が一意に定まる状態と、前記自装置の位置姿勢が一意に定まらない状態とで走行モードを切り替える、ことを特徴とする。

より好ましくは、前記コントローラ部は、前記自装置の位置姿勢が一意に定まらない状態の場合に、終端データが設定されていないセグメントでは走行を停止し、終端データが設定されているセグメントでは壁ならい走行モードで走行を行うように制御する、ことを特徴とする。

さらに、より好ましくは、前記コントローラ部は、前記終端データが設定されていないセグメントで走行を停止中の前記移動体が、前記自装置の位置姿勢が一意に定まる状態に復帰した場合に走行を再開するように制御する、ことを特徴とする。

なお、前述の特許文献５、特許文献６には、壁面に沿って移動する自律移動体に関する発明の開示があるが、特許文献５は、清掃ロボットに部屋の縁端や室内の物体の縁端のみを清掃させる為に、単に壁面に沿って移動するに留まるものである。

また、特許文献６では、「壁面が不連続である場合には壁面からの距離が得られないため、境界に沿った適切な移動が行われないという問題がある」ことに対して、その解決策を提示しているものである。

本発明においては、「一様パターン環境」と称して、幾何的特徴に乏しい環境が混在する環境である場合には、ロボットが自位置を周囲の幾何学的特徴から判断することが困難となることを問題としているが、この点に対して、特許文献６では、何ら関連する技術を開示しているものではない。

本願において開示される発明のうち、代表的なものによって得られる効果を簡単に説明すれば以下の通りである。

すなわち、代表的な効果は、上記構成により、凹凸等の幾何的特徴が多数存在することで、センサデータと地図とのマッチングにより、位置・姿勢のすべてのパラメータが高い確度で求められる環境においては、すべてのパラメータを用いる一般走行モードでの自動走行を行うことができる。かつ、幾何的特徴が乏しく、センサデータと地図とのマッチングを行っても位置・姿勢のすべてのパラメータが高い確度で求められない環境においては、確度が高いパラメータのみを用いる壁ならい走行モードでの自動走行を行うことができる。また、壁ならい走行モードから一般走行モードに切り替えるためには、位置・姿勢のすべてのパラメータが求められる環境に到達したことを判定する必要がある。このため、幾何的特徴が乏しい環境から幾何的特徴が多数存在する環境への切り替わる場所の地図とセンサデータとのマッチングにより、マッチングの確度が高い場合は、切り替え可能な場所に到達したものと判定し、運転モードを切り替え、目的地までの走行を行うことができる。これにより、設備などにより幾何的特徴が多数存在する工場などの環境と、幾何的特徴に乏しい廊下などの環境とが混在する環境での移動体の自律移動が可能となる。

本発明の一実施の形態の線路パターン環境を自律移動可能な移動体の機能構成を示すブロック図である。 図１の移動体において、ソフトウェア構成を示すブロック図である。 図１の移動体において、距離センサ部による現在位置の推定処理を示す説明図である。 図１の移動体において、移動体の自律移動処理の概要を示すフローチャートである。 図１の移動体において、経路データ及び一様パターン環境終端データのデータ構造の一例を示す説明図である。 図１の移動体において、位置姿勢推定処理を示す説明図である。 図１の移動体において、図６に示す範囲Ｃの拡大図である。 図１の移動体において、移動体の一般走行モード及び壁ならい走行モードの処理を示すフローチャートである。 図１の移動体において、一般走行モード及び壁ならい走行モードの互いのモードの切り替えの一例を示す説明図である。 図１の移動体において、壁ならい走行モードから一般走行モードへの切り替えの詳細な処理の一例を示す説明図である。

以下の実施の形態においては、便宜上その必要があるときは、複数のセクションまたは実施の形態に分割して説明するが、特に明示した場合を除き、それらは互いに無関係なものではなく、一方は他方の一部または全部の変形例、詳細、補足説明などの関係にある。また、以下の実施の形態において、要素の数など（個数、数値、量、範囲などを含む）に言及する場合、特に明示した場合および原理的に明らかに特定の数に限定される場合などを除き、その特定の数に限定されるものではなく、特定の数以上でも以下でも良い。

さらに、以下の実施の形態において、その構成要素（要素ステップなども含む）は、特に明示した場合および原理的に明らかに必須であると考えられる場合などを除き、必ずしも必須のものではないことは言うまでもない。同様に、以下の実施の形態において、構成要素などの形状、位置関係などに言及するときは、特に明示した場合および原理的に明らかにそうでないと考えられる場合などを除き、実質的にその形状などに近似または類似するものなどを含むものとする。このことは、上記数値および範囲についても同様である。
［実施の形態の概要］

まず、本発明の実施の形態の概要について説明する。本実施の形態の概要では、一例として、括弧内に実施の形態の対応する構成要素、符号を付して説明する。

実施の形態の移動体は、自装置と前記自装置の周囲にある障害物との距離を検知する距離センサ部（距離センサ部１２）と、前記距離センサ部の検知結果に基づいて前記自装置の位置姿勢を推定して走行を制御するコントローラ部（コントローラ部１１）と、前記コントローラ部の制御に基づいて前記自装置を自律的に走行させる移動機構部（移動機構部２１）と、を備える。そして、前記コントローラ部は、走行環境の地図と前記距離センサ部の検知結果である距離データとを用いて前記自装置の位置姿勢を推定して、前記自装置の位置姿勢が一意に定まる状態（一般環境）と、前記自装置の位置姿勢が一意に定まらない状態（一様パターン環境）とで走行モードを切り替える、ことを特徴とする。

より好ましくは、前記コントローラ部は、前記自装置の位置姿勢が一意に定まらない状態の場合に、終端データが設定されていないセグメントでは走行を停止し、終端データが設定されているセグメントでは壁ならい走行モードで走行を行うように制御する、ことを特徴とする。

さらに、より好ましくは、前記コントローラ部は、前記終端データが設定されていないセグメントで走行を停止中の前記移動体が、前記自装置の位置姿勢が一意に定まる状態に復帰した場合に走行を再開するように制御する、ことを特徴とする。

以下、上述した実施の形態の概要に基づいた実施の形態を図面に基づいて詳細に説明する。なお、実施の形態を説明するための全図において、同一の部材には原則として同一の符号を付し、その繰り返しの説明は省略する。
［一実施の形態］

以下、本発明の一実施の形態を自律移動体（具体的には自律移動ロボットに適用）に限定して、図１〜図１０を参照して説明する。以下、前述の「一般環境」及び「一様パターン環境」の分類定義のもと、一般環境と一様パターン環境とを自動走行する移動体について、本実施の形態で想定する移動体の機能の構成・主な処理内容について始めに述べ、続いて、より具体的なハードウェア・ソフトウェアの構成とこれらの動作について述べる。
＜移動体の機能構成＞

図１は、本実施の形態の線路パターン環境を自律移動可能な移動体（自律移動体とも称する）１０の機能の構成を示す。自律移動体１０は、この自律移動体１０の位置・姿勢を推定して走行を制御するコントローラ部１１、自律移動体１０と周囲にある障害物等の外壁面との距離を検知する距離センサ部１２、及び自律的に走行させる移動機構部２１，２１を備えている。また、コントローラ部１１は、距離センサ部１２を制御する距離センサ制御部１３を備えており、距離センサ部１２からの検知結果を受けて自律移動体１０の位置・姿勢を推定する位置姿勢推定部１４を備えている。

位置姿勢推定部１４は、２つの推定部を備えることが望ましい。この点に関しては、本願発明の課題ではなく、同一出願人の先願（特開２０１３−２５３５１）として既に出願している。簡単に説明しておくが、この２つの位置・姿勢推定部は通常位置・姿勢推定部と初期位置・姿勢推定部である。障害物は自律移動体の動作領域内に複数配置されており、先願発明においては、地図データ上におけるそれら障害物を配置させた際の障害物の外周輪郭形状を障害物の配置形状と称して説明する。通常位置・姿勢推定部は、従前技術による位置・姿勢の推定を行うものであり、先願発明における主要な課題ではない。先願発明においては、初期位置・姿勢推定部を設けたことを特徴としており、この初期位置・姿勢推定部は、位置姿勢候補表示・設定部を備えている。先願発明の実施の形態の自律移動体は、通常位置・姿勢推定部又は初期位置・姿勢推定部により推定された位置・姿勢に基づいて自らが走行する領域の経路を設定する経路計画部を設け、この経路計画部で計画された経路に沿うように車輪を駆動して自律移動体を自律移動させる移動機構制御部を設けている。

それに対して、本発明の自律移動体１０のコントローラ部１１は、さらに、移動体１０の現在位置が一様パターン環境の終端であるか否かを判定する一様パターン環境終端判定部１５を備えている。さらに、移動体１０の現在の位置・姿勢から追従すべき経路上の目標位置・姿勢の算出を行う動作計画部１６、算出された目標位置・姿勢と移動体１０の現在の位置・姿勢とのずれを小さくするように制御する移動機構制御部１７、及び前部キャスタと後部駆動輪を有した移動機構部２１を備えている。また、各種データの記憶部は、地図データ記憶部１８、経路データ記憶部１９、一様パターン環境終端データ記憶部２０から構成される。また、ここでは図示していないが、各部を支持する筐体、電源・配線など、各部が連携し、動作するために必要なものは備わっているものとする。

本実施の形態の自律移動体１０は、距離センサ制御部１３により、距離センサ部１２を制御し、周囲の環境中の設備等の物体外周縁までの距離と方向の計測からなる距離データを得る。ここでは距離センサ部１２として、レーザ距離センサを用いるものとする。このレーザ距離センサは、レーザを照射してから、照射したレーザが環境中の物体により反射してセンサに返ってくるまでの時間を計測することで、センサから物体外周縁までの距離を計測するレーザ照射部を備えている。そして、このレーザ照射部を一定の回転角毎に回転させながら計測することで、回転角度の範囲内にある物体外縁までの距離の計測（以下、「スキャン」との用語を用いる）が可能であるとする。このような機能を備えたレーザ距離センサは、従来公知であるので、具体的測距方法はこれ以上の説明はしない。今、このスキャンが平面内で行われるとすると、スキャンによりレーザがなす平面（以下、「スキャン面」との用語を用いる）上におけるセンサから物体外縁までの距離と方向が得られることとなる。このときに得られる各方向におけるセンサと物体外縁間の距離のデータとレーザを照射した方向データを組としたデータをここでは単に距離データと呼ぶものとする。この距離データの１つ１つは距離と方向のデータを組として記録されているため、センサを基準とした位置のデータに変換することができる。このようにして距離データを位置のデータに変換したものをここでは幾何形状データと呼ぶものとする。今、レーザ距離センサのスキャン面が床面に平行となるように移動体１０に取り付けられており、レーザ距離センサのスキャン面の高さでの幾何形状データが得られるものとする。

以上で得られた幾何形状データは位置姿勢推定部１４に送られる。位置姿勢推定部１４には、スキャン面の高さでの環境の幾何形状を画像として記録した地図データ記憶部１８が予め読み込まれている。そして、この地図データ記憶部１８の物体が存在することを示す画素（以下、「物体存在画素」との用語を用いる）に対して画像と見なした幾何形状データの物体存在画素が最も重なり合うときの地図データ上での幾何形状データの位置・姿勢を探索する処理（以下、当該処理に「マッチング（マッチング処理）」との用語を用いる）が行われる。これにより、幾何形状データと地図データ記憶部１８が最も重なり合うときの地図データ記憶部１８の座標系での幾何形状データの位置・姿勢が求まる。これは、直接的には距離センサ部１２のレーザ照射部の位置・姿勢に相当するが、移動体１０の位置・姿勢を表す際には移動体１０の筐体のどこの位置を基準としてもよいため、ここで得られた距離センサ部１２の位置・姿勢をもって移動体１０の位置・姿勢とする。

本実施の形態の自律移動体１０が一般環境を走行中の場合は、動作計画部１６での処理に進む。動作計画部１６は、一般走行モードで動作し、予め読み込んでおいた移動体１０の経路データ記憶部１９と位置姿勢推定部１４で得られた移動体１０の現在の位置・姿勢から追従すべき経路上の目標位置・姿勢の算出が行われる。

そして、移動機構制御部１７では、算出された目標位置・姿勢と移動体１０の現在の位置・姿勢とのずれを小さくするように移動機構部２１の制御をする。すなわち、車輪（一般的には後部駆動輪）の回転速度やステアリング（一般的には前部キャスタ）の切れ角などを求めてモータなどへの指示が行われる。これらにより、移動体１０の予め設定された経路に沿った追従、ひいては目的地までの自動走行が実現される。

本実施の形態の自律移動体１０は、一般環境での走行の際には、距離センサ部１２からの検知結果を受けて移動体１０の位置・姿勢を推定する位置姿勢推定部１４により自律的に予め設定された経路に沿って走行する。位置姿勢推定部１４の推定処理により、一般環境から一様パターン環境に入ったと推定された時点で、移動体１０は、距離センサ部１２によって検出した障害物に接触しないように進行方向に前進を行う壁ならい走行モードの運転に入る。このように、移動体１０が壁ならい走行モードで一様パターン環境を走行中の場合は、位置姿勢推定部１４に続いて一様パターン環境終端判定部１５にて判定処理が行われる。一様パターン環境終端判定部１５には、予め地図データ記憶部１８と、一様パターン環境の終端位置におけるデータである一様パターン環境終端データ記憶部２０からのデータが読み込まれている。この一様パターン環境終端データ記憶部２０には、幾何形状データと地図データ記憶部１８とのマッチングを行った場合に、一様パターン環境の行程中でのマッチングのように複数の解の候補が現れることなしに、一意に位置・姿勢が求められるマッチングの探索範囲の位置・姿勢、探索範囲の形状（一様パターン環境終端での位置・姿勢、探索範囲の形状）が記録されている。マッチングの探索範囲とは、マッチングにおいて解の候補を探索する範囲（解の取り得る値の範囲）を示す。ここでは位置・姿勢の３つのパラメータに関する範囲となる。

一様パターン環境終端判定部１５では、この一様パターン環境終端データ記憶部２０に記録されたマッチングの探索範囲の位置・姿勢等をもとに、位置姿勢推定部１４と同様に地図データ記憶部１８と幾何形状データとのマッチングを行う。移動体１０が一様パターン環境を自動走行している間は、位置姿勢推定部１４でのマッチングと一様パターン環境終端判定部１５でのマッチングを行いながら移動する。より具体的には、長い廊下等の線路パターン環境では、両方の壁から所定距離だけ離れて直線的に走行する。このとき、動作計画部１６は、一様パターン環境における壁ならい走行モードで動作し、予め読み込んでおいた移動体１０の経路データ記憶部１９と位置姿勢推定部１４で部分的に得られた移動体１０の現在の位置・姿勢、そして周囲にある壁面までの距離・姿勢といった環境との相対的位置・姿勢より、壁面などの環境に沿って移動するための移動体１０の姿勢と速度が算出される。

そして、移動機構制御部１７では、算出された姿勢・速度と移動体１０の現在の姿勢・速度とのずれを小さくするように移動機構部２１の制御、すなわち、車輪の回転速度やステアリングの切れ角などを求めてモータなどへの指示が行われる。これらにより、移動体１０の経路への追従、ひいては目的地までの自動走行が実現される。

一様パターン環境での走行から、やがて一様パターン環境の終端付近に移動体１０が到達したとき、そのときの幾何形状データと地図データ記憶部１８とのマッチングが一様パターン環境終端判定部１５により行われ、マッチすると一様パターン環境の終端に到達したと判定される。これに伴い、一様パターン環境終端判定部１５で求められた位置・姿勢を次の位置姿勢推定部１４でのマッチングの初期位置・姿勢とし、位置姿勢推定を行う。これにより、一様パターン環境の走行中に位置・姿勢の３つのパラメータのいずれか、もしくはすべてが推定できない状態に陥っている位置姿勢推定部１４が再びすべてのパラメータを推定できる状態に復帰する。

一様パターン環境の終端へ到達したと判定されると同時に、移動体１０は、一様パターン環境用の壁ならい走行モードから一般環境用の一般走行モードに切り替え、目的地への自動走行を続ける。以上が、移動体１０で行われる処理の流れの概要となる。
＜移動体のソフトウェア構成＞

続いて、移動体１０のハードウェアとソフトウェアの構成について述べ、移動体が一般環境と一様パターン環境の両方の環境で自動走行する例を通して、ハードウェアとソフトウェア全体の処理の流れについて述べる。なお、以下では移動体が平面内を動作することを想定し、移動体１０が取り得る位置についての２つのパラメータ、姿勢についての１つのパラメータを推定する場合を想定して述べる。

図２は、本実施の形態の自律移動体１０のハードウェアとこれに格納されるソフトウェアの構成を示す。移動体１０は、コントローラ（図１のコントローラ部に相当）１１、距離センサ部１２のセンサたるレーザ距離センサ（同じく符号１２とする）、移動機構（図１の移動機構部に相当）２１、ディスプレイ２５、入力機器２６、これらの機器同士が通信するための通信線２７より構成される。なお、図２では処理の流れに直接関わる要素のみを表記しており、各要素の動作に必要な電源等は当然備わっているものとする。

距離センサ部１２の距離センサには、ここでは前述の距離センサ部１２で挙げたレーザ距離センサと同じ方式のセンサを用いるものとする。ここでは、例として、レーザ距離センサ１２がスキャンする角度範囲を１８０度とし、この角度範囲において０．５度毎にレーザを照射し、物体までの距離を計測することを想定するが、スキャンする角度範囲やレーザを照射する角度の刻み幅、距離の最大計測範囲などは異なっていてもよい。

図３は、距離センサ部１２による現在位置の推定処理を示すもので、移動体１０に取り付けられたレーザ距離センサ１２により、一般環境中での設備等の物体外縁を計測する様子を示す。図３は図示の環境において物体が存在することを示す領域（以下、物体存在領域）３２（幅広のハッチング部分）と、移動体１０（図２の移動体１０に相当）を上から見下ろした様子を表す平面図である。ここで、例として図中の位置・姿勢にある移動体１０がレーザ距離センサ１２（図２のレーザ距離センサ１２に相当）により１８０度の角度範囲をスキャンしたとする。このとき、レーザ距離センサ１２では幾何形状データ３４（破線部が幾何形状データ、破線部同士をつなぐ細線はスキャンした範囲を示すための補助線、幅狭のハッチング部分がスキャン範囲）が得られることとなる。本実施の形態では、以上のようなレーザ距離センサ１２の使用を想定しているが、同様に物体の幾何形状の計測が可能なセンサであればセンサの方式は異なっていてもよい。例えばステレオカメラや、赤外線を面状に物体に照射することで画素毎の物体までの距離計測が可能なデプスカメラなどであってもよい。

移動体１０は、前部のキャスタ及び後部の駆動輪が備えられており、移動機構部２１は、この後部の駆動輪及び前部のキャスタであり、回転角速度の差を制御することで直進・旋回を行えるようになっているものとする。本実施の形態ではこのような移動機構の使用を想定しているが、同様に環境内を移動する効果が得られるのであれば移動機構の方式は異なっていてもよい。例えば、無限軌道を備える車両、脚を備える移動体、船舶、航空機、飛行船などの他の移動機構であってもよい。また、本実施の形態においては、移動体１０が自動走行するようになっているが、本発明を実施した上で人が搭乗して移動体を操縦するようになっていてもよいし、また、搭乗せずに遠隔からの通信によって人が操縦するようになっていてもよい。

また、コントローラ１１は、図２に示すように、プロセッサ２２、メモリ２３、記憶装置２４を備えている。記憶装置２４は、オペレーティングシステム（ＯＳ）２４ａ、ＢＩＯＳ読み込みやＯＳの起動を行うコントローラ初期化プログラム２４ｂ、レーザ距離センサ制御プログラム２４ｃ、位置姿勢推定プログラム２４ｄ、動作計画プログラム２４ｅ、移動機構制御プログラム２４ｆ、一様パターン環境終端判定プログラム２４ｇ、一様パターン環境終端データ記憶部２０、地図データ記憶部１８及び経路データ記憶部１９から構成されている。

レーザ距離センサ制御プログラム２４ｃは、レーザ距離センサ１２から距離データを取得する。位置姿勢推定プログラム２４ｄは、幾何形状データと地図データ記憶部１８に記憶される地図データとのマッチングによって位置・姿勢を算出する。動作計画プログラム２４ｅは、経路データ記憶部１９に記憶された経路データをもとに目的地に辿り着くための経路を算出する。移動機構制御プログラム２４ｆは、経路に沿って移動体１０が移動するように車輪の回転速度などを算出する。一様パターン環境終端判定プログラム２４ｇは、移動体１０が一様パターン環境を走行中に、一様パターン環境の終端付近に到達したことを検出する。一様パターン環境終端データ記憶部２０には、一様パターン環境終端判定プログラム２４ｇが一様パターン環境の終端付近への到達を判定する際に用いる一様パターン環境終端データが記憶されている。

なお、図２に図示した実施の形態のプログラムやデータは、メモリ２３にロードされた上で、プロセッサ２２により処理されることを想定しているが、これと同様の効果が得られるのであれば、実装は異なっていてもよい。例えば、ＦＰＧＡ（Field Programmable Grid Array）やＣＰＬＤ（Complex Programmable Logic Device）などのプログラマブルなハードウェアで以上の処理を実現してもよい。なお、プログラムやデータは、ＣＤ−ＲＯＭ等の記憶媒体から移してもよいし、ネットワーク経由で他の装置からダウンロードしてもよい。

また、プロセッサ２２や記憶装置２４、移動機構２１など、移動体１０を構成する各デバイスは、ここでは有線の通信線２７により互いに通信することを想定しているが無線であってもよく、また、通信が可能であれば、コントローラ１１、ディスプレイ２５、入力機器２６の各デバイスが物理的に遠隔にあってもよい。また、以上のハードウェアやソフトウェアは、実施の形態に応じて、取捨選択してもよい。
＜移動体の自律移動処理＞

続いて、移動体１０で行われる自律移動処理の流れについて、図４および図８に従って、図５〜図７および図９〜図１０を参照しながら述べる。図４は、移動体１０に搭載されるコントローラ１１での処理の流れのうち、主に自動走行前の準備に関する処理（移動体の自律移動処理の概要）を示し、図８は、主に自動走行そのものに関する処理（一般走行モード及び壁ならい走行モードの処理）を示す。

コントローラ１１が起動されると（４０１）、コントローラ初期化プログラム２４ｂにより、ＯＳ２４ａの読み込み、各プログラム２４ｃ〜２４ｇの起動が行われる（４０２）。次に、位置姿勢推定プログラム２４ｄにより、地図データが地図データ記憶部１８（以降、単に地図データ１８と称呼する）より読み込まれる（４０３）。なお、ここでの地図データ１８は画像データとなっており、画素毎に環境中の物体の有無が画素値として記録されているものとする。次に、レーザ距離センサ制御プログラム２４ｃがレーザ距離センサ１２を制御し、環境をスキャンすることによって、環境の幾何形状データが得られる（４０４）。次に、初期位置姿勢推定が行われる（４０５）。初期位置姿勢推定は、位置姿勢推定プログラム２４ｄを用いて行われる処理で、特に移動体１０の動作開始時に行われる位置姿勢推定の処理を指す。この意味で、位置姿勢推定と初期位置姿勢推定の基本原理は同じであるため、ここでは、まず位置姿勢推定について述べる。

位置姿勢推定プログラム２４ｄには、幾何形状データと地図データ１８のマッチングにもとづく位置・姿勢の算出機能が備えられている。この機能について図６を用いて説明する。今、地図データ１８が、図６の６０で表される物体存在画素（物体の外縁を示すデータ）による画像データとして記録されており、これに対して図３の移動体１０が同図中の位置・姿勢でスキャンすることで得た幾何形状データ３４のマッチングを行い、移動体１０の位置・姿勢を推定する場合を考える。また、このとき、移動体１０の前回の位置姿勢推定による推定位置が図６の６２で、推定姿勢は６２から伸びた矢印の方向とするとき、マッチングの探索範囲が推定位置６２を中心としてＸのように設けられたとする。

なお、簡単のため、探索範囲Ｘでは、その範囲のうち、位置の探索範囲のみを記しているが、実際はさらに姿勢の探索範囲が設定されているものとする。ここでは、前回の推定位置６２から伸びた矢印を中心として±３０度の角度範囲の幾何形状データが、姿勢に関する探索範囲として設定されているものとするが、探索範囲はより広くても狭くてもよい。

この探索範囲において、幾何形状データが取り得る位置・姿勢で幾何形状データと地図データ１８である物体存在画素６０との重なり具合を評価し、重なり具合が最も大きくなるときの位置・姿勢を求める。具体的には、例えば、移動体１０の推定位置６３にて、推定位置６３から伸びる矢印の姿勢において、幾何形状データを地図データ１８の物体存在画素６０に重ね合わせたとすると、幾何形状データ３４のような重なり方となる。図６は、物体存在画素６０と幾何形状データ３４に食い違いがある状態を示している。

このとき、例えば図６に示すＣの範囲に着目する。図６のＣに示す範囲の拡大図が図７である。地図データ１８は、物体存在画素６７（黒色の画素）と物体が存在しないことを示す画素６９（白抜きの画素）からなる画像で表されており、また、この画像に対して幾何形状データ３４をなす物体存在画素６８（ハッチングされた画素）で表される。このとき、幾何形状データ３４をなす物体存在画素６８は、画素６６の位置にて地図データ１８の物体存在画素６７と重なり合っており、この場合、この画素はマッチしたものとみなされる。ただし、移動体１０のレーザ距離センサ１２が、図７の右側にあるとすると、物体存在画素６７（黒色の画素）で構成された線より左側の白抜きの画素は直ちに物体が存在しないことを示すものではない。図６に示す実施の形態の通りに、物体存在画素６７（黒色の画素）で構成された線は物体の外縁であり、左側の白抜きの画素部分は物体の内面の位置を意味しているものかもしれない。

以上のような画素単位のマッチング方法によって、幾何形状データ３４と地図データ１８の物体存在画素６０とがマッチする物体存在画素の数をあらゆるパターンにおいて総当たりで求める。

この図６においては、幾何形状データ３４が位置６３において、この位置６３から伸びる矢印の姿勢をとるときに幾何形状データ３４と地図データ１８の物体存在画素６０との重なり具合が最大となり、マッチングの解、つまりは移動体１０の位置・姿勢が位置６３で求められることとなる。以上が位置姿勢推定の処理となるが、初期位置姿勢推定では基本的にはこの位置姿勢推定と同じ処理を行うが、位置姿勢推定では前回の推定位置姿勢をもとに探索範囲を設定していたのに対し、初期位置姿勢推定では、前回の推定位置姿勢を用いず、地図データ全体を探索範囲と設定し、姿勢の探索範囲も３６０度としてマッチングを行い、移動体１０が起動された場所での詳細な位置・姿勢を求める。なお、位置姿勢推定プログラム２４ｄにて位置・姿勢を算出する処理としては前述のようなマッチングの処理をここでは想定しているが、同様の効果が得られるならば他の方法であってもよい。例えばＩＣＰ（Iterative Closest Point）等を用いてもよい。

また、前述のとおり、本実施の形態では、地図データ１８全体を探索範囲としたときに、幾何形状データが地図データ１８に対して最もマッチするときの位置・姿勢を初期位置姿勢として求めることを想定しているが、この場合、探索に時間を要する。このため、例えば、ディスプレイ２５に表示された地図データ１８上で操作者が指定した位置・姿勢周辺でマッチングを行ったり、あるいは予め決まっている移動体１０の駐車場があれば、その周辺でマッチングを行うなどして初期位置姿勢を求めてもよい。

続いて、目的地の設定を終了するかどうかの確認画面がディスプレイ２５に表示される。移動体１０に自動走行を行わせる場合、操作者は目的地の設定を行うことを入力機器２６により選択する（４０６）。もし、移動体１０の自動走行を行わないのであれば終了を選択する。この場合、直ちにプログラムは終了となる（４０７）。今、移動体１０に自動走行を行わせるため、操作者が目的地の設定を行う方を選択した場合、処理はＡに進み、つまりは図８の処理８０１に進む。

続いて、操作者は、ディスプレイ２５に表示される搬送先の候補のリスト上で目的地を確認し、入力機器２６により目的地を設定する（８０１）。次に、初期位置姿勢推定の処理４０５で得られた位置・姿勢をもとに、動作計画プログラム２４ｅにより、経路データ１９が読み込まれる（８０２）。次に、一様パターン環境終端判定プログラム２４ｇにより、一様パターン環境終端データ記憶部２０から一様パターン環境終端データ（以降、一様パターン環境終端データ２０と称呼する）が読み込まれる（８０３）。このデータは先に述べたように、一様パターン環境の走行中に位置・姿勢の３つのパラメータのいずれか、もしくはすべてが推定できない状態に陥っている移動体１０が、位置・姿勢の３つのパラメータのすべてが推定可能な状態に復帰するために、幾何形状データと地図データとのマッチングを行う際に必要なマッチングの探索範囲の位置・姿勢、探索範囲の形状が記録されたデータである。

図５に一様パターン環境終端データ２０と経路データ１９の構造を示す。一様パターン環境終端データは経路セグメントデータと組になって記録されている。経路セグメントデータは、経路始点から経路終点を構成する線分（以下、セグメント）の情報として、セグメント始点とセグメント終点についての地図データの座標系における座標、終点に到達したときの判定基準（以下、単に到達判定基準と称する）、及びセグメントの種類（以下、セグメント種別）が記録されている。セグメント種別とは、そのセグメントが一般環境でのセグメントなのか、或いは一様パターン環境でのセグメントなのかのいずれかが記録されている。また、到達判定基準とは、移動体１０が経路始点から経路終点に向かって走行し、経路終点の座標に到着したと判定するための基準である。ここでは単純に経路終点の座標から半径ｒの範囲内に移動体１０の位置の座標が入っていれば到着と見なすとしているが、移動体１０の運用状況に応じて変更してもよい。この経路セグメントデータが集まることで図２での経路データ１９が構成されている。

また、経路セグメントデータと共に記録される一様パターン環境終端データとしては、復帰時探索範囲位置姿勢と復帰時探索範囲形状がある。復帰時探索範囲位置姿勢とは、一様パターン環境の走行中に位置・姿勢の３つのパラメータのいずれか、もしくはすべてが推定できない状態からすべてのパラメータを推定できる状態に復帰するために幾何形状データと地図データとのマッチングを行う際のマッチングの探索範囲の位置と姿勢を指す。また、復帰時探索範囲形状は、このマッチングの探索範囲の形状を指す。ここでは単純に横方向の長さがｈ、高さ方向の長さがｖの長方形としているが、移動体１０の運用状況に応じて変更してもよい。

次に、経路データ１９の中から最初に追従するセグメントが選択される（８０４）。次に、処理４０４と同様にレーザ距離センサ制御プログラム２４ｃがレーザ距離センサ１２を制御し、環境をスキャンすることで幾何形状データが得られる（８０５）。次に、処理４０５のところで述べた処理の流れに従い、位置姿勢推定が行われる（８０６）。次に、読み込んだ経路データ１９をなすセグメントのうち、最後のセグメントの終点に到達したかどうかの判定が行われる（８０７）。この判定で終点に到達したと判定された場合、処理はＢに進み、つまりは図４の処理４０６に進む。また、この判定で終点に到達したと判定されなかった場合、処理８０８に進む。次に、移動体１０が追従しようとしているセグメントの種別の判定が行われ、セグメントが一般環境セグメントの場合は処理８１６に、セグメントが一様パターン環境セグメントの場合は処理８１７に進む（８０８）。

このセグメントの種別の判定にもとづき、一般環境と一様パターン環境が混在する環境を移動体１０が自動走行する様子について、図９を用いて述べる。ここでは、物体存在領域６０で表される環境において、移動体１０が点９１と点９２とを結ぶセグメント９５ａ、点９２と点９３とを結ぶセグメント９５ｂ、そして点９３と点９４とを結ぶセグメント９５ｃからなる経路データを用いて、スタート地点９１から目的地９４まで走行するものとする。また、セグメント９５ａと９５ｃは一般環境セグメント、セグメント９５ｂは一様パターン環境セグメントであることが経路データ１９に記録されているものとする。なお、物体存在領域６０の表面部分の形状と同じ形の地図データ１８が既に得られているものとする。

この状況のもと、移動体１０が最初のセグメント９５ａを走行中で、例えば移動体１０が１０ａの位置・姿勢にあるとき、レーザ距離センサ１２の計測範囲１２ａ内のスキャンによって得られる幾何形状データ３４ａには、通路両側の壁以外に正面の壁や角などの幾何的特徴が含まれることから、地図データ１８と幾何形状データ３４ａのマッチングにおいては互いが最も重なり合うときの位置・姿勢の解が一意に求められる。移動体１０がこのセグメント９５ａを選択中のとき、経路データ１９のセグメント種別より、一般環境セグメントであることから、一般走行モード８１６で走行する。このとき、処理８０６で得られた位置・姿勢と経路データ１９をもとに、選択中のセグメント（このケースではセグメント９５ａ）のセグメント終点に到達したかが判定される（８０９）。セグメント終点に到達していない場合は、求められた位置・姿勢とセグメント終点とのずれが小さくなるように移動機構の一般走行制御を行う（８１０）。セグメント終点に到達した場合は、選択中のセグメントを走行済みとして記録し、次のセグメントを選択する（８１１）。図９の場合、移動体１０が点９２の位置に到達したと判定された場合には、次にセグメント９５ｂが選択される。

移動体１０がセグメント９５ｂを走行中で、例えば移動体１０が１０ｂの位置・姿勢にあるとき、レーザ距離センサ１２の計測範囲１２ｂ内のスキャンによって得られる幾何形状データ３４ｂには、通路両側の壁のデータのみであり、それ以外に正面の壁や角などの幾何的特徴が含まれていないことから、地図データ１８と幾何形状データ３４ｂのマッチングにおいては互いが最も重なり合う位置が複数箇所あるため、解が一意に求められない。より具体的には、幾何形状データ３４ｂの位置・姿勢の３つのパラメータのうち、通路に対して長手方向（即ち進行方向或いは線路方向）の位置は一意に求められず、通路長手方向に解の候補が複数得られてしまう。よって、移動体１０が一様パターン環境でのセグメントを選択して走行するときは、位置・姿勢の３つのパラメータが一意に求まっている状態での運転モードである一般走行モード８１６を行うことはできない。このことから、通路の長手方向の位置以外のパラメータとして、壁に対する位置、壁に対する姿勢の２つは求めることができることから、これを用いて一様パターン環境における壁ならい走行モード８１７による壁ならい走行を行う。壁ならい走行とは壁との距離、姿勢を一定に保つようにして一様パターン環境の終端に向かって移動する運転モードである。この一様パターン環境における壁ならい走行モード８１７においては、走行中に一様パターン環境セグメントの終端の検出処理が行われる（８１２）。ここでは、位置姿勢推定の処理８０６と同様の処理が行われる。

今、一様パターン環境終端データ２０による復帰時探索範囲が９６に示す破線のように設定されていたとする。なお、復帰時探索範囲９６の向きは図面上向きに設定されているものとする。ここで、１０ｂの位置・姿勢にあった移動体１０が、一様パターン環境における壁ならい走行モード８１７で走行していくうちに、やがて１０ｃの位置・姿勢になったものとする。この時点では、まだ一様パターン環境セグメント９５ｂが選択されているため、一様パターン環境終端判定プログラム２４ｇにより、幾何形状データ３４ｃと物体存在領域６０に対応する地図データ１８との位置姿勢推定と同様のマッチングが行われる。ただし、このマッチングに際しては通常の位置姿勢推定時の探索範囲ではなく、復帰時探索範囲９６をもとにマッチングが行われる。

今、復帰時探索範囲９６が図１０に示すＤの位置を中心にＥに示すような正方形の形状・範囲で設けられ、セグメントＦ（図９におけるセグメント９５ｂ）の矢印の姿勢に設定されており、復帰時探索範囲での一様パターン環境の姿勢の探索範囲についてはＧに示す角度の範囲として設定されていたとする。このとき、マッチングの解の探索時に幾何形状データが取り得る位置・姿勢は、復帰時探索範囲Ｅの各々の頂点から半円状のセグメントＦが示す方向から左右Ｇ／２の角度で回転させた範囲、即ちおよそ図１０に描かれている各半円を重ね合わせた範囲となる。つまりは、この範囲内に含まれる物体存在画素６０と実際の環境をスキャンすることで得られる幾何形状データ３４とのマッチングが行われることとなる。移動体１０が１０ｃの位置・姿勢でスキャンして得た幾何形状データ３４ｃ（図９）は、図１０に示した各半円を重ね合わせた範囲内に入っており、加えて、正面の壁や角などの幾何的特徴があることから位置・姿勢の３つのパラメータが一意に求められる。

このように、一様パターン環境の終端部分の地図データ１８と幾何形状データ３４ｃとのマッチングを行い、マッチングが成立した場合、より具体的には、幾何形状データ３４ｃを一様パターン環境の終端部分の地図データ１８に重ね合わせたときに、解が一意に定まった場合は、移動体１０が一様パターン環境の終端に到達したものと判定する（８１３）。このとき、マッチングに用いる地図データ１８としては終端データで設定された領域から観測可能な部分の地図のみを用いる。この判定において一様パターン環境の終端に到達していないと判定された場合は、前述の壁ならい走行を行うための移動機構の制御を継続して行う（８１４）。また、一様パターン環境の終端に到達した場合は、選択中のセグメントを走行済みとして記録し、経路データ１９より次のセグメントを選択する（８１５）。図９の場合、移動体１０が点９３に到達したと判定された場合、次にセグメント９５ｃが選択される。

上記の実施の形態においては、セグメントに終端データが設定されているもとでの説明を行ったが、セグメントによっては終端データが設定できない場合がある。終端データが設定されていない一般環境セグメントにおいて、地図に記載されていない人や物体の影響により、解が一意に定まらない場合には、移動体１０は移動を停止する。移動体１０は停止している間も位置姿勢推定を実施し、人などの外乱要素がなくなり、解が一意に求まると判定されると、動作を再開する。

以上の処理によって移動体１０が走行し、目的地に到着したと判定されたならば（８０７）、前述の通り、目的地の設定確認の処理４０６に戻る。以上が、移動体１０が通常動作を行っている際の処理の流れとなる。
＜一実施の形態の効果＞

以上説明した本実施の形態の移動体１０によれば、自装置と周囲にある障害物との距離を検知する距離センサ部１２と、距離センサ部１２の検知結果に基づいて自装置の位置姿勢を推定して走行を制御するコントローラ部１１と、コントローラ部１１の制御に基づいて自装置を自律的に走行させる移動機構部２１とを備えることで、以下のような効果を得ることができる。

（１）コントローラ部１１は、走行環境の地図（地図データ）と距離センサ部１２の検知結果である距離データ（幾何形状データ）とを用いて自装置の位置姿勢を推定して、自装置の位置姿勢が一意に定まる状態と、自装置の位置姿勢が一意に定まらない状態とで走行モードを切り替えることができる。具体的には、凹凸等の幾何的特徴が多数存在することで、幾何形状データと地図データとのマッチングにより、位置・姿勢のすべてのパラメータが高い確度で求められる一般環境においては、すべてのパラメータを用いる一般走行モードでの自動走行を行うことができる。かつ、幾何的特徴が乏しく、幾何形状データと地図データとのマッチングを行っても位置・姿勢のすべてのパラメータが高い確度で求められない一様パターン環境においては、確度が高いパラメータのみを用いる壁ならい走行モードでの自動走行を行うことができる。これにより、設備などにより幾何的特徴が多数存在する工場などの環境と、幾何的特徴に乏しい廊下などの環境とが混在する環境での移動体１０の自律移動が可能となる。

（２）コントローラ部１１は、自装置の位置姿勢が一意に定まらない状態の場合に、終端データが設定されていないセグメントでは、走行を停止するように制御することができる。また、終端データが設定されているセグメントでは、壁ならい走行モードで走行を行うように制御することができる。具体的には、幾何的特徴が乏しく、幾何形状データと地図データとのマッチングを行っても位置・姿勢のすべてのパラメータが高い確度で求められない一様パターン環境において、終端データが設定されていないセグメントでは、壁ならい走行モードでの走行を停止することができる。

（３）コントローラ部１１は、終端データが設定されていないセグメントで走行を停止中の移動体１０が、自装置の位置姿勢が一意に定まる状態に復帰した場合に走行を再開するように制御することができる。具体的には、壁ならい走行モードから一般走行モードに切り替えるためには、位置・姿勢のすべてのパラメータが求められる環境に到達したことを判定する必要がある。このため、幾何的特徴が乏しい環境から幾何的特徴が多数存在する環境への切り替わる場所の地図データと幾何形状データとのマッチングにより、マッチングの確度が高い場合は、切り替え可能な場所に到達したものと判定し、運転モードを切り替えることができる。

（４）コントローラ部１１は、壁ならい走行モードでの走行時に、自装置が走行する通路の壁面と距離センサ部１２のセンサとの方向を一定に保つように制御することができる。これにより、一様パターン環境において、通路の長手方向の位置以外のパラメータとして、壁に対する位置、壁に対する姿勢の２つは求めることができることから、これを用いて一様パターン環境における壁ならい走行モードによる走行を行うことができる。

（５）コントローラ部１１は、自装置の位置姿勢が一意に定まらない状態の一様パターン環境の終端データと、距離センサ部１２の検知結果である幾何形状データとを比較することで、終端判定を行うことができる。この場合に、コントローラ部１１は、終端データとして、一様パターン環境の終端から観測できる形状データのみを用いて、終端判定を行うことができる。

以上、本発明者によってなされた発明を実施の形態に基づき具体的に説明したが、本発明は前記実施の形態に限定されるものではなく、その要旨を逸脱しない範囲で種々変更可能であることはいうまでもない。例えば、上記した実施の形態は、本発明を分かり易く説明するために詳細に説明したものであり、必ずしも説明した全ての構成を備えるものに限定されるものではない。また、実施の形態の構成の一部について、他の構成の追加・削除・置換をすることが可能である。

例えば、本発明は、自律移動を行わない移動体にも適用可能である。この場合には、自装置と周囲にある障害物との距離を検知する距離センサ部と、距離センサ部の検知結果に基づいて自装置の位置姿勢を判定して走行を制御するコントローラ部とを備えた構成（例えば前述した図１や図２などと同様）とする。このような構成においても、コントローラ部は、自装置の位置姿勢が一意に定まらない状態の一様パターン環境の終端データと、距離センサ部の検知結果である距離データとを比較することで、終端判定を行うことができる。この場合に、コントローラ部は、終端データとして、一様パターン環境の終端から観測できる形状データのみを用いて、終端判定を行うことができる。

１０ 移動体
１１ コントローラ部
１２ 距離センサ部
１３ 距離センサ制御部
１４ 位置姿勢推定部
１５ 一様パターン環境終端判定部
１６ 動作計画部
１７ 移動機構制御部
１８ 地図データ記憶部
１９ 経路データ記憶部
２０ 一様パターン環境終端データ記憶部
２１ 移動機構部

Claims (1)

1. 走行環境の地図データを記憶する地図データ記憶部と、
   自装置を所望の経路で走行させるための情報であり、経路始点から経路終点を構成する線分であるセグメントの情報として、各セグメントの始点と終点とを示す情報と、当該セグメントが前記自装置の位置姿勢が一意に定まらない状態の一様パターン環境のセグメントであることを示す種別情報とを対応付けた情報と、前記セグメントの情報として、各セグメントの始点と終点とを示す情報と、前記自装置の位置姿勢が一意に定まる一般環境のセグメントを示す種別情報とを対応付けた情報と、を記憶するセグメント記憶部と、
   所定の範囲内における走行の障害となり得る障害物と、前記自装置から前記障害物までの距離と方向を検出する距離センサ部と、
   前記距離センサ部から得られる前記自装置から前記障害物までの距離と方向から、周囲の障害物の位置情報である幾何形状データに変換するとともに、前記距離センサ部の動作を制御する距離センサ制御部と、
   前記幾何形状データと前記地図データとをマッチングして前記自装置の地図上における現在位置と進行方向を推定する位置姿勢推定部と、
   前記セグメント記憶部により記憶されている情報および前記位置姿勢推定部により推定された結果を用いて、自装置の走行制御をする走行制御部とを、
   備え、
   前記走行制御部は、
   前記セグメント記憶部に記憶されている情報および前記位置姿勢推定部により推定された結果に基づいて、前記自装置の位置が一般環境のセグメントに位置しており、前記自装置の位置姿勢が位置に定まる状態であると推定された場合、前記自装置の位置姿勢に基づいて前記自装置を走行させ、
   前記セグメント記憶部に記憶されている情報および前記位置姿勢推定部により推定された結果に基づいて、前記自装置の位置が一様パターン環境のセグメントに位置しており、前記自装置の位置姿勢が一意に定まらない状態であると推定された場合、前記距離センサ部により検出された距離と方向に基づいて前記障害物との距離、姿勢を一定に保つように前記自装置を走行させ、
   前記セグメント記憶部に記憶されている情報および前記位置姿勢推定部により推定された結果に基づいて、前記自装置が一般環境のセグメントに位置しており、前記自装置の位置姿勢が一意に定まらない状態であると推定された場合、前記自装置を停止させ、
   前記位置姿勢推定部は、前記自装置が停止している際に、継続して前記自装置の地図上における現在位置と進行方向を推定し、
   前記走行制御部は、前記自装置を停止させている際に、前記位置姿勢推定部により推定された結果に基づいて、前記自装置の位置姿勢が一意に定まる場合、前記自装置の走行を再開させる、移動体。
   

Images