(57)【特許請求の範囲】
【請求項１】
互いに独立して操舵可能で進行方向の前後に配置された複数の駆動輪を有し、前記駆動輪に関する情報に基づき走行状態が制御されて所定の走行路に沿って走行する無人車の動輪径パラメータ調整方法であって、
前記複数の駆動輪をそれぞれ直進状態に維持させるとともに回転可能な状態として、外力により前記無人車を所定距離だけ移動させて、前記複数の駆動輪のそれぞれの回転数を検出する第１のステップと、
前記第１のステップを、予め設定された回数ｎ（ｎ：自然数）だけ繰り返し、前記それぞれの回転数をｎ個ずつ検出する第２のステップと、
前記ｎ個の回転数の平均値と前記所定距離とに基づき、駆動輪が１回転したときの移動距離を表す動輪径パラメータを、前記複数の駆動輪の各々について取得する第３のステップと、
前記複数の駆動輪をそれぞれ直進状態に維持させて前記無人車を自走させたときの自走距離が、試験的に走行させるためにあらかじめ設定された目標移動距離に達したことを、それぞれの前記動輪径パラメータを用いて検出する第４のステップと、
前記無人車が前記目標移動距離だけ移動した後、該無人車の実移動距離を計測して、該実移動距離と前記目標移動距離とのずれ量を算出する第５のステップと、
前記目標移動距離に対する前記ずれ量の増減に基づいて、前記ずれ量が小さくなるように前記それぞれの動輪径パラメータを修正する第６のステップと、
を含むことを特徴とする無人車の動輪径パラメータ調整方法。
【請求項２】
前記第６のステップでは、前記各動輪径パラメータの比率を維持したまま、前記各動輪径パラメータを修正することを特徴とする請求項１に記載の無人車の動輪径パラメータ調整方法。
【請求項３】
請求項１又は請求項２に記載の無人車の動輪径パラメータ調整方法に用いる無人車の動輪径パラメータ調整装置であって、
前記複数の駆動輪のそれぞれの回転数を検出する駆動軸エンコーダと、
前記ｎ個の回転数の平均値と前記所定距離とに基づき、駆動輪が１回転したときの移動距離を表す動輪径パラメータを、前記複数の駆動輪の各々について取得するパラメータ取得手段と、
前記目標移動距離に対する前記ずれ量の増減に基づいて、前記ずれ量が小さくなるように前記それぞれの動輪径パラメータを修正するパラメータ修正手段と、
を備えたことを特徴とする無人車の動輪径パラメータ調整装置。
【発明の詳細な説明】
【０００１】
【発明の属する技術分野】
この発明は、工場などの構内に設けられた所定の軌道に沿って自走する無人車の動輪径パラメータ調整方法／装置に関する。
【０００２】
【従来の技術】
従来、各種の工場では、ファクトリーオートメーション化の一環として無人化が押し進められており、構内での物資の搬送が無人車により行われている。この無人車は、地上側に設置された制御部からの指令に従って、搬送すべき物資が置かれた場所まで走行路（軌道）を自走して所定の位置に停止し、物資を積載した後に目的地まで搬送するようになっている。
【０００３】
すなわち、この種の無人車の操舵軸および駆動軸には、各軸の回転角を検出するためのエンコーダが取り付けられており、各エンコーダの出力パルスが移動速度演算部および操舵確度演算部によりそれぞれカウントされて、一定時間（制御周期）内に変化したパルス数を基に操舵角と移動速度とが逐次算出される。無人車は、地上の制御部から指令を受けると、逐次算出される操舵角と移動速度とに基づいて車体中心の位置・姿勢・速度を推定し、これらの推定値と目標値との偏差が小さくなるように操舵角や駆動輪を制御しながら目的地まで自走する。
【０００４】
ここで、無人車の移動距離や移動速度の算出は、エンコーダの出力パルス数を用いて算出され、例えば移動速度は、下式により算出される。
移動速度＝｛（パルス数／パルス分解能）×動輪径パラメータ｝／制御周期
ただし、上式において、「パルス分解能」は、動輪１回転あたりのエンコーダの出力パルス数を表し、「動輪径パラメータ」は、動輪が１回転したときの駆動軸の移動距離（すなわち動輪の円周長）を表し、「制御周期」は、出力パルス数の検出に要した時間を表す。
【０００５】
【発明が解決しようとする課題】
ところで、無人車に同じ径の車輪を取り付けても、車体のバランスや走行路状態などにより車輪の変形量が異なり、実質的な車輪の径（以下「等価車輪径」と称す）が異なったものになる。このため、車輪が１回転したときの移動距離（車輪の円周長）が動輪径パラメータと一致しなくなり、動輪径パラメータに誤差が生じる結果、移動速度の算出精度が低下する。
【０００６】
とりわけ、それぞれ独立して操舵可能な複数の駆動輪を装備する無人車において動輪径パラメータに誤差が生じると、次のような問題がある。
（１）各駆動輪の動輪径パラメータに誤差があり、しかも各駆動輪の動輪径パラメータの比率にも誤差が生じた場合、各駆動輪の移動速度が異なる結果、互いの車輪が干渉し合い、各駆動輪を駆動するモータに対して過負荷が加わる現象が発生する。特に、図２に示すように、車体の進行方向と平行な直線上に駆動輪が配置された場合、この現象が顕著に現れる。
【０００７】
（２）各車輪の動輪径パラメータの比率に誤差はないが、動輪径パラメータ自体に誤差がある場合、エンコーダの出力パルス数から推定される移動距離に誤差が生じ、目標とする移動距離に対する誤差が大きくなる。この結果、停止すべき位置を通り越して停止したり、その手前で停止するなど、無人車の停止位置にずれが生じ、停止精度が低下する。この停止精度の低下は、移動距離が長くなるほど顕著となる。この場合、停止精度の低下を抑制するためには、走行中に進行方向の移動距離を逐次補正する必要がある。また、停止時の位置ずれ量が大きい場合、位置決め動作が必要になり、無人車を所定の停止位置に位置させるまでに時間を要する。
【０００８】
この発明は、上記事情に鑑みてなされたもので、複数の駆動輪を有する無人車の動輪径パラメータを正確かつ容易に調整することができる無人車の動輪径パラメータ調整方法／装置を提供することを課題とする。
【０００９】
【課題を解決するための手段】
上記課題を解決するため、この発明は以下の構成を有する。すなわち、この発明にかかる無人車の動輪径パラメータ調整方法は、互いに独立して操舵可能で進行方向の前後に配置された複数の駆動輪を有し、前記駆動輪に関する情報に基づき走行状態が制御されて所定の走行路に沿って走行する無人車の動輪径パラメータ調整方法であって、前記複数の駆動輪をそれぞれ直進状態に維持させるとともに回転可能な状態として、外力により前記無人車を所定距離だけ移動させて、前記複数の駆動輪のそれぞれの回転数を検出する第１のステップと、前記第１のステップを、予め設定された回数ｎ（ｎ：自然数）だけ繰り返し、前記それぞれの回転数をｎ個ずつ検出する第２のステップと、前記ｎ個の回転数の平均値と前記所定距離とに基づき、駆動輪が１回転したときの移動距離を表す動輪径パラメータを、前記複数の駆動輪の各々について取得する第３のステップと、前記複数の駆動輪をそれぞれ直進状態に維持させて前記無人車を自走させたときの自走距離が、試験的に走行させるためにあらかじめ設定された目標移動距離に達したことを、それぞれの前記動輪径パラメータを用いて検出する第４のステップと、前記無人車が前記目標移動距離だけ移動した後、該無人車の実移動距離を計測して、該実移動距離と前記目標移動距離とのずれ量を算出する第５のステップと、前記目標移動距離に対する前記ずれ量の増減に基づいて、前記ずれ量が小さくなるように前記それぞれの動輪径パラメータを修正する第６のステップと、を含むことを特徴とする。
【００１０】
この方法によれば、車体のバランスや走行路状態などにより各車輪の変形量が異なり、実質的な駆動輪の径が異なる場合であっても、複数の駆動輪を有する無人車の各動輪径パラメータを正確かつ容易に調整することが可能となる。
【００１１】
前記第６のステップでは、前記各動輪径パラメータの比率を維持したまま、前記各動輪径パラメータを修正することを特徴とする。
【００１３】
この発明にかかる無人車の動輪径パラメータ調整装置は、請求項１又は請求項２に記載の無人車の動輪径パラメータ調整方法に用いる無人車の動輪径パラメータ調整装置であって、前記複数の駆動輪のそれぞれの回転数を検出する駆動軸エンコーダと、記ｎ個の回転数の平均値と前記所定距離とに基づき、駆動輪が１回転したときの移動距離を表す動輪径パラメータを、前記複数の駆動輪の各々について取得するパラメータ取得手段と、前記目標移動距離に対する前記ずれ量の増減に基づいて、前記ずれ量が小さくなるように前記それぞれの動輪径パラメータを修正するパラメータ修正手段と、を備えたことを特徴とする。
【００１４】
この装置によれば、車体のバランスや走行路状態などにより各車輪の変形量が異なり、実質的な駆動輪の径が異なる場合であっても、複数の駆動輪を有する無人車の各動輪径パラメータを正確かつ容易に調整することが可能となる。
【００１５】
【発明の実施の形態】
以下、図面を参照しながら、この発明の実施の形態を説明する。
図１に、この発明の実施の形態にかかる動輪径パラメータ調整装置が適用された無人車が備える車輪の駆動軸および操舵軸の制御系を示す。この実施の形態にかかる無人車は、後述する図２に示すように、互いに独立して操舵可能な複数の駆動輪１００Ａ，１００Ｂを有し、これら駆動輪に関する情報に基づき走行状態が制御されて所定の走行路に沿って走行するように構成されており、駆動輪が操舵輪を兼ねたものとなっている。
なお、動輪径パラメータは、前述したように、駆動輪が１回転したときの移動距離（動輪の円周長）を表すものであって、無人車の走行状態を制御する上で用いられる上述の「駆動輪に関する情報」の一つである。
【００１６】
図１において、符号１０Ａは、当該無人車が備える駆動輪の回転数を検出するための駆動軸エンコーダであり、駆動輪の駆動軸に取り付けられている。符号１０Ｂは、各駆動輪の操舵角を検出するための操舵角エンコーダであり、駆動輪の操舵軸に取り付けられている。
【００１７】
また、符号１１Ａは、駆動軸エンコーダ１０Ａの出力パルスを受けて、駆動輪の移動速度を演算する移動速度演算部であり、符号１１Ｂは、操舵軸エンコーダ１０Ｂの出力パルスを受けて、駆動輪の操舵角を演算する操舵角演算部である。符号１２は、移動速度演算部１１Ａにより演算された移動速度と操舵角演算部１１Ｂにより演算された操舵角とから無人車の車体位置や姿勢を推定する位置・姿勢推定部である。
【００１８】
また、符号１３は、軌道データ１４を参照して、位置・姿勢推定部１２による推定結果に基づき、車体位置および姿勢を制御するための速度指令および操舵指令を発する位置・姿勢制御部である。この軌道データ１４は、無人車の駆動軸および操舵軸を制御する上で目標とされる車体位置や姿勢を与えるもので、無人車の走行路として設定された軌道に関するデータである。
【００１９】
符号１５Ａは、位置・姿勢制御部１３から速度指令を受けて、駆動軸に結合されたモータ（図示なし）を駆動制御するための駆動軸モータドライバである。符号１５Ｂは、位置・姿勢制御部１３から操舵指令を受けて、操舵軸に結合されたモータ（図示なし）を駆動制御するための操舵軸モータドライバである。
【００２０】
符号２０は、複数の駆動輪間の干渉を抑制するように各動輪径パラメータを取得するパラメータ取得部であり、符号２１は、パラメータ取得部２０により取得された各動輪径パラメータの相対関係を維持し且つ後述する目標移動距離と実移動距離とが一致するように各動輪径パラメータを修正するパラメータ修正部である。これらパラメータ取得部２０およびパラメータ修正部２１は、この実施の形態にかかる動輪径パラメータ調整装置を構成する。
【００２１】
図２に、この実施の形態にかかる無人車が備える車輪の配置を示す。同図に示すように、この無人車は、複数の駆動輪１００Ａ，１００Ｂと、従動輪１００Ｃを有しており、駆動輪１００Ａ，１００Ｂは、車体１００の進行方向の中心軸を表すＸ軸と平行な直線ＸＬ上に配置され、車体１００の左側に配置されている。また、従動輪１００Ｃは、車体１００の略中央でＸ軸と直交するＹ軸上であって車体１００の右側に配置されている。駆動輪１００Ａ，１００Ｂは、互いに独立に操舵可能となっており、その操舵軸は、図２の紙面に対し略垂直に設置されている。また、従動輪１００Ｃの回転軸は、Ｙ軸と平行をなすように固定されている。
【００２２】
なお、図１に示す例では、１台の駆動軸エンコーダ１０Ａが示されているが、この駆動軸エンコーダは、図２に示す駆動輪１００Ａ，１００Ｂの各駆動軸にそれぞれ個別に設置されている。同様に、操舵軸エンコーダ１０Ｂも各駆動輪の操舵軸に個別に設置されている。これにより、各駆動輪の回転数および操舵角が個別に検出可能なようになっている。
【００２３】
以下、上述のように構成された無人車の動輪径パラメータの調整装置による動輪径パラメータ調整方法について、図３および図４に示すフローチャートに沿って説明する。
この動輪径パラメータ調整方法は、パラメータ取得部２０により複数の駆動輪の各動輪径パラメータを取得する第１段階と、第１段階で取得された各動輪径パラメータをパラメータ修正部２１により修正する第２段階からなる。
【００２４】
まず、図３に示すフローに沿って、パラメータ取得部２０による第１段階を説明する。
ステップＳ１０：操舵軸のサーボ系（図示なし）をオン状態とし、動輪径パラメータの調整中に駆動輪１００Ａ，１００Ｂの操舵軸が回転しないように、各駆動輪の操舵軸を直進状態に維持させる。このとき、駆動輪１００Ａ，１００Ｂのブレーキを閉じ、駆動輪が回転しないように固定する。
ステップＳ１１：続いて、駆動軸エンコーダ１０Ａの値をクリアする。そして、駆動輪１００Ａ，１００Ｂのブレーキを開き、駆動輪が回転可能な状態とする。
【００２５】
ステップＳ１２：続いて、手動により無人車を所定の距離Ｌだけ移動させる。すなわち、この無人車の各駆動輪が駆動状態になく且つ各駆動輪間に干渉が生じない状態で、作業員が手で押しながら無人車を所定の距離Ｌだけゆっくりと移動させ、駆動軸エンコーダ１０Ａにより、無人車が所定の距離Ｌだけ移動したときの駆動輪の回転数を検出する。つまり、実際に荷重が加わって変形した状態での各動輪の純然たる回転数を検出する。このとき、操舵軸のサーボ系がオン状態となっており、無人車が直進状態に制御されるので、無人車は、直線距離で所定の距離Ｌだけ移動する。この所定の距離Ｌは、移動速度演算部１１Ａによる移動速度の演算が可能な距離であれば足りるが、駆動軸エンコーダ１０Ａの検出精度を向上させる観点から、長いほど好ましい。
【００２６】
また、この場合の走行路として、各駆動輪１００Ａ，１００Ｂが、これら駆動輪の等価車輪径に応じた相対関係を保って回転するような走行路が選ばれる。具体的には、凹凸が少なく、平面的であり、しかも移動中に車輪がスリップしないような状態の走行路が選ばれる。このような走行路を選ぶことにより、互いに干渉を生じない状態にあるときの複数の駆動輪１００Ａ，１００Ｂの各回転状態が正しく再現され、各駆動輪の間の相互関係が適切に再現される。
【００２７】
ステップＳ１３：続いて、所定の距離Ｌだけ移動した位置で無人車を停止させ、駆動輪１００Ａ，１００Ｂのブレーキを閉じる。そして、そのときの各駆動軸に設置された駆動軸エンコーダ１０Ａの出力値Ｐｉを記憶し、これを取得する。つまり、無人車が所定の距離Ｌだけ移動したときの各駆動輪の回転数が検出されて取得される。
【００２８】
次に、上述のステップＳ１１〜Ｓ１３を、予め設定された回数ｎ（ｎ：自然数）だけ繰り返し、各駆動輪について、駆動軸エンコーダ１０Ａからｎ個の出力値Ｐi（ｉ＝１〜ｎ）を取得する。
ステップＳ１４：つまり、駆動軸エンコーダ１０Ａの出力値の取得回数が、設定回数ｎに達し、手動による移動が終了したか否かを判定する。ここで、駆動軸エンコーダ１０Ａの出力値の取得回数が設定回数ｎに達していない場合には（ステップＳ１４：ＮＯ）、上述のステップＳ１１に処理が戻され、取得回数が設定回数ｎに達するまでステップＳ１１〜ステップＳ１３を繰り返し実行する。
【００２９】
ステップＳ１５：続いて、駆動軸エンコーダ１０Ａの出力値の取得回数が設定回数ｎに達した場合（ステップＳ１４：ＹＥＳ）、取得された駆動軸エンコーダ１０Ａの出力値Ｐiと所定の距離Ｌとに基づき、複数の駆動輪１００Ａ，１００Ｂについて、各動輪径パラメータを算出する。
【００３０】
具体的には、下式（１）により、駆動軸エンコーダ１０Ａの出力値Ｐｉ（ｉ＝１〜ｎ）の平均値Ｐaveを算出する。
Ｐave＝Ｐsum／ｎ                                     ・・・（１）
ただし、式（１）において、Ｐsumは、ｎ個の出力値Ｐi（ｉ＝１〜ｎ）の合計値であり、ｎは設定回数（すなわち出力値Ｐiの個数）である。
【００３１】
次に下式（２）により、駆動輪１００Ａの動輪径パラメータＱａと、駆動輪１００Ｂの動輪径パラメータＱｂとをそれぞれ算出する。
Ｑａ＝Ｌ／Ｍａ                                       ・・・（２ａ）
Ｑｂ＝Ｌ／Ｍｂ                                       ・・・（２ｂ）
【００３２】
ただし、式（２ａ），（２ｂ）において、Ｌは上述の所定の距離である。Ｍａは、無人車が所定の距離Ｌを移動した際の駆動輪１００Ａの駆動軸の回転数であり、駆動輪１００Ａに設けられた駆動軸エンコーダの出力値の平均値Ｐaveをそのエンコーダ分解能で除した値である。Ｍｂは、無人車が所定の距離Ｌを移動した際の駆動輪１００Ｂの駆動軸の回転数であり、駆動輪１００Ｂに設けられた駆動軸エンコーダの出力値の平均値Ｐaveをそのエンコーダ分解能で除した値である。各エンコーダ分解能は、駆動軸が１回転したときのエンコーダの出力パルスの数として与えられる。
【００３３】
ステップＳ１６：最後に、操舵軸のサーボ系をオフ状態とする。
以上により、動輪径パラメータ調整の第１段階の処理が終了し、駆動輪１００Ａ，１００Ｂについて、これら駆動輪間の干渉を抑制するように各動輪径パラメータが取得される。
【００３４】
この第１段階における動輪径パラメータを調整によれば、各車輪の速度差が小さくなり、各動輪間の干渉が緩和される。これにより、走行精度が向上すると共に、各駆動輪を駆動するためのモータに不要な負荷が加わることがなくなるので消費電力が低減し、しかも車体振動が低下するなどの効果が得られる。
【００３５】
次に、上述の第１段階（ステップＳ１０〜Ｓ１６）により各駆動輪の動輪径パラメータを取得した後、以下に説明するように、第２段階（ステップＳ２０〜Ｓ２２）として、各動輪径パラメータの相対関係を維持し且つ後述する目標移動距離と実移動距離とが一致するように、パラメータ修正部２１により各動輪径パラメータを修正する。
【００３６】
ステップＳ２０：まず、上述の第１段階により取得された動輪径パラメータをそのまま用い、後述する目標移動距離として設定された所定の距離Ｌだけ無人車を自走させて停止させる。このとき、無人車が直進状態を維持するように操舵が制御される。また、この場合の走行路は、無人車が実際に運用される環境と同じ条件に設定される。
【００３７】
ここで、上述の目標移動距離は、上述の第１段階で取得された動輪径パラメータを修正する上で試験的に走行させるために設定されたものである。この実施の形態では、目標移動距離として、上述の第１段階で用いた所定の距離Ｌを採用したが、これに限定されることなく、適宜設定すればよい。
【００３８】
ステップＳ２１：無人車が、目標移動距離（所定の距離Ｌ）を自走した後、当該無人車が実際に移動した距離（すなわち実移動距離）を計測して、進行方向における実移動距離と目標移動距離との間のずれ量Δｘ（差分）を算出する。換言すれば、目標とする停止位置に対する実際の停止位置のずれ量を算出する。このずれ量Δｘは、無人車が目標の停止位置を行き過ぎた場合にプラスの値をとり、逆に、目標の停止位置に行き足りない場合にマイナスの値をとる。
【００３９】
ステップＳ２２：続いて、ずれ量Δｘが小さくなるように、上述の第１段階で取得された動輪径パラメータＱａ，Ｑｂを下式（３）により修正し、動輪径パラメータＱＡ，ＱＢを得る。
ＱＡ＝｛（Ｌ＋Δｘ）／Ｌ｝×Ｑａ                     ・・・（３ａ）
ＱＢ＝｛（Ｌ＋Δｘ）／Ｌ｝×Ｑｂ                     ・・・（３ｂ）
【００４０】
この第２段階における動輪径パラメータを調整によれば、実移動距離と目標移動距離とが一致するように動輪径パラメータが修正されるので、走行精度（走行中の進行方向の位置精度）と停止精度とが向上する。
【００４１】
ここで、上式（３ａ）と上式（３ｂ）とを比較すると、第１段階で取得された動輪径パラメータＱａ，Ｑｂに対して共通の係数｛（Ｌ＋Δｘ）／Ｌ｝が乗算されて、動輪径パラメータＱＡ，ＱＢが算出されており、修正前と修正後の各動輪径パラメータの比率が維持される。このことは、第１段階で取得された動輪径パラメータの相対関係が維持されることを意味する。したがって、上述の第１段階および第２段階を経て得られた動輪径パラメータを用いれば、駆動輪間の干渉を生じることがなく、しかも実移動速度が目標移動速度と一致し、目標とする位置に正確に無人車を停止させることが可能となる。
【００４２】
なお、この実施の形態によれば、短い距離を走行する場合、外界センサによる進行方向の補正処理（上記第２段階）を省くことが可能となる。
また、長い距離を走行する場合、補正処理を行う距離間隔を長くすることが可能となる。
さらに、外界センサなどの地上側設備の規模を縮小することができる。
【００４３】
以上、この発明の実施の形態を説明したが、この発明は、この実施の形態に限られるものではなく、発明の要旨を逸脱しない範囲の設計変更等があっても本発明に含まれる。例えば、上述の実施の形態では、駆動軸エンコーダ１０Ａの出力値Ｐiを平均化するようにしたが、これに限定されることなく、１回の測定で精度良く駆動輪の回転数を検出できれば、駆動軸エンコーダ１０Ａの出力値Ｐiを平均化する処理を省いてもよい。
【００４４】
また、上述の実施の形態では、第１段階で各駆動輪の駆動径パラメータを取得し、この動輪径パラメータを第２段階で修正することにより動輪径パラメータ調整を行うものとしたが、これに限定されることなく、例えば、第１段階で、各駆動輪の動輪径パラメータの比率（相対関係を表す要素）を算出し、第２段階で、特定の駆動輪について実移動距離を満足する動輪径パラメータを算出し、この第２段階で算出された特定の動輪径パラメータに、第１段階で算出された比率を乗じることにより、他の動輪径パラメータを調整するものとしてもよい。
【００４５】
【発明の効果】
以上説明したように、この発明によれば、複数の駆動輪間の干渉を抑制するように各動輪径パラメータを取得し、この取得された各動輪径パラメータの相対関係を維持し且つ目標移動距離と実移動距離とが一致するように前記各動輪径パラメータを修正するようにしたので、複数の駆動輪を装備する無人車の動輪径パラメータを正確かつ容易に調整することができる。
【００４６】
また、前記複数の駆動輪の回転数を検出するための各エンコーダの値をクリアし、当該無人車を所定の距離だけ移動させ、前記各エンコーダの出力値を取得し、前記取得された各エンコーダの出力値と前記所定の距離とに基づき前記複数の駆動輪の各動輪径パラメータを算出するようにしたので、複数の駆動輪間の干渉を抑制するように各動輪径パラメータを取得することができる。
【００４７】
さらに、前記取得された動輪径パラメータを用いて当該無人車を目標移動距離だけ自走させて停止させ、自走後に当該無人車の実移動距離を計測して該実移動距離と前記目標移動距離との間のずれ量を算出し、前記ずれ量が小さくなるように前記取得された各動輪径パラメータを修正するようにしたので、前記取得された各動輪径パラメータの相対関係を維持し且つ目標移動距離と実移動距離とが一致するように前記各動輪径パラメータを修正することができる。
【図面の簡単な説明】
【図１】  この発明の実施の形態にかかる動輪径パラメータ調整方法が適用される無人車の駆動軸および操舵軸の制御系を示すブロック図である。
【図２】  この発明の実施の形態にかかる無人車の駆動輪および従動輪の配置を説明するための図である。
【図３】  この発明の実施の形態にかかる動輪径パラメータ調整方法の第１段階での処理の流れを示すフローチャートである。
【図４】  この発明の実施の形態にかかる動輪径パラメータ調整方法の第２段階での処理の流れを示すフローチャートである。
【符号の説明】
１０Ａ：動輪軸エンコーダ
１０Ｂ：操舵軸エンコーダ
１１Ａ：移動速度演算部
１１Ｂ：操舵角演算部
１２：位置・姿勢推定部
１３：位置・姿勢制御部
１４：軌道データ
１５Ａ：駆動軸モータドライバ
１５Ｂ：操舵軸モータドライバ
１００：車体
１００Ａ，１００Ｂ：駆動輪
１００Ｃ：従動輪
Ｓ１０〜Ｓ１６，Ｓ２０〜Ｓ２２：ステップ
【図１】
0004232289.tif 000002
【図２】
0004232289.tif 000003
【図３】
0004232289.tif 000004
【図４】
0004232289.tif 000005