(57)【特許請求の範囲】
【請求項１】
走行路上の所定領域を照射又は走査する照射装置を備え、自律走行する移動体において、
前記移動体の予定経路を算出する予定経路算出部と、
前記照射装置から照射される光の水平角および走行路面に対する傾斜角を変化させる駆動装置と、
走行路面に照射する照射光に対して画像を投影する画像投影装置と、を備え、
前記移動体の走行前に、予め
前記予定経路算出部は、時間間隔ごとに前記移動体が通過する前記予定経路上の通過点と、前記通過点を照射するための前記駆動装置の前記通過点ごとの指令値と、前記通過点ごとに前記画像投影装置によって投影する画像とを、それぞれ算出し、
前記駆動装置は、前記通過点を含む所定の範囲を、前記予定経路に沿って前記照射光が順に照射するように、前記指令値に基づいて前記水平角および前記傾斜角を変化させ、
前記画像投影装置は、前記予定経路に沿って前記照射光が照射される前記所定の範囲ごとに前記予定経路の一部の画像を順に投影することで、前記予定経路の全体を示す画像を投影し、
その後に前記予定経路の走行を開始することを特徴とする移動体。
【請求項２】
前記予定経路を、移動体の幅に基づき移動体の通過する領域を示す画像として投影することを特徴とする請求項１に記載の移動体。
【請求項３】
投影する画像の縦方向のひずみを補正することを特徴とする請求項１又は２に記載の移動体。
【請求項４】
照射装置から照射先までの距離に合わせて投影する画像の大きさを調整することを特徴とする請求項１乃至３のいずれかに記載の移動体。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、例えば、病院、ホテル、デパート、劇場や老人ホームの廊下など多くの人が介在する環境で自律走行する移動体に関し、移動体の動作状態や行き先を周囲の人に分かりやすく提示するための装置に関する。
【背景技術】
【０００２】
近年、施設内の廊下など人間と共存する環境下で走行して、案内や清掃などのサービスを提供する移動体が開発されてきている。移動体は予め設定記憶された目的地に向けて直進や旋回など動作を切替えながら走行するが、該移動体とすれ違ったり、並んで歩いたりする周囲の人間にとっては、該移動体が、今後どのような動作をするかの予測がつかず、不意の針路変更で歩行を邪魔されたり、さらには接触又は衝突したりする危険性がある。
移動体の周囲の人間が、その動作を予測し、接触又は衝突の回避等の行動を取りやすくするためには、移動体がこれからたどるであろう軌道を知ることが必要である。
移動体の動作予告として一般的には、移動体に点滅式ランプに代表されるような方向指示器を備え、周囲の人間に針路変更を予告することが行われている。しかし、ランプの点滅だけでは周囲の人間に提示できる情報量に限りがあるという一般的な課題があった。
【０００３】
これに対し、特開平８−２２１１２６号公報（参考文献１）では、ディスプレイを移動体の外周面に複数備え、該ディスプレイに「現在位置」等の位置情報、「移動中」等の動作状況、あるいは「右に曲がります」等の動作予告を文字により表示させる方式が提案されている。これによれば、ランプの点滅だけの場合と比較して周囲の人間に提示できる情報量を増やすことができる。
【０００４】
しかしながら参考文献１に示す従来例でも、移動体の詳細な軌道を提示するには不充分であった。すなわち、「右に曲がります」又は「左に曲がります」等の表示だけでは、依然として具体的にどれだけ曲がるのかを知ることができず、また仮に「右に３０°曲がります」等と表示しても、それが移動体の軌道をどのように変化させるのか、周囲の人間には把握しづらいという問題点があった。
【０００５】
これに対し特許文献１では、所定時間後に前記移動体が通過する領域を予測し、照射手段により路面上に照射またはスキャンして提示する方式が提案されている。以下図に基づいて説明する。
図１０は、特許文献１の従来例を示すブロック図である。図１０において、１は移動体、２は前記移動体１の動作を制御するコントローラ、３は前記移動体１の走行経路を照射する照射装置、１０１は前記移動体１の前後進を操作する前後進レバー、１０２は前記移動体１の操作ハンドル角度を検出するハンドル角度検出器、１０３は前記移動体１の走行速度を検出する速度検出器、１０４は前記移動体１の傾きを検出する傾斜検出器である。１０５は前記コントローラ２に搭載され、前記前後進レバー１０１、ハンドル角度検出器１０２、速度検出器１０３、および傾斜検出器１０４の検出結果から前記移動体１の所定時間後の移動領域を予測する予測部である。照射装置３は傾斜駆動装置１０６、水平駆動装置１０７、および径変化装置１０８から構成される。傾斜駆動装置１０６は、照射装置３から照射される光の走行路面に対する傾斜角を変化させる。水平駆動装置１０７は、照射装置３から照射される光の水平角を変化させる。径変化装置１０８は、照射装置３から照射される光線の径を変化させる。
【０００６】
上記構成により、走行中にレバー・ハンドル操作や車両状態を検出して、所定時間後の移動領域または位置を予測し、照射装置の傾斜・水平角度と径を制御して路面に照射する。これにより、周辺の人間に対し移動体の予測移動領域または位置を提示できるとしている。
【０００７】
また、特許文献２では、記憶された予定経路に基づいて、移動体の位置が変化する方向、移動速度、移動距離を提示する方法が提案されている。これによれば、移動体は路面に情報を提示する画像投影装置を備え、移動体の進行方向、移動速度、移動距離を示す情報を路面に投影することで、周囲の人間に移動内容を提示できるとしている。
【特許文献１】特開２０００−３４４００５号公報
【特許文献２】特開２００８−９７７４号公報
【発明の開示】
【発明が解決しようとする課題】
【０００８】
しかしながら、特許文献１に示す従来例では、走行中の移動体の移動速度、移動方向、および操舵角度により移動体の移動領域を予測しているため、軌道の曲率が変化する直前でなければ、移動体の予測移動領域または位置を提示することができないという問題点があった。図１１は特許文献１に示す従来例における移動領域の推定を示す図である。施設内を走行する移動体において一般的な、直線と円弧を組み合わせた軌道を例としている。図１１（ａ）のように直線軌道の走行時にはハンドルが中立点にあるため、移動体の推定移動領域を示す照射範囲は走行経路と一致している。ところが、図１１（ｂ）のように円弧軌道に入る直前においては、ハンドル操作は未だ行われていないため、照射範囲は依然として移動体の前方に留まり、これから曲がろうとする走行経路とは大きくずれてしまう。一方、図１１（ｃ）のように円弧軌道に入ればハンドル操作が行われるため、照射範囲と軌道は一致する。上記のように、従来例では軌道の曲率が変化する前後において、移動領域の推定精度が低下するという問題点があった。実際の移動体の移動経路はクロソイド曲線を描くと考えられるが、前述の問題がある。この照射位置のずれは、周囲の人間に誤った情報となるので、移動体との接触又は衝突の回避が誤った行動となる可能性をもっている。
また、特許文献２の従来例では、画像投影装置は移動体に固定されているため照射できる領域が限られており、直近の進行方向は提示することはできるが、移動体の走行経路全体を提示することはできない。また、移動体の進行方向や移動速度が頻繁に変化するような経路を提示するには情報量が不十分という問題点がある。
本発明はこのような問題点に鑑みてなされたものであり、どのような軌道であってもあらかじめ精度良く移動経路を推定して、移動体の通過する領域を周囲の人間にわかりやすく提示することができる移動体を提供することを目的とする。
【課題を解決するための手段】
【０００９】
上記問題を解決するため、本発明は、次のように構成したのである。
請求項１に記載の発明は、走行路上の所定領域を照射又は走査する照射装置を備え、自律走行する移動体において、前記移動体の予定経路を算出する予定経路算出部と、前記移動体の走行前に、予め前記予定経路算出部は、時間間隔ごとに前記移動体が通過する前記予定経路上の通過点と、前記通過点を照射するための前記駆動装置の前記通過点ごとの指令値と、前記通過点ごとに前記画像投影装置によって投影する画像とを、それぞれ算出し、前記駆動装置は、前記通過点を含む所定の範囲を、前記予定経路に沿って前記照射光が順に照射するように、前記指令値に基づいて前記水平角および前記傾斜角を変化させ、前記画像投影装置は、前記予定経路に沿って前記照射光が照射される前記所定の範囲ごとに前記予定経路の一部の画像を順に投影することで、前記予定経路の全体を示す画像を投影し、その後に前記予定経路の走行を開始することを特徴とするものである。
また、請求項２に記載の発明は、前記予定経路を、移動体の幅に基づき移動体の通過する領域を示す画像として投影することを特徴とするものである。
また、請求項３に記載の発明は、投影する画像の縦方向のひずみを補正することを特徴とするものである。
また、請求項４に記載の発明は、照射装置から照射先までの距離に合わせて投影する画像の大きさを調整することを特徴とするものである。
【発明の効果】
【００１０】
請求項１に記載の発明によると、画像投影装置により移動体の走行前にこれから走行する移動体の走行経路全体を投影することができるので、周囲の人はより明確に移動体の走行する経路を知ることができる。
請求項２に記載の発明によると、移動体の大きさに基づき、移動体の通過する領域を投影することによって、周囲の人は移動体と接触する領域を容易に知ることができる。
請求項３に記載の発明によると、照射装置の光軸が傾いたときに生じる、画像の縦方向のひずみを補正することができるので、常に一定の形状の画像を投影することができる。
請求項４に記載の発明によると、照射距離に合わせて投影する画像の大きさを調整することができるので、走行路面に対して所定の大きさの画像を投影することができる。
すなわち、停止時、走行時に関わらず、これから走行する経路全体を事前に精度よく提示することができるという効果が得られる。また、画像を床面上に走査しながら投影することで、広い範囲において移動体の走行経路を提示することができる。
【発明を実施するための最良の形態】
【００１１】
以下、本発明の実施の形態について図を参照して説明する。
【実施例１】
【００１２】
図１は、本発明の第１の実施の形態を示す移動体のブロック図である。図１において、１は移動体、２は前記移動体１の動作を制御するコントローラ、３は前記移動体１の走行経路を照射する照射装置、４は前記移動体１に操作者により目的地を指示するための目的地指定手段である。５は前記移動体１の予定経路を算出する予定経路算出部である。照射装置３は、傾斜駆動装置６、水平駆動装置７、画像投影装置８から構成される。傾斜駆動装置６は、照射装置３から照射される光の走行路面に対する傾斜角を変化させる。水平駆動装置７は、照射装置３から照射される光の水平角を変化させる。画像投影装置８は走行路面に照射する照射光に対して画像を投影する。
【００１３】
図２は、本発明の第１の実施例によって得られる作用の説明図である。図の（ａ）乃至（ｃ）は全て走行開始前であり、（ａ）、（ｂ）、（ｃ）の順に時系列で変化する。移動体１は、目的地指定手段４において指定された目的地までの予定経路を予定経路算出部５で算出し、図のように予定経路上に投影装置８によって投影する画像(投影画像)を走査させ、予定経路を提示する。本方式によれば、予定経路の軌道の曲率が変化する前後であっても、移動領域(移動体の通過する領域)の推定の後に、精度を低下させることなく提示させることができる。また、走行前に予定経路の画像を投影することにより、周囲の人は、移動体が走行する前に予め走行経路を把握することができる。また、移動体の大きさに基づき、移動体の通過する領域を画像投影装置８により投影することにより、周囲の人は、移動体が走行する前に、移動体と接触又は衝突する可能性を容易に把握することができ、必要に応じた回避行動をとることができる。
【００１４】
図３は、照射装置３の構成図である。図３において、６は傾斜駆動装置、７は水平駆動装置、８は画像投影装置である。傾斜駆動装置６において、６aは減速機、６bはモータ、６cはエンコーダである。モータ６bは、予定経路算出部５の指令により駆動する(図ではモータ駆動部を省略している)。減速機６aの出力側の回転軸は、画像投影装置８の光軸と直交している。水平駆動装置７において、７aは減速機、７bはモータ、７cはエンコーダ、７dは軸である。モータ７bは、予定経路算出部５の指令により駆動する(図ではモータ駆動部を省略している)。減速機７aの出力側の回転軸は走行路面の法線方向と一致し、画像投影装置８の光軸と交差している。画像投影装置８において、８ａは液晶パネル、８ｂはランプ、８ｃはレンズ、８ｄはピント調整装置、８ｅは液晶画像制御部となっている。液晶パネル８ａは、液晶画像制御部８ｅより入力された画像を表示しており、その背後にあるランプ８ｂにより画像は投影され、投影された画像は、レンズ８ｃによって拡大される。また、レンズ８ｃは、ピント調節装置８ｄに固定され、投影方向に移動可能となっており、投影する画像のピントを調節できる(図ではピント調整装置の駆動部を省略している)。
【００１５】
図４は、画像投影装置８によって投影される画像の大きさの補正の説明図である。（a）に示すように、画像投影装置により画像を走行路面上に投影するとき、画像投影装置８の光軸の傾斜角度φの大きさに応じて、走行路面上に投影画像の大きさは変化する。そこで、常に一定の大きさの投影画像となるよう、液晶画像制御部８ｅにおいて、（ｂ）に示すように投影する画像の大きさの補正を行う。このとき、投影画像の基準の大きさは、φ＝0となる、床面に垂直に投影した投影画像であり、常にこの大きさの画像が投影される。まず、投影画像の幅は、画像投影装置８から、光軸と床面の交点までの距離に比例する。そこで、元の画像の幅をＷとすると画像の幅を式（１）に示すように縮小する。また、投影画像の高さは、光軸の傾斜角度φの大きさに応じて変化する。画像投影装置８の視野角の大きさをφl、元の画像の長さをｈとするとき、投影画像の光軸から手前方向の長さｈ’lower、奥方向の長さをｈ’upperは、それぞれ式（２）、式（３）によって求められる。さらに、投影距離に応じてピント調節装置を制御し、レンズ８ｃを前後に動かしてピントを調節する。
【００１６】
【数１】
0005262669.tif 000002
【００１７】
図５は画像投影装置８によって投影される画像の縦方向のひずみの補正の説明図である。本発明は、(ａ)のように画像投影装置８の光軸が走行路面の法線方向に対して角度をなして投影しているため、（ｂ）のような長方形の画像を投影すると、（ｃ）のような手前から奥に広がる台形の形状となってしまう。これを補正するため、光軸の傾斜角度に応じて、投影する画像の形状を補正する。例えば、（ｂ）の画像を（ｄ）に示す形状に補正することで、走行路面に投影される画像は、（ｅ）に示すような長方形のものとなる。
【００１８】
図６は、移動体の移動先と照射装置の各駆動装置の回転角の関係を示す説明図である。図６において、移動先Ｐｔは、移動体１の水平駆動装置７の回転軸と走行路面との交点を原点とし、水平駆動装置７の回転角＝０°のときの照射装置３の光軸の方向をＹ軸とするＸ‐Ｙ座標系で表現される。移動先Ｐｔ（Ｘｔ，Ｙｔ）を照射するための傾斜駆動装置６の傾斜角φｔは、照射装置３の走行路面からの高さｈより、式（４）によって算出される。また、回転駆動装置７の回転角θｔ（左回りを正とする）は，式（５）、式（６）によって算出される。
【００１９】
【数２】
0005262669.tif 000003
【００２０】
図７は、移動体の通過する領域を投影する方法の説明図である。照射装置３によって走行経路を走査しながら、画像投影装置８によって移動体の通過する領域を投影する。
画像投影装置８によって投影する画像の作成方法を説明する。まず、予定経路算出部において移動体の走行経路全体を算出し、走行経路を移動体の幅Ｗほどオフセットして移動体の通過する領域を算出し、現在地から目的地までの移動体の通過する領域全体を示す経路全体画像を作成する。作成する経路全体画像は、画像投影装置が照射できる範囲のものとする。座標Ptに対して画像投影装置８が投影する画像は、経路全体画像において、照射装置３が照射する移動位置Ptを中心とし、水平駆動装置７の回転角θほど回転させた、所定の四角形の範囲の画像を抽出したものである。経路上の各点について投影する画像を算出する。
【００２１】
図８は、移動体の走行経路を投影するフローチャートであり、静止時に移動体の走行経路を投影する場合のフローチャートである。
まず、予定経路算出部５において、所定の時間後Ｔeまでの移動体の走行経路を算出し、時間間隔Δｔごとに移動体の通る座標Pt（Xt，Yt）を算出する（ステップ１）。
次に、各座標を照射するための傾斜駆動装置６と水平駆動装置７のそれぞれの回転角指令値θ、φを算出する（ステップ２）。
画像投影装置８によって投影する画像を各座標ごとに算出する（ステップ３）。
傾斜角φに基づいて、投影する画像の形状および大きさを算出する。また、ピントを合わせるためのピント調節装置への指令値を算出する（ステップ４）。
照射装置３が移動体１の予定経路を走査するように、算出した回転角指令値θ、φを傾斜駆動装置６と水平駆動装置７に与えて駆動させ、画像投影装置８によって照射する座標に対応する画像を投影することで走行路面上に移動体の通過する領域を表示する（ステップ５）。ステップ５において、傾斜駆動装置６と水平駆動装置７の角速度は、次の回転角指令値までの回転角を所定の時間（例えば時間間隔Δt）で割ることで算出できる。
【００２２】
本発明において、移動体１の走行する予定経路は事前にわかっているため、走行中に走行経路を照射する場合においても、走行しながら照射先をリアルタイムに算出することなく走行前に前もって算出することができる。ただし、移動体は予定経路を予定された速度で走行するものとする。
図９は、移動体の走行経路を投影するフローチャートであり、走行時に移動体の予定経路を投影する場合のフローチャートである。
これは、走行前に予定経路と、所定時間移動後での予定経路を照射するための照射装置３で照射する。
まず、走行前に、図８と同様にステップ１からステップ４において、照射装置３の回転角指令値θ、φを算出する。走行時に移動体の走行経路を投影する場合は、移動体の走行に伴い、座標系が時間ごとに変化するため、ステップ１において移動体の通過点を算出したあとに、座標変換処理を行う（ステップ１２）。ｔ＝ｔ１の移動体１の座標をPｖ１（Xｖ１，Yｖ１）、ｔ＝０との姿勢の変化（左回りを正とする角度）をαｖ１、また、ｔ＝0の移動体の座標を原点としてステップ１で求めたｔ＝ｔ１の照射装置３による照射座標をPｓ１（Xｓ１，Yｓ１）とする。ｔ＝ｔ１における移動体１の座標Pｖ１（Xｖ１，Yｖ１）を原点とする座標系において、照射装置３の照射する座標Pt（Xt，Yt）は、式（７）、式（８）の座標変換によって算出される。
【００２３】
【数３】
0005262669.tif 000004
【００２４】
求めた値より式（４）、式（５）、式（６）を用いて、照射装置３の回転角指令値θ、φを算出できる。このように走行前に事前に演算することが本発明の特徴である。続いて走行を開始したら、ステップ６で移動体の現在位置を求め、ステップ７において走行路面上に移動体の通過する領域を表示する。移動体１は、現在位置を計測し、走行時に生じるずれを補正しながら照射装置によって提示された経路上を走行する。
【００２５】
また、画像投影装置８は文字を投影できるので、走行路面に走行経路を提示しながら同時に文字情報も提示することができる。例えば、バッテリ残量やアラーム発生などを表示することで、周囲から移動体の走行領域と動作状態を把握することができる。また、走行経路を走査しながら移動先の名称などを投影することで、移動体の動作をより詳しく知ることができる。移動体の動作状態や移動先の名称などの情報は、コントローラ２より画像投影装置８に与えられ、文字情報を含めた画像が液晶画像制御部８eにおいて生成される。
【産業上の利用可能性】
【００２６】
走行経路を予め提示することが安全対策となっており、多くの人間が介在する施設内においてサービス用途として利用できる。
【図面の簡単な説明】
【００２７】
【図１】本発明の第１の実施の形態を示す移動体のブロック図
【図２】本発明の第１の実施例によって得られる作用の説明図
【図３】本発明の第１の実施例における照射装置の構成図
【図４】本発明の画像投影装置によって投影される画像の大きさの補正の説明図
【図５】本発明の画像投影装置によって投影される画像の縦方向の補正の説明図
【図６】本発明の移動体の移動先と照射装置の各駆動装置の回転角の関係を示す説明図
【図７】本発明の移動体の通過する領域を投影する方法の説明図
【図８】本発明の移動体の静止時に走行経路を投影するフローチャート
【図９】本発明の移動体の走行時に走行経路を投影するフローチャート
【図１０】従来例を示すブロック図
【図１１】従来例の手法によって得られる作用を示す説明図
【符号の説明】
【００２８】
１  移動体
２  コントローラ
３  照射装置
４  目的地指定手段
５  予定経路算出部
６  傾斜駆動手段
７  水平駆動装置
８  画像投影装置
１０１  前後進レバー
１０２  ハンドル角度検出器
１０３  速度検出器
１０４  傾斜検出器
１０５  予測部
１０６  傾斜駆動装置
１０７  水平駆動装置
１０８  径変化装置
【図１】
0005262669.tif 000005
【図２】
0005262669.tif 000006
【図３】
0005262669.tif 000007
【図４】
0005262669.tif 000008
【図５】
0005262669.tif 000009
【図６】
0005262669.tif 000010
【図７】
0005262669.tif 000011
【図８】
0005262669.tif 000012
【図９】
0005262669.tif 000013
【図１０】
0005262669.tif 000014
【図１１】
0005262669.tif 000015