移動体システム
【課題】距離センサを用いて移動体を精度良く自律走行させるとともにより省スペース化できるようにした、移動体システムを提供する。
【解決手段】移動体１に取り付けられ、所定の探索範囲に検出用光を走査して移動体と探索範囲内に存在する物体までの距離及び方向を検出する距離方向検出装置７と、平板標識２０の設置される位置を含む走行経路の地図情報を記憶する地図情報記憶手段と、距離方向検出装置の検出結果と地図情報記憶手段に記憶された地図情報とを照合して移動体の進行方向を決定する進行方向決定手段と、を有する移動体システムであって平板標識２０に検出用光を拡散反射させる拡散反射面と検出用光を鏡面反射させる鏡面加工面とを設けて構成する。
【解決手段】移動体１に取り付けられ、所定の探索範囲に検出用光を走査して移動体と探索範囲内に存在する物体までの距離及び方向を検出する距離方向検出装置７と、平板標識２０の設置される位置を含む走行経路の地図情報を記憶する地図情報記憶手段と、距離方向検出装置の検出結果と地図情報記憶手段に記憶された地図情報とを照合して移動体の進行方向を決定する進行方向決定手段と、を有する移動体システムであって平板標識２０に検出用光を拡散反射させる拡散反射面と検出用光を鏡面反射させる鏡面加工面とを設けて構成する。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、工場、オフィス、病院や商業施設等において、自律移動することにより各種用途に使用可能な移動体システムに関する。
【背景技術】
【０００２】
生産工場等では、省力化のため製品や部材の運搬に自律走行できる移動体が利用されている。このような移動体は、床に設置した反射テープ、マグネットテープなどのガイドレールに沿って走行するように進行走行を制御して自律移動するものが主流であった。
ところが、この方法では移動体をガイドレールに沿って確実に誘導することはできるが、ガイドレールを設置する作業が煩雑であり走行経路の変更が容易でないことや、ガイドレールに破損や汚れが生じやすく移動体の誘導精度が低下する、或いは、移動体の走行の自由度が制限されるなどの技術課題も生じていた。
そのため、最近では床等にガイドレール設置することなく自律走行可能な移動体が提案され実用化されつつある。
【０００３】
例えば、特許文献１には、レーザー距離センサ等によって移動体探索範囲内に存在する物体までの距離と方向とを計測し、移動体の走行経路に沿って延びる側壁との延在方向（ライン）を検出して検出したラインに倣って移動体を移動させる旨が記載されている。
また、移動体の近傍（距離センサの計測可能な距離範囲内）に走行経路に沿って延びる側壁面がない場合でも移動体を正常に制御する技術として、特許文献２には、走行経路の近傍にレーザーを受ける受光平面を有する目標物（ランドマーク）を設置する技術が提案されている。
【０００４】
特許文献２の技術では、距離センサの計測範囲角度において移動体から目標物までの距離が急激に変化する方向をエッジとして検出し、複数のエッジの位置と方向とから目標物（受光平面）の位置を検出して、検出した目標物の位置に基づいて移動体を自律走行させる。
また、特許文献３には、移動体前方に設置した撮像部で進行方向を撮像し、撮像画像と予め撮影した参照画像のパターンマッチングを行い、ズレ量を逐次算出して移動体の走行方向を制御する制御方法が開示されている。
【先行技術文献】
【特許文献】
【０００５】
【特許文献１】特開２００８−０５２６６９号公報（００６３，図５）
【特許文献２】特開２００６−２９３９７５号公報（図１）
【特許文献３】特開２００８−０２８６１４号公報
【発明の概要】
【発明が解決しようとする課題】
【０００６】
しかしながら、特許文献２のように走行経路に目標物を設置する場合、レーザー距離センサでエッジを十分な精度で検出して目標物の位置を得るためには、受光平面とその背面の壁面との距離を十分に大きくとる必要がある。
このため、目標物を設置する為のスペースを大きく確保する必要がある。このため、目標物を設置することによって移動体自身が走行する走行路が狭められる等の課題があった。
【０００７】
本発明はこのような問題点に鑑みてなされたものであり、距離センサを用いて移動体を精度良く自律走行させるとともにより省スペース化できるようにした、移動体システムを提供することを目的とする。
【課題を解決するための手段】
【０００８】
上記問題を解決するため、本発明は、次のように構成したのである。
本発明は、予め設定された走行経路に応じて配置された平板標識と、前記走行経路に沿って自律走行する移動体と、を有する移動体システムであって、前記移動体に設けられ、所定の探索範囲に検出用光を走査することにより、前記移動体と前記探索範囲内に存在する物体までの距離及び方向を検出する距離方向検出装置と、前記距離方向検出装置の検出結果に基づいて前記移動体の進行方向を決定する進行方向決定手段と、を有し、前記平板標識は、鏡面と、入射光を拡散反射する割合が当該鏡面よりも高い拡散反射面と、を含むことを特徴としている。
【発明の効果】
【０００９】
本発明にかかる移動体システムによれば、鏡面と拡散反射面、あるいは、鏡面と平板標識の背後の壁面との間で検出用光の反射態様を異ならせることで、検出用光を用いてランドマークを精度良く検出することができる。また、ランドマークと背後の壁面との間にギャップを設ける必要がないので移動体の走行経路近傍を省スペース化することができる。
【図面の簡単な説明】
【００１０】
【図１】本発明の一実施形態を説明するものであり、平板標識と移動体との構成を模式的に示す上面図である。
【図２】本発明の一実施形態を説明するものであり、移動体システムの全体構成を模式的に示す図である。
【図３】本発明の一実施形態を説明するものであり、移動体の概略構成を示す模式的な図である。
【図４】本発明の一実施形態を説明するものであり、駆動制御部の機能構成を示すブロック図である。
【図５】本発明の一実施形態を説明するものであり、平板標識を正面視で模式的に示す図である。
【図６】本発明の一実施形態を説明するものであり、平板標識を壁面に沿った方向からみた模式的な側面図である。
【図７】本発明の一実施形態を説明するものであり、距離センサによる距離計測用ランドマークの検出態様を示す模式図である。
【発明を実施するための形態】
【００１１】
以下、本発明の実施の形態について図を参照して説明する。
図１〜図７はいずれも本発明の一実施形態にかかる移動体システムを説明するものであり、図１は平板標識と移動体との構成を模式的に示す上面図、図２は移動体システムの全体構成を模式的に示す図、図３は移動体の概略構成を示す模式的な図、図４は駆動制御部の機能構成を示すブロック図、図５は平板標識を正面視で模式的に示す図、図６は平板標識を壁面に沿った方向からみた模式的な側面図、図７は距離センサによる距離計測用ランドマークの検出態様を示す模式図である。
【００１２】
図２に示すように、本実施形態にかかる移動体システム１００では、フロア１０１上に予め走行経路Ｒが設定されており、移動体１が走行経路Ｒに沿って自律走行するように構成されている。また、走行経路Ｒの近傍には受光平面を有する平板状のランドマーク（平板標識，目標物）２０が複数設置されている。なお、走行経路Ｒの経路は適宜変更することが可能である。
【００１３】
走行経路Ｒには、移動体１を制御する制御手法毎に区間Ａ１〜Ａ３が設定されている。区間Ａ１では移動体１は進行方向の正面に存在する平板標識に向かって進行する経路であり、区間Ａ２は走行経路Ｒに沿って延びる壁面１０２に沿って進行する経路であり、区間Ａ３は主として後述する画像誘導手段により移動体を制御する区間である。
なお、図２では説明を容易にするために走行経路Ｒや各区間Ａ１〜Ａ３を図示しているが、実際のフロア１０１等には走行経路Ｒや各区間Ａ１〜Ａ３を示すライン等は存在せず、各区間Ａ１〜Ａ３それぞれの境界についても厳密に規定されるものではない。
【００１４】
図３に示すように、移動体１は、車体２に電子演算器，記憶装置及び入力装置からなる駆動制御部３を内蔵している。
駆動部（走行装置）４は車輪（走行装置）５の駆動を制御するようになっており、前記駆動制御部３からの指令に従って前記車輪５を駆動することで前記移動体１の前進後退および姿勢角（操舵方向）を制御することができる。
【００１５】
６は撮像装置であり、前記移動体１の中心軸上に進行方向に向けて設置されており、移動体１の進行方向の画像を撮像し、画像データ（実画像）をリアルタイムで取得するようになっている。また、撮像装置６は画像を静止画像で取得することも可能である。
前記撮像部６で撮像された画像は前記駆動制御部３に伝達される。ここで、撮像部６を進行方向に向けて設置しているのは、高速走行中でも撮像部の取得画像が乱れにくく、より安定した実画像を得ることができるためである。
【００１６】
７は例えば半導体レーザー等のレーザー発信装置を有するレーザー距離センサ（距離方向検出装置）であり、図１にも示すように、レーザー距離センサ７から水平方向（車体２の方向において）に所定の探索角度範囲に所定の角度毎（例えば、０．５°毎）に検出用のレーザー光（検出用光）を発信するようになっている。そして、物体に反射して戻ってくるまでの時間から各点までの距離と計測点の角度を検出するようになっている。つまり、レーザー距離センサ７の有効な探索範囲（距離と角度との検出が有効である範囲）は探索角度を中心角として車体２の設置面（水平）に対して平行な扇形の平面となる。
移動体周囲の壁や柱といった構造物および歩行者など移動体の周囲の環境の距離を計測する。レーザー距離センサ７で計測された距離データは駆動制御部３に伝達される。
【００１７】
図４に示すように駆動制御部３は機能構成として、進行方向決定部（進行方向決定手段）３１，画像誘導部（画像誘導手段）３２及び記憶部（地図情報記憶手段，教示画像記憶手段）３３を有している。
進行方向決定部３１は、予め、記憶部３３に記憶された地図情報と予めレーザー距離センサ７の検出結果とを照合して移動体１の位置を検出し、移動体１が走行経路Ｒに沿うように駆動部４に進行方向に関する信号を送信するようになっている。
なお、地図情報とは走行経路Ｒのフロア１０１位置座標とランドマーク２０が設置される位置座標との情報を含んでいる。
【００１８】
なお、走行経路Ｒは図２中矢印で示す直線上の区間（直線部）と、直線部と直線部とを接続する方向転換部からなり、地図情報には、予め得た走行データに記載された距離情報と、スタート地点からの現在の走行距離とを照会する方法、もしくは距離センサを用いた走行経路直線部終端への位置決め完了のいずれかによって、現在直線部と方向転換部のどちらを走行しているかを判別し、直線部では本発明の走行制御を行い、方向転換部では車輪回転量を基に方向を変えて次の直線部の走行を開始する手順情報が含まれている。
また、記憶部３３には予め走行経路Ｒ上の離散した地点である複数の教示地点のそれぞれにおいて撮像装置６の実画像の目標となる画像として取得した複数の教示画像が記憶されている。
画像誘導部３２は、実画像と前記教示画像との比較結果に基づいて駆動部４を制御するようになっている。
【００１９】
（区間Ａ１）
以下、区間Ａ１における移動体１の制御態様について説明する。図２に示すように区間Ａ１は走行経路Ｒの前方にある窓２４からの外光により、窓２４に近づくほど走行経路Ｒの近傍の光環境の経時的な変化度合いが大きくなる。
区間Ａ１では、レーザー距離センサ７がランドマーク２０を検出するまでは、画像誘導部３２により駆動部４を制御し、レーザー距離センサ７がランドマーク２０を検出した後は、検出したランドマーク２０の位置から予め設定されたオフセット地点（目標点）まで進行方向決定部３１により駆動部４を制御するようになっている。
なお、ランドマーク２０は、図１，図６に示すように、壁面１０２に貼り付けられており、光を鏡面反射（全反射）させる鏡面加工部２１と光を拡散反射させる拡散反射面２２とから構成されている。鏡面加工部２１は拡散反射面２２の両端に配設されており、水平方向と直交する面に対して所定の角度θだけ下向きに傾斜している。
【００２０】
鏡面加工部２１は、光を鏡面反射させる素材であれば何を用いて構成してもよい。また、拡散反射面２２は、紙や樹脂等の適宜の素材で構成可能であるが、レーザー距離センサ７の検出用光の入射方向に拠らずあらゆる方向に光を反射する素材を用いて形成すればよい。
また、拡散反射面２２には、画像誘導部３２よる制御を行なう際に画像の特徴点となる図柄２３が設けられている。なお図中Ｌは、レーザー距離センサ７からの検出用光の照射方向を表わしている。
図１に示すように、レーザー距離センサ７から照射された検出用のレーザー光は、壁面１０２及び拡散反射面２２では拡散的に反射されるため、レーザー距離センサ７が壁面１０２及び拡散反射面２２に対して傾斜した位置にあっても、レーザー距離センサ７が壁面１０２及び拡散反射面２２から反射した検出用光を検知して距離と方向とを検出することができる。
【００２１】
一方、レーザー距離センサ７から鏡面加工部２１に照射された検出用光は、図６に示すように鏡面加工部２１の傾斜により下方に反射する。また、図１に示すように移動体１が鏡面加工部２１に対して正対している場合を除いて水平方向に全反射する。つまり、鏡面加工部２１からの反射光はレーザー距離センサ７側に反射されず、レーザー距離センサ７は鏡面加工部２１に対応する領域は探索範囲に存在しないと判断することとなる。
進行方向決定部３１は、レーザー距離センサ７の検出結果から壁面１０２に取り付けられたランドマーク２０の位置（方向）と距離とを求め、と記憶部３３に記憶されている地図情報（ランドマークの形状）とを照合させて、自身の位置を地図情報上の走行経路Ｒに沿うように駆動部４に指令を与える。
【００２２】
（区間Ａ２）
次に、区間Ａ２における移動体１の制御態様について説明する。
区間Ａ２では走行経路Ｒ側方の窓２４からの外光が多すぎるため、主として進行方向決定部３１によって駆動部４を制御するようになっている。
図７に示すように平板状の距離計測用のランドマーク２０が設置されているとすると、連続する計測角度において計測された距離が連続的に変化する領域を検索し、検索により抽出した距離計測用ランドマーク候補領域に対して最小自乗法により領域の直線性を評価して、平板であると判定した領域の両端の計測データから距離計測用ランドマーク基準点の位置および移動体１に対する距離計測用ランドマークの角度が求められる。距離計測用ランドマークの位置および角度の値と予め指定されている通過点指定位置ｈ，ｖの値を用いて、移動体の現在地からの補正量が求まる。ここで、距離計測用ランドマークを精度良く計測するためには、移動体１を静止させて計測することが望ましい。
駆動制御部は補正量を基に移動体を駆動し、通過点指定位置に位置決めさせる。これにより経路を補正できるのである。
なお、区間Ａ２におけるランドマーク２０も区間Ａ１のものと同様に構成されている。
【００２３】
本発明の一実施形態にかかる移動体システムはこのように構成されているので、ランドマーク２０を壁面１０２と接触して配置している場合であっても鏡面反射部２１と拡散反射面２２、あるいは、鏡面反射部２１と壁面１０２との間で検出用光の反射態様が大きく異なるため、レーザー距離センサ７による検知結果が大きく異なるためランドマーク２０の受光面の位置を精度良く検出することができる。これにより、走行経路Ｒ及び移動体１の自立走行のために必要なスペースのフロア１０１への占有率を低減する省スペース化することができる。ランドマーク２０を薄い平板状に形成して受光平面と背後の壁面との間のギャップｇを小さくしてもランドマーク２０の位置を精度良く検出することができる。
また、走行経路Ｒにおいて、外光による撮像画像の変化が少ない場所（区間Ａ３）では撮像画像と撮像用ランドマークのパターンマッチングが成功する確率が高く、撮像部のみを利用して走行経路上を走行することが可能である。一方、区間Ａ１，Ａ２では、外光等により光環境の変化に伴って同じ位置から同じ方向を撮像したとしても撮像装置６により取得される実画像の変化が大きい区間では、撮像画像と撮像用ランドマークのパターンマッチングが成功した特徴点の数が減少する。
【００２４】
このような状況では、撮像用ランドマークのパターンマッチングが成功した特徴点の数が予め定められたしきい値以上であればマッチング結果を有効として静止することなく走行し、しきい値以下の場合は一旦停止して距離計測用ランドマークを計測して計測結果を有効として経路を補正する。このようにして撮像画像および距離データを適切に組み合わせて走行経路に対する前記移動体１の移動補正量を求め、移動体を走行制御することで教示した走行経路を走行し、目的地へ到達できるのである。
【００２５】
また、認識した撮像用ランドマークの数が複数であり、どのランドマークの計測結果を使用すればよいか判定できない際に自動的に切り替えるようにしてもよい。また、撮像部で撮像した画像から求めた進行方向からの角度のズレ量が予め定められた範囲を超えた際にパターンマッチングが誤認識した、もしくは走行経路に対する角度のズレ量が大きすぎると判定してレーザー距離センサ７を用いた経路補正方法に自動的に切り替えるようにしてもよい。
なお、本実施形態ではランドマーク２０の鏡面加工部２１に傾斜θを設けたが、傾斜θについて省略してもよく、鏡面加工部２１と拡散反射面２２とが同一平面上になるように形成してもよい。このようにすればランドマーク２０をさらに薄く形成することができる。
また、移動体１とランドマーク２０とがわずかなにでも角度を持っていれば、鏡面反射部２１からの反射光をレーザー距離センサ７で受光しにくく、鏡面加工部２１とその他の拡散反射面との区別を精度良く行なうことができる。
【符号の説明】
【００２６】
１ 移動体
２ 車体
３ 駆動制御部
４ 駆動部
５ 車輪
６ 撮像部
７ レーザー距離センサ
２０ ランドマーク（平板標識）
【技術分野】
【０００１】
本発明は、工場、オフィス、病院や商業施設等において、自律移動することにより各種用途に使用可能な移動体システムに関する。
【背景技術】
【０００２】
生産工場等では、省力化のため製品や部材の運搬に自律走行できる移動体が利用されている。このような移動体は、床に設置した反射テープ、マグネットテープなどのガイドレールに沿って走行するように進行走行を制御して自律移動するものが主流であった。
ところが、この方法では移動体をガイドレールに沿って確実に誘導することはできるが、ガイドレールを設置する作業が煩雑であり走行経路の変更が容易でないことや、ガイドレールに破損や汚れが生じやすく移動体の誘導精度が低下する、或いは、移動体の走行の自由度が制限されるなどの技術課題も生じていた。
そのため、最近では床等にガイドレール設置することなく自律走行可能な移動体が提案され実用化されつつある。
【０００３】
例えば、特許文献１には、レーザー距離センサ等によって移動体探索範囲内に存在する物体までの距離と方向とを計測し、移動体の走行経路に沿って延びる側壁との延在方向（ライン）を検出して検出したラインに倣って移動体を移動させる旨が記載されている。
また、移動体の近傍（距離センサの計測可能な距離範囲内）に走行経路に沿って延びる側壁面がない場合でも移動体を正常に制御する技術として、特許文献２には、走行経路の近傍にレーザーを受ける受光平面を有する目標物（ランドマーク）を設置する技術が提案されている。
【０００４】
特許文献２の技術では、距離センサの計測範囲角度において移動体から目標物までの距離が急激に変化する方向をエッジとして検出し、複数のエッジの位置と方向とから目標物（受光平面）の位置を検出して、検出した目標物の位置に基づいて移動体を自律走行させる。
また、特許文献３には、移動体前方に設置した撮像部で進行方向を撮像し、撮像画像と予め撮影した参照画像のパターンマッチングを行い、ズレ量を逐次算出して移動体の走行方向を制御する制御方法が開示されている。
【先行技術文献】
【特許文献】
【０００５】
【特許文献１】特開２００８−０５２６６９号公報（００６３，図５）
【特許文献２】特開２００６−２９３９７５号公報（図１）
【特許文献３】特開２００８−０２８６１４号公報
【発明の概要】
【発明が解決しようとする課題】
【０００６】
しかしながら、特許文献２のように走行経路に目標物を設置する場合、レーザー距離センサでエッジを十分な精度で検出して目標物の位置を得るためには、受光平面とその背面の壁面との距離を十分に大きくとる必要がある。
このため、目標物を設置する為のスペースを大きく確保する必要がある。このため、目標物を設置することによって移動体自身が走行する走行路が狭められる等の課題があった。
【０００７】
本発明はこのような問題点に鑑みてなされたものであり、距離センサを用いて移動体を精度良く自律走行させるとともにより省スペース化できるようにした、移動体システムを提供することを目的とする。
【課題を解決するための手段】
【０００８】
上記問題を解決するため、本発明は、次のように構成したのである。
本発明は、予め設定された走行経路に応じて配置された平板標識と、前記走行経路に沿って自律走行する移動体と、を有する移動体システムであって、前記移動体に設けられ、所定の探索範囲に検出用光を走査することにより、前記移動体と前記探索範囲内に存在する物体までの距離及び方向を検出する距離方向検出装置と、前記距離方向検出装置の検出結果に基づいて前記移動体の進行方向を決定する進行方向決定手段と、を有し、前記平板標識は、鏡面と、入射光を拡散反射する割合が当該鏡面よりも高い拡散反射面と、を含むことを特徴としている。
【発明の効果】
【０００９】
本発明にかかる移動体システムによれば、鏡面と拡散反射面、あるいは、鏡面と平板標識の背後の壁面との間で検出用光の反射態様を異ならせることで、検出用光を用いてランドマークを精度良く検出することができる。また、ランドマークと背後の壁面との間にギャップを設ける必要がないので移動体の走行経路近傍を省スペース化することができる。
【図面の簡単な説明】
【００１０】
【図１】本発明の一実施形態を説明するものであり、平板標識と移動体との構成を模式的に示す上面図である。
【図２】本発明の一実施形態を説明するものであり、移動体システムの全体構成を模式的に示す図である。
【図３】本発明の一実施形態を説明するものであり、移動体の概略構成を示す模式的な図である。
【図４】本発明の一実施形態を説明するものであり、駆動制御部の機能構成を示すブロック図である。
【図５】本発明の一実施形態を説明するものであり、平板標識を正面視で模式的に示す図である。
【図６】本発明の一実施形態を説明するものであり、平板標識を壁面に沿った方向からみた模式的な側面図である。
【図７】本発明の一実施形態を説明するものであり、距離センサによる距離計測用ランドマークの検出態様を示す模式図である。
【発明を実施するための形態】
【００１１】
以下、本発明の実施の形態について図を参照して説明する。
図１〜図７はいずれも本発明の一実施形態にかかる移動体システムを説明するものであり、図１は平板標識と移動体との構成を模式的に示す上面図、図２は移動体システムの全体構成を模式的に示す図、図３は移動体の概略構成を示す模式的な図、図４は駆動制御部の機能構成を示すブロック図、図５は平板標識を正面視で模式的に示す図、図６は平板標識を壁面に沿った方向からみた模式的な側面図、図７は距離センサによる距離計測用ランドマークの検出態様を示す模式図である。
【００１２】
図２に示すように、本実施形態にかかる移動体システム１００では、フロア１０１上に予め走行経路Ｒが設定されており、移動体１が走行経路Ｒに沿って自律走行するように構成されている。また、走行経路Ｒの近傍には受光平面を有する平板状のランドマーク（平板標識，目標物）２０が複数設置されている。なお、走行経路Ｒの経路は適宜変更することが可能である。
【００１３】
走行経路Ｒには、移動体１を制御する制御手法毎に区間Ａ１〜Ａ３が設定されている。区間Ａ１では移動体１は進行方向の正面に存在する平板標識に向かって進行する経路であり、区間Ａ２は走行経路Ｒに沿って延びる壁面１０２に沿って進行する経路であり、区間Ａ３は主として後述する画像誘導手段により移動体を制御する区間である。
なお、図２では説明を容易にするために走行経路Ｒや各区間Ａ１〜Ａ３を図示しているが、実際のフロア１０１等には走行経路Ｒや各区間Ａ１〜Ａ３を示すライン等は存在せず、各区間Ａ１〜Ａ３それぞれの境界についても厳密に規定されるものではない。
【００１４】
図３に示すように、移動体１は、車体２に電子演算器，記憶装置及び入力装置からなる駆動制御部３を内蔵している。
駆動部（走行装置）４は車輪（走行装置）５の駆動を制御するようになっており、前記駆動制御部３からの指令に従って前記車輪５を駆動することで前記移動体１の前進後退および姿勢角（操舵方向）を制御することができる。
【００１５】
６は撮像装置であり、前記移動体１の中心軸上に進行方向に向けて設置されており、移動体１の進行方向の画像を撮像し、画像データ（実画像）をリアルタイムで取得するようになっている。また、撮像装置６は画像を静止画像で取得することも可能である。
前記撮像部６で撮像された画像は前記駆動制御部３に伝達される。ここで、撮像部６を進行方向に向けて設置しているのは、高速走行中でも撮像部の取得画像が乱れにくく、より安定した実画像を得ることができるためである。
【００１６】
７は例えば半導体レーザー等のレーザー発信装置を有するレーザー距離センサ（距離方向検出装置）であり、図１にも示すように、レーザー距離センサ７から水平方向（車体２の方向において）に所定の探索角度範囲に所定の角度毎（例えば、０．５°毎）に検出用のレーザー光（検出用光）を発信するようになっている。そして、物体に反射して戻ってくるまでの時間から各点までの距離と計測点の角度を検出するようになっている。つまり、レーザー距離センサ７の有効な探索範囲（距離と角度との検出が有効である範囲）は探索角度を中心角として車体２の設置面（水平）に対して平行な扇形の平面となる。
移動体周囲の壁や柱といった構造物および歩行者など移動体の周囲の環境の距離を計測する。レーザー距離センサ７で計測された距離データは駆動制御部３に伝達される。
【００１７】
図４に示すように駆動制御部３は機能構成として、進行方向決定部（進行方向決定手段）３１，画像誘導部（画像誘導手段）３２及び記憶部（地図情報記憶手段，教示画像記憶手段）３３を有している。
進行方向決定部３１は、予め、記憶部３３に記憶された地図情報と予めレーザー距離センサ７の検出結果とを照合して移動体１の位置を検出し、移動体１が走行経路Ｒに沿うように駆動部４に進行方向に関する信号を送信するようになっている。
なお、地図情報とは走行経路Ｒのフロア１０１位置座標とランドマーク２０が設置される位置座標との情報を含んでいる。
【００１８】
なお、走行経路Ｒは図２中矢印で示す直線上の区間（直線部）と、直線部と直線部とを接続する方向転換部からなり、地図情報には、予め得た走行データに記載された距離情報と、スタート地点からの現在の走行距離とを照会する方法、もしくは距離センサを用いた走行経路直線部終端への位置決め完了のいずれかによって、現在直線部と方向転換部のどちらを走行しているかを判別し、直線部では本発明の走行制御を行い、方向転換部では車輪回転量を基に方向を変えて次の直線部の走行を開始する手順情報が含まれている。
また、記憶部３３には予め走行経路Ｒ上の離散した地点である複数の教示地点のそれぞれにおいて撮像装置６の実画像の目標となる画像として取得した複数の教示画像が記憶されている。
画像誘導部３２は、実画像と前記教示画像との比較結果に基づいて駆動部４を制御するようになっている。
【００１９】
（区間Ａ１）
以下、区間Ａ１における移動体１の制御態様について説明する。図２に示すように区間Ａ１は走行経路Ｒの前方にある窓２４からの外光により、窓２４に近づくほど走行経路Ｒの近傍の光環境の経時的な変化度合いが大きくなる。
区間Ａ１では、レーザー距離センサ７がランドマーク２０を検出するまでは、画像誘導部３２により駆動部４を制御し、レーザー距離センサ７がランドマーク２０を検出した後は、検出したランドマーク２０の位置から予め設定されたオフセット地点（目標点）まで進行方向決定部３１により駆動部４を制御するようになっている。
なお、ランドマーク２０は、図１，図６に示すように、壁面１０２に貼り付けられており、光を鏡面反射（全反射）させる鏡面加工部２１と光を拡散反射させる拡散反射面２２とから構成されている。鏡面加工部２１は拡散反射面２２の両端に配設されており、水平方向と直交する面に対して所定の角度θだけ下向きに傾斜している。
【００２０】
鏡面加工部２１は、光を鏡面反射させる素材であれば何を用いて構成してもよい。また、拡散反射面２２は、紙や樹脂等の適宜の素材で構成可能であるが、レーザー距離センサ７の検出用光の入射方向に拠らずあらゆる方向に光を反射する素材を用いて形成すればよい。
また、拡散反射面２２には、画像誘導部３２よる制御を行なう際に画像の特徴点となる図柄２３が設けられている。なお図中Ｌは、レーザー距離センサ７からの検出用光の照射方向を表わしている。
図１に示すように、レーザー距離センサ７から照射された検出用のレーザー光は、壁面１０２及び拡散反射面２２では拡散的に反射されるため、レーザー距離センサ７が壁面１０２及び拡散反射面２２に対して傾斜した位置にあっても、レーザー距離センサ７が壁面１０２及び拡散反射面２２から反射した検出用光を検知して距離と方向とを検出することができる。
【００２１】
一方、レーザー距離センサ７から鏡面加工部２１に照射された検出用光は、図６に示すように鏡面加工部２１の傾斜により下方に反射する。また、図１に示すように移動体１が鏡面加工部２１に対して正対している場合を除いて水平方向に全反射する。つまり、鏡面加工部２１からの反射光はレーザー距離センサ７側に反射されず、レーザー距離センサ７は鏡面加工部２１に対応する領域は探索範囲に存在しないと判断することとなる。
進行方向決定部３１は、レーザー距離センサ７の検出結果から壁面１０２に取り付けられたランドマーク２０の位置（方向）と距離とを求め、と記憶部３３に記憶されている地図情報（ランドマークの形状）とを照合させて、自身の位置を地図情報上の走行経路Ｒに沿うように駆動部４に指令を与える。
【００２２】
（区間Ａ２）
次に、区間Ａ２における移動体１の制御態様について説明する。
区間Ａ２では走行経路Ｒ側方の窓２４からの外光が多すぎるため、主として進行方向決定部３１によって駆動部４を制御するようになっている。
図７に示すように平板状の距離計測用のランドマーク２０が設置されているとすると、連続する計測角度において計測された距離が連続的に変化する領域を検索し、検索により抽出した距離計測用ランドマーク候補領域に対して最小自乗法により領域の直線性を評価して、平板であると判定した領域の両端の計測データから距離計測用ランドマーク基準点の位置および移動体１に対する距離計測用ランドマークの角度が求められる。距離計測用ランドマークの位置および角度の値と予め指定されている通過点指定位置ｈ，ｖの値を用いて、移動体の現在地からの補正量が求まる。ここで、距離計測用ランドマークを精度良く計測するためには、移動体１を静止させて計測することが望ましい。
駆動制御部は補正量を基に移動体を駆動し、通過点指定位置に位置決めさせる。これにより経路を補正できるのである。
なお、区間Ａ２におけるランドマーク２０も区間Ａ１のものと同様に構成されている。
【００２３】
本発明の一実施形態にかかる移動体システムはこのように構成されているので、ランドマーク２０を壁面１０２と接触して配置している場合であっても鏡面反射部２１と拡散反射面２２、あるいは、鏡面反射部２１と壁面１０２との間で検出用光の反射態様が大きく異なるため、レーザー距離センサ７による検知結果が大きく異なるためランドマーク２０の受光面の位置を精度良く検出することができる。これにより、走行経路Ｒ及び移動体１の自立走行のために必要なスペースのフロア１０１への占有率を低減する省スペース化することができる。ランドマーク２０を薄い平板状に形成して受光平面と背後の壁面との間のギャップｇを小さくしてもランドマーク２０の位置を精度良く検出することができる。
また、走行経路Ｒにおいて、外光による撮像画像の変化が少ない場所（区間Ａ３）では撮像画像と撮像用ランドマークのパターンマッチングが成功する確率が高く、撮像部のみを利用して走行経路上を走行することが可能である。一方、区間Ａ１，Ａ２では、外光等により光環境の変化に伴って同じ位置から同じ方向を撮像したとしても撮像装置６により取得される実画像の変化が大きい区間では、撮像画像と撮像用ランドマークのパターンマッチングが成功した特徴点の数が減少する。
【００２４】
このような状況では、撮像用ランドマークのパターンマッチングが成功した特徴点の数が予め定められたしきい値以上であればマッチング結果を有効として静止することなく走行し、しきい値以下の場合は一旦停止して距離計測用ランドマークを計測して計測結果を有効として経路を補正する。このようにして撮像画像および距離データを適切に組み合わせて走行経路に対する前記移動体１の移動補正量を求め、移動体を走行制御することで教示した走行経路を走行し、目的地へ到達できるのである。
【００２５】
また、認識した撮像用ランドマークの数が複数であり、どのランドマークの計測結果を使用すればよいか判定できない際に自動的に切り替えるようにしてもよい。また、撮像部で撮像した画像から求めた進行方向からの角度のズレ量が予め定められた範囲を超えた際にパターンマッチングが誤認識した、もしくは走行経路に対する角度のズレ量が大きすぎると判定してレーザー距離センサ７を用いた経路補正方法に自動的に切り替えるようにしてもよい。
なお、本実施形態ではランドマーク２０の鏡面加工部２１に傾斜θを設けたが、傾斜θについて省略してもよく、鏡面加工部２１と拡散反射面２２とが同一平面上になるように形成してもよい。このようにすればランドマーク２０をさらに薄く形成することができる。
また、移動体１とランドマーク２０とがわずかなにでも角度を持っていれば、鏡面反射部２１からの反射光をレーザー距離センサ７で受光しにくく、鏡面加工部２１とその他の拡散反射面との区別を精度良く行なうことができる。
【符号の説明】
【００２６】
１ 移動体
２ 車体
３ 駆動制御部
４ 駆動部
５ 車輪
６ 撮像部
７ レーザー距離センサ
２０ ランドマーク（平板標識）
【特許請求の範囲】
【請求項１】
予め設定された走行経路に応じて配置された平板標識と、前記走行経路に沿って自律走行する移動体と、を有する移動体システムであって、
前記移動体に設けられ、所定の探索範囲に検出用光を走査することにより、前記移動体と前記探索範囲内に存在する物体までの距離及び方向を検出する距離方向検出装置と、
前記距離方向検出装置の検出結果に基づいて前記移動体の進行方向を決定する進行方向決定手段と、を有し、
前記平板標識は、鏡面と、入射光を拡散反射する割合が当該鏡面よりも高い拡散反射面と、を含む、移動体システム。
【請求項２】
前記鏡面は前記拡散反射面の両端側に配置されている
ことを特徴とする請求項１記載の移動体システム。
【請求項３】
前記平板標識が前記探索範囲内に存在するときに前記鏡面から反射された前記検出用光を前記距離方向検出装置が受光しないように、前記鏡面の配置位置が決定されている
ことを特徴とする請求項１又は２記載の移動体システム。
【請求項４】
前記距離方向検出装置は前記検出用光を水平方向に発信するように設定され、
前記鏡面は、前記水平方向と直交する面に対して所定の角度だけ傾斜している
ことを特徴とする請求項１〜３のいずれか１項に記載の移動体システム。
【請求項５】
前記平板標識は前記走行経路中、前記移動体が直進する経路の末端部に前記直進する方向に対向するように設置されている
ことを特徴とする、請求項１〜４のいずれか１項に記載の移動体システム。
【請求項６】
前記平板標識は前記走行経路を形成する壁面に取り付けられている
ことを特徴とする、請求項１〜５のいずれか１項に記載の移動体システム。
【請求項１】
予め設定された走行経路に応じて配置された平板標識と、前記走行経路に沿って自律走行する移動体と、を有する移動体システムであって、
前記移動体に設けられ、所定の探索範囲に検出用光を走査することにより、前記移動体と前記探索範囲内に存在する物体までの距離及び方向を検出する距離方向検出装置と、
前記距離方向検出装置の検出結果に基づいて前記移動体の進行方向を決定する進行方向決定手段と、を有し、
前記平板標識は、鏡面と、入射光を拡散反射する割合が当該鏡面よりも高い拡散反射面と、を含む、移動体システム。
【請求項２】
前記鏡面は前記拡散反射面の両端側に配置されている
ことを特徴とする請求項１記載の移動体システム。
【請求項３】
前記平板標識が前記探索範囲内に存在するときに前記鏡面から反射された前記検出用光を前記距離方向検出装置が受光しないように、前記鏡面の配置位置が決定されている
ことを特徴とする請求項１又は２記載の移動体システム。
【請求項４】
前記距離方向検出装置は前記検出用光を水平方向に発信するように設定され、
前記鏡面は、前記水平方向と直交する面に対して所定の角度だけ傾斜している
ことを特徴とする請求項１〜３のいずれか１項に記載の移動体システム。
【請求項５】
前記平板標識は前記走行経路中、前記移動体が直進する経路の末端部に前記直進する方向に対向するように設置されている
ことを特徴とする、請求項１〜４のいずれか１項に記載の移動体システム。
【請求項６】
前記平板標識は前記走行経路を形成する壁面に取り付けられている
ことを特徴とする、請求項１〜５のいずれか１項に記載の移動体システム。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【公開番号】特開２０１２−１１３７６５（Ｐ２０１２−１１３７６５Ａ）
【公開日】平成２４年６月１４日（２０１２．６．１４）
【国際特許分類】
【出願番号】特願２０１２−６５０４３（Ｐ２０１２−６５０４３）
【出願日】平成２４年３月２２日（２０１２．３．２２）
【分割の表示】特願２００８−３１５７４５（Ｐ２００８−３１５７４５）の分割
【原出願日】平成２０年１２月１１日（２００８．１２．１１）
【出願人】（０００００６６２２）株式会社安川電機 (2,482)
【Ｆターム（参考）】
【公開日】平成２４年６月１４日（２０１２．６．１４）
【国際特許分類】
【出願日】平成２４年３月２２日（２０１２．３．２２）
【分割の表示】特願２００８−３１５７４５（Ｐ２００８−３１５７４５）の分割
【原出願日】平成２０年１２月１１日（２００８．１２．１１）
【出願人】（０００００６６２２）株式会社安川電機 (2,482)
【Ｆターム（参考）】
[ Back to top ]