(57)【特許請求の範囲】
【請求項１】
筐体の側面に前記筐体の重心回りに等角度で３つ以上の駆動輪を配置し、前記駆動輪と前記重心を結ぶ直線を軸として前記駆動輪を回転するようにした多軸移動体の前記各駆動輪を駆動する駆動装置の制御パラメータ決定装置において、
搭載物を搭載後における前記多軸移動体の重心位置と搭載前の前記多軸移動体単体の重心位置とがずれた状態で置き、
前記搭載物の搭載前の重心位置を通る駆動輪の軸に平行な方向に向かって前記平行な方向の両側に線対称に配置される２つの駆動輪を選択して駆動し、一定速度に到達するまで前記多軸移動体を直線運動させ、前記駆動された２つの駆動輪に発生するトルクを検出し該トルク比を求め、前記駆動された２つの駆動輪を結ぶ軸線を前記トルク比で分配した第１分配点を求め、
前記多軸移動体を前回とは異なる駆動輪でかつ前記選択した駆動輪と前記筐体の重心回りに１８０度離れた位置にない駆動輪を選択し、該選択した駆動輪の駆動軸と平行な方向に向かって一定速度に到達するまで前記多軸移動体を直線運動させて前回と同様にして第２分配点を求め、前記第１分配点と前記第２分配点とに基づいて前記搭載物の搭載後における前記多軸移動体の重心位置と搭載前の前記多軸移動体単体の重心位置との距離を推定し、
前記距離を前記制御パラメータとして演算することを特徴とする多軸移動体の各駆動装置の制御パラメータ決定装置。
【請求項２】
前記パラメータ決定装置によって決定された各駆動装置の制御パラメータを基に各駆動装置に最適なゲイン調整をすることを特徴とする請求項１記載の多軸移動体の各駆動装置の制御パラメータ決定装置。
【請求項３】
式（１）から前記搭載物の重量を推定することを特徴とする請求項１記載の多軸移動体の各駆動装置の制御パラメータ決定装置。
(T1+T2)・cosθ = (M1+M2)・R2・dω/dt + M3・R2・dω/dt   ・・・式（１）
ここで、T1：一方の駆動輪の検出トルク、
T2：他方の駆動輪の検出トルク、
θは多軸移動体と駆動輪との角度で、多軸移動体に取り付けられた駆動輪の数によって変化し、θ=（１８０−３６０／駆動輪数）／２、
M1:多軸移動体の重量、
M2:搭載物Ｗの重量、
ω：駆動輪の角速度、
M3:駆動輪の重量、
R:駆動輪の半径、である。
【請求項４】
前記搭載物を前記多軸移動体単体の重心位置に乗せて移動する場合に速度指令が与えられた駆動輪のゲインを予め算出し、
次ぎに前記多軸移動体上に搭載する場合に前記搭載物の搭載後における前記多軸移動体の重心位置と搭載前の前記多軸移動体単体の重心位置とをずれた状態で置き、
式（２）から駆動輪の前記トルク比を求め、式（３）〜（５）から各駆動輪のゲインを修正することを特徴とする請求項１記載の多軸移動体の各駆動装置の制御パラメータ決定装置。
T3a: T3b: T3c = (T3a1 * T3a2):( T3b1 * T3a2):( T3c2 * T3a1) ・・・・・・式（２）
ここで、Ｔ３a、Ｔ３ｂ、Ｔ３ｃ  ：駆動輪のトルク、
Ｔ３a１、Ｔ３ｂ１：一方向に直線運動させたときの駆動輪３a、３ｂのトルク、
Ｔ３a２、Ｔ３ｃ２：他の方向に直線運動させたときの駆動輪３a、３ｃのトルク、
G3a  = G ・T3a /(T3a + T3b + T3c)  ・・・・・・式（３）
G3b = G ・T3b /(T3a + T3b + T3c)  ・・・・・・式（４）
G3c = G ・T3c /(T3a + T3b + T3c)  ・・・・・・式（５）
ここで、G3a ,G3b ,G3c：各駆動輪の補正後のゲイン、
G：搭載物の推定重量を重心位置上で移動する時の駆動輪のゲイン
【請求項５】
請求項１記載の多軸移動体の各駆動装置の制御パラメータ決定装置を備えたことを特徴とする多軸移動体装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、搬送車など移動体の走行制御方法に関するもので、特に、多軸移動体の各駆動装置の制御パラメータ決定方法およびその装置に関する。
【背景技術】
【０００２】
電動機を駆動輪とした搬送車や移動台車に荷物を載せて走行させる場合、荷物の重量が判明していないと、駆動輪を速度制御する場合の最適な制御ゲインを設定することができず安定に走行制御することができない。
従来の移動体による荷物の重量測定方法として圧力センサや重量計測器上に荷物を搭載した状態の移動体を載せて重量を計測し、それを駆動輪の制御パラメータとして演算し、速度制御系の最適なゲインを求めていた。
一方、センサや測定装置を用いない重量測定方法として、特許文献１〜４の例があった。これらは、搭載物を載置台に搭載した時の載置台に備えた前輪の変形による外周変化の下での走行距離と搭載物無しの場合の走行距離とを比較して荷重を求めていた。また、他の搭載物の重量推定方法として、移動体を一定速度になるまで加速させ、この際に得られたトルクと加速度から移動体の搭載物の重量を推定していた。この重量を制御パラメータとして演算し、速度制御系のゲイン制御信号を演算することで安定な走行制御を実現していた。
【特許文献１】特開２００４-０９１０７９号公報
【特許文献２】特開昭６０-１６９９１２号公報（第４頁、図１）
【特許文献３】特開昭６０-  ５８３１３号公報（第６頁、図３）
【特許文献４】特開昭６２-６５９１０９号公報（第５頁、図３）
【発明の開示】
【発明が解決しようとする課題】
【０００３】
従来例の複数の駆動装置を持つ移動体は、一定速度まで加速する時に検出したトルクから搭載物の重量を推定していたが、重心位置のずれを考慮していないため、移動体の走行時に各駆動装置に適正な指令を与えることができず、安定な走行ができなかった。
本発明は、移動体上に重量不明の搭載物を任意の場所に配置しても、搭載物の重量および重心位置のずれを検出、または演算によって推定し、この重量および重心位置ずれを制御パラメータとして演算し、自動的に各駆動装置のゲイン調整することで安定な走行を実現できる多軸移動体の制御パラメータ決定方法を提供することを目的とする。
また、従来例では路面の動摩擦係数を考慮していないため、路面状況に応じた制御パラメータの決定ができず駆動輪を安定に制御することができなかった。本発明は、等速運動中に各駆動装置で検出させる動摩擦係数μも制御パラメータとして演算し、自動的に各駆動装置のゲイン調整することで安定な走行を実現できる多軸移動体の制御パラメータ決定方法を提供することを目的とする。
【課題を解決するための手段】
【０００４】
上記問題を解決するため、本発明は、次のように構成したものである。
請求項１記載の多軸移動体の各駆動装置の制御パラメータ決定装置の発明は、筐体の側面に前記筐体の重心回りに等角度で３つ以上の駆動輪を配置し、前記駆動輪と前記重心を結ぶ直線を軸として前記駆動輪を回転するようにした多軸移動体の前記各駆動輪を駆動する駆動装置の制御パラメータ決定装置において、
搭載物を搭載後における前記多軸移動体の重心位置と搭載前の前記多軸移動体単体の重心位置とがずれた状態で置き、
前記搭載物の搭載前の重心位置を通る駆動輪の軸に平行な方向に向かって前記平行な方向の両側に線対称に配置される２つの駆動輪を選択して駆動し、一定速度に到達するまで前記多軸移動体を直線運動させ、前記駆動された２つの駆動輪に発生するトルクを検出し該トルク比を求め、前記駆動された２つの駆動輪を結ぶ軸線を前記トルク比で分配した第１分配点を求め、
前記多軸移動体を前回とは異なる駆動輪でかつ前記選択した駆動輪と前記筐体の重心回りに１８０度離れた位置にない駆動輪を選択し、該選択した駆動輪の駆動軸と平行な方向に向かって一定速度に到達するまで前記多軸移動体を直線運動させて前回と同様にして第２分配点を求め、前記第１分配点と前記第２分配点とに基づいて前記搭載物の搭載後における前記多軸移動体の重心位置と搭載前の前記多軸移動体単体の重心位置との距離を推定し、
前記距離を前記制御パラメータとして演算することで前記多軸移動体を安定に走行制御するようにしたのである。
【０００５】
請求項２記載の発明は、請求項１記載の多軸移動体の各駆動装置の制御パラメータ決定装置において、前記パラメータ決定装置によって決定された各駆動装置の制御パラメータを基に各駆動装置に最適なゲイン調整をすることで前記多軸移動体を安定に走行制御するようにしたのである。
【０００６】
請求項３記載の発明は、請求項１記載の多軸移動体の各駆動装置の制御パラメータ決定装置において、式（１）から前記搭載物の重量を推定することで前記多軸移動体を安定に走行制御するようにしたのである。
(T1+T2)・cosθ = (M1+M2)・R2・dω/dt + M3・R2・dω/dt   ・・・式（１）
ここで、T1：一方の駆動輪の検出トルク、
T2：他方の駆動輪の検出トルク、
θは多軸移動体と駆動輪との角度で、多軸移動体に取り付けられた駆動輪の数によって変化し、θ=（１８０−３６０／駆動輪数）／２、
M1:多軸移動体の重量、
M2:搭載物Ｗの重量、
ω：駆動輪の角速度、
M3:駆動輪の重量、
R:駆動輪の半径、である。
【０００７】
請求項４記載の発明は、請求項１記載の多軸移動体の各駆動装置の制御パラメータ決定装置において、前記搭載物を前記多軸移動体単体の重心位置に乗せて移動する場合に速度指令が与えられた駆動輪のゲインを予め算出し、
次ぎに前記多軸移動体上に搭載する場合に前記搭載物の搭載後における前記多軸移動体の重心位置と搭載前の前記多軸移動体単体の重心位置とをずれた状態で置き、
式（２）から駆動輪の前記トルク比を求め、式（３）〜（５）から各駆動輪のゲインを修正することで前記多軸移動体を安定に走行制御するようにしたのである。
T3a: T3b: T3c = (T3a1 * T3a2):( T3b1 * T3a2):( T3c2 * T3a1) ・・・・・・式（２）
ここで、Ｔ３a、Ｔ３ｂ、Ｔ３ｃ  ：駆動輪のトルク、
Ｔ３a１、Ｔ３ｂ１：一方向に直線運動させたときの駆動輪３a、３ｂのトルク、
Ｔ３a２、Ｔ３ｃ２：他の方向に直線運動させたときの駆動輪３a、３ｃのトルク、
G3a  = G ・T3a /(T3a + T3b + T3c)  ・・・・・・式（３）
G3b = G ・T3b /(T3a + T3b + T3c)  ・・・・・・式（４）
G3c = G ・T3c /(T3a + T3b + T3c)  ・・・・・・式（５）
ここで、G3a , G3b ,G3c：各駆動輪の補正後のゲイン、
G：搭載物の推定重量を重心位置上で移動する時の駆動輪のゲイン
請求項５記載の多軸移動体装置の発明は、請求項１記載の多軸移動体の各駆動装置の制御パラメータ決定装置を備えたことで前記多軸移動体を安定に走行制御するようにしたのである。
【発明の効果】
【０００８】
請求項１に記載の発明によると、多軸移動体を一定速度に到達するまで直線に走行させたときに発生する各駆動装置間のトルク比から重心位置のずれを推定し、制御パラメータとして演算し、各駆動装置に最適なゲイン調整をすることで、多軸移動体の重心位置を中心とした安定な走行制御を実現することができる。
【０００９】
請求項２に記載の発明によると、パラメータ決定装置によって決定された各駆動装置の制御パラメータを基に各駆動装置に最適なゲイン調整をすることで、安定な走行制御を実現することができる。
請求項３に記載の発明によると、式（１）から搭載物の重量を推定することで、安定な走行制御を実現することができる。
【００１０】
請求項４に記載の発明によると、式（２）〜（５）から各駆動輪のゲインの修正が簡単かつ正確に行えるようになる。
請求項５に記載の発明によると、請求項１記載の多軸移動体の各駆動装置の制御パラメータ決定装置を備えたことで、多軸移動体の重心位置を中心とした安定な走行制御を実現する多軸移動体装置が得られる。
【発明を実施するための最良の形態】
【００１１】
以下、本発明の実施の形態について図を参照して説明する。
【実施例１】
【００１２】
〈重心の推定方法〉
図１は、本発明の多軸移動体１の例で，（ａ）は上面図、（ｂ）は正面図である。
筐体２の側面に３つの駆動輪３（３ａ〜３ｃ）が互いに１２０度の間隔で取り付けられている。各駆動輪３ａ〜３ｃの外周にはそれぞれ駆動輪３ａ〜３ｃの軸方向３ａｓ〜３ｃｓに回転する多数の車輪５が配置されていることで、駆動輪３ａ〜３ｃは回転方向３ａｒ〜３ｃｒのほかに軸方向３ａｓ〜３ｃｓにも移動することができる。多軸移動体１は、その上面中央に搭載物Ｗを載せて重心位置４を中心に走行、回転する。
【００１３】
図２は本発明の三輪式多軸移動体の上に搭載物を載せた時の上面図である。
図において、多軸移動体１の上面に重量不明の搭載物Ｗを多軸移動体１の重心位置４からずらして載せた状態を示している。このように配置することで搭載物Ｗを含む多軸移動体１の重心は重心位置４から重心位置７へ移動する。
【００１４】
図３は図２のように搭載物Ｗを多軸移動体１上に中心からそれた位置に置いた際の搭載物Ｗの重量および重心位置を推定する方法のフローチャート８である。
まず、多軸移動体１上の搭載物Ｗの重量変化があったかどうかを判断し（９ａ）、判断結果、変化がなければステップ１５ａへ飛んでそのまま走行を続ける。
また、判断結果、変化があればまず一方向への直線運動ルーチンに移り、ステップ１０ａで一方向への直線運動をし、各駆動輪３ａ〜３ｃでの各トルク検出を行い（ステップ１１ａ）、駆動輪３ａ〜３ｃ間のトルク比検出を行う（ステップ１２ａ）。
次に、他の方向への直線運動ルーチンに移り、前のステップ１０ａでの直線運動とは異なる方向に直線運動を行う（ステップ１０ｂ）。各駆動輪３ａ〜３ｃでの各トルク検出を行い（ステップ１１ｂ）、駆動輪３ａ〜３ｃ間のトルク比検出を行う（ステップ１２ｂ）。
その後、ステップ１３ａで搭載物Ｗの重量と重心位置を推定し、これを制御パラメータとして演算し、各駆動輪３のゲイン補正を行った後（ステップ１４ａ）、多軸移動体１を走行させる（ステップ１５ａ）。
【００１５】
以上のフローチャート８の手法について図４〜図６を用いて具体的に説明する。
まず、図３のフローチャート８の１つめのルーチンを図４のようにして実行する。図４は本発明の三輪式多軸移動体を直線走行させた時の上面図である。図４のように搭載物Ｗを搭載した状態で重心位置４を通る駆動輪３ｃの軸に平行な方向１９ｃに向かって多軸移動体１を一定速度に達するまで直線運動させる（図３のステップ１０ａ）。この場合、駆動輪３aと３ｂには速度指令を与えるが、駆動輪３ｃには速度指令を与えず、駆動輪３ｃの外周に配備した車輪５を空転させる。
重心位置７が重心位置４から偏心している結果、直線運動している駆動輪３a、３ｂから反力として検出される駆動輪３aのトルクＴ3a1２０と駆動輪３ｂのトルクＴ3b1２１を検出する（図３のステップ１１ａ）と、両者に差が生じる。そこで、駆動輪３a、３ｂのそれぞれの取り付け部を結ぶ軸線２２をこのトルク比（Ｔ3a1：Ｔ3b1）で分配する。この場合、線分２３は駆動輪３ｂのトルクＴ3b1２１による長さとなり、線分２４は駆動輪３ａのトルクＴ3a1による長さ２０となり、この比で分配点２５が求まる。
【００１６】
次に、図３のフローチャート８の２つめのルーチンを図５のようにして実行する。図５は本発明の三輪式多軸移動体を他の方向へ直線走行させた時の上面図である。図５は図４の直線方向とは異なる直線方向へ直線運動させるもので、図において、重心位置４を通る駆動輪３ｂの軸方向に平行な方向１９ｂに向かって多軸移動体１を一定速度に達するまで直線運動 １０ｂさせる。
この場合、駆動輪３a、３ｃには速度指令を与えるが、駆動輪３ｂには速度指令を与えず、駆動輪３ｂの外周に配備した車輪５を空転させる。
この結果、重心位置７が重心位置４から偏心していることにより駆動輪３a、３ｃから反力として検出される駆動輪３aのトルクＴ3a2 ２６と駆動輪３ｃのトルクＴ3c2２７に差が生じる。駆動輪３a、３ｃのそれぞれの取り付け部を結ぶ軸線２８をこのトルク比（Ｔ3a2：Ｔ3c2）で分配する。この場合、線分２９は駆動輪３aのトルクＴ3a2２６による長さ、線分３０は駆動輪３ｃのトルクＴ3c2２７による長さとなり、分配点３１が求まる。
【００１７】
図６は本発明の三輪式多軸移動体に搭載物を載せた時の重心位置の求め方を説明する上面図である。図６から判るように、図４で求めた分配点２５から駆動輪３ｃの軸に平行な直線３２と、図５で求めた分配点３１から駆動輪３ｂの軸に平行な直線３３の交点から重心位置７を推定することができる。
【００１８】
重心位置７の位置をさらに精度よく求めるため、重心位置４を通る駆動輪３aの軸３ａｓ（図１ａ参照）方向に平行な方向１９ａ（図６）にも多軸移動体１を直線運動させてもよい。この場合、駆動輪３ｂ、３ｃには速度指令を与えるが、駆動輪３ａには速度指令を与えず、駆動輪３ａの外周に配備した車輪５を空転させて、駆動輪３ｂのトルクと駆動輪３ｃのトルクとを測定する。重心が移動していることからトルクに差が生じるので、駆動輪３ｂ、３ｃのそれぞれの取り付け部を結ぶ軸線をこのトルク比で分配すれば分配点が求まる。そこでこの分配点から駆動輪３ａの軸に平行な直線を引くと、図４および図５で求めた重心位置を通ることで推定重心が正確であることが確認できる。また、先の重心位置からずれていれば、３つの推定重心の描く三角形の重心を取る等の補正をすればよい。
【実施例２】
【００１９】
〈搭載物の重量推定方法〉
次に、搭載物Ｗの重量の推定方法を説明する。
図４で示した直線運動の方向１９ｃに向かって多軸移動体１を一定速度Ｖに達するまで直線運動させた際に得られた駆動輪３a、３ｂから反力として検出されたトルクＴ3a1 １７、Ｔ3b1１８とそのときの駆動輪３の各速度ωから以下の式によって算出する。
(T3a1+T3b1)・cosθ = (M1+M2)・R2・dω/dt + M3・R2・dω/dt ・・・・・式（１）
ここで、M1:多軸移動体１の重量、M2:搭載物Ｗの重量、M3:駆動輪３の重量
R:駆動輪３の半径
式（１）から搭載物Ｗの重量Ｍ2を推定することができる。θは多軸移動体１と駆動輪３との角度であり、多軸移動体１に取り付けられた駆動輪３の数によって変化する。駆動輪が二輪の時はθ= 0、三輪の時はθ= 30°となる。
【００２０】
同様に、方向１９ｂに向かって多軸移動体１を一定速度に達するまで直線運動させた場合も駆動輪３a、３ｃから検出されたトルクＴ3a2 ２３、Ｔ3c2２４を用いて式（１）から搭載物Ｗの重量を推定することができる。
【実施例３】
【００２１】
〈駆動輪のゲインの算出方法〉
次に、搭載物Ｗの推定重量を多軸移動体１の重心位置４上に載せて移動する場合の駆動輪３のゲインＧをあらかじめ算出する。
図４で示した直線運動の方向方向１９ｃに向かって多軸移動体１を一定速度に達するまで直線運動させたときに得られた駆動輪３a、３ｂのトルク比（Ｔ3a1：Ｔ3b1）と、図５で示した直線運動の方向１９ｂに向かって多軸移動体１を一定速度に達するまで直線運動させたときに得られた駆動輪３a、３ｃのトルク比（Ｔ3a2：Ｔ3c2）から、３個の駆動輪３a、３ｂ、３ｃのトルク比（Ｔ3a：Ｔ3b：Ｔ3c）を、式（２）により求める。
T3a: T3b: T3c = (T3a1 * T3a2):( T3b1 * T3a2):( T3c2 * T3a1) ・・・・式（２）
このトルク比（Ｔ3a：Ｔ3b：Ｔ3c）用いて、以下の式（３）、（４）、（５）によって各駆動輪３a、３ｂ、３ｃのゲインを修正する。
G3a  = G ・T3a /(T3a + T3b + T3c)  ・・・・・・式（３）
G3b = G ・T3b /(T3a + T3b + T3c)  ・・・・・・式（４）
G3c = G ・T3c /(T3a + T3b + T3c)  ・・・・・・式（５）
ここで、G3a ,G3b ,G3c：各駆動輪の補正後のゲイン、
G：搭載物Ｗの推定重量を重心位置４上で移動する時の駆動輪３のゲイン
である。
このようにして算出した補正後のゲインを、駆動輪３の速度制御、位置制御に使用する。
【実施例４】
【００２２】
〈駆動輪のゲインの別の算出方法〉
次に、各駆動輪３の別の補正ゲイン算出方法について説明する。
図７は本発明の三輪式多軸移動体の別のゲイン補正方法のフローチャートである。図７におけるフローチャート４０は、まず、多軸移動体１上の搭載物Ｗの重量変化があったかどうかを判断し（９ｂ）、判断結果、変化がなければステップ１５ｂへ飛んでそのまま走行を続ける。また、判断結果、変化があればステップ４１へ移って回転運動をし、各駆動輪３ａ〜３ｃでの各トルク検出を行い（ステップ１１ｃ）、駆動輪３ａ〜３ｃ間のトルク比検出を行う（ステップ１２ｃ）。
次に搭載物Ｗの重量を推定し（ステップ４２）、これを制御パラメータとして演算し、各駆動輪３のゲイン補正を行った後（ステップ１４ｂ）、多軸移動体１を走行させる（ステップ１５ｂ）。
【００２３】
次に、図７のフローチャート４０の手法の具体的なやり方を図８を用いて説明する。図８は本発明の三輪式多軸移動体の上面図で、三輪式多軸移動体１の駆動輪３aの位置を角度ゼロとする重心位置４を中心とした円周４２（点線）を示したものである。重心位置４を中心に１回転で一定角速度に達するまで多軸移動体１を回転運動する（図７のステップ４１）ように速度指令を与えると、駆動輪３a、３ｂ、３ｃのトルクＴ3a、Ｔ3b、Ｔ3cは、点線で示す円周４２上の重心位置７の位置によって図９のような線図が得られる。図９は本発明の三輪式多軸移動体における重心位置と各駆動輪のトルクの相関関係を示す線図である。図において、（ａ）は駆動輪３aのトルク変化、（ｂ）は駆動輪３ｂのトルク変化、（ｃ）は駆動輪３ｃのトルク変化をそれぞれ示している。
図に示すように、駆動輪３a、３ｂ、３ｃのトルクＴ3a、Ｔ3b、Ｔ3cは、円周４３上の重心位置７の位置によってそれぞれの位相が２/３πずれたサイン波を描き、各サイン波の振幅の大きさは、搭載物Ｗの重量に比例して増減する。
例えば、重心位置７が図８のように多軸移動体１の上の点線で示す円周上に置かれていた場合、駆動輪３aのトルク、駆動輪３ｂのトルク、駆動輪３ｃのトルクのそれぞれの大きさはそれぞれ図中の矢印４４、４５、４６の大きさとなる。
この各駆動輪のトルク大きさ４４、４５、４６の長さをトルク比（Ｔ3a：Ｔ3b：Ｔ3c）として用いて上記式（３）、（４）、（５）から各駆動輪のゲインを修正することができる。
【実施例５】
【００２４】
〈二輪式多軸移動体の場合の搭載物重量および重心位置の推定方法〉
次に、図１０のように多軸移動体１の駆動輪３が２輪の場合の搭載物重量および重心位置の推定方法について説明する。
〈二輪式多軸移動体の場合の重心位置の推定方法〉
まず、二輪式多軸移動体の場合の重心位置の推定方法について説明する。
図１０は本発明の二輪式多軸移動体の例で、（ａ）は上面図、（ｂ）は側面図、図１１は本発明の二輪式多軸移動体の上に搭載物を載せた時の上面図である。
図１０において、筐体２の互いの反対面に駆動輪３a、３ｂが設けられ、搭載物の無いときの重心位置は４となっている。また、筐体２には転倒防止のため補助輪４７が取り付けられている。
図１１のように多軸移動体１の上面に重量不明の搭載物Ｗを置くことで、多軸移動体１と搭載物Ｗを含む重心は、重心位置４から重心位置７へと移動する。
【００２５】
図１２は本発明の二輪式多軸移動体における重心および重量推定方法とゲイン補正方法のフローチャートである。図１２に示すフローチャート４８は、まず、多軸移動体１上の搭載物Ｗの重量変化があったかどうかを判断し（ステップ９ｃ）、判断結果、変化がなければステップ１５ｃへ飛んでそのまま走行を続ける。
また、判断結果、変化があれば、ステップ１０ｃで直線運動をし、各駆動輪３ａ、３ｂでの各トルク検出を行い（ステップ１１ｄ）、駆動輪３ａ、３ｂ間のトルク比検出を行う（ステップ１２ｄ）。その後、ステップ１３ｃで搭載物Ｗの重量と重心位置を推定し、これを制御パラメータとして演算し、各駆動輪３ａ、３ｂのゲイン補正を行った後（ステップ１４ｃ）、多軸移動体１を走行させる（ステップ１５ｃ）。
【００２６】
フローチャート４８の手法の具体的なやり方を説明する。
図１３は本発明の二輪式多軸移動体に搭載物を載せた時の重心位置の求め方を説明する上面図である。図１３のように多軸移動体１を方向４９に向かって一定速度Ｖに達するまで直線運動させる（図１２の１０ｃ）と、重心位置７が重心位置４から偏心していることにより駆動輪３a、３ｂで検出されるトルクはそれぞれＴ3a3５０、Ｔ3b3 ５１となる。
駆動輪３a、３ｂの取り付け軸を結ぶ軸線５２を、直線運動１０ｃで得られたトルク比（Ｔ3a3：Ｔ3b3）で分割される箇所に重心位置７が存在すると推定できる。この場合、重心位置７はトルクＴ3b3５１による長さ５３と、トルクＴ3a3５０よる長さ５４で分割される分配線５５の上となる。
【実施例６】
【００２７】
〈二輪式多軸移動体の場合の搭載物重量の推定方法〉
次に、二輪式多軸移動体の場合の搭載物重量の推定方法について説明する。
搭載物Ｗの重量は、式（６）からＭ2として推定することができる。
T3a +T3b = (M1+M2)・R2・dω/dt + M3・R2・dω/dt ・・・・・式（６）
ここで、M1:多軸移動体１の重量、M2:搭載物Ｗの重量、M3:駆動輪３の重量
R:駆動輪３の半径
【実施例７】
【００２８】
〈等速度運動による制御パラメータ決定方法〉
次に、多軸移動体１を等速度運動させた時に動摩擦係数を推定し、制御パラメータとして演算して前記多軸移動体を安定に走行制御させる方法について説明する。
多軸移動体１を等速度運動させた時、駆動輪３で検出されるトルクＴｍは式（７）のようになる。ここでは静摩擦係数は無視する。
Tm = μ・(M1+M2) ・g・r / S  ・・・・・式（７）
ここで、μ:動摩擦係数、M1:多軸移動体１の重量、M2:搭載物Ｗの重量、
g：重力加速度、ｒ:駆動輪３の半径、S : 駆動輪３の数である。
式（７）から動摩擦係数μが推定される。制御パラメータとして演算して駆動輪３のゲイン調整に使用する。
ここで、G3a’= G3a・(T + Tm) /T        ・・・・・・式（７）
G3b’= G3b・(T + Tm) /T        ・・・・・・式（８）
G3c’= G3c・(T + Tm) /T        ・・・・・・式（９）
ここで、G3a’, G3b’, G3c’：各駆動輪の補正後のゲイン
G3a, G3b, G3c：搭載物重量、重心位置推定後の修正した各駆動輪のゲイン
T：搭載物重量、重心位置推定後の速度指令におけるトルク値、である。
【産業上の利用可能性】
【００２９】
本発明の多軸移動体は、搭載物を多軸移動体上に搭載後、一定速度または一定各速度で移動させることで搭載物の重量、重心位置を推定し、自動的に制御パラメータを求めるため、任意の重量の搭載物を載せても制御の設定の手間が省け、多軸移動体の運用に利便性向上に期待できる。
【図面の簡単な説明】
【００３０】
【図１】本発明の三輪式多軸移動体の例で、（ａ）は上面図、（ｂ）は正面図である。
【図２】本発明の三輪式多軸移動体の上に搭載物を載せた時の上面図である。
【図３】本発明の三輪式多軸移動体の重心および重量推定方法とゲイン補正方法      のフローチャートである。
【図４】本発明の三輪式多軸移動体を直線走行させた時の上面図である。
【図５】本発明の三輪式多軸移動体を別の方向へ直線走行させた時の上面図である。
【図６】本発明の三輪式多軸移動体に搭載物を載せた時の重心位置の求め方を説明する上面図である。
【図７】本発明の三輪式多軸移動体のゲイン補正方法フローチャートである。
【図８】本発明の三輪式多軸移動体の上面図である。
【図９】本発明の三輪式多軸移動体における重心位置と各駆動輪のトルクの相関関係を示す線図である。
【図１０】本発明の二輪式多軸移動体の例で、（ａ）は上面図、（ｂ）は側面図である。
【図１１】本発明の二輪式多軸移動体の上に搭載物を載せた時の上面図である。
【図１２】本発明の二輪式多軸移動体における重心および重量推定方法とゲイン補正方法のフローチャートである。
【図１３】本発明の二輪式多軸移動体に搭載物を載せた時の重心位置の求め方を説明する上面図である。
【符号の説明】
【００３１】
１  多軸移動体
２  筐体
３a、３ｂ、３ｃ  駆動輪
４  搭載物のないときの重心位置
７  搭載物のあるときの重心位置
５  駆動輪の外周にあって駆動輪の軸方向に回転できる車輪
４７  補助輪
Ｗ  搭載物
【図１】
0004840301.tif 000002
【図２】
0004840301.tif 000003
【図３】
0004840301.tif 000004
【図４】
0004840301.tif 000005
【図５】
0004840301.tif 000006
【図６】
0004840301.tif 000007
【図７】
0004840301.tif 000008
【図８】
0004840301.tif 000009
【図９】
0004840301.tif 000010
【図１０】
0004840301.tif 000011
【図１１】
0004840301.tif 000012
【図１２】
0004840301.tif 000013
【図１３】
0004840301.tif 000014