(57)【要約】【課題】台車設置面が傾いていたり荷重の変動等があっても、安定した倒立制御を行う。【解決手段】車輪１２，１３と、車輪１２，１３に支持される車体１０とを備え、その重心が車輪の回転軸より上方に位置する移動台車であって、車輪１２，１３を駆動する駆動手段１４，１５と、車体の傾斜角度及び傾斜角速度の中の少なくとも１つを検出する第１検出手段１９と、第１検出手段１９により検出された検出値を少なくとも１つの入力値として、車体１０が倒立を維持するように駆動手段１４，１５の制御指令値を算出する制御手段２０とを有する。この制御手段２０は、外乱に対して安定倒立可能なようにロバスト性を有する。【選択図】  図１
2004295430.tif 000002
【特許請求の範囲】
【請求項１】
車輪と、該車輪に支持される車体とを備え、その重心が車輪の回転軸より上方に位置する移動台車であって、
車輪を駆動する駆動手段と、
車体の傾斜角度及び傾斜角速度の中の少なくとも１つを検出する第１検出手段と、
前記第１検出手段により検出された検出値を少なくとも１つの入力値として、車体が倒立を維持するように駆動手段の制御指令値を算出する制御手段と、を有し、
前記制御手段は、外乱に対して安定倒立可能なようにロバスト性を有することを特徴とする移動台車。
【請求項２】
台車の略水平面内における位置、速度及び加速度の中の少なくとも１つを特定可能な物理量を検出する第２検出手段と、台車の略水平面内における位置、速度及び加速度の中の少なくとも１つに関して目標値を入力する手段と、をさらに有し、
前記制御手段は、前記目標値入力手段により入力された目標値と前記第２検出手段で検出された物理量から特定される現在値との偏差をさらに入力値として、その偏差を小さくするように駆動手段の制御指令値を算出することを特徴とする請求項１に記載の移動台車。
【請求項３】
前記第１検出手段はジャイロセンサであり、前記制御手段はジャイロセンサで検出された傾斜角速度を入力値とすることを特徴とする請求項１又は２に記載の移動台車。
【請求項４】
２以上の車輪と、該車輪に支持される車体とを備え、その重心が車輪の回転軸より上方に位置する移動台車であって、
２以上の車輪の１つを駆動する第１駆動手段と、
第１駆動手段で駆動されない他の車輪を駆動する第２駆動手段と、
車体の傾斜角度及び傾斜角速度の中の少なくとも１つを検出する第１検出手段と、
台車の略水平面内における位置、速度及び加速度の中の少なくとも１つを特定可能で、かつ、台車の略水平面内における向き、旋回速度及び旋回加速度の少なくとも１つを特定可能な物理量を検出する第２検出手段と、
台車の略水平面内における並進方向に関する第１目標値と、台車の略水平面内における回転方向に関する第２目標値を入力する目標値入力手段と、
前記第１検出手段により検出された検出値と、前記目標値入力手段により入力された第１目標値と前記第２検出手段で検出された物理量から特定される第１目標値に対応する現在値との偏差を入力値として、その偏差を小さくすると共に車体が倒立を維持するように各駆動手段の制御指令値をそれぞれ算出する第１制御指令値算出手段と、
前記目標値入力手段により入力された第２目標値と前記第２検出手段で検出された物理量から特定される第２目標値に対応する現在値との偏差を少なくとも１つの入力値として、その偏差を小さくするように各駆動手段の制御指令値をそれぞれ算出する第２制御指令値算出手段と、
第１制御指令値算出手段で算出された制御指令値と、第２制御指令値算出手段で算出された制御指令値とを加算する手段とを、を有することを特徴とする移動台車。
【請求項５】
前記第１制御指令値算出手段は、外乱に対して安定倒立可能なようにロバスト性を有することを特徴とする請求項４に記載の移動台車。
【請求項６】
前記の各車輪は同一の回転軸上に配置され、前記車体は前記回転軸に対して直交する方向に傾斜可能に支持されていることを特徴とする請求項４又は５に記載の移動台車。
【請求項７】
２以上の車輪と、該車輪に支持される車体と、２以上の車輪の１つを駆動する第１駆動手段と、第１駆動手段で駆動されない他の車輪を駆動する第２駆動手段と、第１駆動手段と第２駆動手段に制御指令値を出力する制御コンピュータと、車体の傾斜角度及び傾斜角速度の中の少なくとも１つを検出する第１検出手段と、台車の略水平面内における位置、速度及び加速度の中の少なくとも１つを特定可能で、かつ、台車の略水平面内における向き、旋回速度及び旋回加速度の少なくとも１つを特定可能な物理量を検出する第２検出手段とを備え、その重心が車輪の回転軸より上方に位置する移動台車の制御方法であって、
第１検出手段により検出される検出値を読込む工程、
第２検出手段により検出される物理量を読込む工程、
読込まれた検出値と、台車の略水平面内における並進方向に関する第１目標値と読込まれた物理量から特定される第１目標値に対応する現在値との偏差を入力値として、その偏差を小さくすると共に車体が倒立を維持するように各駆動手段の制御指令値をそれぞれ算出する工程、
台車の略水平面内における回転方向に関する第２目標値と読込まれた物理量から特定される第２目標値に対応する現在値との偏差を少なくとも１つの入力値として、その偏差を小さくするように各駆動手段の制御指令値をそれぞれ算出する工程、
算出された各制御指令値を加算した制御指令値を各駆動手段に出力する工程、とを有し、
上記各工程を制御コンピュータで繰返し実行することで移動台車を制御することを特徴とする移動台車の制御方法。
【発明の詳細な説明】
【０００１】
【発明の属する技術分野】本発明は移動台車に関し、詳しくは、その重心が車輪の回転軸より上方に位置する倒立振子型の移動台車の制御方法に関する。
【０００２】
【従来の技術】倒立振子型の移動台車の制御方法としては、例えば、特許文献１に記載の技術が知られている。
特許文献１には、一対の車輪と、車輪間に架設された車軸と、車軸上に回転可能に支持された車体とを備えた同軸二輪車が開示されている。車体の傾きは角度検出手段によって検出されるようになっている。この同軸二輪車では、車輪を駆動するための車輪駆動用モータを有し、車輪駆動用モータは制御コンピュータから出力される制御指令値（制御トルク値）に基づいて駆動される。制御コンピュータ内には、車体の傾斜角度を入力値とし、フィードバックゲイン（Ｋ）を係数として制御トルク値を算出するための制御入力算出式が予め設定されている。
かかる構成においては、角度検出手段により車体の傾きを短時間間隔にてサンプリングする。次いで、サンプリングされた傾斜角度を制御入力算出式に代入して演算し、車輪用駆動用モータの制御トルクを算出する。そして、算出された制御トルクに相当する電流指令値を車輪駆動用モータに出力する。これによって、車輪駆動用モータが回転し、車体の倒立が維持される。
【０００３】
【特許文献１】
特開昭６３−３０５０８２号
【０００４】
【発明が解決しようとする課題】上述の特許文献１に開示された技術では、状態フィードバック制御を用いているため、制御対象をモデル化したときの数式モデルと実物とが厳密に一致する必要がある。しかしながら、台車が設置される設置面が傾斜していたり、台車に作用する荷重に変動等が生じると、数式モデルと実物との間に違いが生じる。これによって、制御が不安定化するという問題があった。
【０００５】
本発明は上述した事情に鑑みてなされたものであり、その目的は、台車設置面が傾いていたり荷重の変動等があっても、安定した倒立制御を行うことができる技術を提供することである。
【０００６】
【課題を解決するための手段と作用と効果】上記課題を解決するために、本願の第１の移動台車は、車輪と、該車輪に支持される車体とを備え、その重心が車輪の回転軸より上方に位置する移動台車であって、車輪を駆動する駆動手段と、車体の傾斜角度及び傾斜角速度の中の少なくとも１つを検出する第１検出手段と、前記第１検出手段により検出された検出値を少なくとも１つの入力値として、車体が倒立を維持するように駆動手段の制御指令値を算出する制御手段と、を有する。そして、前記制御手段が、外乱に対して安定倒立可能なようにロバスト性を有することを特徴とする。
この移動台車は、駆動手段を制御する制御手段が外乱に対して安定倒立可能なようにロバスト性を有する。このため、台車設置面が傾斜していたり、荷重の変動が生じても、安定して車体の倒立を維持することができる。
【０００７】
上記第１の移動台車においては、台車の略水平面内における位置、速度及び加速度の中の少なくとも１つを特定可能な物理量を検出する第２検出手段と、台車の略水平面内における位置、速度及び加速度の中の少なくとも１つに関して目標値を入力する手段と、をさらに有し、前記制御手段は、前記目標値入力手段により入力された目標値と前記第２検出手段で検出された物理量から特定される現在値との偏差をさらに入力値として、その偏差を小さくするように駆動手段の制御指令値を算出することが好ましい。
この移動台車では、車体の倒立を維持しながら、台車の略水平面内において台車の位置、速度又は加速度が所定の値（目標値）となるように台車を運動させることができる。
【０００８】
上記第１の移動台車においては、前記第１検出手段はジャイロセンサであり、前記制御手段はジャイロセンサで検出された傾斜角速度を入力値とすることが好ましい。
このような構成では、ジャイロセンサ（角速度計）の出力を積分せずに制御手段への入力値とするため、センサのドリフトが累積されず、精度の良い位置制御が可能となる。
【０００９】
なお、台車が設置された設置面上で台車を所望の位置に移動させるためには、台車の略水平面内において台車の並進方向の運動制御と回転方向の運動制御の両者を行う必要がある。本願の第２の移動台車は、台車の並進方向の運動と回転方向の運動を安定して制御することを可能とする。
すなわち、本願の第２の移動台車は、２以上の車輪と、該車輪に支持される車体とを備え、その重心が車輪の回転軸より上方に位置する移動台車であって、２以上の車輪の１つを駆動する第１駆動手段と、第１駆動手段で駆動されない他の車輪を駆動する第２駆動手段と、車体の傾斜角度及び傾斜角速度の中の少なくとも１つを検出する第１検出手段と、台車の略水平面内における位置、速度及び加速度の中の少なくとも１つを特定可能で、かつ、台車の略水平面内における向き、旋回速度及び旋回加速度の少なくとも１つを特定可能な物理量を検出する第２検出手段と、台車の略水平面内における並進方向に関する第１目標値と、台車の略水平面内における回転方向に関する第２目標値を入力する目標値入力手段と、前記第１検出手段により検出された検出値と、前記目標値入力手段により入力された第１目標値と前記第２検出手段で検出された物理量から特定される第１目標値に対応する現在値との偏差を入力値として、その偏差を小さくすると共に車体が倒立を維持するように各駆動手段の制御指令値をそれぞれ算出する第１制御指令値算出手段と、前記目標値入力手段により入力された第２目標値と前記第２検出手段で検出された物理量から特定される第２目標値に対応する現在値との偏差を少なくとも１つの入力値として、その偏差を小さくするように各駆動手段の制御指令値をそれぞれ算出する第２制御指令値算出手段と、第１制御指令値算出手段で算出された制御指令値と、第２制御指令値算出手段で算出された制御指令値とを加算する手段とを、を有する。
この移動台車では、２以上の車輪を備え、これらの車輪の少なくとも２輪を独立して駆動することで台車を回転（旋回）させる。また、台車の並進方向の制御と車体の倒立制御を同時に行うための制御指令値が算出され、また、台車の回転方向の制御を行うための制御指令値が算出される。そして、算出された各制御指令値を加算して、各駆動手段がそれぞれ駆動される。
この移動台車では、車体倒立制御と、車体倒立制御に関連性の大きい台車の並進方向の運動制御とが組合わされて同時に行われるため、車体の倒立を維持しながら、台車を並進方向及び回転方向に運動させることができる。
【００１０】
上記第２の移動台車においては、前記第１制御指令値算出手段は、外乱に対して安定倒立可能なようにロバスト性を有することが好ましい。
このような構成によると、車体の倒立制御を行う第１制御指令値算出手段が外乱に対するロバスト性を有するため、台車設置面が傾斜していたり、荷重の変動が生じても、安定して車体の倒立を維持することができる。
【００１１】
また、上記第２の移動台車においては、前記の各車輪は同一の回転軸上に配置され、前記車体は前記回転軸に対して直交する方向に傾斜可能に支持されていることが好ましい。
このように構成すると、台車の回転方向の運動制御と車体の倒立制御との干渉が小さいため、台車の回転方向の制御を行っても車体の倒立を安定して維持することが容易になる。
【００１２】
さらに、本発明は倒立振子型の移動台車を制御するための新たな制御方法を提供する。
すなわち、本発明の移動台車の制御方法は、２以上の車輪と、該車輪に支持される車体と、２以上の車輪の１つを駆動する第１駆動手段と、第１駆動手段で駆動されない他の車輪を駆動する第２駆動手段と、第１駆動手段と第２駆動手段に制御指令値を出力する制御コンピュータと、車体の傾斜角度及び傾斜角速度の中の少なくとも１つを検出する第１検出手段と、台車の略水平面内における位置、速度及び加速度の中の少なくとも１つを特定可能で、かつ、台車の略水平面内における向き、旋回速度及び旋回加速度の少なくとも１つを特定可能な物理量を検出する第２検出手段とを備え、その重心が車輪の回転軸より上方に位置する移動台車の制御方法に関する。
この制御方法は、第１検出手段により検出される検出値を読込む工程、第２検出手段により検出される物理量を読込む工程、読込まれた検出値と、台車の略水平面内における並進方向に関する第１目標値と読込まれた物理量から特定される第１目標値に対応する現在値との偏差を入力値として、その偏差を小さくすると共に車体が倒立を維持するように各駆動手段の制御指令値をそれぞれ算出する工程、台車の略水平面内における回転方向に関する第２目標値と読込まれた物理量から特定される第２目標値に対応する現在値との偏差を少なくとも１つの入力値として、その偏差を小さくするように各駆動手段の制御指令値をそれぞれ算出する工程、算出された各制御指令値を加算した制御指令値を各駆動手段に出力する工程、とを有する。そして、上記の各工程が制御コンピュータによって繰返し実行されることで、移動台車が制御される。
この制御方法によっても、倒立を維持しながら、台車を並進方向及び回転方向に運動させることができる。
【００１３】
【発明の実施の形態】上述した本発明に係る移動台車は、下記に示す形態で好適に実施することができる。
（形態１）  移動台車では、倒立振子制御と並進方向制御と回転方向制御とが行われる。並進方向制御と倒立振子制御とは組合わされ、その組合わされた制御系に対してＨ∞制御理論を用いて設計する。移動台車の回転方向制御についてはＰＤ制御を行う。
（形態２）  移動台車の回転方向の制御は、位置（ｘ，ｙ，φ）の偏差と速度（ｄｘ／ｄｔ，ｄｙ／ｄｔ，ｄφ／ｄｔ）の偏差にそれぞれ所定のゲインをかけ、ゲインにより得られた値を加算する。そして、加算された値と転置ヤコビ行列を用いて各車輪のトルク指令値を直接算出する。
【００１４】
【実施例】本発明を具現化した一実施例に係る移動台車について図面を参照して説明する。図１は本実施例に係る移動台車の概略構成を示す斜視図である。
図１に示すように、台車本体１０の下部には左右の車輪１２，１３が配設されている。両車輪１２，１３は同一回転軸線上に配され、この回転軸線に対して直交する方向に台車本体１０が傾動可能となっている。右車輪１２にはモータ１４が接続されており、左車輪１３にはモータ１５が接続されている。モータ１４，１５には、それぞれのモータの回転角度を検出するエンコーダ（図示省略）が取付けられている。図中の１９は１軸ジャイロセンサであり、車軸とは直交する方向（すなわち、台車本体１０の傾動方向）に配置されている。したがって、ジャイロセンサ１９によって台車本体１０の傾斜角速度が検出される。
台車本体１０の収納部には、両モータ１４，１５を駆動するためのモータドライバ１６、制御コンピュータ２０およびバッテリ１８が搭載されている。制御コンピュータ２０は、ジャイロセンサ１９の出力、モータ１４，１５のエンコーダ出力に基づいてモータ１４，１５のトルク指令値を算出し、この算出されたトルク指令値に基づいてモータ１４，１５が制御される。
また、台車本体１０の上部１０ａには、たとえばロボットのボディー（図示省略）が載置される。
【００１５】
次に、上述したように構成される移動台車の制御系について説明する。図２は、移動台車の制御系の構成を示す機能ブロック図である。
図２に示すように、移動台車の制御は制御コンピュータ２０を中心に行われる。制御コンピュータ２０は、ＣＰＵ，ＲＯＭ，ＲＡＭ等により構成され、ＲＯＭに格納された制御プログラムを実行することで、台車並進方向に関する制御指令値を算出する台車並進方向制御指令値算出手段２２（以下、単に第１制御指令値算出手段という）と、台車回転方向に関する制御指令値を算出する台車回転方向制御指令値算出手段２６（以下、単に第２制御指令値算出手段という）と、両制御指令値算出手段２２，２６に目標値を入力する目標値入力手段２４と、両制御指令値算出手段２２，２６で算出された制御指令値を加算する制御指令値加算手段２８として機能する。制御コンピュータ２０によって構成される各手段２２，２４，２６，２８については後で詳述する。
制御コンピュータ２０には、ジャイロセンサ１９が接続され、ジャイロセンサ１９の出力（台車本体１０の傾斜角速度）が入力するようになっている。また、制御コンピュータ２０には、モータ駆動回路１６ａ（モータドライバ１６の一部）とモータ駆動回路１６ｂ（モータドライバ１６の一部）が接続されている。モータ駆動回路１６ａは、モータ１４と接続され、制御コンピュータ２０からのトルク指令値に応じてモータ１４を駆動する。同様に、モータ駆動回路１６ｂは、モータ１５と接続され、制御コンピュータ２０からのトルク指令値に応じてモータ１５を駆動する。各モータ１４，１５のエンコーダ１４ａ，１５ａは、制御コンピュータ２０に接続され、エンコーダ１４ａ，１５ａからの出力（各モータ１４，１５の回転角度）が制御コンピュータ２０に入力するようになっている。
【００１６】
次に、第１制御指令値算出手段２２について説明する。第１制御指令値算出手段２２は、台車並進方向を制御するためのトルク指令値を算出する。詳しくは、ジャイロセンサ１９の出力と、目標値入力手段２４によって入力される台車並進方向に関する目標値とエンコーダ１４ａ，１５ａの出力から決まる現在値との偏差を入力として、その偏差を小さくすると共に車体が倒立を維持するようにモータ１４，１５のトルク指令値を算出する。
なお、本実施例では、Ｈ∞制御理論を用いて第１制御指令値算出手段２２を設計している。Ｈ∞制御理論を用いることで、第１制御指令値算出手段２２は外乱に対して安定倒立可能なようにロバスト性を有することとなる。ただし、Ｈ∞制御理論以外の制御理論（例えば、Ｈ２制御理論、μ−設計法等）を用いて第１制御指令値算出手段２２を設計することもできる。なお、Ｈ∞制御理論以外の制御理論を用いて設計する場合にも、第１制御指令値算出手段２２は外乱に対して安定倒立可能なようにロバスト性を有することが好ましい。
【００１７】
第１制御指令値算出手段２２の設計手順の一例を説明する。まず、移動台車を真横から見て、１輪の倒立振子としてモデル化する（図３参照）。図３中、ｍ１は車体の質量、Ｊ１は車体の重心周りのイナーシャ、ｍ２は車輪の質量、Ｊ２は車輪の軸周りのイナーシャとし、また、車軸から車体重心までの距離をｌとする。これら各パラメータｍ１，ｊ１，ｍ２，ｊ２，ｌは、計算または実測により求めることができる。また、鉛直方向からの車体の傾きをηとし、車輪の回転角度をθ１とする。
そして、図３に示す１輪の倒立振子に対し運動方程式を作成する。すなわち、この制御モデルに対してトルク指令値ｕが入力されるとして運動方程式を作成すると、その運動方程式は下記に示す式で表される。
【００１８】
【数１】
2004295430.tif 000003
【００１９】
次いで、上述した運動方程式中のηが小さいとして線形化し、行列表示を行うと次の式が導かれる。
【００２０】
【数２】
2004295430.tif 000004
【００２１】
したがって、上記の式から次の状態方程式が導出される。
【００２２】
【数３】
2004295430.tif 000005
【００２３】
ここで、上記制御系で観測される観測量ｙｇは、鉛直方向からの車体の傾きηの１階微分ｄη／ｄｔと、車体に対する車輪の回転角度（θ１−η）と、この回転角度（θ１−η）の１階微分ｄ（θ１−η）／ｄｔとする。すなわち、観測量ｙｇは、次に示す式で表される。
【００２４】
【数４】
2004295430.tif 000006
【００２５】
上述した手順でモデル化された制御系の全体構成を図５に示す。図５に示すように、制御対象である倒立振子モデル３０からは、観測量としてｄη／ｄｔと、（θ１−η）と、ｄ（θ１−η）／ｄｔとが観測される。観測された観測量には観測ノイズ３２が加えられる。具体的には、観測量ｄη／ｄｔには観測ノイズｎ２が、観測量（θ１−η）には観測ノイズｎ１が、観測量ｄ（θ１−η）／ｄｔには観測ノイズｎ３が加えられる。
観測ノイズ３２が加えられた観測量と目標値３４との偏差は、ロバストコントローラ３６（すなわち、第１制御指令値算出手段２２）に入力する。ここで、観測量ｄη／ｄｔには目標値「０」が、観測量（θ１−η）には目標値「（θ１−η）＊」が、観測量ｄ（θ１−η）／ｄｔには目標値「ｄ（θ１−η）＊／ｄｔ」が与えられる。ｄη／ｄｔ（すなわち、ジャイロセンサ１９の出力）に目標値「０」が与えられるため（すなわち、車体の鉛直方向からの傾き角速度は０）、車体は倒立姿勢を保つこととなる。
ロバストコントローラ３６からはトルク指令値ｕが出力される。そして、出力されたトルク指令値ｕと外乱ｗが倒立振子モデル３０に入力されることとなる。
【００２６】
ここで、かかる制御系を評価するための評価値としては、例えば、ロバストコントローラ３６からの出力ｕや車輪の回転角θ１を用いることができる。出力ｕを評価するための重み関数Ｗと回転角θ１を評価する評価関数Ｑは、例えば、シミュレーション等によりある程度の絞り込みを行い、実験によって最終的に決定することができる。本実施例では、下記に示す関数Ｗ，Ｑを用いている。
【００２７】
【数５】
2004295430.tif 000007
【００２８】
なお、ロバストコントローラ３６（すなわち、第１制御指令値算出手段２２）の具体的な設計は、公知となっている種々の制御系設計ツールを用いることができる。
【００２９】
次に、第２制御指令値算出手段２６について説明する。第２制御指令値算出手段２６は、台車回転方向を制御するためのトルク指令値を算出する。
ここで、台車回転方向に関しては、移動台車を真上から見て、２輪車としてモデル化している（図４参照）。図４中、φは移動台車の台車回転角を表し、ｄは両車輪１２，１３間の距離を表し、ｒは車輪の半径を表している。なお、図４に示す幾何学的関係から、左右の車輪速度（右車輪の速度ｄθＬ／ｄｔ，左車輪の速度ｄθＲ／ｄｔ）を直交座標系での移動台車の位置の速度（ｄｘ／ｄｔ，ｄｙ／ｄｔ）と台車回転方向の角速度（ｄφ／ｄｔ）に変換するためのヤコビ行列は下記に示すようになる。
【００３０】
【数６】
2004295430.tif 000008
【００３１】
図６に第２制御指令値算出手段２６による制御系の全体構成を示している。図６から明らかなように、第２制御指令値算出手段２６は、現在位置（ｘ，ｙ，φ）と目標位置（ｘ，ｙ，φ）＊の偏差に所定のゲイン５０を乗じたものと、現在速度〔（ｄｘ／ｄｔ，ｄｙ／ｄｔ，ｄφ／ｄｔ）〕と目標速度〔（ｄｘ／ｄｔ，ｄｙ／ｄｔ，ｄφ／ｄｔ）＊〕の偏差に所定のゲイン５２を乗じたものを加算し、その加算した値からモータ１４，１５を制御するためのトルク指令値ＴＲ＊，ＴＬ＊を算出している（いわゆる、ＰＤ制御を行っている）。
なお、移動台車は、平面上の位置として２自由度、台車回転方向に１自由度の計３自由度を持つが、アクチュエータとしてはモータ１４，１５の計２個しか有さない。このため、上記した位置の偏差（詳しくは、位置の偏差にゲイン５０が乗じられた値）と上記した速度の偏差（詳しくは、速度の偏差にゲイン５２が乗じられた値）とを加算したものに転置ヤコビ行列ＪＴ５４を用いて、直接トルク指令値ＴＲ＊，ＴＬ＊を算出している。
また、右車輪１２の回転角速度ｄθＲ／ｄｔ（すなわち、右車輪速度）と左車輪１３の回転角速度ｄθＲ／ｄｔ（すなわち、左車輪速度）にヤコビ行列５６（数６に示す行列）をかけることで、現在速度〔（ｄｘ／ｄｔ，ｄｙ／ｄｔ，ｄφ／ｄｔ）〕を算出している。
なお、図６に示す制御系によっても移動台車の平面内での位置（ｘ，ｙ）とその速度（ｄｘ／ｄｔ，ｄｙ／ｄｔ）について制御することができる。しかしながら、これらについては第１制御指令値算出手段２２によって制御を行うため、ゲイン５０，５２においては、位置成分（ｘ，ｙ）とその速度成分（ｄｘ／ｄｔ，ｄｙ／ｄｔ）に乗じるゲイン（係数）を「０」としている。したがって、移動台車の台車回転角φの偏差と台車回転角速度ｄφ／ｄｔの偏差のみが、第２制御指令値算出手段２６で使用される。
【００３２】
以上説明したように、台車並進方向の制御（車軸と直行方向）には倒立振子制御と位置制御が同時に行われ、台車回転方向（車軸旋回方向）には位置制御のみが行われ、これらの制御は互いに干渉しないものとなっている。このため、モータ１４，１５への最終的な制御指令値は、第１制御指令値算出手段２２で算出された制御指令値と第２制御指令値算出手段２６で算出された制御指令値を足し合わせたものとなっている。すなわち、制御指令値加算手段２８は、第１制御指令値算出手段２２で算出された制御指令値と第２制御指令値算出手段２６で算出された制御指令値とを加算し、加算した値をモータ駆動回路１６ａ，１６ｂに出力する。
なお、上述した第１制御指令値算出手段２２と、第２制御指令値算出手段２６と、制御指令値加算手段２８とによって構成される制御系の構成を図７に示している。図７から明らかなように、本実施例の制御系は、台車回転方向の制御ループ内に台車並進方向の制御が組み込まれたものとなっている。
【００３３】
次に、目標値入力手段２４について説明する。図８には目標値入力手段２４の構成を示すブロック図が示されている。図８に示すように目標値入力手段２４は、目標軌道データ記憶手段６０と、並進方向目標値算出手段６２と、回転方向目標値算出手段６４で構成される。
【００３４】
目標軌道データ記憶手段６０は、移動台車の軌道と、軌道上の各位置における移動台車の速度と加速度、並びに、移動台車の台車回転方向の角速度と角加速度を規定する目標軌道データを記憶する。本実施例では、移動台車の軌道を等加速度運動〔加速度０の場合（等速運動の場合）も等加速度運動としている〕を行っている区間に分割し、分割された各区間の（区間時間ｔ，区間加速度ａ，区間初速度ｂ，区間角加速度ａ’，区間角初速度ｂ’）が目標軌道データとされる。すなわち、移動台車の並進方向の速度をｖ、移動台車の台車回転方向の速度をｄφ／ｄｔ、制御開始からの経過時間をｔとすると、これらの関係は次に示す式で表される。
【００３５】
【数７】
2004295430.tif 000009
【００３６】
図９には、移動台車を移動させる軌道の一部と、そのときの目標軌道データを示している。図９から明らかなように、移動台車を移動させる軌道上のＡ点からＢ点までは台車並進方向に等加速度ａ１で等加速度運動を行い、台車回転方向の速度及び加速度は「０」である。Ｂ点からＣ点までは台車並進方向に等速度運動を行い、台車回転方向に等角加速度ａ１’で等角加速度運動を行う。Ｃ点からＤ点までは台車並進方向に等速度運動を行い、台車回転方向にも等角速度運動を行う。
したがって、目標軌道データは、Ａ点からＢ点までの運動を規定するデータと、Ｂ点からＣ点までの運動を規定するデータと、Ｃ点からＤ点までの運動を規定するデータにより構成される。すなわち、Ａ点からＢ点までの運動を規定する目標軌道データは（ｔ１，ａ１，０，０，０）となり、Ｂ点からＣ点までの運動を規定する目標軌道データは（ｔ２，０，ａ１ｔ１，ａ１’，０）となり、Ｃ点からＤ点までの運動を規定する目標軌道データ（ｔ３，０，ａ１ｔ１，０，ａ１’ｔ２）となる。
【００３７】
並進方向目標値算出手段６２は、目標軌道データ記憶手段６０に記憶されている目標軌道データからＸ−Ｙ平面内における移動台車の目標位置（ｘ、ｙ）＊と目標速度（ｄｘ／ｄｔ，ｄｙ／ｄｔ）＊を算出する。例えば、図９に示すＡ点を原点として運動を開始した場合において運動開始から時間ｔ（ただし、０＜ｔ＜ｔ１）を経過したときは、目標位置（ｘ、ｙ）＊＝（ａ１ｔ２／２，０）＊となり、目標速度（ｄｘ／ｄｔ，ｄｙ／ｄｔ）＊＝（ａ１ｔ，０）＊となる。
回転方向目標値算出手段６４は、目標軌道データ記憶手段６０に記憶されている目標軌道データから移動台車の目標回転角（φ）＊と目標速度（ｄφ／ｄｔ）＊を算出する。ここで、目標回転角（φ）＊は移動台車の総回転角量を意味する。したがって、移動台車が同一姿勢（すなわち、同一台車角度）となっている場合でも、回転角量（旋回数）が異なる場合は目標回転角（φ）＊も異なることとなる。
並進方向目標値算出手段６２と回転方向目標値算出手段６４によって算出された目標位置（ｘ，ｙ，φ）＊と目標速度（ｄｘ／ｄｔ，ｄｙ／ｄｔ，ｄφ／ｄｔ）＊は、第１制御指令値算出手段２２と第２制御指令値算出手段２６の目標値として用いられる。すなわち、図７に示すように、第１制御指令値算出手段２２（詳しくは、図７に示すロバストコントローラ３６）には、上記の目標位置と目標速度が台車中心位置（θ１−η）と台車中心速度ｄ（θ１−η）／ｄｔに変換されて用いられる。また、第２制御指令値算出手段２６には、上記の目標位置（ｘ，ｙ，φ）＊が用いられる（ただし、ゲイン５０のうちｘ、ｙに関する係数は０であるため、実際にはφのみが用いられる）。
【００３８】
次に、上述のように構成される制御コンピュータ２０によって行われる処理について説明する。図１０は制御コンピュータ２０の処理手順を示すフローチャートである。
図１０に示すように、制御コンピュータ２０は、まず、各モータ１４，１５のエンコーダ１４ａ，１５ａの値（すなわち、車輪１２，１３の回転角度θＲ，θＬ）を読込む（Ｓ１０）。
次に、ステップＳ１０で読込んだエンコーダ１４ａ，１５ａの値から車輪速度（ｄθＲ／ｄｔ，ｄθＬ／ｄｔ）と、現在速度・現在方向速度（ｄｘ／ｄｔ，ｄｙ／ｄｔ，ｄφ／ｄｔ）を算出する（Ｓ１２）。すなわち、エンコーダ１４ａ，１５ａの値の時間的変化量から車輪１２，１３の車輪速度（ｄθＲ／ｄｔ，ｄθＬ／ｄｔ）を算出し、これら算出された車輪速度（ｄθＲ／ｄｔ，ｄθＬ／ｄｔ）とヤコビ行列５６とから現在速度・現在方向速度（ｄｘ／ｄｔ，ｄｙ／ｄｔ，ｄφ／ｄｔ）を算出する（図７参照）。
ステップＳ１４では、ジャイロセンサ１９の出力値ｄη／ｄｔを読込む。
ステップＳ１６では、制御コンピュータ２０が起動されてからの時間ｔ（すなわち、移動台車の軌道制御開始時からの経過時間）と、目標軌道データ記憶手段６０に記憶されている目標軌道データとから、目標位置（ｘ，ｙ，φ）＊と目標速度（ｄｘ／ｄｔ，ｄｙ／ｄｔ，ｄφ／ｄｔ）＊を算出する。
ステップＳ１０からステップＳ１６までの処理により移動台車の現在値と目標値が算出されるため、次に、台車並進方向に関するモータ１４，１５のトルク指令値ＴＲ１，ＴＬ１をそれぞれ算出し（Ｓ１８）、台車回転方向に関するモータ１４，１５のトルク指令値ＴＲ２，ＴＬ２をそれぞれ算出する（Ｓ２０）。すなわち、第１制御指令値算出手段２２によってトルク指令値ＴＲ１，ＴＬ１を算出し、第２制御指令値算出手段２６によってトルク指令値ＴＲ２，ＴＬ２を算出する。
ステップＳ２２では、ステップＳ１８で算出されたトルク指令値ＴＲ１，ＴＬ１と、ステップＳ２０で算出されたトルク指令値ＴＲ２，ＴＬ２を加算し、これらの値をモータ駆動回路１６ａ，１６ｂに出力する。これによって、各車輪１２，１３が駆動されることとなる。ステップＳ２２が終わるとステップ１０に戻り、次の制御タイミングにおける処理が開始される。
なお、ステップＳ１０〜ステップＳ２２までの処理は、所定の時間間隔（例えば、１０ｍｓ）で行われ、これによって移動台車は目標軌道データで規定された軌道を所定の速度・加速度・角速度・角加速度で運動することとなる。
【００３９】
上述した説明から明らかなように、本実施例の移動台車ではＨ∞制御理論を用いて倒立振子制御系を設計しているため、設置面の斜度の変化や負荷の変動等の外乱に対して安定して倒立を維持することができる。また、Ｈ∞制御理論を用いることで、制御対象である移動台車の厳密なモデル化を不要としている。
また、ジャイロセンサの角速度出力を積分して用いないため（すなわち、車体の傾斜角を制御に用いていないため）、ジャイロセンサのドリフトが累積されず精度の良い位置制御が可能となる。
【００４０】
以上、本発明の好適ないくつかの実施形態について詳細に説明したが、これらは例示に過ぎず、本発明は当業者の知識に基づいて種々の変更、改良を施した形態で実施することができる。
例えば、上述した実施例は駆動輪を２つ有していたが、本発明に係る技術はこのような例に限られず、例えば、駆動輪を１輪のみとし他の車輪を従輪としてもよい。
また、本実施例では、車体の傾斜角速度を測定するセンサにジャイロセンサを用いたが、このようなセンサに限られず、傾斜角や傾斜角速度の計測に用いることができる種々の計測器（例えば、重力加速度センサ、重り吊り下げ型傾斜角度計等）を用いることができる。
さらに、図１０に示す制御フローは、制御コンピュータ２０によって行われる処理の一例を示しており、例えば、ステップＳ１０〜Ｓ１２とステップＳ１４の順序を逆にしてもよいし、ステップＳ１８とステップＳ２０の順序を逆にしてもよい。
なお、本明細書または図面に説明した技術要素は、単独であるいは各種の組み合わせによって技術的有用性を発揮するものであり、出願時請求項記載の組み合わせに限定されるものではない。また、本明細書または図面に例示した技術は複数の目的を同時に達成するものであり、そのうちの一つの目的を達成すること自体で技術的有用性を持つものである。
【図面の簡単な説明】
【図１】本実施例に係る移動台車の斜視図。
【図２】移動台車の制御系の構成を示す機能ブロック図。
【図３】移動台車を並進方向に関してモデル化した図。
【図４】移動台車を台車の回転方向に関してモデル化した図。
【図５】移動台車の並進方向に関する制御系の構成を示す図。
【図６】移動台車の台車回転方向に関する制御系の構成を示す図。
【図７】移動台車の並進方向の制御系と台車回転方向の制御系とを組合せた状態を示す図。
【図８】目標値入力手段の構成を示すブロック図。
【図９】移動台車の目標軌道の一例と、その目標軌道を達成するための目標軌道データの一例を併せて示す図。
【図１０】本実施例の制御コンピュータにより行われる処理手順を示すフローチャート。
【符号の説明】
１０：台車本体
１２：右車輪
１３：左車輪
１４，１５：モータ
１６：モータドライバ
１８：バッテリ
１９：ジャイロセンサ
２０：制御コントローラ
【図１】
2004295430.tif 000010
【図２】
2004295430.tif 000011
【図３】
2004295430.tif 000012
【図４】
2004295430.tif 000013
【図５】
2004295430.tif 000014
【図６】
2004295430.tif 000015
【図７】
2004295430.tif 000016
【図８】
2004295430.tif 000017
【図９】
2004295430.tif 000018
【図１０】
2004295430.tif 000019