(57)【要約】【課題】  移動体を動かす事なく目標位置情報の教示が可能であり、また教示者が教示と同時に目標位置情報の確認および編集を容易に行う。【解決手段】  教示装置は、ランドマークを計測するランドマーク計測部と、ランドマークの計測結果から環境内での教示装置位置を算出する位置算出部と、教示装置位置を教示者に提示する位置提示部と、教示装置位置を移動体の目標位置として編集する位置編集部と、位置編集部で編集された目標位置を記憶する位置記憶部と、位置記憶部に記憶された目標位置を移動体に送信する位置送信部とを備え、移動体は、位置送信部から送られた目標位置を受信する位置受信部と、位置送信部から送られた目標位置を受信する位置受信部と、位置受信部にて受信した目標位置に従って移動を実行する移動実行部とを備える。【選択図】図１
2009175903.tif 000002
【特許請求の範囲】
【請求項１】
移動体と、前記移動体が環境内で自己位置を計測するためのランドマークと、教示者が前記移動体の目標位置を教示するための教示装置とを備えた、移動体教示システムにおいて、
前記教示装置は、
前記ランドマークを計測するランドマーク計測部と、
前記ランドマークの計測結果から環境内での教示装置位置を算出する位置算出部と、
前記教示装置位置を教示者に提示する位置提示部と、
教示者が前記教示装置位置を移動体の目標位置として編集する位置編集部と、
前記位置編集部で編集された目標位置を記憶する位置記憶部と、
前記位置記憶部に記憶された目標位置を前記移動体に送信する位置送信部とを備え、
前記移動体は、
前記位置送信部から送られた目標位置を受信する位置受信部と、
前記位置受信部にて受信した目標位置に従って移動を実行する移動実行部とを備える
ことを特徴とする、移動体教示システム。
【請求項２】
前記教示装置は、３個以上の回転体に支えられた棒状材の上端に前記ランドマーク計測部を備えた構成になっていることを特徴とする、請求項１記載の移動体教示システム。
【請求項３】
前記教示装置は、複数の移動体と通信が可能であって、前記教示者が選択した移動体に対して目標位置を送信可能であることを特徴とする、請求項１または請求項２に記載の移動体教示システム。
【請求項４】
前記教示装置は、前記移動体が移動実行時には前記移動体に結合されるとともに、教示した目標位置に前記移動体が到達した際に、ランドマークを計測して前記移動体の現在位置を算出し、前記位置記憶部に記憶された目標位置情報と現在位置を比較し、現在位置を補正することを特徴とする、請求項１乃至３のいずれかに記載の移動体教示システム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、移動体の目標位置を教示する教示システムに関する。  
【背景技術】
【０００２】
工場での搬送用途、あるいは病院やオフィスでの案内サービス用途として、自律移動可能な移動体を適用する事例が近年増加している。従来は床面に敷設された磁気テープ等のガイドに沿って走行する方式が主流であったが、よりルート設定に柔軟性の高い方式として、移動体に搭載された内界および外界センサによって自分の現在位置を把握しながら予め設定されたルートどおりに走行するガイドレス方式が新たに提案されている。
このようなガイドレス方式の移動体を導入・運用する上では、走行すべきルートを予め教示設定するティーチング作業が必須となる。パソコン等の端末上でＣＡＤ等専用のソフトを用いて走行ルートを入力する方法もあるが、走行環境の地図情報が必要であり、また専用ソフトの取扱いが難しいという問題点がある。これに対し、より簡便な方法として、移動体本体と無線通信を行う遠隔操作装置にジョイスティックを備え、ジョイスティックによって移動体を走行させた時の移動体の駆動輪に設けられたエンコーダにより算出される重心座標を記憶する教示システムが提案されている（特許文献１参照）。
【０００３】
特許文献１における従来例を図７に示す。図７において、１は教示者、２は移動体、５は教示者１が移動体２を操作するための教示装置である。教示装置５は、教示者１が移動体２に移動量を操作するためのジョイスティック１０２と、操作した間の移動量を記憶させるための教示ボタン１１と、記憶した移動量に基づき移動体２を移動させるための移動実行ボタン２０を備えている。また、移動体２は、車輪と、前記車輪の回転量を検出する車輪位置検出器１００と、前記車輪の回転量より移動体２の位置を算出する移動体位置算出器１０１と、前記移動体２の位置を記憶する位置記憶部３と、記憶した位置に基づき前記移動体２に移動指令を与える移動実行部４とを備えている。図に示すように、教示者１がジョイスティック１０２を操作して走行させ、この間の車輪の回転量を車輪位置検出器１００により検出し、移動体の位置を車輪位置算出器１０１により算出することで走行地図を自動生成させ、位置記憶部３へ記憶することで、移動体に走行ルートを教示記憶させることができる。
特許文献１に示す上記従来例では、移動経路地図の基準となる移動体の位置座標を検出する際に、車輪の回転量に基づき位置座標を検出している。しかし車輪の回転量を用いた場合、車輪と路面との滑りにより教示位置に誤差が生じ、長距離を移動させたときにこの誤差が累積してしまい正確な移動経路地図を生成できないという課題があった。
これを克服した従来例として、複数のランドマークを配置し、移動体から撮像されたランドマーク画像を基に移動体の位置座標を測定することにより目標位置を教示する方法が特許文献２に提案されている。
【０００４】
特許文献２における従来例を図８に示す。図８において、１は教示者、２は移動体、６は移動体の走行環境である屋内の天井面若しくは壁面上方に添付されたランドマークである。移動体２は、全方位カメラ７と、前記全方位カメラ７の画像情報からランドマーク６を検出するランドマーク計測部８と、計測されたランドマークから移動体位置を算出する位置算出部９と、算出された移動体位置を記憶する位置記憶部３と、記憶した位置に基づき前記移動体２に移動指令を与える移動実行部４とを備えている。図に示すように、教示者１が走行ルートに沿って移動体２を直接押すもしくはジョイスティックにより走行させることで移動させ、その間にランドマーク６を全方位カメラ７にて撮像することで現在位置の座標を算出し、位置記憶部３に記憶することで、移動体に走行ルートを直接教示記憶させる。これにより、車輪と路面との滑りにより教示位置に誤差が生じても、ランドマーク検出によって得られた移動体位置によりこれを補正することができる。長距離を移動させても教示した位置座標に累積誤差が生じないため、より正確な移動経路地図を作成できるという効果がある。
【特許文献１】特開平７−１１０７０９号公報（第２−３頁、図４）
【特許文献２】特開２００６−２４２９７８号公報（第５−８頁、図１）
【発明の開示】
【発明が解決しようとする課題】
【０００５】
ところが、特許文献２に示す従来の教示システムは、目標位置を教示する際に移動体を動かす必要があるため、煩雑であり、移動体近傍での作業のため、注意を怠ると危険が伴うという問題があった。さらに、教示者が教示と同時に位置情報を確認することができないため、教示作業完了後に数値を編集する手間が必要になるという問題があった。
本発明はこのような問題点に鑑みてなされたものであり、移動体を動かす事なく目標位置情報の教示が可能であり、また教示者が教示と同時に目標位置情報の確認および編集を容易に行うことができる、教示システムを提供することを目的とする。
【課題を解決するための手段】
【０００６】
上記問題を解決するため、本発明は、次のように構成したのである。
請求項１に記載の発明は、移動体と、前記移動体が環境内で自己位置を計測するためのランドマークと、教示者が前記移動体の目標位置を教示するための教示装置とを備えた、移動体教示システムにおいて、
前記教示装置は、
前記ランドマークを計測するランドマーク計測部と、
前記ランドマークの計測結果から環境内での教示装置位置を算出する位置算出部と、
前記教示装置位置を教示者に提示する位置提示部と、
教示者が前記教示装置位置を移動体の目標位置として編集する位置編集部と、
前記位置編集部で編集された目標位置を記憶する位置記憶部と、
前記位置記憶部に記憶された目標位置を前記移動体に送信する位置送信部とを備え、
前記移動体は、
前記位置送信部から送られた目標位置を受信する位置受信部と、
前記位置受信部にて受信した目標位置に従って移動を実行する移動実行部とを備える
ことを特徴とするものである。
また、請求項２に記載の発明は、前記教示装置は、３個以上の回転体に支えられた棒状材の上端に前記ランドマーク計測部を備えた構成になっていることを特徴とするものである。
また、請求項３に記載の発明は、前記教示装置は、複数の移動体と通信が可能であって、前記教示者が選択した移動体に対して目標位置を送信可能であることを特徴とするものである。
また、請求項４に記載の発明は、前記教示装置は、前記移動体が移動実行時には前記移動体に結合されるとともに、教示した目標位置に前記移動体が到達した際に、ランドマークを計測して前記移動体の現在位置を算出し、前記位置記憶部に記憶された目標位置情報と現在位置を比較し、現在位置を補正することを特徴とするものである。
【発明の効果】
【０００７】
請求項１に記載の発明によると、目標位置を教示する時に移動体を動かすことなく、簡単に、安全に目標位置を教示することができる。また、教示者の手元に配置された位置提示部に教示装置の位置情報を提示し、教示者が編集可能とすることで、目標位置の教示と同時に位置情報の確認および編集を容易に行うことができる。
請求項２に記載の発明によると、請求項１の効果に加え、移動体の目標位置を確実に計測することができる。
請求項３に記載の発明によると、請求項１または２の効果に加え、選択された複数の移動体に目標位置を教示することができる。
請求項４に記載の発明によると、請求項１から３のいずれかの効果に加え、移動実行時に位置補正することができる。
【発明を実施するための最良の形態】
【０００８】
以下、本発明の実施の形態について図を参照して説明する。
【実施例１】
【０００９】
図１は、本発明の移動体教示システムの全体構成図である。図において、１は教示者、２は移動体、５は教示者１が操作する教示装置である。
教示装置５は、所定の高さにランドマークを計測する手段として全方位カメラ７を備えた構成になっており、３個の回転体に支えられた棒状材の上端に地面と水平に固定されることによって、前記全方位カメラ７は地面との水平を維持される。
【００１０】
全方位カメラ７は、教示装置５の周囲３６０°の画像を撮影する事が可能であり、その撮影画像より、ランドマーク計測部８が移動空間内の固定された場所に設置されたランドマーク６の位置を計測する。そして、計測されたランドマーク６の位置を、位置算出部９が移動体２のスタート位置を中心とした直交座標上の位置に変換し、位置提示部１０へ教示装置位置情報として提示する。提示された教示装置位置情報は、位置提示部１０に備わる位置編集部１１にて目標位置を編集される。前記位置編集部にて編集された目標位置情報は目標位置として位置記憶部３に記憶される。そして、教示者が教示ボタン１１を押す事で、移動体の目標位置として位置送信部３０により移動体２へ送信される。位置記憶部３、ランドマーク計測部８、位置算出部９、位置提示部１０、教示ボタン１１、位置送信部３０はいずれも教示装置５に搭載される。
【００１１】
移動体２は２つ以上の回転機構（例えば、サーボモータ）を備えた車輪によって駆動される。前記教示装置５に備わる位置送信部３０から送信された目標位置は位置受信部３１により受信され、受信した目標位置に従って移動実行部４が前記車輪を駆動制御する。移動実行部４は、移動体２に搭載される。
【００１２】
上記構成によれば、目標位置を教示する時に移動体を動かすことなく、簡単に、安全に目標位置を教示することができる。また、教示者の手元に配置された位置提示部に位置情報を提示することで、教示と同時に位置情報の確認および編集を容易に行うことができる。
【００１３】
なお、図１では、前記全方位カメラ７は下端に３個の回転体が備わる棒状材の上端に備わる前記位置提示部１０の上部に備わっているが、この回転体は４個以上でも良く、前記教示装置５が持ち運び容易なくらい軽量であれば、回転体は備えずに平面板の上に棒状材を備えるなど、目標位置を教示する際に高さと水平が保たれる構成をとっていれば良い。
【００１４】
また、前記位置提示部１０は棒状材の上端に備わっているが、前記教示者１が提示内容を認識しやすく操作しやすい場所ならば、教示装置５の何処に備わっても良く、棒状材から離れた場所であっても良い。例えば、全方位カメラ７のみが３個の回転体に支えられた棒状材の上端に備わり、位置提示部１０は棒状材からケーブルで遠隔接続されており、教示者１が棒状材を左手で把持し、位置提示部１０を右手で把持する、などの構成でも良い。
【００１５】
さらに、図１では、前記教示装置５と前記移動体２とのデータ送受信には無線（例えば、無線ＬＡＮ、赤外線通信など）を使用する事を想定してケーブルを描いていないが、教示する経路が単純・近距離であるなどの場合は、有線（例えば、有線ＬＡＮなど）でも良い。前記位置提示部１０の詳細については図２、教示の手順については図３、全方位カメラ画像からランドマーク位置を算出する方法については図４および図５にて説明する。
【００１６】
図２は、本実施例１における前記位置提示部１０の画面例である。図において、１１は各方向の移動量を教示する教示ボタン、１３は各方向の移動量を提示する移動量提示部、１４は各方向の移動量を編集する移動量編集ボタン、１７は複数の位置を教示する時に用いる連続教示ボタン、１８は教示を終了させる教示終了ボタン、１９は各方向の移動量を初期化する移動量初期化ボタン、２０は教示した目標位置を確認するために移動体２を移動させる移動実行ボタン、２１は移動実行ボタン２０にて教示した目標位置を確認した際、教示した位置の修正が必要な時に移動体２を初期位置に戻す初期位置戻りボタン、２２は複数の移動体に目標位置を教示する場合に、どの移動体に対して提示された目標位置を目標位置記憶部に送信するか選択する教示移動体選択ボタンである。
【００１７】
図３は前記位置提示部１０を用いた前記移動体２の目標位置を教示する手順である。以下に前記位置提示部１０の説明と共に前記位置提示部１０を用いた前記移動体２の目標位置を教示する手順例を図２および図３を用いて説明する。
【００１８】
前記教示者１は、目標位置の計測を始める（Step1）にあたり、前記移動体２の移動開始位置にてＸ，Ｙ，回転（θ）の全ての移動量を初期化する（Step2、図２のＸ方向移動量初期化ボタン１９−Ｘ、Ｙ方向移動量初期化ボタン１９−Ｙ、回転移動量初期化ボタン１９−θを全て押す）。その後、前記教示者１は、前記回転体が床面に接するように前記目標位置教示装置５を把持し、前記移動体２の目標位置まで進み（Step3）、前記全方位カメラ７にて前記ランドマーク６を計測することで前記教示装置５の位置を計測する（Step4）。この教示装置５の位置は、移動量提示部１３に提示され、Ｘ方向移動量提示部１３−Ｘは、計測される移動量のＸ方向成分のみを提示し、Ｙ方向移動量提示部１３−Ｙは、計測される移動量のＹ方向成分のみを提示し、回転移動量提示部１３−θは、計測される移動量の回転方向成分のみを提示する（Step5）。そして、目標位置に到達したら前記移動量提示部１３に提示される各移動量を前記教示者１が確認し（Step6）、前記移動量提示部１３に提示された値に編集が必要か判断し（Step7）、編集が必要と判断された場合で移動量編集ボタン１４での編集が不可能であり前記教示装置５の位置を変更する場合（Step8でのNo）は、Step3へ戻る。Step7にて編集が必要でない場合は、Step10へ移る。また、Step7にて前記移動量提示部１３に提示される移動量が要求精度以下の計測誤差が含まれている場合や、細かな精度を前記移動体２へ送信する目標位置情報に求めない場合など、前記移動量提示部１３に示された計測値を調整するには移動量編集ボタン１４を使用し、四捨五入して良い桁のボタンを押すことで、その桁以下が四捨五入された位置情報に編集される。例えば、前記Ｘ方向移動量提示部１３−Ｘに表示された値が、１５３６．３ｍｍであり１０ｍｍの精度しか望まない場合は１の位の前記Ｘ方向移動量編集ボタン１４−Ｘを押すことにより、Ｘ方向移動量は１５４０．０ｍｍとなる。同様に、前記Ｙ方向移動量提示部１３−Ｙに提示された値を編集する場合には、Ｙ方向移動量編集ボタン１４−Ｙを使用し、前記回転移動量提示部１３−θに提示された値を編集する場合には回転移動量編集ボタン１４−θを使用する（Step9）。
【００１９】
そして、Ｘ，Ｙ，θの各移動量のみを送信する場合は（Step10のYes）、Ｘ方向移動量教示ボタン１１−Ｘを押すことにより、前記教示装置５から前記移動体２へＸ方向移動量のみが送信され、Ｙ方向移動量教示ボタン１１−Ｙを押すことにより、前記教示装置５から前記移動体２へＹ方向移動量のみが送信され、回転方向移動量教示ボタン１１−θを押すことにより、前記教示装置５から前記移動体２へ回転方向移動量のみが送信される（Step12,15）。ここで、Ｘ方向とＹ方向の両方の移動量を同時に送信したい場合（前記移動体２を斜めに動かしたい場合）は、Ｘ，Ｙ方向移動量教示ボタン１１−ＸＹを押すことにより、前記教示装置５から前記移動体２へＸ方向の移動量とＹ方向移動量が同時に送信される（Step13,15）。また、Ｘ，Ｙ，θ（回転）移動量の全てを同時に送信したい場合（前記移動体２を斜めに動かし、かつ、移動後の姿勢を回転した状態にしたい場合）は、Ｘ，Ｙ，θ移動量教示ボタン１１−ＸＹθを押すことにより、前記教示装置５から前記移動体２へＸ方向の移動量とＹ方向移動量と回転移動量が同時に送信される（Step14,15）。
【００２０】
そして、その地点から次の地点への教示を続け一連の動作として教示したい場合は（Step16のYes）、連続教示ボタン１７を押して前記教示装置５内の位置記憶部３に目標位置を記憶する（Step17）。そして、一連の動作が相対位置での移動指令の場合（Step18のYes）、移動実行ボタン２０を押して前記移動体２を目標位置（その時点で前記目標位置教示装置５のある位置、次の目標位置教示の初期位置）へ移動させ、移動後に前記Ｘ方向移動量初期化ボタン１９−Ｘと前記Ｙ方向移動量初期化ボタン１９−Ｙと前記回転移動量初期化ボタン１９−θの全てを押し、計測移動量データを初期化し（Step20）、Step3へ進む。一連の動作が絶対位置での移動指令の場合（Step18のNo）は、何もせずにStep3へ進む。
【００２１】
連続教示をしない場合および教示を終了する場合（Step16のNo）は、教示終了ボタン１８を押し（Step21）、前記位置記憶部３へそれまでの目標位置情報を記憶させ、（Step22）教示を終了する。
【００２２】
なお、路面状況によっては、移動経路に小さな段差がある場合など、教示どおりの目標位置情報では、希望の場所に到達しない場合がある。その場合は、目標位置を送信する移動体に割り当てられた教示移動体選択ボタン２２から移動実行させて確認する移動体を選択し（Step23、例えば『ボタンＡ』）、移動実行ボタン２０を押す事で前記教示装置５に備わる前記位置送信部３０から選択された前記移動体２（例えば、移動体Ａ）に備わる前記位置受信部３１に目標位置が伝達され、受信された目標位置を前記移動実行部４が呼び出し、選択された前記移動体２（例えば、移動体Ａ）が移動する（Step24）。ここで、実行された目標位置が要求どおりか判断を行い（Step25）、修正が必要でなければ複数の移動体へその目標位置を記憶させるか判断し（Step26）、移動実行させた移動体のみで良い場合（Step26におけるNo）は、確認終了ボタン３３を押して計測を終了する（Step27）。移動実行させた移動体（例えば、移動体Ａ）以外にも同じ位置へ移動させたい移動体がある場合（Step26におけるYes）は、前記教示移動体選択ボタン２２の他のボタン（例えば、『ボタンＢおよびボタンＣ』）を押す事により、選ばれた移動体（例えば、『移動体Ｂおよび移動体Ｃ』）へ教示に使用した移動体にて移動実行させた目標位置情報が送信され、その移動体（例えば、『移動体Ｂおよび移動体Ｃ』）に備わる位置受信部３１へ記憶される。この時、選ばれた移動体（例えば、『移動体Ｂおよび移動体Ｃ』）では、移動実行による確認（Step24およびStep25）は行わない。Step25にて教示した目標位置に修正が必要な場合は、初期位置戻りボタンを押して前記移動体２を初期位置へ戻し（Step29）、前記Ｘ方向移動量初期化ボタン１９−Ｘと前記Ｙ方向移動量初期化ボタン１９−Ｙと前記回転移動量初期化ボタン１９−θの全てを押し、計測移動量データを初期化し（Step30）、Step3へ進み、再び教示を行うという手順を追加しても良い。
【００２３】
なお、前記教示移動体選択ボタン２２は、いずれの移動体も選択されていない場合は１つの移動体しか選択できず、いずれか１つの移動体が選択されている場合は、次から押された移動体には移動実行ボタン２０が有効にならない。また、一度選択された移動体は前記確認終了ボタン３３を押すまで前記教示移動体選択ボタン２２は有効にならない。これは、Step23において目標位置を送信して移動実行させる移動体が複数選択されて複数の移動体が同時に移動実行する事を防ぐためであると共に、Step28において目標位置を送信する移動体を選択する際に、前記確認終了ボタン３３が押される前に誤って移動実行ボタン２０が押されても、複数の移動体が同じ位置に向かって移動を実行するのを防ぐためである。
【００２４】
また、連続教示する場合で特定の方向は必要でない場合（例えば、Ｘ方向のみへ1000mm進み、その後に斜めへＸ，Ｙそれぞれ500mm進む場合）に、必要のない方向のみ初期化ボタン（前記の例では、Ｘ方向のみに進むステップでのＹ方向移動量初期化ボタン１９−Ｙおよび回転移動量初期化ボタン１９−θ）を押してから、次の移動目標位置（前記の例では、Ｘ方向のみへ1000mm進んだ後の斜めへＸ，Ｙそれぞれ500mm進む位置）への教示を行えば良い。
【００２５】
また、図２に示した前記位置提示部１０の画面の配置は一例であり、前述した機能が満たされるならば、図２の配置およびボタン数でなくても良い。
さらに、図２では複数の移動体に教示する場合に用いる教示移動体選択ボタン２２がＡ〜Ｃの３個あるが、１個以上であれば何個でも良く、複数の移動体を教示する必要がない場合は、なくても良い。
【００２６】
図４および図５は、全方位カメラ７による撮像画像からランドマーク位置を検出し、位置算出部９にてランドマーク位置を移動体基準とした直交座標に変換する方法を示している。図においてHは前記ランドマーク６の床面からの高さ、ｈは全方位カメラ中心の床面からの高さ、ｈ’は全方位カメラ中心から前記ランドマーク６までの高さである。
【００２７】
目標位置を教示する前の準備段階として、全方位カメラの撮像画像中での前記ランドマーク６の位置と、全方位カメラ中心から前記ランドマーク６までの直線距離ｒを求めるキャリブレーションを行う。全方位カメラ中心から前記ランドマーク６までの直線距離ｒは、ランドマーク高さHが固定であるため、前記移動体２から前記教示装置５までの距離Lが既知である場合、以下の式より求めることが出来る。
【００２８】
【数１】
2009175903.tif 000003
式（１）を用いて距離Lが既知の数箇所で撮像画像上でのランドマーク位置と、距離ｒの関係（ｒとｒ’の関係）を求め、キャリブレーションを行う。このキャリブレーションデータを基に、前記位置算出部９は、前記全方位カメラ７の撮像画像から得られる距離ｒ’から実際の距離ｒを算出し、前記移動体２から前記教示装置５までの距離Lを以下の式（２）から求める。
【００２９】
【数２】
2009175903.tif 000004
また、前記全方位カメラ７の撮像画像より、前記移動体２を中心とした直交座標上の前記ランドマーク６と各軸との角度αは求まるため、式（２）にて求まった距離Lと角度αを用いて前記移動体２から前記目標位置教示装置５までのＸおよびＹ方向のそれぞれの移動量が式（３）から求まる。
【００３０】
2009175903.tif 000005
【００３１】
図６は、本発明の移動体教示システムの教示装置ホルダ構成図であり、図７は本発明の移動体教示システムが目標位置へ移動後に位置補正する流れ図である。図６において、２は移動体、５は教示装置、６はランドマークである。
教示装置ホルダ３３は、移動体２に備わり、教示装置５を教示に使用しない時に移動体２と教示装置５を結合する物である。
【００３２】
以下に前記移動体２に前記教示装置５を結合した場合の目標位置へ移動後に位置補正する流れの例を図１〜３および図７を用いて説明する。
図３において移動体の目標位置が教示され、確認終了ボタン３３が押され、教示位置の計測が終了した後（Step27）、前記移動体２は、図示していない外部指令装置（例えば、移動指令クライアントの備わるパソコン）から、移動実行を指令する移動体が選択され、前記移動実行部４へ目標位置への移動実行を指令される（Step32）。指令を受けた前記移動実行部４は受信した目標位置に従って前記車輪を駆動制御することにより、目標位置に移動する（Step32）。目標位置への移動が完了した時点で、前記全方位カメラ７にて移動環境内に備わる前記ランドマーク６の位置を前記ランドマーク計測部８により計測し、前記位置算出部９にて現在位置を算出する（Step33）。このとき、現在位置と目標位置を教示した時に計測した教示装置位置を比較し（Step34）、一致する場合には次の目標位置へ移動する指令を前記移動実行部４へ与える（Step38）。Step34にて位置が一致しない場合には、現在位置と目標位置を教示した時に計測した教示装置位置の誤差を算出し（Step35）、補正すべき移動量を算出する（Step36）。算出された補正移動量は前記移動実行部４に送信され、補正移動量が移動実行される（Step37）。補正移動量が移動実行された後は、Step33に戻り、現在位置と目標位置を教示した時に計測した教示装置位置を比較し、現在位置と目標位置を教示した時に計測した教示装置位置が一致するまでStep33からStep37が繰り返される。以上のStep33〜Step38は、図７に示す前記移動体２に備わる位置補正部３４が行う。
【００３３】
このように、移動空間内の固定された場所に設置されたランドマーク６を教示装置５に備わる全方位カメラ７で計測する事で得られる教示装置の位置の計測情報を、教示者１が確認・編集して移動体２へ送信する構成をしているので、簡単に、安全に目標位置を教示することができる。
【産業上の利用可能性】
【００３４】
本発明の移動体への位置教示システムによれば、移動空間内の固定された場所に設置されたランドマークを教示装置に備わる全方位カメラで計測する事で得られる教示装置の位置の計測情報を、教示者が確認・編集して無線にて送信するので、移動体を動かすことなく、移動体の目標位置および経路の教示を安全に、容易に行うことができる。
【図面の簡単な説明】
【００３５】
【図１】本発明の第１実施例を示す移動体教示システムの全体構成図
【図２】本実施例１における位置提示部の画面例
【図３】位置提示部を用いた移動体の目標位置を教示する手順
【図４】全方位カメラ画像からのランドマーク位置算出図1)
【図５】全方位カメラ画像からのランドマーク位置算出図2)
【図６】本発明の移動体教示システムの教示装置ホルダ構成図
【図７】本発明の移動体教示システムが目標位置へ移動後に位置補正する流れ図
【図８】従来例１の目標体教示システムの全体構成図
【図９】従来例２の目標体教示システムの全体構成図
【符号の説明】
【００３６】
１  教示者
２  移動体
３  位置記憶部
４  移動実行部
５  教示装置
６  ランドマーク
７  全方位カメラ
８  ランドマーク計測部
９  位置算出部
１０  位置提示部
１１  教示ボタン
１３  移動量提示部
１４  移動量編集ボタン
１７  連続教示ボタン
１８  教示終了ボタン
１９  移動量初期化ボタン
２０  移動実行ボタン
２１  初期位置戻りボタン
２２  教示移動体選択ボタン
３０  位置送信部
３１  位置受信部
３２  教示装置ホルダ
３３  確認終了ボタン
３４  位置補正部
１００  車輪位置検出器
１０１  車輪位置算出器
１０２  ジョイスティック
【図１】
2009175903.tif 000006
【図２】
2009175903.tif 000007
【図３】
2009175903.tif 000008
【図４】
2009175903.tif 000009
【図５】
2009175903.tif 000010
【図６】
2009175903.tif 000011
【図７】
2009175903.tif 000012
【図８】
2009175903.tif 000013
【図９】
2009175903.tif 000014