移動体
【課題】 安価で高精度に、閉じられた活動領域を設定された誘導予定経路に沿って移動することができる移動体を提供する。
【解決手段】 本発明の移動体１は、閉じられた所定の活動領域を自動的に移動する移動体であって、活動領域の地図情報を記憶する地図情報記憶部１２と、地図情報記憶部１２に記憶された地図情報に対応して移動体１の誘導予定経路を設定する誘導経路設定部１３と、誘導経路設定部１３により設定された誘導予定経路に基づいて移動体１を誘導制御する制御部１７とを備えてなる。
【解決手段】 本発明の移動体１は、閉じられた所定の活動領域を自動的に移動する移動体であって、活動領域の地図情報を記憶する地図情報記憶部１２と、地図情報記憶部１２に記憶された地図情報に対応して移動体１の誘導予定経路を設定する誘導経路設定部１３と、誘導経路設定部１３により設定された誘導予定経路に基づいて移動体１を誘導制御する制御部１７とを備えてなる。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は予め設定した誘導予定経路に従って自動的に走行する移動体に関し、特に地図情報に対応して設定された閉じられた活動領域内の誘導予定経路に従って自動走行を行う移動体に関する。
【背景技術】
【０００２】
近年、人件費の高騰や労働力不足などにより、無人走行車や移動ロボットなどの開発が活発であるが、実用のためには活動領域を高精度に且つスピーディに移動することが求められると共にコストも高くならないことが求められる。
【発明の開示】
【発明が解決しようとする課題】
【０００３】
しかしながら、これら移動体の経路誘導技術としては、ティーチング・プレーバック方式を採用するのが一般的であるため、高精度且つスピーディな誘導を要求する用途には応えられない。例えば、屋外用では精密農業やゴルフ場の芝刈り、屋内用では倉庫内での荷物の運搬などにおいては、スピーディ且つ高精度な移動が要求される。こうした要求を満たす手段がコストの問題で実現できないのが実情である。
【０００４】
例えば、ゴルフ場の自動芝刈り機を例にとり、より詳しく説明すると、従来存在する誘導方法としては、グリーンなどの活動領域内の誘導予定経路を予めオペレータが実際に機械を移動させて、経路を教示（ティーチング）し、それに基づいて移動させるいわゆるティーチング・プレーバック方式が一般的である。
【０００５】
しかしながら、この方式では、一定時間または一定距離移動するごとにＧＰＳなどの手段を使って位置座標を求めるので、経路は点列で記憶されることになり、実走行時はこの点列を辿ってプレーバックするので、次のような誤差を生むことになる。
【０００６】
（１）グリーンエッジのように経路が曲線の場合には、点列を直線的に移動すると円弧部分に誤差を生じる。
（２）人の操作のバラツキによりティーチングエラーが生じる。
（３）移動体がカーブなどで方位角を変える場合、方向転換の指示を受けてから転換量を演算し制御回路が駆動部に指令を出して実際に移動体が転換を始めるまでに時間遅れを生じることによって誤差が生じる。
（４）ＧＰＳの示す位置精度は現在最も精度が高いといわれるＲＴＫ−ＧＰＳでも数ｃｍの誤差を有するので、グリーンエッジのように高精度を要求される用途において、ＧＰＳを用いてティーチングするのは不適切である。すなわち、ティーチングにおいてＧＰＳによる誤差を有し、更に実走行時においてもＧＰＳを用いることにより、誤差が重なりその誤差が２倍にもなるおそれがある。
【０００７】
本発明は上述した問題点を解決するためになされたものであり、安価で高精度に、且つスピーディに閉じられた活動領域を設定された誘導予定経路に沿って移動することができる移動体を提供することを目的とする。
【課題を解決するための手段】
【０００８】
上述した課題を解決するため、本発明は、閉じられた所定の活動領域を自動的に移動する移動体であって、活動領域の地図情報を記憶する記憶手段と、前記地図記憶手段に記憶された地図情報に対応して前記移動体の誘導予定経路を設定する誘導経路設定手段と、前記誘導経路設定手段により設定された誘導予定経路に基づいて前記移動体を誘導制御する制御手段とを備えてなる。
【０００９】
ここで、前記誘導経路設定手段は、前記誘導予定経路を複数区間に分割し、且つ各区間をパラメータを用いた数式で表現し、前記制御手段は、該誘導経路設定手段により設定された数式に基づいて各区間毎に前記移動体を誘導制御する。この構成によれば、数式による連続した予定経路が得られ、ＧＰＳを基準とする場合のように離散的経路に比べて制御し易く、その精度を高めることができる。なお、実施の形態において、前記制御手段は、制御部１７及び角速度センサ１４及びロータリーエンコーダ１５により構成される。
【００１０】
また、前記地図情報は、平面方向及び高さ方向の情報を含む三次元地図情報であり、前記制御手段は、前記誘導経路設定手段により設定される誘導予定経路と前記地図情報とに基づいて前記制御手段が移動体の誘導制御に際して用いる付帯情報を取得し、該付帯情報に基づいて前記移動体を誘導制御する。この構成によれば、例えば予定経路の状況を走行前に知ることができ、駆動制御等の対応準備を行うことができて、応答性を高めることができる。
【００１１】
更には、前記移動体の位置を検出するためのセンサと、前記誘導経路設定手段により設定された誘導予定経路と、前記センサの検出信号に基づいて得られる誘導実経路との誤差を演算する誤差演算手段と、該誤差演算手段により演算された誤差に基づいて前記誘導予定経路を補正する補正手段を備えることができる。実施の形態において、前記センサは位置検出器（３点マーカ検出器）により構成されているが、ＲＴＫ−ＧＰＳなどのＧＰＳを用いても良い。
【００１２】
そして、前記補正手段は複数分割された前記誘導予定経路の各区間を移動体が走行する度に、前記センサの検出信号に基づいて誤差を検出し、該誤差に基づいて次の区間における数式から得られるパラメータを補正することができる。この構成によれば、走行制御に基づく誘導予定経路と実際に走行する実走行経路との誤差が拡大していくことを防止でき、安価で且つ極めて高精度な走行制御を行わせることができる。
【００１３】
また、前記移動体の方位を検出する方位検出手段（例えば地磁気センサ）を備え、前記誤差演算手段は、所定のタイミング毎に前記誘導予定経路と誘導実経路との横ずれ量、方位誤差及び走行距離誤差をそれぞれ演算し、前記補正手段は、前記横ずれ量、方位誤差及び走行距離誤差に基づいて、誘導予定経路を補正するようにしても良い。
【００１４】
この場合に、前記補正手段は、前記走行距離誤差として、誘導予定経路方向に生じる距離誤差Ｘｅについては、誘導予定経路に対しその誤差Ｘｅ分だけその後の誘導予定経路の位置をずらすことによって補正することができる。
【００１５】
また、前記補正手段は、方向誤差Θｅと横ずれ量Ｙｅについては、左右車輪に指令する速度の差をＶｄ，ｃｏｍ、移動体の規定速度をＶｒ、予定経路を規定速度で走行する場合の規定角速度をωｒ、規定角速度ωｒと実走行角速度ωａとの差（ωｒ−ωａ）をωｅ、車輪幅をＷとし、且つＫΘ、Ｋｙ、Ｋωを各誤差を補正するためのゲイン係数とした場合に、
Ｖｄ，ｃｏｍ／Ｗ＝ωｒ＋ＫΘ・Θｅ＋Ｋｙ・Ｙｅ／Ｖｒ＋Ｋω・ωｅ
を満たすように、制御手段に移動体の車輪の駆動制御を行わせて補正を行うことができる。なお、補正を行うタイミング、及びゲイン係数については、移動体の使用環境等により適宜変更設定することができる。
【００１６】
なお、前記移動体に該移動体の所定周りを撮像するカメラを備え、前記制御手段は、該カメラによる撮像映像に基づいて移動体を誘導制御することもできる。
【発明の効果】
【００１７】
以上に詳述したように本発明によれば、安価で高精度に、且つスピーディに閉じられた活動領域を設定された誘導予定経路に沿って移動することができる移動体を提供することができる。
【発明を実施するための最良の形態】
【００１８】
以下、本発明の実施の形態について図面を参照しつつ説明する。
実施の形態１．
図１は本発明の実施の形態における移動体を示すブロック図である。
この移動体１は、移動体１を走行させようとする経路である誘導予定経路などを入力するための操作部１１と、３次元のデジタルパラメータによる地図情報記憶部１２と、誘導予定経路を地図情報に対応させて設定する誘導経路設定部１３と、角速度を検出する角速度センサ１４と、移動距離を検出する距離センサであるロータリーエンコーダ１５と、位置検出器１６と、誘導予定経路と検出角速度と検出距離とに基づいて移動体を誘導移動させながら、位置検出器１６の検出位置に基づいて移動体の今後（先）の誘導予定経路を補正部１７ａにより補正する制御部１７と、制御部１７からの制御信号を受けて移動体を走行駆動させる駆動部１８とを備える。
【００１９】
制御部１７は図示しない移動体の車輪の回転駆動制御と進路方向変更制御（ハンドルの操舵制御による方向変更、若しくは左右駆動輪の回転速度変更制御による方向変更）を行い、これを受けて駆動部１８は車輪を駆動し或いは操舵を行う。
【００２０】
位置検出器１６としては、例えば３点マーカ検出器を採用する。この３点マーカ検出器とは、図２で後述するが、誘導予定経路の付近の所定箇所に光学的に検出できる３つのマークを設けると共に、これらマークにより基準点を設定し、これらマークを光学的に検出することで、基準点に対する相対的位置を検出するものである。勿論、基準点としてこのような相対的な位置検出に対し、緯度や経度で表すことができるＲＴＫ−ＧＰＳ等の絶対的な位置検出器を採用しても良い。
【００２１】
図２は誘導経路設定部に設定された誘導予定経路の一例を示す図である。図２では、出発点Ｓ（ｘ０、ｙ０）、方位角θ、直線長Ｓｎ、円弧半径Ｒｎ、円弧長Ｃｎで示されている。図２に示される誘導予定経路は、ループ状をなし、複数の円弧部分Ｃと直線部分Ｓに区分けされて設定されている。
【００２２】
ここで、図２に示す誘導予定経路は、上述した位置検出器（３点マーカ検出器）１６による位置検出原理に対応するように、活動領域付近の所定箇所に３点（例えばＱ１，Ｑ２，Ｑ３）からなるマーカを設け、これらマーカから導出される所定の点（例えば図示されるＸ，Ｙ軸の交点）を基準点とした座標系ＱＲ（ｘＲ，ｙＲ）で表したものである。もちろん、緯度、経度などの絶対座標系によって設定することもでき、この場合は、ＲＴＫ−ＧＰＳなどの検出信号に対応することが容易である。もっとも、本実施の形態のように、活動領域付近にマーカを設けることで基準点を設け、座標系を構成するようにすると、例えば位置検出器（３点マーカ検出器）１６によるその座標系における位置検出が極めて高精度に行い得る。
【００２３】
制御部１７はこのように区分けされた部分区間毎にその経路を数式で表し、移動体の走行経路がその数式に沿うように、角速度センサ１４とロータリーエンコーダ１５の検出信号に基づいて制御信号を形成して駆動部に与える。ここで、説明の便宜のため、例えば図３に示す経路の一部を数式で近似する場合について説明する。
【００２４】
図３における座標形上の点Ｓ（ｘ０，ｙ０）を起点とした経路において、直線と円弧で設定される数式は、それぞれ次のようになる。
１）Ｓ〜Ｐ１間の直線上を移動体がＳ１移動した点の座標（ｘ、ｙ）を求める式は下式のように表される。
【００２５】
ｙ＝（ｙ１−ｙ０）／（ｘ１−ｘ０）×ｘ＋（ｙ１−ｙ０）／（ｘ１−ｘ０）×ｘ０ （１）
（ｘ−ｘ０）2＋（ｙ−ｙ０）2＝Ｓ１2 （２）
【００２６】
上記（１）（２）式から任意距離Ｓ１移動した点の座標（ｘ、ｙ）を求めることができ、制御部１７は上記直線区間においては、このような数式を満たすような座標に従うように駆動部を制御する。この場合、進路方向制御に関し、直線区間の移動では角速度がゼロになるようにハンドル又は車輪角を固定する。
【００２７】
２）Ｐ１〜Ｐ２間の円弧上を移動体がＰ１からＣ１分移動した点の座標（ｘ、ｙ）を求める式は下式のように表される。
【００２８】
（ｘ１−ｘｒ１）2＋（ｙ−ｙｒ１）2＝Ｒ１2 （３）
（ｘ−ｘ１）２＋（ｙ−ｙ１）２＝（２Ｒ１ｓｉｎ（３６０／（４πＲ１）×Ｃ１） （４）
【００２９】
上記（３）（４）式から移動距離Ｃ１地点の座標が求まり、制御部１７は上記円弧区間においては、このような数式を満たすような座標に従うように駆動部を制御する。この場合、操舵角については、角速度がＶ／Ｒとなるようにハンドルを一定角度切るように固定する。ここで、Ｖは移動速度、Ｒは半径（曲率半径）である。
【００３０】
このようにして、制御部１７は誘導経路設定部１３に設定された経路に従うように、駆動信号を駆動部１８に出力するが、実際には様々な誤差要因により移動体は少しずつ誘導予定経路からずれていく。例えば、方向誤差は角速度センサの零点偏移や角度誤差などで生じ図４（ａ）に示される。また距離誤差は車輪のスリップなどで生じ図４（ｂ）に示される。そこで、本実施の形態では、この方向誤差及び距離誤差を所定区間毎に補正するようにする。
【００３１】
以下、かかる補正方法について、その一例を説明する。
図４（ｃ）において、誘導予定経路に設定した最初の補正点をＡ´´、実際の到達した位置（位置検出器１６により検出される軌跡上の点）を点Ａとし、点Ａの位置を基準座標系に位置付ける。基準座標系への位置付けは、上述したように、誘導予定経路の設定を活動領域付近に基準点（任意の例えば３点のマーカ）を設けた座標系に対して行った場合においては、それら３点マーカの検出により行う。尚、緯度、経度などの絶対座標系で表した場合においては、ＲＴＫ−ＧＰＳなどにより位置を求めて位置付ける。次に、当該座標系において、起点Ｓを支点とし、軌跡ＳＡをθ度ずらしたときの誘導予定経路との交点をＡ´とする。
【００３２】
もし、位置誤差を５ｍｍ以下に設定するならば、区間ＡＡ´≦５ｍｍとなるように、Ａ´´のポイントを決めることになる。以後、等ピッチに補正するとして、区間ＳＡ´´＝区間Ａ´´Ｂ´´＝区間Ｂ´´Ｃ´´…、とＢ´´、Ｃ´´を補正点として設定していく。
【００３３】
移動体が補正点Ａ´´に対応する位置Ａに到達したとき、実際の位置Ａの誘導予定経路における補正点Ａ´´とのずれは、位置検出器１６により得られる軌跡を誘導予定経路と比較して（一致するまで回転シフトして）、その角度差θとして求めることができる。そこで、移動体は方位（進路方向）の補正のため、その角度差θを解消するように、誘導予定経路の次の区間（Ａ´´Ｂ´´）における当所の設定における方向を補正する。
【００３４】
また、この軌跡（実走行経路）のシフトによって、点Ａが誘導予定経路と交わる点をＡ´とすると、シフトによって点Ａからの移動体のその後の誘導予定経路（移動体内のコンピュータに記憶されている計画進路）も同時にシフトされることとなるので、点Ａからその後移動体が移動する予定経路は上記角度補正に伴い誘導予定経路上では、点Ａ´からとされるべきであり、当初設定された誘導予定経路の次の区間が区間Ａ´´Ｂ´´から区間Ａ´Ｂ´´に補正される。つまり距離の補正は当初の次の区間Ａ´´Ｂ´´のＡ´´点を誘導予定経路上で距離誤差（誘導予定経路に対応させた距離誤差）Ａ´Ａ´´だけ後退させることによって行われることとなる。
【００３５】
つまり、現実の距離ずれ量ＡＡ´´の補正を方向の補正と同時に行い、次の予定経路に沿って行くために、次の予定経路の起点をＡ´に設定し直す。さらにＡ´を始点とする予定経路に戻るために次の経路区間の設定値を補正する。すなわち、次の経路区間は当所、区間Ａ´´Ｂ´´であったが、それを区間Ａ´Ｂ´´とし、その区間の数式によるパラメータを変更する。
【００３６】
例えば区間Ａ´Ｂ´´が半径Ｒの円弧だった場合、制御部は移動体が角速度Ｖ／Ｒ＋θ／ｔで駆動されるように駆動部に制御信号を出力する。ここで、Ｖは移動速度、ｔは区間Ａ´Ｂ´´の移動時間である。また区間Ａ´Ｂ´´が直線の場合、θ／ｔとなるようにハンドルの操舵を行う。
【００３７】
以上、本実施の形態の動作について、図５に纏めて説明する。
まず、誘導予定経路を入力する（ステップＳ１）。次にこの誘導予定経路を図２に示すように複数区間に分割し、各区間を数式表示する（ステップＳ２）。そして、制御部は始点から第１区間（その後第ｎ区間）における数式に基づいて駆動制御を行う（ステップＳ３、Ｓ４）。次に第１区間移動（第ｎ区間移動）後にセンサ（位置検出器１６）による検出信号に基づいて移動距離及び方位の誤差を演算処理し（ステップＳ６）、その演算結果に基づいて第２区間（第ｎ＋１区間）を補正し（ステップＳ７、Ｓ８）、その補正値に従って駆動制御を行う（ステップＳ４）。この処理を最終区間終了まで行って、誘導制御が終了する（ステップＳ５）。
【００３８】
実施の形態２．
制御部は、移動体の進行方向前方に上り坂又は下り坂がある場合、直線からカーブに入る場合、又はカーブから直線に入る場合等、移動体の移動に付帯する動作情報を地図情報と誘導予定経路とに基づいて、事前にその情報を取得し、付帯する動作にスムーズに入れるように制御信号を駆動部に出力するようにすることもできる。
【００３９】
この場合、例えば、現在速度と残距離から次の動作を行うまでの時間を算出し、情報の種類と応答速度とによって定められた時間前に制御信号の出力を行い、次への動作をスムーズに行えるようにすることができる。
【００４０】
例えば、上り坂がある場合、地図情報から得られる現在速度に対するその上り勾配の大きさ、その長さなどに対応するエンジンの出力、出力変更時などをテーブルにしておき、制御部は地図情報の付帯情報に基づいて、このテーブルから上記上り坂にかかる直前にパラメータを抽出して駆動信号を出力する。
【００４１】
直線からカーブに入る場合、逆にカーブから直線に入る場合も同様に、ハンドルの切り角の制御信号を、地図情報の付帯情報に基づいて、テーブルから抽出し、その動作に入る直前に出力する。
【００４２】
また、後述する移動体が芝刈り機の場合は、上記パラメータと共に、芝領域の境界に対するカッターの上げ下ろし、又はその角度調整に関するパラメータを同様に用意されたテーブルから抽出し、その制御信号を動作位置直前に出力するようにする。
【００４３】
このような構成によれば、応答速度が遅い場合でも、その動作位置においてスムーズに動作に移ることができ、移動体の機能精度を高めることができる。
【００４４】
実施の形態３．
次に、本発明を自動芝刈り機に適用した場合について図６、図７を用いて説明する。
【００４５】
（１コース設定）
作業に先立って、グリーンキーパーは予め作業経路（仮想軌道）を決定する。作業経路の設定については以下で詳述するが、グリーンキーパーは芝目の関係から作業手順を決めていくつかの作業パターンを用意する。その内から一つを選択する。選択した後の作業手順は次のようなものとする。
【００４６】
（２誘導予定経路の設定）
最初に図６（ａ）のように出発点Ｓ１（予め基準となる正確位置を設定）から高精度を要求されるグリーンエッジの刈込みを行う。高精度を得る最も重要なポイントは初期合わせ（位置と向き）である。従って、管理者は出発点に正しい位置・向きに芝刈機を置く。
【００４７】
（２−１初期合わせの方法）
（１）位置はデジタルマップ上で決めたＳ点に対応する実際のグリーンエッジ近辺にマーキングしておく。あるいは、予め精密測量等で測定した基準点をグリーンサイドに設置する。この基準点にＧＰＳアンテナを置いて基準局とする。基準局と所定の位置関係にある地点に移動局ＧＰＳアンテナを置いて初期化する。初期化が終了した移動局ＧＰＳアンテナを移動体に搭載し、ＧＰＳの示す位置座標がスタート位置座標に合うように移動体を駆動することにおって位置合わせを行う。
【００４８】
（２）方向は、位置合わせと同様、グリーンエッジ近辺に予め設定用治具によって決めても良い。他の方法は、誘導予定経路（数式で表した予定経路）をカッターエッジ等本機の基準となる部位に関係的に表示（例えばオンボードのＬＣＤ）し、実際のグリーンエッジを示す誘導予定経路のライン表示と一致するように設定する。なお、後述（実施の形態７）するように、地磁気センサを用いる場合は地磁気センサにより誘導予定経路の方向に合わせるようにしても良い。
【００４９】
（３作業）
次に芝刈り機は予定経路に沿って作業開始する。
移動時、角速度センサーとロータリーエンコーダで方向と距離の演算を行い指定距離走行後停止する。位置補正は実施の形態１で記述の方法で行う。
停止後、カッターを上げて仮想軌道に沿って、一旦グリーンの外へ出て次の起点Ｓ２へ移動する。Ｓ２への移動は予定の仮想軌道通りに誘導する。
【００５０】
次にＳ２点から上述した図６（ｂ）のようなパターンの刈込みを行う。Ｓ２点にてパラメータデータの指示に従ってカッターを降ろし、図６（ｂ）のように刈り進みグリーンエッジ近くに到達するとパラメータデータの指示によりカッターを上げてグリーンの外へ出る。
【００５１】
グリーン外では、設定された仮想軌道に従って１８０度回転し、再びグリーン内に入りカッターを降ろして刈込みを開始する。以上を繰り返し、Ｇ２にて図６（ｂ）の作業を終了する。この間、位置と方向の補正は上述したと同様に行う。
【００５２】
又、カッターの上下、即ちグリーンエッジ出・入のタイミングに本機の移動を一定時間停止し、方位センサーの０（ゼロ）点補正を行うことによって精度を高めることができる。
【００５３】
図６（ｂ）に示した作業動作を行わせるための設定動作を図７のフローチャートに纏めて説明すると、まず、出発点座標を入力する（ステップＤ１）。すなわち、予め作成したグリーンのデジタルマップ座標上でグリーンキーパーが指定する狩り込みパターンに従って出発点Ｓ２を設定する。
【００５４】
次に、グリーンエッジ侵入位置座標を入力する（Ｄ２）と共にグリーンエッジ侵出位置座標を入力（Ｄ３）する。すなわち、芝刈り機が刈り込みを開始するために、グリーンエッジ侵入点の点Ａ及びグリーンエッジを出る点Ｂの座標を入力する。
【００５５】
次に、走行経路（誘導予定経路）の数式を生成する（Ｄ４）。すなわち、点Ａと点Ｂとを結ぶ直線式を演算し記憶する。この直線式生成に基づき、Ａ点から任意の距離ＬＡ及びＢ点の手前のＬＢの位置にカッターを下降、上昇の指示を付帯情報として入力する。
【００５６】
次に、方向転換開始点・終了点座標入力し（Ｄ５）、最適転回半径（Ｒ）を演算する（Ｄ６）。すなわち、点Ｂの手前ＬＢの位置でカッターを上げ、そのまま直線路を進み、グリーン外へ出て、１８０度方向転回を開始する点と終了点を入力すると同時に転回半径（Ｒ）が演算される。
【００５７】
次に、グリーン内の再入点は直線ＡＢに対してＬ−ｌ（Ｌ：カッター幅、ｌ：ラップ分）の平行移動条件を入力することによって、グリーンエッジ線との交点として求まる。再入点が決まることによって、グリーンエッジから所定距離をおいて、芝刈り機のグリーン外での仮想軌道を直線と円弧の数式で設定し（Ｄ７）、記憶する。以上の動作を繰り返してゴール座標を入力して処理を終了する（Ｄ８）。
【００５８】
（作業終了４） 図６（ｂ）の作業の終了後、図６（ｃ）で示すＳ３へ移動し同様の作業後Ｇ３にて停止する。以上で一グリーンの作業は完了し、管理者の到達を待つか次のグリーンへ自動移動する。
【００５９】
実施の形態４．
以上に述べた実施の形態は、誘導予定経路に従って、補正しながら走行できる場合について説明したが、場合によっては、オペレータが補正を支援するべく適宜進路変更を指示したり、始点における位置及び方向合わせをオペレータが確実に行えるような構成とすることが望ましい。
【００６０】
実施の形態４は、そのような場合を想定して移動体に遠隔指示を行える構成とした場合について説明する。図８は実施の形態４における移動体１Ａ及びモニタ室３０内の構成を示すブロック図である。実施の形態４において、移動体の構成は、図１に示した構成において更に図８に示す構成が付加されているものとする。
【００６１】
図８に示す移動体１Ａは、更に移動体の適所に設けられ、進行方向における所定範囲を撮像することができるカメラ２１と、カメラ２１により撮像された映像信号を処理する映像信号処理部２２と、処理された映像信号を送信すると共に、遠隔指示信号を受信する送受信部２３と、送受信部２３で受けた遠隔指示信号に基づいて駆動部１８を制御する制御部１７Ａとを備えている。
【００６２】
一方、モニタ室３０では、移動体１Ａと送受信を行う送受信部３１と、移動体１Ａから送られた映像信号を映し出すモニタ装置３２と、オペレータが移動体１Ａに対して指示を出す操作部３３とを備えている。
【００６３】
以上の構成において、移動体１Ａが始点に存するときは、その周囲の映像を送信し、モニタ装置３２に映し出す。オペレータはその映像から移動体１Ａの位置及び方向を操作部３３を介して合わせるように操作する。この場合、例えばモニタ装置３２側では正しく位置と方向が合わせられた場合の映像を別に用意しておき、それら映像の重なりが一致するようにオペレータが指示を出すようにすれば、より正確に位置及び方向合わせを行うことが可能となる。
【００６４】
また、移動体１Ａの走行時においては、映像信号をオペレータが監視しながら、誤差がより迅速に収束するように操作部３３を操作するようにすることもできる。勿論この場合も制御部１７Ａは実施の形態１に示した補正動作を行っているが、それにオペレータの操作を加えることにより、移動体１Ａの走行精度をより高めることができる。更にこの場合、映像信号処理部２２において、映像上に移動体の所定部が通過しようとする進路を重ねて表示するようにすれば、オペレータの操作がより容易となる。
【００６５】
実施の形態５．
実施の形態５は更に必要に応じてパターンマッチング処理を行うことにより自動走行を可能とする構成を更に付加した場合について説明する。
図９は実施の形態５において付加される構成を示すブロック図である。
実施の形態５においては、基準パターン記憶部２４とパターンマッチング処理部２５を有し、カメラ２１により撮像されるパターンと基準パターンと比較することにより、マッチング処理を行い、その結果に基づいて制御部１７Ｂは駆動部１８に出力を行うようにする。このパターンの比較において、移動体１Ｂの方位変動に伴うパターンの回転は角速度センサ１４（図１参照）の検出信号に基づいて方位を検出する方位検出部１４Ａを備えて、この方位を用いて回転補正を行った上でパターンマッチング処理を行う。
【００６６】
また基準パターン記憶部２４には、誘導予定経路に沿って予め取得された映像パターンが記憶されており、移動体１Ｂの進行に伴ってこれらパターンを順次読み出してマッチング処理に用いるようにする。このような構成によれば、極めて高精度な移動制御を行うことができるので、例えば芝刈り機の場合、グリーンエッジ周りの芝刈りにおいて適用すると効果的である。
【００６７】
実施の形態６．
実施の形態５は予め進路に基づいた基準パターンを用いるようにしたが、基準パターンを用いずとも、パターンマッチング処理を用いて移動体の進行方向及び走行距離を正確に検出することもできる。
【００６８】
図１０は実施の形態６における構成を示すブロック図である。この構成は、カメラの映像を一時的に記憶する映像記憶部（前ステップ映像記憶部）２６を備え、カメラ２１から出力される生の映像（最新映像）と、前ステップ映像記憶部２６に記憶された前ステップ（例えば１又は数フレーム前）の映像を記憶したものとのマッチングをパターンマッチング処理部２５Ａで行うことで、二つのフレーム間において移動体１Ｃがどの方向にどれだけの距離移動したかを検出するようにしたものである。この検出処理を繰り返すことで、移動体の移動に追従して、その経路を検出することができる。
【００６９】
特に、移動体１Ｃが芝刈り機の場合、芝生は殆どランダム模様と考えられるので、１ステップ前に撮影した映像の一部（例えば映像の中央部を構成する複数（例えば１０２４個）の画素データが１ステップ後に撮影した映像の何処に移動したかをマッチング処理で検出することにより極めて正確に移動距離と方向を検出することができる。この場合も移動体の方位変動に伴う映像の回転は、方位検出部による検出結果に基づいて修正するようにすることができる。
【００７０】
実施の形態７．
実施の形態７は、実経路と誘導予定経路に差が生じた場合に、実施の形態１とは異なる方法で補正を行うようにしたものである。
【００７１】
図１１は本発明の実施の形態７における移動体を示すブロック図である。
この移動体１Ｄは、実施の形態１の構成に加えて、更に移動体１Ｄの絶対方位を検出する地磁気センサ４１を備えることができる。
【００７２】
本実施の形態では、制御部１７Ｄは、角速度センサ１４による検出角度とロータリーエンコーダ１５による検出距離に基づいて移動体１Ｄが走行した場合の検出角度及び検出距離と、位置検出器１６による検出位置及び地磁気センサ４１の検出方位とに基づいて、移動体１Ｄが誘導予定経路に沿うように、補正部１７ａ−１により誘導予定経路を補正しつつ移動体１Ｄを移動制御する。
【００７３】
なお、図１１において、図１と同一の符号は図１で説明したものと同一又は相当物を示しており、ここでの説明を省略する。
【００７４】
制御部１７Ｄは、実施の形態１で説明したように区分けされた部分区間毎にその経路を数式で表し、移動体の走行経路がその数式に沿うように、制御信号を形成して駆動部１８に与える。
【００７５】
すなわち、この実施の形態７において、制御部１７Ｄは実施の形態１において上述した式（１）（２）から任意距離Ｓ１移動した点の座標（ｘ、ｙ）を求めることができ、制御部１７Ｄは上記直線区間においては、このような数式を満たすような座標に従うように駆動部１８を制御する。この場合、進路方向制御に関し、直線区間の移動では、ハンドルを固定し、又は左右車輪回転速度を同一にする。
【００７６】
また、実施の形態１において上述した式（３）（４）から移動距離Ｃ１の地点の座標が求まり、制御部１７Ｄは上記円弧区間においては、このような数式を満たすような座標に従うように駆動部１８を制御する。
【００７７】
この駆動に際し、制御部１７Ｄは、直線部では、駆動部に対し、左右車輪の回転速度が一定、且つ両輪が指定速度になるように指令する。また、円弧部では、回転半径と移動体速度（車輪の回転速度の平均値）から定まる所定の角速度になるように駆動部へ指令する。
【００７８】
すなわち、制御部１７Ｄは移動体１Ｄが誘導予定経路設定部１３に設定された経路に沿うように、パラメータと角速度センサ１４及びロータリーエンコーダ１５の出力に基づいて誘導予定経路を走行（自律走行）させる。しかし、実際には図１２に示すように、初期方位設定誤差や左右車輪回転差のような様々な誤差要因のために予定経路からずれる。そこで、実施の形態７では、位置検出器１６の検出位置および地磁気センサ４１の絶対方位のそれぞれを所定時間ごと（例えば２０ｍｓごと）にサンプリングし、誘導予定経路との誤差を検出し、それを以下のように補正する。
【００７９】
以下、本実施の形態の動作を図１２に基づいて説明する。
誘導予定経路方向に生じる距離誤差Ｘｅ（誘導予定経路上の予定位置と移動体位置から誘導予定経路に垂線を下ろした場合の交点との距離差）については、誘導予定経路に対しその誤差Ｘｅ分だけその後の誘導予定経路の位置をずらす（加減算する）ことによって補正する。例えば、誘導予定経路に対して実経路の距離が小さい場合は、その距離だけ誘導予定経路上における移動体１Ｄの位置を戻す。
【００８０】
方向誤差Θｅと横ずれ量Ｙｅの補正は、左右車輪速度を制御することによって行うことができる。この補正について以下に説明する。
【００８１】
左右車輪に指令する速度の差をＶｄ，ｃｏｍとすると、
Ｖｄ，ｃｏｍ／Ｗ＝ωｒ＋ＫΘ・Θｅ＋Ｋｙ・Ｙｅ／Ｖｒ＋Ｋω・ωｅ （５）
ここで、Ｖｒは移動体の規定速度であり、左右両車輪の平均速度に相当する。
ωｒは予定経路を規定速度で走行する場合の規定角速度を表す。
ωｅは規定角速度ωｒと実走行角速度ωａとの差（ωｒ−ωａ）を表す。
Ｗは車輪幅である。
【００８２】
また、ＫΘ、Ｋｙ、Ｋωは、各誤差を補正するための定数であり、制御の感度を決めるゲイン係数である。これらの定数は、大きく設定すれば、補正制御がシャープになり姿勢が左右に振れてジグザグする傾向になる。逆に小さく設定すれば、制御が緩慢になりなかなか補正されない傾向になる。
【００８３】
芝刈り機の場合、特にグリーンエッジの刈り取りは高精度が要求されるので、ジグザグしないで且つ迅速な補正を行わなければならない。そのために、これらの定数は、
【００８４】
０＜ＫΘ、Ｋｙ、Ｋω＜１０
【００８５】
のように設定することが適切である。
ここで、距離誤差Ｘｅを補正するための時間間隔と、方向誤差Θ及び横ずれ量Ｙｅを補正するための時間間隔は、それぞれ異ならせるようにしても良い。例えば距離誤差を補正するための時間間隔は方向誤差及び横ずれ量を補正するための時間間隔よりも小さくすることで、実経路をより滑らかにすることができる。これらは、移動体１Ｄの使用状態等によって、適宜変更することが可能であることは言うまでもない。
【００８６】
以上、本発明の実施の形態を説明したが、本発明は、上記各実施形態に限定されるものではなく、実施段階ではその要旨を逸脱しない範囲で構成要素を変形して具体化できる。また、上記各実施形態に開示されている複数の構成要素の適宜な組み合わせにより種々の発明を形成できる。例えば、各実施形態に示される全構成要素から幾つかの構成要素を削除してもよい。更に、異なる実施形態に亘る構成要素を適宜組み合わせてもよい。
【図面の簡単な説明】
【００８７】
【図１】実施の形態１を示すブロック図である。
【図２】誘導経路設定部に設定された誘導予定経路の一例を示す図である
【図３】経路の一部を数式で近似する場合について説明する図である。
【図４】誤差と補正方法を説明するための図である。
【図５】実施の形態１の全体動作を示すフローチャートである。
【図６】本実施の形態３として本発明を自動芝刈り機に適用した場合についてその動作を説明する図である。
【図７】実施の形態３の動作を説明するフローチャートである。
【図８】実施の形態４における移動体及びモニタ室内の構成を示すブロック図である。
【図９】実施の形態５の構成を示すブロック図である。
【図１０】実施の形態６の構成を示すブロック図である。
【図１１】実施の形態７の構成を示すブロック図である。
【図１２】実施の形態７の動作を示す説明図である。
【符号の説明】
【００８８】
１，１Ａ，１Ｂ，１Ｃ，１Ｄ 移動体、１１ 操作部、１２ ３Ｄデジタルパラメータ地図情報記憶部、１３ 誘導経路設定部、１４ 角速度センサ、１４Ａ 方位検出部、１５ ロータリーエンコーダ、１６ 位置検出器、１７，１７Ａ，１７Ｂ，１７Ｃ 制御部、１７ａ 補正部、１８ 駆動部、２１ カメラ、２２ 映像信号処理部、２３，３１ 送受信部、２４ 基準パターン記憶部、２５，２５Ａ パターンマッチング処理部、２６ 前ステップ映像記憶部、３０ モニタ室、３２ モニタ装置、３３ 操作部，４１ 地磁気センサ。
【技術分野】
【０００１】
本発明は予め設定した誘導予定経路に従って自動的に走行する移動体に関し、特に地図情報に対応して設定された閉じられた活動領域内の誘導予定経路に従って自動走行を行う移動体に関する。
【背景技術】
【０００２】
近年、人件費の高騰や労働力不足などにより、無人走行車や移動ロボットなどの開発が活発であるが、実用のためには活動領域を高精度に且つスピーディに移動することが求められると共にコストも高くならないことが求められる。
【発明の開示】
【発明が解決しようとする課題】
【０００３】
しかしながら、これら移動体の経路誘導技術としては、ティーチング・プレーバック方式を採用するのが一般的であるため、高精度且つスピーディな誘導を要求する用途には応えられない。例えば、屋外用では精密農業やゴルフ場の芝刈り、屋内用では倉庫内での荷物の運搬などにおいては、スピーディ且つ高精度な移動が要求される。こうした要求を満たす手段がコストの問題で実現できないのが実情である。
【０００４】
例えば、ゴルフ場の自動芝刈り機を例にとり、より詳しく説明すると、従来存在する誘導方法としては、グリーンなどの活動領域内の誘導予定経路を予めオペレータが実際に機械を移動させて、経路を教示（ティーチング）し、それに基づいて移動させるいわゆるティーチング・プレーバック方式が一般的である。
【０００５】
しかしながら、この方式では、一定時間または一定距離移動するごとにＧＰＳなどの手段を使って位置座標を求めるので、経路は点列で記憶されることになり、実走行時はこの点列を辿ってプレーバックするので、次のような誤差を生むことになる。
【０００６】
（１）グリーンエッジのように経路が曲線の場合には、点列を直線的に移動すると円弧部分に誤差を生じる。
（２）人の操作のバラツキによりティーチングエラーが生じる。
（３）移動体がカーブなどで方位角を変える場合、方向転換の指示を受けてから転換量を演算し制御回路が駆動部に指令を出して実際に移動体が転換を始めるまでに時間遅れを生じることによって誤差が生じる。
（４）ＧＰＳの示す位置精度は現在最も精度が高いといわれるＲＴＫ−ＧＰＳでも数ｃｍの誤差を有するので、グリーンエッジのように高精度を要求される用途において、ＧＰＳを用いてティーチングするのは不適切である。すなわち、ティーチングにおいてＧＰＳによる誤差を有し、更に実走行時においてもＧＰＳを用いることにより、誤差が重なりその誤差が２倍にもなるおそれがある。
【０００７】
本発明は上述した問題点を解決するためになされたものであり、安価で高精度に、且つスピーディに閉じられた活動領域を設定された誘導予定経路に沿って移動することができる移動体を提供することを目的とする。
【課題を解決するための手段】
【０００８】
上述した課題を解決するため、本発明は、閉じられた所定の活動領域を自動的に移動する移動体であって、活動領域の地図情報を記憶する記憶手段と、前記地図記憶手段に記憶された地図情報に対応して前記移動体の誘導予定経路を設定する誘導経路設定手段と、前記誘導経路設定手段により設定された誘導予定経路に基づいて前記移動体を誘導制御する制御手段とを備えてなる。
【０００９】
ここで、前記誘導経路設定手段は、前記誘導予定経路を複数区間に分割し、且つ各区間をパラメータを用いた数式で表現し、前記制御手段は、該誘導経路設定手段により設定された数式に基づいて各区間毎に前記移動体を誘導制御する。この構成によれば、数式による連続した予定経路が得られ、ＧＰＳを基準とする場合のように離散的経路に比べて制御し易く、その精度を高めることができる。なお、実施の形態において、前記制御手段は、制御部１７及び角速度センサ１４及びロータリーエンコーダ１５により構成される。
【００１０】
また、前記地図情報は、平面方向及び高さ方向の情報を含む三次元地図情報であり、前記制御手段は、前記誘導経路設定手段により設定される誘導予定経路と前記地図情報とに基づいて前記制御手段が移動体の誘導制御に際して用いる付帯情報を取得し、該付帯情報に基づいて前記移動体を誘導制御する。この構成によれば、例えば予定経路の状況を走行前に知ることができ、駆動制御等の対応準備を行うことができて、応答性を高めることができる。
【００１１】
更には、前記移動体の位置を検出するためのセンサと、前記誘導経路設定手段により設定された誘導予定経路と、前記センサの検出信号に基づいて得られる誘導実経路との誤差を演算する誤差演算手段と、該誤差演算手段により演算された誤差に基づいて前記誘導予定経路を補正する補正手段を備えることができる。実施の形態において、前記センサは位置検出器（３点マーカ検出器）により構成されているが、ＲＴＫ−ＧＰＳなどのＧＰＳを用いても良い。
【００１２】
そして、前記補正手段は複数分割された前記誘導予定経路の各区間を移動体が走行する度に、前記センサの検出信号に基づいて誤差を検出し、該誤差に基づいて次の区間における数式から得られるパラメータを補正することができる。この構成によれば、走行制御に基づく誘導予定経路と実際に走行する実走行経路との誤差が拡大していくことを防止でき、安価で且つ極めて高精度な走行制御を行わせることができる。
【００１３】
また、前記移動体の方位を検出する方位検出手段（例えば地磁気センサ）を備え、前記誤差演算手段は、所定のタイミング毎に前記誘導予定経路と誘導実経路との横ずれ量、方位誤差及び走行距離誤差をそれぞれ演算し、前記補正手段は、前記横ずれ量、方位誤差及び走行距離誤差に基づいて、誘導予定経路を補正するようにしても良い。
【００１４】
この場合に、前記補正手段は、前記走行距離誤差として、誘導予定経路方向に生じる距離誤差Ｘｅについては、誘導予定経路に対しその誤差Ｘｅ分だけその後の誘導予定経路の位置をずらすことによって補正することができる。
【００１５】
また、前記補正手段は、方向誤差Θｅと横ずれ量Ｙｅについては、左右車輪に指令する速度の差をＶｄ，ｃｏｍ、移動体の規定速度をＶｒ、予定経路を規定速度で走行する場合の規定角速度をωｒ、規定角速度ωｒと実走行角速度ωａとの差（ωｒ−ωａ）をωｅ、車輪幅をＷとし、且つＫΘ、Ｋｙ、Ｋωを各誤差を補正するためのゲイン係数とした場合に、
Ｖｄ，ｃｏｍ／Ｗ＝ωｒ＋ＫΘ・Θｅ＋Ｋｙ・Ｙｅ／Ｖｒ＋Ｋω・ωｅ
を満たすように、制御手段に移動体の車輪の駆動制御を行わせて補正を行うことができる。なお、補正を行うタイミング、及びゲイン係数については、移動体の使用環境等により適宜変更設定することができる。
【００１６】
なお、前記移動体に該移動体の所定周りを撮像するカメラを備え、前記制御手段は、該カメラによる撮像映像に基づいて移動体を誘導制御することもできる。
【発明の効果】
【００１７】
以上に詳述したように本発明によれば、安価で高精度に、且つスピーディに閉じられた活動領域を設定された誘導予定経路に沿って移動することができる移動体を提供することができる。
【発明を実施するための最良の形態】
【００１８】
以下、本発明の実施の形態について図面を参照しつつ説明する。
実施の形態１．
図１は本発明の実施の形態における移動体を示すブロック図である。
この移動体１は、移動体１を走行させようとする経路である誘導予定経路などを入力するための操作部１１と、３次元のデジタルパラメータによる地図情報記憶部１２と、誘導予定経路を地図情報に対応させて設定する誘導経路設定部１３と、角速度を検出する角速度センサ１４と、移動距離を検出する距離センサであるロータリーエンコーダ１５と、位置検出器１６と、誘導予定経路と検出角速度と検出距離とに基づいて移動体を誘導移動させながら、位置検出器１６の検出位置に基づいて移動体の今後（先）の誘導予定経路を補正部１７ａにより補正する制御部１７と、制御部１７からの制御信号を受けて移動体を走行駆動させる駆動部１８とを備える。
【００１９】
制御部１７は図示しない移動体の車輪の回転駆動制御と進路方向変更制御（ハンドルの操舵制御による方向変更、若しくは左右駆動輪の回転速度変更制御による方向変更）を行い、これを受けて駆動部１８は車輪を駆動し或いは操舵を行う。
【００２０】
位置検出器１６としては、例えば３点マーカ検出器を採用する。この３点マーカ検出器とは、図２で後述するが、誘導予定経路の付近の所定箇所に光学的に検出できる３つのマークを設けると共に、これらマークにより基準点を設定し、これらマークを光学的に検出することで、基準点に対する相対的位置を検出するものである。勿論、基準点としてこのような相対的な位置検出に対し、緯度や経度で表すことができるＲＴＫ−ＧＰＳ等の絶対的な位置検出器を採用しても良い。
【００２１】
図２は誘導経路設定部に設定された誘導予定経路の一例を示す図である。図２では、出発点Ｓ（ｘ０、ｙ０）、方位角θ、直線長Ｓｎ、円弧半径Ｒｎ、円弧長Ｃｎで示されている。図２に示される誘導予定経路は、ループ状をなし、複数の円弧部分Ｃと直線部分Ｓに区分けされて設定されている。
【００２２】
ここで、図２に示す誘導予定経路は、上述した位置検出器（３点マーカ検出器）１６による位置検出原理に対応するように、活動領域付近の所定箇所に３点（例えばＱ１，Ｑ２，Ｑ３）からなるマーカを設け、これらマーカから導出される所定の点（例えば図示されるＸ，Ｙ軸の交点）を基準点とした座標系ＱＲ（ｘＲ，ｙＲ）で表したものである。もちろん、緯度、経度などの絶対座標系によって設定することもでき、この場合は、ＲＴＫ−ＧＰＳなどの検出信号に対応することが容易である。もっとも、本実施の形態のように、活動領域付近にマーカを設けることで基準点を設け、座標系を構成するようにすると、例えば位置検出器（３点マーカ検出器）１６によるその座標系における位置検出が極めて高精度に行い得る。
【００２３】
制御部１７はこのように区分けされた部分区間毎にその経路を数式で表し、移動体の走行経路がその数式に沿うように、角速度センサ１４とロータリーエンコーダ１５の検出信号に基づいて制御信号を形成して駆動部に与える。ここで、説明の便宜のため、例えば図３に示す経路の一部を数式で近似する場合について説明する。
【００２４】
図３における座標形上の点Ｓ（ｘ０，ｙ０）を起点とした経路において、直線と円弧で設定される数式は、それぞれ次のようになる。
１）Ｓ〜Ｐ１間の直線上を移動体がＳ１移動した点の座標（ｘ、ｙ）を求める式は下式のように表される。
【００２５】
ｙ＝（ｙ１−ｙ０）／（ｘ１−ｘ０）×ｘ＋（ｙ１−ｙ０）／（ｘ１−ｘ０）×ｘ０ （１）
（ｘ−ｘ０）2＋（ｙ−ｙ０）2＝Ｓ１2 （２）
【００２６】
上記（１）（２）式から任意距離Ｓ１移動した点の座標（ｘ、ｙ）を求めることができ、制御部１７は上記直線区間においては、このような数式を満たすような座標に従うように駆動部を制御する。この場合、進路方向制御に関し、直線区間の移動では角速度がゼロになるようにハンドル又は車輪角を固定する。
【００２７】
２）Ｐ１〜Ｐ２間の円弧上を移動体がＰ１からＣ１分移動した点の座標（ｘ、ｙ）を求める式は下式のように表される。
【００２８】
（ｘ１−ｘｒ１）2＋（ｙ−ｙｒ１）2＝Ｒ１2 （３）
（ｘ−ｘ１）２＋（ｙ−ｙ１）２＝（２Ｒ１ｓｉｎ（３６０／（４πＲ１）×Ｃ１） （４）
【００２９】
上記（３）（４）式から移動距離Ｃ１地点の座標が求まり、制御部１７は上記円弧区間においては、このような数式を満たすような座標に従うように駆動部を制御する。この場合、操舵角については、角速度がＶ／Ｒとなるようにハンドルを一定角度切るように固定する。ここで、Ｖは移動速度、Ｒは半径（曲率半径）である。
【００３０】
このようにして、制御部１７は誘導経路設定部１３に設定された経路に従うように、駆動信号を駆動部１８に出力するが、実際には様々な誤差要因により移動体は少しずつ誘導予定経路からずれていく。例えば、方向誤差は角速度センサの零点偏移や角度誤差などで生じ図４（ａ）に示される。また距離誤差は車輪のスリップなどで生じ図４（ｂ）に示される。そこで、本実施の形態では、この方向誤差及び距離誤差を所定区間毎に補正するようにする。
【００３１】
以下、かかる補正方法について、その一例を説明する。
図４（ｃ）において、誘導予定経路に設定した最初の補正点をＡ´´、実際の到達した位置（位置検出器１６により検出される軌跡上の点）を点Ａとし、点Ａの位置を基準座標系に位置付ける。基準座標系への位置付けは、上述したように、誘導予定経路の設定を活動領域付近に基準点（任意の例えば３点のマーカ）を設けた座標系に対して行った場合においては、それら３点マーカの検出により行う。尚、緯度、経度などの絶対座標系で表した場合においては、ＲＴＫ−ＧＰＳなどにより位置を求めて位置付ける。次に、当該座標系において、起点Ｓを支点とし、軌跡ＳＡをθ度ずらしたときの誘導予定経路との交点をＡ´とする。
【００３２】
もし、位置誤差を５ｍｍ以下に設定するならば、区間ＡＡ´≦５ｍｍとなるように、Ａ´´のポイントを決めることになる。以後、等ピッチに補正するとして、区間ＳＡ´´＝区間Ａ´´Ｂ´´＝区間Ｂ´´Ｃ´´…、とＢ´´、Ｃ´´を補正点として設定していく。
【００３３】
移動体が補正点Ａ´´に対応する位置Ａに到達したとき、実際の位置Ａの誘導予定経路における補正点Ａ´´とのずれは、位置検出器１６により得られる軌跡を誘導予定経路と比較して（一致するまで回転シフトして）、その角度差θとして求めることができる。そこで、移動体は方位（進路方向）の補正のため、その角度差θを解消するように、誘導予定経路の次の区間（Ａ´´Ｂ´´）における当所の設定における方向を補正する。
【００３４】
また、この軌跡（実走行経路）のシフトによって、点Ａが誘導予定経路と交わる点をＡ´とすると、シフトによって点Ａからの移動体のその後の誘導予定経路（移動体内のコンピュータに記憶されている計画進路）も同時にシフトされることとなるので、点Ａからその後移動体が移動する予定経路は上記角度補正に伴い誘導予定経路上では、点Ａ´からとされるべきであり、当初設定された誘導予定経路の次の区間が区間Ａ´´Ｂ´´から区間Ａ´Ｂ´´に補正される。つまり距離の補正は当初の次の区間Ａ´´Ｂ´´のＡ´´点を誘導予定経路上で距離誤差（誘導予定経路に対応させた距離誤差）Ａ´Ａ´´だけ後退させることによって行われることとなる。
【００３５】
つまり、現実の距離ずれ量ＡＡ´´の補正を方向の補正と同時に行い、次の予定経路に沿って行くために、次の予定経路の起点をＡ´に設定し直す。さらにＡ´を始点とする予定経路に戻るために次の経路区間の設定値を補正する。すなわち、次の経路区間は当所、区間Ａ´´Ｂ´´であったが、それを区間Ａ´Ｂ´´とし、その区間の数式によるパラメータを変更する。
【００３６】
例えば区間Ａ´Ｂ´´が半径Ｒの円弧だった場合、制御部は移動体が角速度Ｖ／Ｒ＋θ／ｔで駆動されるように駆動部に制御信号を出力する。ここで、Ｖは移動速度、ｔは区間Ａ´Ｂ´´の移動時間である。また区間Ａ´Ｂ´´が直線の場合、θ／ｔとなるようにハンドルの操舵を行う。
【００３７】
以上、本実施の形態の動作について、図５に纏めて説明する。
まず、誘導予定経路を入力する（ステップＳ１）。次にこの誘導予定経路を図２に示すように複数区間に分割し、各区間を数式表示する（ステップＳ２）。そして、制御部は始点から第１区間（その後第ｎ区間）における数式に基づいて駆動制御を行う（ステップＳ３、Ｓ４）。次に第１区間移動（第ｎ区間移動）後にセンサ（位置検出器１６）による検出信号に基づいて移動距離及び方位の誤差を演算処理し（ステップＳ６）、その演算結果に基づいて第２区間（第ｎ＋１区間）を補正し（ステップＳ７、Ｓ８）、その補正値に従って駆動制御を行う（ステップＳ４）。この処理を最終区間終了まで行って、誘導制御が終了する（ステップＳ５）。
【００３８】
実施の形態２．
制御部は、移動体の進行方向前方に上り坂又は下り坂がある場合、直線からカーブに入る場合、又はカーブから直線に入る場合等、移動体の移動に付帯する動作情報を地図情報と誘導予定経路とに基づいて、事前にその情報を取得し、付帯する動作にスムーズに入れるように制御信号を駆動部に出力するようにすることもできる。
【００３９】
この場合、例えば、現在速度と残距離から次の動作を行うまでの時間を算出し、情報の種類と応答速度とによって定められた時間前に制御信号の出力を行い、次への動作をスムーズに行えるようにすることができる。
【００４０】
例えば、上り坂がある場合、地図情報から得られる現在速度に対するその上り勾配の大きさ、その長さなどに対応するエンジンの出力、出力変更時などをテーブルにしておき、制御部は地図情報の付帯情報に基づいて、このテーブルから上記上り坂にかかる直前にパラメータを抽出して駆動信号を出力する。
【００４１】
直線からカーブに入る場合、逆にカーブから直線に入る場合も同様に、ハンドルの切り角の制御信号を、地図情報の付帯情報に基づいて、テーブルから抽出し、その動作に入る直前に出力する。
【００４２】
また、後述する移動体が芝刈り機の場合は、上記パラメータと共に、芝領域の境界に対するカッターの上げ下ろし、又はその角度調整に関するパラメータを同様に用意されたテーブルから抽出し、その制御信号を動作位置直前に出力するようにする。
【００４３】
このような構成によれば、応答速度が遅い場合でも、その動作位置においてスムーズに動作に移ることができ、移動体の機能精度を高めることができる。
【００４４】
実施の形態３．
次に、本発明を自動芝刈り機に適用した場合について図６、図７を用いて説明する。
【００４５】
（１コース設定）
作業に先立って、グリーンキーパーは予め作業経路（仮想軌道）を決定する。作業経路の設定については以下で詳述するが、グリーンキーパーは芝目の関係から作業手順を決めていくつかの作業パターンを用意する。その内から一つを選択する。選択した後の作業手順は次のようなものとする。
【００４６】
（２誘導予定経路の設定）
最初に図６（ａ）のように出発点Ｓ１（予め基準となる正確位置を設定）から高精度を要求されるグリーンエッジの刈込みを行う。高精度を得る最も重要なポイントは初期合わせ（位置と向き）である。従って、管理者は出発点に正しい位置・向きに芝刈機を置く。
【００４７】
（２−１初期合わせの方法）
（１）位置はデジタルマップ上で決めたＳ点に対応する実際のグリーンエッジ近辺にマーキングしておく。あるいは、予め精密測量等で測定した基準点をグリーンサイドに設置する。この基準点にＧＰＳアンテナを置いて基準局とする。基準局と所定の位置関係にある地点に移動局ＧＰＳアンテナを置いて初期化する。初期化が終了した移動局ＧＰＳアンテナを移動体に搭載し、ＧＰＳの示す位置座標がスタート位置座標に合うように移動体を駆動することにおって位置合わせを行う。
【００４８】
（２）方向は、位置合わせと同様、グリーンエッジ近辺に予め設定用治具によって決めても良い。他の方法は、誘導予定経路（数式で表した予定経路）をカッターエッジ等本機の基準となる部位に関係的に表示（例えばオンボードのＬＣＤ）し、実際のグリーンエッジを示す誘導予定経路のライン表示と一致するように設定する。なお、後述（実施の形態７）するように、地磁気センサを用いる場合は地磁気センサにより誘導予定経路の方向に合わせるようにしても良い。
【００４９】
（３作業）
次に芝刈り機は予定経路に沿って作業開始する。
移動時、角速度センサーとロータリーエンコーダで方向と距離の演算を行い指定距離走行後停止する。位置補正は実施の形態１で記述の方法で行う。
停止後、カッターを上げて仮想軌道に沿って、一旦グリーンの外へ出て次の起点Ｓ２へ移動する。Ｓ２への移動は予定の仮想軌道通りに誘導する。
【００５０】
次にＳ２点から上述した図６（ｂ）のようなパターンの刈込みを行う。Ｓ２点にてパラメータデータの指示に従ってカッターを降ろし、図６（ｂ）のように刈り進みグリーンエッジ近くに到達するとパラメータデータの指示によりカッターを上げてグリーンの外へ出る。
【００５１】
グリーン外では、設定された仮想軌道に従って１８０度回転し、再びグリーン内に入りカッターを降ろして刈込みを開始する。以上を繰り返し、Ｇ２にて図６（ｂ）の作業を終了する。この間、位置と方向の補正は上述したと同様に行う。
【００５２】
又、カッターの上下、即ちグリーンエッジ出・入のタイミングに本機の移動を一定時間停止し、方位センサーの０（ゼロ）点補正を行うことによって精度を高めることができる。
【００５３】
図６（ｂ）に示した作業動作を行わせるための設定動作を図７のフローチャートに纏めて説明すると、まず、出発点座標を入力する（ステップＤ１）。すなわち、予め作成したグリーンのデジタルマップ座標上でグリーンキーパーが指定する狩り込みパターンに従って出発点Ｓ２を設定する。
【００５４】
次に、グリーンエッジ侵入位置座標を入力する（Ｄ２）と共にグリーンエッジ侵出位置座標を入力（Ｄ３）する。すなわち、芝刈り機が刈り込みを開始するために、グリーンエッジ侵入点の点Ａ及びグリーンエッジを出る点Ｂの座標を入力する。
【００５５】
次に、走行経路（誘導予定経路）の数式を生成する（Ｄ４）。すなわち、点Ａと点Ｂとを結ぶ直線式を演算し記憶する。この直線式生成に基づき、Ａ点から任意の距離ＬＡ及びＢ点の手前のＬＢの位置にカッターを下降、上昇の指示を付帯情報として入力する。
【００５６】
次に、方向転換開始点・終了点座標入力し（Ｄ５）、最適転回半径（Ｒ）を演算する（Ｄ６）。すなわち、点Ｂの手前ＬＢの位置でカッターを上げ、そのまま直線路を進み、グリーン外へ出て、１８０度方向転回を開始する点と終了点を入力すると同時に転回半径（Ｒ）が演算される。
【００５７】
次に、グリーン内の再入点は直線ＡＢに対してＬ−ｌ（Ｌ：カッター幅、ｌ：ラップ分）の平行移動条件を入力することによって、グリーンエッジ線との交点として求まる。再入点が決まることによって、グリーンエッジから所定距離をおいて、芝刈り機のグリーン外での仮想軌道を直線と円弧の数式で設定し（Ｄ７）、記憶する。以上の動作を繰り返してゴール座標を入力して処理を終了する（Ｄ８）。
【００５８】
（作業終了４） 図６（ｂ）の作業の終了後、図６（ｃ）で示すＳ３へ移動し同様の作業後Ｇ３にて停止する。以上で一グリーンの作業は完了し、管理者の到達を待つか次のグリーンへ自動移動する。
【００５９】
実施の形態４．
以上に述べた実施の形態は、誘導予定経路に従って、補正しながら走行できる場合について説明したが、場合によっては、オペレータが補正を支援するべく適宜進路変更を指示したり、始点における位置及び方向合わせをオペレータが確実に行えるような構成とすることが望ましい。
【００６０】
実施の形態４は、そのような場合を想定して移動体に遠隔指示を行える構成とした場合について説明する。図８は実施の形態４における移動体１Ａ及びモニタ室３０内の構成を示すブロック図である。実施の形態４において、移動体の構成は、図１に示した構成において更に図８に示す構成が付加されているものとする。
【００６１】
図８に示す移動体１Ａは、更に移動体の適所に設けられ、進行方向における所定範囲を撮像することができるカメラ２１と、カメラ２１により撮像された映像信号を処理する映像信号処理部２２と、処理された映像信号を送信すると共に、遠隔指示信号を受信する送受信部２３と、送受信部２３で受けた遠隔指示信号に基づいて駆動部１８を制御する制御部１７Ａとを備えている。
【００６２】
一方、モニタ室３０では、移動体１Ａと送受信を行う送受信部３１と、移動体１Ａから送られた映像信号を映し出すモニタ装置３２と、オペレータが移動体１Ａに対して指示を出す操作部３３とを備えている。
【００６３】
以上の構成において、移動体１Ａが始点に存するときは、その周囲の映像を送信し、モニタ装置３２に映し出す。オペレータはその映像から移動体１Ａの位置及び方向を操作部３３を介して合わせるように操作する。この場合、例えばモニタ装置３２側では正しく位置と方向が合わせられた場合の映像を別に用意しておき、それら映像の重なりが一致するようにオペレータが指示を出すようにすれば、より正確に位置及び方向合わせを行うことが可能となる。
【００６４】
また、移動体１Ａの走行時においては、映像信号をオペレータが監視しながら、誤差がより迅速に収束するように操作部３３を操作するようにすることもできる。勿論この場合も制御部１７Ａは実施の形態１に示した補正動作を行っているが、それにオペレータの操作を加えることにより、移動体１Ａの走行精度をより高めることができる。更にこの場合、映像信号処理部２２において、映像上に移動体の所定部が通過しようとする進路を重ねて表示するようにすれば、オペレータの操作がより容易となる。
【００６５】
実施の形態５．
実施の形態５は更に必要に応じてパターンマッチング処理を行うことにより自動走行を可能とする構成を更に付加した場合について説明する。
図９は実施の形態５において付加される構成を示すブロック図である。
実施の形態５においては、基準パターン記憶部２４とパターンマッチング処理部２５を有し、カメラ２１により撮像されるパターンと基準パターンと比較することにより、マッチング処理を行い、その結果に基づいて制御部１７Ｂは駆動部１８に出力を行うようにする。このパターンの比較において、移動体１Ｂの方位変動に伴うパターンの回転は角速度センサ１４（図１参照）の検出信号に基づいて方位を検出する方位検出部１４Ａを備えて、この方位を用いて回転補正を行った上でパターンマッチング処理を行う。
【００６６】
また基準パターン記憶部２４には、誘導予定経路に沿って予め取得された映像パターンが記憶されており、移動体１Ｂの進行に伴ってこれらパターンを順次読み出してマッチング処理に用いるようにする。このような構成によれば、極めて高精度な移動制御を行うことができるので、例えば芝刈り機の場合、グリーンエッジ周りの芝刈りにおいて適用すると効果的である。
【００６７】
実施の形態６．
実施の形態５は予め進路に基づいた基準パターンを用いるようにしたが、基準パターンを用いずとも、パターンマッチング処理を用いて移動体の進行方向及び走行距離を正確に検出することもできる。
【００６８】
図１０は実施の形態６における構成を示すブロック図である。この構成は、カメラの映像を一時的に記憶する映像記憶部（前ステップ映像記憶部）２６を備え、カメラ２１から出力される生の映像（最新映像）と、前ステップ映像記憶部２６に記憶された前ステップ（例えば１又は数フレーム前）の映像を記憶したものとのマッチングをパターンマッチング処理部２５Ａで行うことで、二つのフレーム間において移動体１Ｃがどの方向にどれだけの距離移動したかを検出するようにしたものである。この検出処理を繰り返すことで、移動体の移動に追従して、その経路を検出することができる。
【００６９】
特に、移動体１Ｃが芝刈り機の場合、芝生は殆どランダム模様と考えられるので、１ステップ前に撮影した映像の一部（例えば映像の中央部を構成する複数（例えば１０２４個）の画素データが１ステップ後に撮影した映像の何処に移動したかをマッチング処理で検出することにより極めて正確に移動距離と方向を検出することができる。この場合も移動体の方位変動に伴う映像の回転は、方位検出部による検出結果に基づいて修正するようにすることができる。
【００７０】
実施の形態７．
実施の形態７は、実経路と誘導予定経路に差が生じた場合に、実施の形態１とは異なる方法で補正を行うようにしたものである。
【００７１】
図１１は本発明の実施の形態７における移動体を示すブロック図である。
この移動体１Ｄは、実施の形態１の構成に加えて、更に移動体１Ｄの絶対方位を検出する地磁気センサ４１を備えることができる。
【００７２】
本実施の形態では、制御部１７Ｄは、角速度センサ１４による検出角度とロータリーエンコーダ１５による検出距離に基づいて移動体１Ｄが走行した場合の検出角度及び検出距離と、位置検出器１６による検出位置及び地磁気センサ４１の検出方位とに基づいて、移動体１Ｄが誘導予定経路に沿うように、補正部１７ａ−１により誘導予定経路を補正しつつ移動体１Ｄを移動制御する。
【００７３】
なお、図１１において、図１と同一の符号は図１で説明したものと同一又は相当物を示しており、ここでの説明を省略する。
【００７４】
制御部１７Ｄは、実施の形態１で説明したように区分けされた部分区間毎にその経路を数式で表し、移動体の走行経路がその数式に沿うように、制御信号を形成して駆動部１８に与える。
【００７５】
すなわち、この実施の形態７において、制御部１７Ｄは実施の形態１において上述した式（１）（２）から任意距離Ｓ１移動した点の座標（ｘ、ｙ）を求めることができ、制御部１７Ｄは上記直線区間においては、このような数式を満たすような座標に従うように駆動部１８を制御する。この場合、進路方向制御に関し、直線区間の移動では、ハンドルを固定し、又は左右車輪回転速度を同一にする。
【００７６】
また、実施の形態１において上述した式（３）（４）から移動距離Ｃ１の地点の座標が求まり、制御部１７Ｄは上記円弧区間においては、このような数式を満たすような座標に従うように駆動部１８を制御する。
【００７７】
この駆動に際し、制御部１７Ｄは、直線部では、駆動部に対し、左右車輪の回転速度が一定、且つ両輪が指定速度になるように指令する。また、円弧部では、回転半径と移動体速度（車輪の回転速度の平均値）から定まる所定の角速度になるように駆動部へ指令する。
【００７８】
すなわち、制御部１７Ｄは移動体１Ｄが誘導予定経路設定部１３に設定された経路に沿うように、パラメータと角速度センサ１４及びロータリーエンコーダ１５の出力に基づいて誘導予定経路を走行（自律走行）させる。しかし、実際には図１２に示すように、初期方位設定誤差や左右車輪回転差のような様々な誤差要因のために予定経路からずれる。そこで、実施の形態７では、位置検出器１６の検出位置および地磁気センサ４１の絶対方位のそれぞれを所定時間ごと（例えば２０ｍｓごと）にサンプリングし、誘導予定経路との誤差を検出し、それを以下のように補正する。
【００７９】
以下、本実施の形態の動作を図１２に基づいて説明する。
誘導予定経路方向に生じる距離誤差Ｘｅ（誘導予定経路上の予定位置と移動体位置から誘導予定経路に垂線を下ろした場合の交点との距離差）については、誘導予定経路に対しその誤差Ｘｅ分だけその後の誘導予定経路の位置をずらす（加減算する）ことによって補正する。例えば、誘導予定経路に対して実経路の距離が小さい場合は、その距離だけ誘導予定経路上における移動体１Ｄの位置を戻す。
【００８０】
方向誤差Θｅと横ずれ量Ｙｅの補正は、左右車輪速度を制御することによって行うことができる。この補正について以下に説明する。
【００８１】
左右車輪に指令する速度の差をＶｄ，ｃｏｍとすると、
Ｖｄ，ｃｏｍ／Ｗ＝ωｒ＋ＫΘ・Θｅ＋Ｋｙ・Ｙｅ／Ｖｒ＋Ｋω・ωｅ （５）
ここで、Ｖｒは移動体の規定速度であり、左右両車輪の平均速度に相当する。
ωｒは予定経路を規定速度で走行する場合の規定角速度を表す。
ωｅは規定角速度ωｒと実走行角速度ωａとの差（ωｒ−ωａ）を表す。
Ｗは車輪幅である。
【００８２】
また、ＫΘ、Ｋｙ、Ｋωは、各誤差を補正するための定数であり、制御の感度を決めるゲイン係数である。これらの定数は、大きく設定すれば、補正制御がシャープになり姿勢が左右に振れてジグザグする傾向になる。逆に小さく設定すれば、制御が緩慢になりなかなか補正されない傾向になる。
【００８３】
芝刈り機の場合、特にグリーンエッジの刈り取りは高精度が要求されるので、ジグザグしないで且つ迅速な補正を行わなければならない。そのために、これらの定数は、
【００８４】
０＜ＫΘ、Ｋｙ、Ｋω＜１０
【００８５】
のように設定することが適切である。
ここで、距離誤差Ｘｅを補正するための時間間隔と、方向誤差Θ及び横ずれ量Ｙｅを補正するための時間間隔は、それぞれ異ならせるようにしても良い。例えば距離誤差を補正するための時間間隔は方向誤差及び横ずれ量を補正するための時間間隔よりも小さくすることで、実経路をより滑らかにすることができる。これらは、移動体１Ｄの使用状態等によって、適宜変更することが可能であることは言うまでもない。
【００８６】
以上、本発明の実施の形態を説明したが、本発明は、上記各実施形態に限定されるものではなく、実施段階ではその要旨を逸脱しない範囲で構成要素を変形して具体化できる。また、上記各実施形態に開示されている複数の構成要素の適宜な組み合わせにより種々の発明を形成できる。例えば、各実施形態に示される全構成要素から幾つかの構成要素を削除してもよい。更に、異なる実施形態に亘る構成要素を適宜組み合わせてもよい。
【図面の簡単な説明】
【００８７】
【図１】実施の形態１を示すブロック図である。
【図２】誘導経路設定部に設定された誘導予定経路の一例を示す図である
【図３】経路の一部を数式で近似する場合について説明する図である。
【図４】誤差と補正方法を説明するための図である。
【図５】実施の形態１の全体動作を示すフローチャートである。
【図６】本実施の形態３として本発明を自動芝刈り機に適用した場合についてその動作を説明する図である。
【図７】実施の形態３の動作を説明するフローチャートである。
【図８】実施の形態４における移動体及びモニタ室内の構成を示すブロック図である。
【図９】実施の形態５の構成を示すブロック図である。
【図１０】実施の形態６の構成を示すブロック図である。
【図１１】実施の形態７の構成を示すブロック図である。
【図１２】実施の形態７の動作を示す説明図である。
【符号の説明】
【００８８】
１，１Ａ，１Ｂ，１Ｃ，１Ｄ 移動体、１１ 操作部、１２ ３Ｄデジタルパラメータ地図情報記憶部、１３ 誘導経路設定部、１４ 角速度センサ、１４Ａ 方位検出部、１５ ロータリーエンコーダ、１６ 位置検出器、１７，１７Ａ，１７Ｂ，１７Ｃ 制御部、１７ａ 補正部、１８ 駆動部、２１ カメラ、２２ 映像信号処理部、２３，３１ 送受信部、２４ 基準パターン記憶部、２５，２５Ａ パターンマッチング処理部、２６ 前ステップ映像記憶部、３０ モニタ室、３２ モニタ装置、３３ 操作部，４１ 地磁気センサ。
【特許請求の範囲】
【請求項１】
閉じられた所定の活動領域を自動的に移動する移動体であって、
活動領域の地図情報を記憶する記憶手段と、
前記記憶手段に記憶された地図情報に対応して前記移動体の誘導予定経路を設定する誘導経路設定手段と、
前記誘導経路設定手段により設定された誘導予定経路に基づいて前記移動体を誘導制御する制御手段と
を備えてなる移動体。
【請求項２】
前記誘導経路設定手段は、前記誘導予定経路を複数区間に分割し、且つ各区間をパラメータを用いた数式で表現し、前記制御手段は、該誘導経路設定手段により設定された数式に基づいて各区間毎に前記移動体を誘導制御することを特徴とする請求項１に記載の移動体。
【請求項３】
前記地図情報は、平面方向及び高さ方向の情報を含む三次元地図情報であり、前記制御手段は、前記誘導経路設定手段により設定される誘導予定経路と前記地図情報とに基づいて前記制御手段が移動体の誘導制御に際して用いる付帯情報を取得し、該付帯情報に基づいて前記移動体を誘導制御することを特徴とする請求項１又は請求項２に記載の移動体。
【請求項４】
前記移動体の位置を検出するための位置検出手段と、
前記誘導経路設定手段により設定された誘導予定経路と、前記位置検出手段の検出信号に基づいて得られる誘導実経路との誤差を演算する誤差演算手段と、
該誤差演算手段により演算された誤差に基づいて前記誘導予定経路を補正する補正手段を備えることを特徴とする請求項１乃至請求項３のいずれかに記載の移動体。
【請求項５】
前記補正手段は複数分割された前記誘導予定経路の各区間を移動体が走行する度に、前記位置検出手段の検出信号に基づいて誤差を検出し、該誤差に基づいて次の区間における数式から得られるパラメータを補正することを特徴とする請求項４に記載の移動体。
【請求項６】
前記移動体の方位を検出する方位検出手段を備え、
前記誤差演算手段は、所定のタイミング毎に前記誘導予定経路と誘導実経路との横ずれ量、方位誤差及び走行距離誤差をそれぞれ演算し、
前記補正手段は、前記横ずれ量、方位誤差及び走行距離誤差に基づいて、誘導予定経路を補正することを特徴とする請求項４に記載の移動体。
【請求項７】
前記補正手段は、前記走行距離誤差として、誘導予定経路方向に生じる距離誤差Ｘｅについては、誘導予定経路に対しその誤差Ｘｅ分だけその後の誘導予定経路の位置をずらすことによって補正することを特徴とする請求項６に記載の移動体。
【請求項８】
前記補正手段は、方向誤差Θｅと横ずれ量Ｙｅについては、
左右車輪に指令する速度の差をＶｄ，ｃｏｍ、移動体の規定速度をＶｒ、予定経路を規定速度で走行する場合の規定角速度をωｒ、規定角速度ωｒと実走行角速度ωａとの差（ωｒ−ωａ）をωｅ、車輪幅をＷとし、且つＫΘ、Ｋｙ、Ｋωを各誤差を補正するためのゲイン係数とした場合に、
Ｖｄ，ｃｏｍ／Ｗ＝ωｒ＋ＫΘ・Θｅ＋Ｋｙ・Ｙｅ／Ｖｒ＋Ｋω・ωｅ
を満たすように、制御手段に移動体の車輪の駆動制御を行わせて補正を行うことを特徴とする請求項７に記載の移動体。
【請求項９】
前記移動体に該移動体の所定周りを撮像するカメラを備え、前記制御手段は、該カメラによる撮像映像に基づいて移動体を誘導制御することを特徴とする請求項１乃至請求項５のいずれかに記載の移動体。
【請求項１】
閉じられた所定の活動領域を自動的に移動する移動体であって、
活動領域の地図情報を記憶する記憶手段と、
前記記憶手段に記憶された地図情報に対応して前記移動体の誘導予定経路を設定する誘導経路設定手段と、
前記誘導経路設定手段により設定された誘導予定経路に基づいて前記移動体を誘導制御する制御手段と
を備えてなる移動体。
【請求項２】
前記誘導経路設定手段は、前記誘導予定経路を複数区間に分割し、且つ各区間をパラメータを用いた数式で表現し、前記制御手段は、該誘導経路設定手段により設定された数式に基づいて各区間毎に前記移動体を誘導制御することを特徴とする請求項１に記載の移動体。
【請求項３】
前記地図情報は、平面方向及び高さ方向の情報を含む三次元地図情報であり、前記制御手段は、前記誘導経路設定手段により設定される誘導予定経路と前記地図情報とに基づいて前記制御手段が移動体の誘導制御に際して用いる付帯情報を取得し、該付帯情報に基づいて前記移動体を誘導制御することを特徴とする請求項１又は請求項２に記載の移動体。
【請求項４】
前記移動体の位置を検出するための位置検出手段と、
前記誘導経路設定手段により設定された誘導予定経路と、前記位置検出手段の検出信号に基づいて得られる誘導実経路との誤差を演算する誤差演算手段と、
該誤差演算手段により演算された誤差に基づいて前記誘導予定経路を補正する補正手段を備えることを特徴とする請求項１乃至請求項３のいずれかに記載の移動体。
【請求項５】
前記補正手段は複数分割された前記誘導予定経路の各区間を移動体が走行する度に、前記位置検出手段の検出信号に基づいて誤差を検出し、該誤差に基づいて次の区間における数式から得られるパラメータを補正することを特徴とする請求項４に記載の移動体。
【請求項６】
前記移動体の方位を検出する方位検出手段を備え、
前記誤差演算手段は、所定のタイミング毎に前記誘導予定経路と誘導実経路との横ずれ量、方位誤差及び走行距離誤差をそれぞれ演算し、
前記補正手段は、前記横ずれ量、方位誤差及び走行距離誤差に基づいて、誘導予定経路を補正することを特徴とする請求項４に記載の移動体。
【請求項７】
前記補正手段は、前記走行距離誤差として、誘導予定経路方向に生じる距離誤差Ｘｅについては、誘導予定経路に対しその誤差Ｘｅ分だけその後の誘導予定経路の位置をずらすことによって補正することを特徴とする請求項６に記載の移動体。
【請求項８】
前記補正手段は、方向誤差Θｅと横ずれ量Ｙｅについては、
左右車輪に指令する速度の差をＶｄ，ｃｏｍ、移動体の規定速度をＶｒ、予定経路を規定速度で走行する場合の規定角速度をωｒ、規定角速度ωｒと実走行角速度ωａとの差（ωｒ−ωａ）をωｅ、車輪幅をＷとし、且つＫΘ、Ｋｙ、Ｋωを各誤差を補正するためのゲイン係数とした場合に、
Ｖｄ，ｃｏｍ／Ｗ＝ωｒ＋ＫΘ・Θｅ＋Ｋｙ・Ｙｅ／Ｖｒ＋Ｋω・ωｅ
を満たすように、制御手段に移動体の車輪の駆動制御を行わせて補正を行うことを特徴とする請求項７に記載の移動体。
【請求項９】
前記移動体に該移動体の所定周りを撮像するカメラを備え、前記制御手段は、該カメラによる撮像映像に基づいて移動体を誘導制御することを特徴とする請求項１乃至請求項５のいずれかに記載の移動体。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【図１２】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【図１２】
【公開番号】特開２００６−４４１２（Ｐ２００６−４４１２Ａ）
【公開日】平成１８年１月５日（２００６．１．５）
【国際特許分類】
【出願番号】特願２００５−１４１３６０（Ｐ２００５−１４１３６０）
【出願日】平成１７年５月１３日（２００５．５．１３）
【出願人】（５９９１５２８１０）有限会社ヒューマンリンク (5)
【Ｆターム（参考）】
【公開日】平成１８年１月５日（２００６．１．５）
【国際特許分類】
【出願日】平成１７年５月１３日（２００５．５．１３）
【出願人】（５９９１５２８１０）有限会社ヒューマンリンク (5)
【Ｆターム（参考）】
[ Back to top ]