(57)【要約】【課題】装置が滑らかに動作するように装置を制御する。【解決手段】システムは、制御アーキテクチャ間で切り替わり、又は装置を制御するため制御ループで用いられる利得係数を変える。そのアーキテクチャ又は利得が切り換えられるとき、制御信号が平滑化され、それにより装置はそれが受け取る制御信号の突然の変化を被らない。一実施形態において、制御信号は、減衰オフセット値を制御信号に加えることにより平滑化されて、装置に印加される平滑化された制御信号を生成する。【選択図】図２Ａ
2010094533.tif 000002
【特許請求の範囲】
【請求項１】
装置の重心の位置を推定するのに使用するための基準データ・セットを生成する方法において、
ａ）装置を第１の位置に置くステップと、
ｂ）前記装置が第１の位置にある間に前記装置の第１の構成要素の第１の位置を記録するステップと、
ｃ）前記装置を第２の位置に置くステップと、
ｄ）前記装置が第２の位置にある間に前記装置の第１の構成要素の第２の位置を記録するステップと
を備える方法。
【請求項２】
前記第１の位置は、前記装置が平衡されている位置である請求項１記載の方法。
【請求項３】
前記第２の位置は、前記装置が平衡されている位置である請求項１記載の方法。
【請求項４】
前記装置が人輸送装置であり、前記第１の構成要素は前記人輸送装置の電子機器ボックスであり、前記第１の位置は重力に関する前記電子機器ボックスの角度である請求項１記載の方法。
【請求項５】
前記装置が人輸送装置であり、前記第１の構成要素は前記人輸送装置の可動腕部であり、前記第１の位置は重力に関する前記可動腕部の角度である請求項１記載の方法。
【請求項６】
前記装置が人輸送装置であり、
人間を支えることができるプラットフォームの高さがまた、ステップｂ）及びｄ）で記録される
請求項１記載の方法。
【請求項７】
ステップｂ）は、前記装置が第１の位置にある間に第１の構成要素の角度方向を記録するステップを含み、
ステップｄ）は、前記装置が第２の位置にあるとき第１の構成要素の角度方向を記録するステップを含み、
前記方法は更に、
前記装置の重心の位置を推定するのに用いるため、各位置での前記少なくとも１つの構成要素の角度方向を含む適合曲線を生成するステップを含む
請求項１記載の方法。
【請求項８】
前記少なくとも１つの構成要素がシステムの電子機器ボックスである請求項７記載の方法。
【請求項９】
前記置くステップは、前記生成するステップが実行される前に２回反復される請求項７記載の方法。
【請求項１０】
前記置くステップが行われる第１回は前記システムのクラスタが第１の方向であり、前記置くステップが行われる第２回は前記クラスタが第２の方向である請求項９記載の方法。
【請求項１１】
第１の方向が第２の方向と異なる請求項１０記載の方法。
【請求項１２】
前記置くステップがまた、システムに含まれた人間を支えることができるプラットフォームの各位置での高さを記録するステップを含む請求項７記載の方法。
【発明の詳細な説明】
【技術分野】
【０００１】
［関連出願］
本出願は、参照として本明細書に援用される１９９９年３月１５日に出願された発明の名称が「個人用車両の制御モード」である先に出願された仮り特許出願第６０／１２４，４０３号の恩恵を主張する。
［背景］
１．発明の分野
本発明は、制御スケジューリングの分野、特に異なった制御モード間で円滑な変更を行う分野に関する。
【背景技術】
【０００２】
２．関連技術の説明
人輸送装置は、人を表面上で移動させる働きをし、多くの異なった形態をとることができる。たとえば、ここで使用する人輸送装置は、車椅子、動力付きカート、自転車、オートバイ、自動車、ホバークラフトなどを含むことができるが、それらに制限されることはない。一部の形式の人輸送装置は、装置が倒れて輸送装置のユーザが負傷することがないようにするために、安定化機構を含むことができる。
【０００３】
典型的な４輪形車椅子は、４つの車輪すべてで地面と接触する。車椅子およびユーザを合わせたものの重心が車輪間の面積の上方にあれば、車椅子は転倒しないはずである。重心が輸送装置の接地部材の外側の上方に位置する場合、輸送装置が不安定になってひっくり返るであろう。
【０００４】
図１Ａを参照すると、典型的な車椅子１００が示されている。車椅子１００およびユーザ１０２がフレーム(frame)を定めている。フレームは、表面１０６の垂直方向上方に配置された位置にある重心１０４を有する。ここで使用する用語「表面」は、人輸送装置が載ることができるすべての表面を指すものとする。表面の例として、平坦な地面、スロープなどの傾斜面、砂利道などがあり、互いに垂直方向に変位した２つのほぼ平行な表面を垂直に連結した縁石（道路縁石など）も含まれるであろう。
【０００５】
表面１０６は、水平軸１０８に対して傾斜していてもよい。表面１０６が水平軸１０８からずれている角度をここでは表面ピッチと呼び、θsの角度で表す。
車椅子１００の前輪１１２および後輪１１０は、距離ｄだけ離れている。２つの車輪間の距離ｄは、線（たとえば、直線）距離として測定することができる。システムの重心１０４が２つの車輪１１０及び１１２間の上方の位置にある場合、車椅子１００は直立して比較的安定しているはずである。車輪１１０および１１２は一般的に、車椅子の他方側に反対の車輪(opposing counerparts)（図示せず）を有する。反対の車輪の各々は、それぞれ車輪１１０および１１２と軸を共有しているであろう。これらの４つの車輪が地面と接触する点（接地部分が点より多くを覆うような時、接地部分の外側部分）を結んだ多角形によって囲まれる範囲が、車椅子が安定している時に重心１０４が位置することができる範囲である。以下の説明の様々な箇所で、この範囲を装置のフットプリント(footprint)と呼ぶであろう。ここで使用する用語としての「装置のフットプリント」は、車輪間の範囲（面積）を水平面上に投影した時の投影図によって定められる。重心がこの場所の上方にある場合、輸送装置は安定しているはずである。
【０００６】
重心１０４が表面１０６の垂直方向上方でフットプリント（すなわち、車輪１１０および１１２間の範囲を水平面上に投影したもの）の外側に変位している場合、車椅子１００の安定性が低下して、車椅子１００が転倒するであろう。このことは、たとえば、車椅子が急勾配の表面上にある時に発生するであろう。急勾配にある時、重心１０４が後方へ移動して、車椅子１００が後方へひっくり返るであろう。これは、重心１０４が車椅子１００のフットプリントの外側の位置にある図１Ｂに示されている。重心１０４が、重心１０４を下方向に線形移動させる重力加速度ベクトル（ｇ）を含めて示されている。車椅子１００は、それが通行中の表面と接触するまで、後輪１１０の軸を中心に回転するであろう。
【０００７】
ユーザ１０２は、車椅子１００内で前傾することによって、重心１０４を車輪１１０および１１２の間の範囲の上方の位置に戻すことを助けることができる。重心１０４の位置をこのように限定的に制御できるとしても、車椅子などの人輸送装置が縁石または段差などの凹凸表面を通行する時に大きな困難に直面することは明らかである。
【０００８】
別の形式の人輸送装置は、輸送装置を２つの車輪上で釣り合わせることができる制御機構を含むであろう。２つの車輪は、車輪の中心を通る単一軸に連結することができる。その軸は、装置の前後移動が軸に直交する方向になるようにして車輪を連結する。制御機構は、重心を車輪軸の上方位置に保持できるように車輪を前後方向に駆動することによって、装置およびユーザを安定的な直立位置に保持することができる。そのような装置はさらに、重心を車輪軸から前後方向に一定距離だけ変位させることができるようにし、重心をその位置に保持するように車輪を回転させることによって、移動を行うことができる。そのような装置の例が、米国特許第５，７０１，９６５号および第５，７１９，４２５号に開示されており、それらは参照として本明細書に援用される。
【発明の概要】
【課題を解決するための手段】
【０００９】
［発明の概要］
本発明の実施形態によれば、装置の第１作動モードおよび第２作動モード間の転換を行うシステムが開示されている。この実施形態では、システムが、第１作動モードでシステムを制御するために第１作動モードに関連した利得係数を用い、第２作動モードで作動する時に第２作動モードに関連した利得係数を用いる制御ループを含む。本実施形態では、システムはさらに、装置が第１作動モードから第２作動モードに移行するのとほぼ同時に、第２作動モードに対応した係数を使用して制御ループを作動させる利得セレクタも含む。
【００１０】
本発明の別の実施形態によれば、制御信号に応答する装置を円滑に作動させる方法が開示されている。この実施形態では、方法は、制御信号用の値を決定するステップと、制御信号を処理して修正された制御信号を生成するステップと、修正された制御信号を装置に印加するステップとを含む。
【００１１】
本発明の別の実施形態では、マルチモジュラー装置(multi-modular apparatus)においてモード間の円滑な切り換えを行う方法が開示されている。この実施形態の方法は、モード変更が行われたかを決定するステップと、モードが変更されている場合にオフセット値を決定するステップとを含む。この実施形態の方法はまた、平滑化された制御信号を生成するために、制御信号を装置に印加する前に、制御信号に減衰オフセット値を加算するステップと、平滑化された制御信号を装置に印加するステップとを含む。
【図面の簡単な説明】
【００１２】
【図１】図１Ａおよび図１Ｂは、従来型車椅子の例を示している。
【図２Ａ】図２Ａは、人輸送装置の様々な実施形態を示している。
【図２Ｂ】図２Ｂは、人輸送装置の様々な実施形態を示している。
【図２Ｃ】図２Ｃは、人輸送装置の様々な実施形態を示している。
【図２Ｄ】図２Ｄは、人輸送装置の様々な実施形態を示している。
【図２Ｅ】図２Ｅは、人輸送装置の様々な実施形態を示している。
【図２Ｆ】図２Ｆは、人輸送装置の様々な実施形態を示している。
【図３】図３は、人輸送装置の別の実施形態を示している。
【図４】図４は、図２Ａに示されている輸送装置の簡略形を示している。
【図５】図５Ａおよび図５Ｂは、階段モードで作動中の人輸送装置のクラスタの相対向きを示している。
【図６】図６は、人輸送装置の可能な作動モードのブロック図を示している。
【図７】図７Ａおよび図７Ｂは、輸送装置の簡略化した側面図である。
【図８】図８は、本発明の態様に従って実行することができる制御ループの一例を示している。
【図９】図９は、本発明の態様に従った切り換えモードに使用できる値の例をグラフで示している。
【図１０】図１０は、制御切り換え値を決定する１つの実施形態のデータ・フロー図である。
【図１１】図１１は、輸送装置の様々なサブモード間での移行時を決定する方法をフローチャートで示している。
【図１２Ａ】図１２Ａは、本発明と組み合わせて使用することができる制御ユニットの一例を示している。
【図１２Ｂ】図１２Ｂは、図１２Ａの制御ユニットの１つの実施形態の機能ブロック図を示している。
【図１３】図１３は、本発明に従って実行することができる制御ループを示している。
【図１４】図１４は、本発明の態様に従って使用することができる利得テーブルの一例を示す図である。
【図１５】図１５は、制御装置に印加する前に制御信号を平滑化するために実行されるシステムの一例を示している。
【図１６】図１６は、制御信号を平滑化する方法のブロック図を示している。
【図１７Ａ】図１７Ａは、本発明の態様に従って利得スケジューリング動作を実行するために構成された制御ループのブロック図を示している。
【図１７Ｂ】図１７Ｂは、モード間で円滑に移行することができる制御システムの実施形態を示している。
【図１８】図１８は、本発明の態様に従ってフィードバック制御システムで実行される制御スケジューリング・プロセスのフローチャートを示している。
【図１９】図１９は、図１７Ａおよび図１７Ｂに存在する様々な信号をグラフで示している。
【図２０】図２０は、輸送装置の車輪の位置を制御する制御ループの一例を示している。
【図２１】図２１は、輸送装置のクラスタの位置を制御する制御ループの一例を示している。
【図２２】図２２Ａは、重心推定値を使用することができる制御ループの一例を示している。図２２Ｂは、重心の位置の推定値に基づいて所望の向きを生成するシステムのブロック図を示している。
【図２３】図２３は、輸送装置のフリー・ボディ(free body)図の一例を示している。
【図２４】図２４は、装置の重心の位置を推定するためのデータ・セットを生成する方法の一例を示している。
【図２５Ａ】図２５Ａは、図２４の方法の各部分を図形で示している。
【図２５Ｂ】図２５Ｂは、図２４の方法の各部分を図形で示している。
【図２５Ｃ】図２５Ｃは、図２４の方法の各部分を図形で示している。
【図２６】図２６は、輸送装置の重心の位置を推定するために使用することができるデータ・セットのグラフを示している。
【発明を実施するための形態】
【００１３】
［詳細な説明］
本発明の態様は、人輸送装置の作動のための様々な制御モードに関する。様々なモードの各々によって異なった形式の制御が可能である。一部の実施形態では、モードの一部ではユーザの入力コマンドに対する応答性が非常に高いが、別のモードは、輸送装置を、従ってユーザを直立した安定位置に保持しようとして、ユーザの入力コマンドを完全に無視するであろう。
【００１４】
図２Ａは、本発明の態様を実施することができる輸送装置２００の一例を示している。本発明の様々な内容が様々な輸送装置に関連させて説明されているが、その説明の教示が人輸送装置での実施だけに制限されないことに注意されたい。たとえば、様々な制御モードは、図２Ａに示されている輸送装置２００に似ていない輸送装置にも適用可能である。また、様々なモード間での円滑な移行を可能にするシステムおよび方法は他の装置にも適用可能である。
【００１５】
輸送装置２００は、ユーザの人（図示せず）を支持するのに適したプラットフォーム２０２を含むことができる。プラットフォーム２０２は、図２Ａに示されているものと同様な、ユーザが座る椅子形プラットフォームにすることができる。しかし、後述するように、プラットフォーム２０２は椅子形プラットフォームである必要はなく、ユーザの人を支持することができるいずれの形式のプラットフォームでもよい。たとえば、プラットフォームは、ユーザが立つプラットフォームにすることもできる。
【００１６】
輸送装置２００はまた、椅子のアームに似たアーム２０４を含む。アームは、ユーザが寄りかかったり、他の方法でユーザを支持する場所を提供することができる。アーム２０４は、ユーザから方向コマンド入力を受け取ることができるジョイスティックなどのユーザ・インターフェース２０６を含むことができる。ユーザ・インターフェースの他の形式として、ローラ・ボール、タッチ・パッド、息感知入力装置(breath sensitive input)、ユーザに、またはユーザが着用している衣類に取り付けられた位置通報センサ、音声認識システム、押しボタン制御装置などを含むことができるが、それらに制限されない。ユーザ・インターフェース２０６がこれらの入力コマンドを輸送装置２００の制御ユニット２４０に中継することによって、輸送装置２００の所望方向の移動を実施することができる。ユーザ・インターフェース２０６はまた、移動速度を決定する(effect)こともできる。
【００１７】
輸送装置２００はまた、接地部材２０８および２１０を含むことができる。図２Ａに示されているように、接地部材２０８および２１０は車輪である。しかし、接地部材２０８および２１０は車輪に制限されないことに注意されたい。たとえば、接地部材は、キャスタ、剛直部材（たとえば、米国特許第５，７９１，４２５号の図２２〜図２４に示されている弓形部材）、トレッド(treads)または他の移動機構にすることができる。上記および他の接地部材を有する人輸送装置について以下に記載する。
【００１８】
車輪２０８および２１０を含む実施形態では、車輪が表面と接触して、表面上を移動できるようにしている。車輪２０８および２１０は、モータ（図示せず）によって駆動することができる。また、各車輪２０８および２１０を輸送装置の他方側の同軸的な車輪（図示せず）と左右逆転配置することによって、通行中の表面と接触する４つの車輪を設けることができる。
【００１９】
車輪２０８および２１０は、可動アーム２１２（またはクラスタ）に取り付けることができる。ここで使用する用語「可動アーム」および「クラスタ」は、接地部材を取り付けることができるアセンブリを指すものとする。また、クラスタは、文脈によっては接地部材を含んでそれらを互いに連結したアセンブリ全体を指すことも時々あるであろう。クラスタ２１２は剛直部材でもよいが、様々な軸を中心に折り畳むことができる部材でもよい。たとえば、ここでクラスタ２１４が第１部分２１６および第２部分２１８を有するように示されている図２Ｂを参照すると、第１部分２１６および第２部分２１８は、ピボット点２２０で互いに回動するように取り付けられているであろう。クラスタ２１４は、２つの車輪２２２および２２４を含むであろう。２つの車輪２２２および２２４は、それぞれ接触点２２６および２２８で表面と接触することができる。クラスタが水平面上にあるために、本実施形態では接触点２２６と接触点２２８との間の距離が輸送装置のフットプリントの長さ（ｌ）を定める。（もちろん、クラスタが傾斜上にある場合、フットプリントの長さは水平面上のＬの投射図の長さに等しいであろう。本実施形態では、クラスタ２１４の第１部分２１６および第２部分２１８間のピボット点２２０のため、フットプリントの長さ（ｌ）が可変である。クラスタ２１４の第１部分２１６とクラスタ２１４の第２部分２１８との間の角度θcが約１８０°の時、フットプリントの長さ（ｌ）が最大である。
【００２０】
１つの実施形態では、クラスタ２１４の第１部分２１６と第２部分２１８との間の角度θcが極めて小さくなるように、クラスタのフットプリントの長さを短くすることができる。そのような実施形態の一例が、図２Ｃに示されている。この実施形態では、車輪２２２および２２４の外周が重なるであろう。もちろん、この実施形態では、車輪２２２および２２４をＺ軸に沿って互いにずらせることによって、車輪２２２および２２４が互いに接触して車輪の回転が妨害されることがないようにすることができる。
【００２１】
再び図２Ａに戻ると、クラスタ２１２は、プラットフォーム支持体２３０によってプラットフォーム２０２に取り付けることができる。プラットフォーム支持体２３０は、上側部分２３２と下側部分２３４とを含むことができる。（プラットフォーム支持体２３０を一体形部材にすることもできる。）
１つの実施形態では、プラットフォーム支持体２３０の下側部分２３４をクラスタ２１２に回動可能に取り付けることができる。クラスタ２１４とプラットフォーム２０２の底部との間の高さＨを調整するために、プラットフォーム支持体２３０の下側部分２３４をクラスタ連結部ピボット点２３６中心に回転させて、もっと垂直向きにすることができる。また、下側部分２３４を垂直向きに回転させる時、上側部分２３２も支持体ピボット点２３８を中心に回転させて、プラットフォームをさらに高くすることもできる。
【００２２】
プラットフォーム２０２を降下させようとする時、下側部分２３４をクラスタ２１２に接近するように移動させる。また、上側部分２３２を下側部分２３４およびクラスタ２１２の両方に接近するように移動させることもできる。
【００２３】
輸送装置２００はまた、制御ユニット２４０（または電子機器ボックス）を含むことができる。一般的に、制御ユニット２４０は、輸送装置２００を作動させるために輸送装置２００内に含むことができる様々なモータにコマンドを送る。制御ユニット２４０は、傾斜センサ、速度センサ、加速度センサ、位置通報センサなどの様々なセンサを含むことができる。１つの実施形態では、制御ユニット２００は、輸送装置２００を安定させるために、車輪２０８および２１０の位置や、クラスタ２１２の角度向きを、またはその両方を調整することができる。また、制御ユニット２４０は、ユーザ・インターフェース２０６から受け取った入力コマンドに応答するために、クラスタ２１２および車輪２０８および２１０を回転させることができる。１つの実施形態では、制御ユニット２４０は様々なセンサ入力に基づいて、プラットフォーム２０２に対するクラスタ２１２の角度を調整することによって、クラスタ２１２を通る軸２４２および車輪２０８および２１０のそれぞれの車軸２４４および２４６を通行中の表面にほぼ平行にして、プラットフォーム２０２を直立位置に保持することができる。輸送装置２００が標準または強化モードで作動している時、このような向きが好ましい。標準モードおよび強化モードなどの様々なモードについてさらに詳細に後述する。
【００２４】
図２Ｄは、人輸送装置２００用のクラスタ２４８の変更実施形態を示している。この実施形態では、クラスタ２４８は、モータ（図示せず）によって駆動される第１車輪２５０を含む。モータを駆動するコマンドは、制御ユニット２４０（図２Ａ）から受け取ることができる。クラスタ２４８は、モータで駆動されない第２車輪２５２も含むことができる。たとえば、第２車輪２５２は、クラスタ２４８に固定されたキャスタ形車輪でもよい。これまでの図面は前進方向が左から右方向であるように記載されているが、図２Ｄのクラスタ２４８はいずれの方向に向けてもよいことを理解されたい。すなわち、動力付き車輪２５０を前輪にしても、第２車輪２５２を前輪にしてもよい。
【００２５】
図２Ｅは、輸送装置２００の制御ユニット２４０に固定された非駆動(non-motorized)車輪２５４を含む輸送装置２００の一例を示している。この実施形態では、１つの作動モードにおいて、後輪２０８が表面と接触したままであるが、前輪２１０が表面と接触しないようにクラスタ２１２を回転させることができる。不安定状態にならないと仮定して、クラスタ２１２の回転によるトルクによって、非駆動車輪２５４が表面と接触するまで輸送装置２４０が前方に傾くであろう。この作動モードは、輸送装置２００が滑らかな平坦表面上で作動しているときに好ましいであろう。この向きでは、後輪２１２をモータで駆動するだけでよく、したがって、輸送装置２００が消費する動力量を減少させることができることに利点がある。
【００２６】
クラスタに取り付けられた車輪２０８および２１０の両方が表面と接触するようにクラスタ２１２を回転させた場合、非駆動車輪２５４が表面から持ち上がり、輸送装置が４輪駆動装置になるであろう。そのような配置の輸送装置２００の一例が、図２Ｆに示されている。図２Ｆでは、車輪２１０および２０８が表面２７０と接触している。非駆動車輪２５４は表面２７０の上方に上昇している。この実施形態では、クラスタ２１２およびプラットフォーム２０２が表面２７０にほぼ平行である。以上に人輸送装置２００の様々な実施形態を詳細に説明してきた。車輪２０８および２１０を、各々が個別のモータで駆動される動力付き車輪にしてもよいことに注意されたい。しかし、車輪２０８および２１０の両方を単一のモータで駆動してもよい。また、車輪の一方だけをモータで駆動してもよい。さらに、輸送装置２００を側面図だけで示してきた。側面図で示されている構成要素を輸送装置２００の他方側に左右逆配置することができることを理解されたい。たとえば、輸送装置は、輸送装置２００の各側にクラスタを含むことができる。１つの実施形態では、クラスタを互いに固定連結して、それらが一体部材として移動するようにしてもよい。しかし、各クラスタが互いに独立的に作動するように、クラスタを回転またはその他の方法で平行移動できるようにすることも、本発明の範囲に入る。さらに、本発明は、上記の輸送装置で実現されることに制限されないことにも注意されたい。たとえば、本説明に含まれる教示の一部または全部は、ヘリコプター、航空機、自動車、オフロード車、原付自転車、オートバイなどの輸送装置でも実施することができる。本発明の教示を実施できる他の形式の輸送装置が、図３に示されている。
【００２７】
図３は、ユーザが立つことができる人輸送装置３００を示している。輸送装置は、立った姿勢のユーザの人３０４を支持するのに適したプラットフォーム３０２を含むことができる。１つの実施形態では、人３０４がプラットフォーム３０２上で所望の移動方向へ傾くことによって、装置３００の移動を制御することができる。この実施形態では、プラットフォーム３０２がベース・ユニット３０６に回動可能に取り付けられている。ベース・ユニット３０６は、輸送装置３００の移動と、おそらくは安定性とを制御することができる制御ユニット３０８を含むことができる。ベース・ユニット３０６はまた、車輪３１２および３１４などの接地部材を含むクラスタ３１０も含むことができる。人輸送装置はまた、ユーザから所望の移動コマンドを受け取るためのジョイスティック３１６などの第２ユーザ入力装置も含むことができる。図３に示されているように、人輸送装置３００は、傾斜プラットフォーム３０２およびジョイスティック３１６の両方を含む。
【００２８】
さらに具体的に言うと、ユーザが輸送装置３００の移動を指示することができるようにするために、プラットフォーム３０２またはジョイスティック３１６が制御ユニット３０８に入力を送る。ユーザ入力に応答して、制御ユニット３０８は車輪（３１２および３１４）およびクラスタ３１０のいずれか一方または両方を回転させることができる。また、制御ユニット３０８は、重心３１８を輸送装置３００のフットプリントの垂直方向上方に保持するために、時にはユーザ入力に関係なく、クラスタ３１０の位置および車輪３１２および３１４の位置の両方またはいずれか一方を調整することができる。図３に示されているように、重心３１８は、車輪３１２および３１４の軸の間でクラスタ３１０の垂直方向上方に変位する。１つの実施形態では、制御ユニット３０８は、重心３１８をクラスタ３１０の中心点３２０の上方に維持する。重心３１８がクラスタ３１０の中心点３２０の上方に位置する時、輸送装置３００は非常に安定しているであろう。
【００２９】
便宜上、以下の説明の一部では、重心の位置が既知であるように述べるであろう。しかし、場合によっては、その位置は推定位置に基づく。重心を推定するシステムおよび方法については後述する。さらに、重心を基準量として記載するが、本説明の教示はそれに制限されず、輸送装置を効果的に安定させるために輸送装置の他の特性を考慮するだけでもよいことに注意されたい。たとえば、重心の位置の推定に依存する必要性の代わりに、（後述の）ピッチ率を考慮することもできる。
【００３０】
図４は、図２に示されている輸送装置２００の簡略形を示している。この例では、輸送装置がいわゆる「均衡モード」で作動している（図２〜図３の例のような他の実施形態も、均衡モードで作動することができる。）。（輸送装置が静止している）均衡モードでは、制御ユニットは、様々な入力に基づいて、接地車輪４０４を通る横軸４０２の上方に重心４００を維持しようとする。このモードでは、重心４００を接地車輪４０４の横軸４０２の垂直方向上方の位置に維持するために、接地車輪４０４を回転させることによって、安定化のほぼすべてが行われる。このために、クラスタ４０８は、プラットフォーム２０２の底部に対して固定位置に保持されるであろう。図４に示されている実施形態では、クラスタ４０８がほぼ垂直位置に保持されている。（クラスタを他の相対角度に保持することもできる。）
繰り返すと、均衡モードにある輸送装置２００は、重心４００を輸送装置２００が載っている接地車輪４０４の横軸４０２の垂直方向上方のいずれかの位置に変位させるように、プラットフォーム２０２の位置を制御することによって作動する。移動できるようにするために、装置が「FORE/AFT」方向に制御状態で落下を開始するように、重心４００を接地車輪４０４の横軸４０２の前方または後方のいずれかにわずかに変位させることができる。重心４００が横軸４０２に対して変位している時、本質的に重心４００を軸４０２に対して比較的接近しているがずれた位置に保持するように、接地車輪４０４を駆動する。このようにして、装置は転倒しない。図４に示されているような輸送装置の均衡モードは、米国特許第５，７０１，９６５号に開示されている。均衡モードのこの実施形態では、輸送装置４００の安定化を助けるために、クラスタ４０６が適所位置にロックされて、回転することはないであろう。このため、本実施形態では、均衡モードは一般的に、人輸送装置を動的に安定させる「車輪のみ」の方法("wheel only" approach)であると考えることができる。
【００３１】
場合によっては、人輸送装置がユーザまたは他のいずれかの外的手助けの補助をほとんど、またはまったく受けないで、階段の昇降を行うことが望ましいであろう。このため、一部の人輸送装置は、階段を登る能力を発達させて、いわゆる「階段」または「傾斜」モードで作動する。そのような装置の例が、米国特許第５，７０１，９６５号および第５，７９１，４２５号に示されている。階段モードでは、車輪をクラスタに「連動(slaved)」させることができる。すなわち、車輪は、移動手段としてではなく、クラスタを回転させるためだけに運動することができる。
【００３２】
図５Ａおよび図５Ｂは、階段モードで作動している人輸送装置のクラスタ５００の相対向きの２つの例を示している。階段モードで作動する時、階段をどちらの方向に進むか（すなわち、階段を登るのか、降りるのか）によって、後輪車軸または前輪車軸のいずれかの上方に重心が位置するように、クラスタ５００を回転させることができる。車輪５０２が階段５０８の前縁部５０６と接触した時、車輪は階段に押し付けられた状態に保持される。重心が接触点５１４に向かって移動する時、クラスタ５００は、図５Ｂに示されているように、上向きに回転し始めるであろう。クラスタ５００が回転する時、連動車輪５０２はクラスタの回転に応じてクラスタ５００に対して回転するので、車輪上の同一点が階段と接触点５１０で接触している。車輪５０２が移動できるとすると、クラスタの回転によって車輪５０２が階段から離れる方向に移動するため、輸送装置が転倒するであろう。
【００３３】
第２車輪５０４が階段５０８の上縁部５１２と接触点５１４で接触するまで、クラスタ５００が（本例では、時計回り方向に）回転する。輸送装置が階段の上部に達するまで、このプロセスが繰り返される。別の実施形態では、たとえば、輸送装置が大きい縁石を横切っている場合、上記プロセスを一度実行するだけでよいであろう。
【００３４】
上記システムは、装置の均衡を効果的に維持するために、クラスタまたは車輪のいずれかを使用している。しかし、場合によっては、ユーザが転倒しないようにする位置に重心を保持するために、車輪およびクラスタの両方を使用する方が望ましいことが分かった。たとえば、凹凸表面を通過する時、プラットフォームを直立位置に保持するために、車輪およびクラスタが同時に回転することが望ましいであろう。
【００３５】
このため、本発明の幾つかの実施形態の態様が、輸送制御の新しいモードに向けられている。この新しいモードをここでは強化モードと呼ぶ。１つの実施形態では、強化モードは、重心が輸送装置のフットプリントの上方に位置するか、それに非常に接近した位置にあるように（または、輸送装置のフレームピッチ（またはフレームピッチの関数）を所定範囲内のパラメータに保つなどの他の基準を満たすように）、輸送装置の車輪およびクラスタの両方を制御することによって、輸送装置の作動および安定化を制御する。
【００３６】
図６は、人輸送装置の可能な作動モードを詳細に説明するブロック図である。１つの実施形態では、人輸送装置は、標準モード６０２、均衡モード６０４および階段モード６０６を含むことができる。本発明のある一定の実施形態の態様によれば、輸送装置は強化モード６０８も含むことができる。これらの様々な制御モードは、装置の移動を行うために制御ユニット内に収容されたソフトウェアおよびハードウェアによって使用される。各モードは、人輸送装置が異なったパラメータに従って作動できるようにする。人輸送装置は他の作動モードも含むことができることに注意されたい。たとえば、人輸送装置は、モード間の移行を行うモードや、システム故障を処理するモードを含むことができる。
【００３７】
ここに説明した制御モードおよび関連のソフトウェアおよびハードウェアは、図３に関連して以上に説明した制御ユニットなどの制御ユニット内に包含することができる。しかし、ソフトウェアおよびハードウェアの様々な部分を制御ユニット以外の場所で使用することもできる。たとえば、プラットフォーム、クラスタ、車輪、または人輸送装置の作動を効果的に制御するために望ましいか、必要な他の場所に様々なセンサを配置することができる。
【００３８】
均衡モード６０４および階段モード６０６は前述されており、例示のため、図６の実施形態が上記説明に従って作動するものと仮定することができる。しかし、均衡モード６０４および制御モード６０６の変更形が存在し、本説明に与えられている様々な制御計画に基づいて作動する輸送装置に完全に組み込むことができることに注意されたい。
【００３９】
ここで使用する用語「標準モード」は、動的安定化がまったく生じない作動モードを指すものとする。標準モードでは、クラスタおよびプラットフォームが互いに固定関係のままである。たとえば、ユーザが椅子形プラットフォーム（図２）を有する人輸送装置を標準モードで作動させている場合、クラスタに対するプラットフォームの角度を制御するモータは一定位置に保持される。輸送装置が傾斜を上っている時、プラットフォームは後方に傾斜する。しかし、傾斜が急になりすぎると、システムの重心が、輸送装置のフットプリントの外側の位置にあって、輸送装置が後方にひっくり返る可能性がある。
【００４０】
標準モードでは、ユーザが輸送装置の移動を完全に制御することができる。すなわち、制御ユニットは、ユーザ入力に非常に敏感である。１つの実施形態では、ユーザ入力部から受け取った入力に高い利得係数（後述）を適用することによって、これを達成することができる。ユーザ入力部は、ジョイスティックか、ユーザが作動させる他の適当な入力装置にすることができる。また、輸送装置は、ユーザ入力部として機能する傾斜可能なプラットフォームを含むことができる。
【００４１】
ある一定の実施形態によれば、標準モードは２つのサブモードを含むことができる。第１のサブモードは、図２Ｅに示されているようなシステムで実行されるであろう。このサブモードでは、非駆動車輪２５４を輸送装置２００の制御ユニット２４０に固定することができる。少なくとも装置が前傾して非駆動車輪２５４が表面と接触するまで、クラスタ２１２が回転点２１３を中心に回転することができる。このモードでは、ユーザコマンドに応答して移動を行うために、後輪２０８を駆動するモータに電力が供給される。このように、クラスタ２１２の前駆動車輪（たとえば、車輪２１０）に取り付けられたモータへの電力供給が停止されているので、電力を温存することができる。この理由から、一般的に標準モードは、特にこのサブモードは、限られた電源（たとえば、充電式バッテリ）を有する輸送装置２００を長時間にわたって作動させようとする時に特に魅力的である。また、このモードでは、エネルギを温存するために、輸送装置によって与えられるいずれのタイプの安定化も使用不能になるであろう。また、非駆動車輪がキャスタ形車輪で、高い操縦性を有することができるため、このモードでの旋回半径が最小になるであろう。また、クラスタ２１２の各側に連結された各車輪が独自の車輪モータを含むこともできる。両側の車輪の各々に異なった信号を送ることによって、輸送装置２００は円を描いて旋回することができるであろう。これは、一方の車輪に正のトルクを、他方に負のトルクを与えることによって達成することができる。
【００４２】
標準モードの別のサブモードは、図２Ｆに示されているように、４車輪すべてが表面と接触し、非駆動車輪２５４が地面から離れた状態に保持されるようにクラスタを回転させるモードを含む。このサブモードでは、輸送装置２００は、４輪駆動輸送装置として機能することができる。しかし、ユーザが標準モードのこのサブモードを後述の強化モードと混同しないように、このモードでは車輪がユーザ入力コマンドに応答しないことが好ましい。
【００４３】
前述したように、標準モードはプラットフォームをクラスタに対してほぼ一定の角度関係に保持することができる。この場合、標準モードのいずれのサブモードでも、クラスタをプラットフォームに対して位置決めするモータを使用不能にすることができる。
【００４４】
図６に戻って説明すると、ユーザは、ユーザ・インターフェース上でユーザに提示されたオプションを選択することによって、モード間の移行を行うことができる。ユーザ・インターフェースは、たとえば、プラットフォーム２０２上に設けられたアーム２０４（図２Ａ）に設けることができる。あるいは、モード移行を自動的に行うこともできる。たとえば、供給電力が低レベルになると、電力を節約するか、安全性を確保しようとして、輸送装置を自動的に均衡モードから標準モードに移行させることができる。
【００４５】
輸送装置は、様々なモードから別のモードに移行することができる。たとえば、輸送装置は、矢印６２０で表されているように、標準モード６０２から均衡モード６０４に移行したり、戻ることができる。輸送装置はまた、矢印６２１で表されているように、均衡モード６０４から階段モード６０６に移行したり、戻ることができる。また、輸送装置は、矢印６２２で表されているように、標準モードから階段モード６０６に移行したり、戻ることができる。ユーザがユーザ入力装置からモード移行を選択した時、輸送装置は、矢印６２３で表されているように、標準モード６０２、均衡モード６０４または階段モード６０６から強化モード６０８に出入りすることができる。後述するように、強化モードは、輸送装置の他のいずれのモードより動的安定性を高くすることができる。そのため、輸送装置が現在の作動モードでは不安定になっていると制御ユニットが決定した場合、輸送装置は自動的に強化モードに入ることができる。
【００４６】
幾つかの実施形態によれば、クラスタがほぼ垂直向きである時、強化モードに自動的に入ることが防止される。輸送装置の現在の向きの幾つかのパラメータが、モード変更を行った時に輸送装置が不安定になるような値でなければ、ほとんどいつでも強化モードから出ることができるであろう。
【００４７】
やはり後述するように、強化モードは、自動的に切り換えられる複数のサブモードを含むことができる。また、後述する制御切り換えおよび利得スケジューリング・システムおよび方法によって、強化モードを円滑かつ効果的にサブモード間で切り換えることができる。
【００４８】
図７Ａは、強化モードで作動することができる輸送装置７００の簡略化した側面図である。輸送装置７００は一例として与えられているだけであって、ここに記載する強化モードの作動の応用を決して制限するものではないことに注意されたい。
【００４９】
輸送装置７００は、プラットフォーム７０２を含む。前述したように、このプラットフォームは、図２Ａに示されているような椅子形のプラットフォームでもよいが、図３に示されているように、ユーザが立つプラットフォームでもよい。しかし、強化モードでの輸送装置の相対角度の説明は、いずれの構造または他の構造にも等しく当てはまる。以下の説明のため、図７Ａでは、時計回り方向を指す矢印によって表された角度は正の値であり、反時計回り方向を指す矢印によって表された角度は負の値であるように、角度を測定する。たとえば、φc（重力に対するクラスタ位置）として示された角度は正の角度であり、θ3として示された角度は負の角度である。
【００５０】
重心７０４は、システム全体の重心を表す。これは、輸送装置７００、ユーザ（図示せず）およびユーザが持っていると思われる（やはり図示せず）いずれのペイロードも含む。また、重心は、輸送装置の安定性を決定するために、推定および試験の両方またはいずれか一方によって得ることができる輸送装置のパラメータの一例として与えられているだけであることに注意されたい。
【００５１】
制御ユニット７０６が発生する制御信号は、重心７０４を輸送装置７００のフットプリントの上方に保持しようとする。繰り返すが、装置のフットプリントは、クラスタの端部点の間に存在するものと定義することができ、さらに好ましくは、前輪７１２および後輪７１４の横軸７０８および７１０の間にある。これらの車輪は、クラスタ７１６に取り付けられ、その一部にすることができる。１つの実施形態では、強化モードにおいて重心はクラスタ７１６の中心点７１８の上方に位置し続ける。
【００５２】
プラットフォーム７０２は、プラットフォーム支持体７２０によって支持することができる。ここで用いられるプラットフォーム高さ（Ｈ）は、プラットフォーム７０２の底部と座部支持体７２０がクラスタ７１６に連結される場所との間の距離を指すものとする。
【００５３】
プラットフォーム支持体７２０の上側部分７２２および下側部分７２４間の角度θhを変更することによって、座部高さＨを調整することができる。上側部分７２２および下側部分７２４を回動式に連結するピボット点７２８にモータを設けることができる。このモータは、座部高さコマンドに基づいて、上側部分７２２および下側部分７２４間の角度θhを増減することができる。これは、ユーザが立っている人の目の高さまで上昇する（またはそれに近づく）ことができるようにするため、好都合である。１つの実施形態では、プラットフォーム７２６および上側部分７２２も、上側部分７２２の向きに関係なく、プラットフォーム７０２の底部がほぼ水平方向であるように角度θsを設定するモータを含むことができる。
【００５４】
図９〜図１１に開示され、本明細書に参照として援用される米国特許第５，７９１，４２５号の説明に関連した別の実施形態では、プラットフォーム・ホルダ７２０が、プラットフォームに対して、また互いに対して調整することができる上側および下側部分を有する関節式アームでもよい。この調整は、接触ピボット点７２６、７２８および７３０に位置する動力付き駆動装置によって行うことができる（そこにおいて、下側部分７２４は、クラスタ７１６に回動式に連結している。）。動力付き駆動装置を（たとえば、ベルトによって）互いに連結することによって、上側および下側部分間のピボット点７２８で連結された１つのモータの位置の変化が、プラットフォーム７０２および上側部分７２２間の角度θsに対応する変化を生じることによって、プラットフォーム７０２の底部がほぼ水平であるようにすることができる。
【００５５】
座部高さが人輸送装置７００の作動に重要である理由は少なくとも２つある。第１に、システム全体の重心７０４を推定するために、座部高さＨを利用することができる。また、座部高さは、重心が重力（ｇ）によって定められる垂直軸に対して移動する速度に影響するであろう。座部が高いほど、重心が外乱に応答して移動する速度が遅くなるであろう。このため、座部高さは、輸送装置の動的安定性を制御する時に考えられる変数であろう。たとえば、座部高さは、輸送装置を制御する、または他の方法で安定させるために使用される特定の利得係数（後述する）の大きさに影響を与える入力であろう。
【００５６】
重心７０４がクラスタ７１６を通る垂直軸からずれる量を本説明では「フレームピッチ」と呼び、図７Ａにθ1で表す。このフレームピッチは、角変位に基づいた「回転」ピッチにすることができる。図示のように、垂直軸は、クラスタ７１８の中心点７１８を通っている。しかし、強化モードでは、垂直軸が、車輪７１４または車輪７１２の中心を通る横軸の間に位置するクラスタのいずれかの部分（たとえば、フットプリント）を通ることができることに注意されたい。中心点７１８を通らないクラスタ７１６の部分を軸が通ることが望ましい場合、クラスタ７１６を通る垂直軸がクラスタ７１６の中心点７１８から離れている距離を考慮に入れるために、後述の安定化制御プロセスが変更されるであろう。
【００５７】
重心７０４をクラスタ７１６の中心点７１８の上方に置くという制御目的は、輸送装置の別の作動モードには適用できないこともあることに注意されたい。たとえば、均衡モードでは、制御目的は、重心７０４をクラスタ７１６の車輪の１つを通る横軸の上方に適当な関係で保持することであろう。
【００５８】
前述したように、重心７０４の位置は、座部高さに依存した概算に基づくであろう。重心７０４の位置はまた、プラットフォームが重力に関して移動する割合に基づいて決定されるであろう。この割合を本説明ではピッチ率と呼ぶ。たとえば、輸送装置７００上に配置された移動センサ（図示せず）によって、システムが高率で前傾していることを感知することができる。この移動が、場合によっては、輸送装置７００のフットプリントから外れるように重心７０４を変位させるであろう。このため、装置のフットプリントを表面に対してピッチ率の方向に移動させて、フットプリントが重心７０４の下方に位置するようにする必要があるであろう。
【００５９】
図７Ａは、制御ユニット７０６も示している。制御ユニット７０６の作動については後述する。制御ユニット７０６は、システムのピッチ率などを決定する様々な動きセンサを含むことができる。センサは、いずれかの特定形式のセンサに制限されることはなく、たとえば、加速度計、位置センサ、「レベル」センサ等にすることができる。容易に理解できるように、ピッチ率は、測定または推定フレームピッチθ1を時間に関して微分することによって、経験的に決定することができる。制御ユニット７０６は、車輪７１２および７１４に取り付けられたモータ、並びにクラスタ７１６に取り付けられたモータを制御することができる様々なハードウェアおよびソフトウェアも含むことができる。また、制御ユニット７０６は、輸送装置７００を安定化するように働く後述の様々な制御ループも含むことができる。
【００６０】
１つの実施形態では、制御ユニット７０６にクラスタ７１６を回動可能に取り付けることができる。このため、垂線に対するクラスタ７１６の角度向きの変化が制御ユニット７０６の向きに同じ変化を生じることはないであろう。制御ユニット７０６の上部が水平線から変位している角度（制御ユニット角度θcで表す）とクラスタ７１６が垂線から変位している角度（φc、重力に対するクラスタ位置を表す）との差を本説明では相対クラスタ位置と呼び、角度θcで表す。角度θcは、重心７０４に対する制御ユニット７０６の上部の角度向きを表す。
【００６１】
繰り返すと、強化モードの包括的目的は、重心７０４を輸送装置７００のフットプリントにほぼ入る位置に配置しようとすることである。一部の実施形態では、強化モードは、重心７０４をクラスタ７１６の中心点７１８の上方に配置しようとする。この実施形態は、重心がクラスタ７１６の中心点７１８の垂直方向上方に位置した状態で輸送装置７００の４つの車輪すべてを表面上に配置しようとする安定化であるとほぼ見なすことができる。この状態を満たした時、輸送装置７００はほぼ安定した位置にある。また、プラットフォーム７０２の底部を水平線にほぼ平行に保持することが好ましいであろう。プラットフォーム７０２の底部が水平線にほぼ平行である場合、ユーザはより安定した感じを持ち、従ってより快適であろう。
【００６２】
クラスタ７１６の長手方向軸７４０が水平線から角変位した状態に示されている。しかし、プラットフォーム７０２の底部は水平線にほぼ平行な状態のままである。この状態は、たとえば、輸送装置７００が傾斜面を通る時に発生するであろう。重心７０４を輸送装置７０４のフットプリント内に保持するために、クラスタ７１６と下側部分７２４との間の角度を減少させる必要がある。この減少は、ピボット点７３０に連結されて、クラスタ７１６を反時計回り方向に回転させると共に下側部分７２４を前方を押し付けるモータによって行うことができる。
【００６３】
前述したように、一部の状況では、垂線からのクラスタ変位量が小さすぎる（すなわち、φc＝０）場合、クラスタ安定化ルーチンを設けるだけでは、輸送装置を効果的に釣り合わせることができない。一部の実施形態では、車輪の回転を使用して重心を装置のフットプリントの上方に（または、それに対して適当な関係に）配置することを助けることによって、均衡を維持することもできる。また、２つの車輪上で均衡をとることが、輸送装置の有用性を低下させる可能性があることがわかった。たとえば、２つの車輪上だけで均衡をとることによって、凹凸表面上をうまく進むことが困難になるであろう。たとえば、そのような２輪装置で縁石を越える場合、輸送装置を直接的に上方に実質的に持ち上げるために車輪に加える必要があるトルク量が過大になるであろう。車輪を垂直面で上昇させるためにすべてのトルクを加えた時、輸送装置をほぼ垂直位置に保持するために必要な制御が大きく妨げられるであろう。
【００６４】
幾つかの実施形態によれば、強化モードがこの問題を処理することができる。強化モードは、重心を輸送装置のフットプリントを定める領域の垂直方向上方の位置に保持しようとして、車輪釣り合い技術と共にクラスタ釣り合い技術の両方の一部を利用する。クラスタおよび車輪釣り合いアルゴリズムの両方を利用することによって、輸送装置が凹凸表面を進む時、従来技術より本来的に安定した輸送装置が提供される。
【００６５】
１つの実施形態では、この新しい強化モードが幾つかのサブモードを含むことができる。たとえば、強化モードは、車輪ＰＤ（「比例微分」）モード、車輪ＰＯＣ（カート上の振子(pendulum-on-a-cart)）モード、および車輪均衡モードを含むことができる（ラベルとして使用されている名前は制限または説明を意図しているものではない、これらの様々なサブモードの各々は、異なった状況で適用可能である。１つの実施形態では、輸送装置の現在の作動特性に応じて、本発明がこれらのサブモード間で移行する。
【００６６】
これらの目的および図７Ａで定められたパラメータ（すなわち、角度）が与えられると、制御ユニットは、輸送装置が多くの様々なタイプの異なった表面を進む時にそれを安定させることができる。１つの実施形態では、制御ユニットは、輸送装置の安定化を助けるための利得係数を実現する１つまたは幾つかの制御ループを含むことができる。別の実施形態では、制御ユニットは、各モード用に異なった制御アーキテクチャを含むことができる。
【００６７】
図８は、本発明で実行することができる制御ループ８００の一例を示している。制御ループ８００は、たとえば、モータと、輸送装置の様々なパラメータを監視する複数のセンサとを含むプラント８０２を含むことができる。少なくとも１つ、場合によっては幾つかのパラメータをプラント８０２から制御ループ８００にフィードバックすることができる。たとえば、人輸送装置のフレーム・ピッチ８０４およびピッチ率８０６をフィードバックすることができる。パラメータの各々に利得係数（たとえば、利得係数８０８ａおよび８０８ｂ）を掛けることによって、最終的に再びプラントに加えられる制御信号（加算器８１０の出力）を生成することができる。あるパラメータに掛ける係数の値が大きいほど、そのパラメータが制御信号の値に与える影響が大きい。輸送装置に適用することができる制御ループのさらなる例について詳細に後述する（図２０および図２１）。
【００６８】
再び図７Ａおよび図７Ｂの両方を参照すると、輸送装置の作動をモデル化する１つの方法は、システムをクラスタ・ピボット連結点７３０で回動する倒立振子としてモデル化することであろう。もちろん、システムを他の幾つかの方法でモデル化してもよい。システムの（位置エネルギおよび運動エネルギを含めた）全エネルギ（Ｅ）は以下のように表される。
【００６９】
【数１】
2010094533.tif 000003
【００７０】
但し、Ｊは（輸送装置、ユーザおよびペイロードを含めた）フレーム慣性であり、θ1はフレーム・ピッチであり、θ1’はピッチ率（θ1の時間に対する導関数）であり、ｍはフレーム質量であり、ｇは重力であり、Ｌ1は重心７０４からクラスタ・ピボット連結点７３０までの距離である（Ｌ1はプラットフォーム高さＨによって決まることに注意されたい）。この式は、余弦に小角近似値を使用して次のように簡略化することができる。
【００７１】
【数２】
2010094533.tif 000004
【００７２】
輸送装置７００は、全エネルギがゼロの時に最も安定している。このことは、少なくとも２つの場合に起きる。第１の場合では、フレーム・ピッチθ1およびピッチ率θ1’がゼロである。この場合、輸送装置７００は完全に静止している。別の場合では、フレーム・ピッチθ1が負（図７Ｂ）である一方、重心７０４が前方へ移動中である。重心がフレーム・ピッチθ1に対抗することができる大きさのピッチ率θ1’で前方移動している場合、やはり全エネルギが再びゼロに戻るであろう。このため、上記等式がゼロになるように、フレーム・ピッチθ1およびフレーム率θ1’間の関係を定めることが望ましい。上記の簡略化したエネルギ等式をゼロに設定した場合、次の等式を導き出すことができる。
【００７３】
【数３】
2010094533.tif 000005
【００７４】
この等式は、２つの場合の一方でゼロになるであろう。一方は、ピッチ項θ1（ｍｇＬ1／Ｊ）1/2 をθ1’に加える時であり、他方は、ピッチ項をθ1’から減算する時である。正の解は、輸送装置が垂直方向に戻っていることを表し、負の解は、全エネルギがゼロのままであっても、装置が転倒し続けていることを表す。このため、均衡インディケータｑ0を決定するために正の解が選択され、このｑ0は次の等式で定めることができる。
【００７５】
【数４】
2010094533.tif 000006
【００７６】
但し、ωnは倒立振子の固有振動数（ｍｇＬ1／Ｊ）1/2 に等しい。以上から、ｑ0＝０の時、システムがうまく釣り合うことが明らかである。ゼロから上または下への変動は、輸送装置が完全には釣り合っておらず、様々な補正を加えなければならないことを表す。後述するように、ｑ0の値は、輸送装置を強化モードの様々なサブモード間で移行させる値として使用することができる。もちろん、輸送装置をモデル化する仕方に応じて、ｑ0以外の値を使用することもできる。
強化モード
繰り返すと、輸送装置の１つの作動モードが「強化モード」である。強化モードは、スロープ、砂利道および縁石などの平坦でない地面を通行する能力を高めるために適用することができる（しかし、そうでなくてもよい）。動的安定性を与えるために、クラスタおよび車輪が一緒に使用される。強化モードはまた（あるいは代わりに）、何らかの理由から（すなわち、牽引力が失われることや、車輪が転動できなくなることなど）均衡モードが安定性を維持できない場合に、動的安定性を取り戻そうとする方法として使用することができる。
【００７７】
輸送装置の様々な状態に応じて、強化モード内の異なったサブモードを実行する必要があるであろう。これらのサブモードについて以下に説明する。
第１サブモードは、車輪ＰＤモードと呼ばれる。車輪ＰＤは、ユーザの移動コマンドに応答するモードであって、静的に安定しており、通行中の表面の緩やかな変化に対応することができる。車輪ＰＤモードでは、輸送装置はユーザコマンドに厳密に従うであろう。一部の実施形態では、これによってユーザがスロープを上り、適所で旋回し、小さいこぶなどの様々な障害物を越えることができるであろう。車輪ＰＤ制御器は、車輪ＰＤモードである時の輸送装置がユーザ入力に対して非常によく応答することを特徴とするであろう。これによって、ユーザは輸送装置の移動をしっかり制御することができる。１つの実施形態では、これは、車輪に伝達されるユーザ入力コマンドに高い利得値を適用することによって達成されるであろう。ユーザ入力コマンドに高レベルの利得を適用すると、最大量のトルクを車輪に得ることができるようになるであろう。しかし、車輪利得のこの本来的な硬直性のため、車輪加速度の急激な変化（すなわち、急発進または急停止）によって重心が前後に傾くであろう。その結果、クラスタを回転させることによってシステムに補正トルクを加えようとする時、クラスタが１対の車輪を地面から持ち上げるであろう。そのようなトルクが加えられた時、車輪ＰＤはおそらく不適当である。このため、装置は第２モードの車輪ＰＯＣモードに切り換わるであろう。
【００７８】
車輪ＰＯＣの目的は、４つの車輪すべてが地面上にあり、重心がクラスタ上方でクラスタの２つの端部点の間に位置するように輸送装置を安定させることである。このモードでは、重心をフットプリントの内側の基準位置に配置しようとするために、車輪およびクラスタの両方が使用される。このモードでは、重心をフットプリントの上方の位置に平行移動させるために、車輪がピッチ情報を使用する。重心をクラスタ連結部の上方中央に置くように車輪に指令することは、時にはユーザが与えたコマンドと一致しないであろう。これを調整するために、車輪ＰＯＣサブモードで制御ユニットが使用する利得またはアーキテクチャがピッチ及びピッチ率信号に大きい影響力を与え、ユーザコマンドに小さい影響力を与える。一般的に、車輪ＰＯＣサブモードは、輸送装置の安定性が信頼できなくなっている時に働くだけであろう。たとえば、大きい障害物や凹凸が非常に激しい表面上を進む時、安定性を信頼できない状態が生じるであろう。
【００７９】
当業者であれば容易にわかるように、重心がクラスタの端部点の間のほぼ中央に位置する時に輸送装置を安定させるには、クラスタのみの回転だけで有効であろう。ピッチ誤差（すなわち、重心がクラスタのほぼ中心の位置から変位する量）が大きくなって、重心が１組の車輪の上方に位置するほどになると、クラスタの有効性が低下し、安定化の主要手段として車輪を使用する必要があるであろう。このため、強化モードは、車輪均衡サブモードと呼ばれる第３のサブモードも含む。車輪均衡サブモードの目的は２つあり、ピッチ変動が大きい場合に輸送装置を安定させることと、重心およびクラスタを車輪ＰＤまたは車輪ＰＯＣサブモードのいずれかが有効である向きに戻すことである。前述したように、クラスタが水平に近い時、車輪ＰＤおよび車輪ＰＯＣの方が有効であろう。車輪均衡は、車輪作動の均衡モードに似ているが、クラスタを回転させる能力も含む。
【００８０】
上記モードの各々は、制御ユニット内に含まれる単一の制御ループで実行することができる。強化モードのどのサブモードで輸送装置が現在作動中であるかに応じて、上記効果を達成するために様々な利得係数が制御ループに適用される。各サブモード用の利得は、たとえば、ユーザが輸送装置を制御する量や、輸送装置が自身の動的安定化を行う量を変化させることができる。また、各サブモードを個別制御アーキテクチャとして実行することもできる。
【００８１】
前述したように、輸送装置の制御ユニットは、強化モードで輸送装置の制御および安定化を行うために、制御ループで様々な利得または制御アーキテクチャを実行することができる。強化モードのサブモード間の切り換え時（したがって、適当な実施形態では利得または制御アーキテクチャを切り換える時）を知るために、幾つかの基本的切り換え基準を定めなければならない。一部の実施形態では、モード間の切り換え時を決定する基準として、上記量ｑ0を使用することができる。たとえば、ｑ0を使用して、車輪ＰＤおよび車輪ＰＯＣ間の切り換えを行うことができる。また、値φc（重力に対するクラスタ位置）も、車輪ＰＤまたは車輪ＰＯＣのいずれかから車輪均衡モードへ切り換えるために使用することができる。（もちろん、他の実施形態では、他のパラメータを追加して、または代わりに使用することもできる。）
強化モード内の様々なモード間の切り換えは、重力に対するクラスタ位置φcによって決まるであろう。図９は、φcの様々な値のグラフ表示９００を示している。繰り返すが、φcは、重力に対するクラスタ位置を表し、垂直のクラスタ位置でφcがゼロになり、水平のクラスタ位置でφcが９０°になるように測定が行われる。図９のグラフ表示では、縦軸９０２が０°のφcを表し、水平軸９０４が９０°のφcを表す。本実施形態では、角度φcが９０°に近い時、輸送装置は車輪ＰＯＣまたは車輪ＰＤのいずれかに留まっているであろう。
【００８２】
図９に示されているように、輸送装置が車輪ＰＯＣまたは車輪ＰＤのいずれかに留まる領域は、水平軸９０４と射線(ray)９０８との間に位置する領域９０６である。重力に対するクラスタ角度φcが射線９０８より下方にある場合、輸送装置は車輪ＰＯＣまたは車輪ＰＤのいずれかに留まるであろう。φcが射線９１０で表される値より高くなった場合、輸送装置は車両均衡モードに移行してそれに留まる。すなわち、φcは、縦軸９０２と射線９１０との間の領域９１２に留まる間、輸送装置は車輪均衡に留まるであろう。しかし、本実施形態の適当な作動モードの選択が困難な領域９１４が、射線９１０および９０８の間に存在する。この領域９１４では、輸送装置を車輪均衡モードにするか、残りのモードの一方にするかを決定するために、様々な他のファクタが考慮されるであろう。フレーム角およびピッチ率によって決定されるように、重心が装置のフットプリントに接近中か、その上方に位置する場合、輸送装置は車輪ＰＤまたは車輪ＰＯＣのいずれかに移行するはずである。しかし、重心が接地部材のいずれかのほぼ上方にある場合、輸送装置は車輪均衡モードに移行するはずである。射線９１０および９０８の位置の角度値の例をそれぞれ３０°および６０°にすることができる。
【００８３】
１つの実施形態によれば、車輪ＰＤから車輪ＰＯＣへの、またはその逆の移行は、制御スイッチ値σに基づいて決定され、σはｑ0に関して次式で定めることができる。
【００８４】
【数５】
2010094533.tif 000007
【００８５】
但し、Ａ1はスケーリング定数であり、ＬＰＦ（ｑ0）は、ｑ0の入力信号を与えられた一次ロー・パス・フィルタの出力である。φ’cは、通行中の表面の平滑さを大まかに表す。たとえば、凹凸表面では、クラスタ向きが急激に変化するために、φ’cが大きい。同様に、平滑な表面ではφ’cが小さくなるであろう。値が１．６６のＡ1が、幾つかの実施例の有効値であることが経験的に決定されている。
【００８６】
モード間のチャタリングを防止するために、モードの切り換え時にヒステリシス形の決定を行うことができる。たとえば、σが入場値（たとえば、１）以上である場合、輸送装置は車輪ＰＯＣに入る。σの値が、輸送装置が車輪ＰＤに移行する点である退場値（たとえば、０．５）以下になるまで、輸送装置は車輪ＰＯＣにあるであろう。もちろん、輸送装置の作動特性に応じて、入場値および退場値は変化するであろう。
【００８７】
図１０は、σの値を決定することができる１つの実施形態のデータ・フロー図を示している。外部入力は、データ・ブロック１００２に含まれるピッチ率（θ1’）、データ・ブロック１００４に含まれるフレーム・ピッチθ1、およびデータ・ブロック１００６に含まれる重力に対するクラスタ速度φc’である。ブロック１００６で、フレーム・ピッチθ1に倒立振子の固有振動数ωnを掛ける。加算ブロック１００８で、データ・ブロック１００２から受け取ったピッチ率にブロック１００６の出力を加算する。加算ブロック１００８の出力はｑ0である。次に、ブロック１０１０で値ｑ0をロー・パス・フィルタに通す。次に、ブロック１０１２で、ローパス・フィルタリングされたｑ0信号の絶対値を決定する。次に、加算器１０１６で、データ・ブロック１００６のクラスタ速度φc’をブロック１０１４でロー・パス・フィルタに通してから（ブロック１０２０で）絶対値を決定した後の値にブロック１０１２の出力を加算する。次に、加算器１０１６の出力をロー・パス・フィルタ１０１８に通し、そのロー・パス・フィルタ１０１８の出力が、上記等式に従ったσの値である。
【００８８】
図１１は、（本実施形態では）φcおよびσに基づいて強化モードのサブモード間での移行を行う時を決定する方法のフローチャートの１つの実施形態を示している。もちろん、輸送装置をモデル化する方法によって、様々な切り換え基準を使用することができる。処理は、φcおよびσの現在値を受け取るブロック１１０２で始まる。ブロック１１０４で、φcがＷＢonより小さいかどうかが決定される。変数ＷＢonは、φcの、それ以下では輸送装置が常に車輪均衡モードでなければならない角度値を表す。これは、図９に射線９１０および縦軸９０２の間の領域９１２として示されている。
【００８９】
φcがＷＢonより小さい場合、ブロック１１０６で、輸送装置が現時点で車輪均衡モードにあるかどうかが決定される。輸送装置が現時点で車輪均衡モードにある場合、それ以上の処理は必要なく、処理はブロック１１０２に戻る。しかし、輸送装置がその時に車輪均衡モードにない場合、ブロック１１０８で、輸送装置は車輪均衡モードに移行して、処理がブロック１１０２に戻る。
【００９０】
φcがＷＢon以上である場合、ブロック１１１０で、φcがＷＢoffより大きいかどうかが決定される。ＷＢoffの値は、θcの、それ以下では輸送装置が車輪ＰＯＣモードまたは車輪ＰＤモードのいずれかでなければならない値である。ＷＢoffは、図９に射線９０８として示されている。φcがＷＢoffより大きい場合、処理は車輪ＰＤ／車輪ＰＯＣヒステリシス処理セクション１１１２に移行する。φcがＷＢoff以下である場合、φcの値が図９の射線９１０および９０８の間の領域（たとえば、領域９１４）にあることがわかる。前述したように、この領域では、重心がクラスタの車輪の１つの軸に近い場合、輸送装置は車輪均衡モードに移行しなければならない。このため、ブロック１１１４で、重心が車輪軸の１つの近くにあるかどうかが決定される。重心が車輪軸の１つの近くにある場合、ブロック１１１６で、輸送装置は車輪均衡モードに移行し、処理がブロック１１０２に戻る。しかし、重心が車輪軸の１つの近くにない場合、処理は車輪ＰＤ／車輪ＰＯＣヒステリシス処理ブロック１１１２に入る。前述したように、重心の位置は、モードの切り換え時を決定する時に考慮するのに好都合な量である。しかし、重心は実際には、輸送装置の作動特性に基づいた推定位置に過ぎないことに注意されたい。たとえば、重心は、輸送装置のフレーム・ピッチおよびピッチ率の両方またはいずれか一方の表示にすることができる。これらの量（他のものと同様に）は、輸送装置内に含むことができる位置、速度および加速度センサから求めることができる。
【００９１】
ヒステリシス処理ブロック１１１２は、σの値に基づいた車輪ＰＯＣおよび車輪ＰＤ間の移行に関する上記の機能を実行する。ブロック１１１２内で、輸送装置が現時点で車輪ＰＯＣモードにあるかどうかがブロック１１１８で最初に決定される。輸送装置が車輪ＰＯＣモードにある場合、ブロック１１２０で、σが０．５より大きいかどうかが決定される。輸送装置がすでに車輪ＰＯＣにあることがすでに決定されているので、車輪ＰＤモードに移行するためには、σの値が０．５より小さくなければならない。このため、ブロック１１２０でσが０．５より大きいと決定された場合、輸送装置は車輪ＰＯＣモードに留まらなければならず、処理がブロック１１０２に戻る。しかし、σが０．５より小さくなっている場合、ブロック１１２２で輸送装置が車輪ＰＤモードに移行して、処理がブロック１１０２に戻る。
【００９２】
ブロック１１１８で、輸送装置が現時点で車輪ＰＯＣにないと決定された場合、ブロック１１２４で、σが１より高くなっていないと決定されると、輸送装置は車輪ＰＤモードに留まらなければならず、処理がブロック１１０２に戻る。しかし、σが１より高くなっている場合、ブロック１１２６で、輸送装置は車輪ＰＯＣモードに移行し、処理がブロック１１０２に戻る。上記の切り換え用の値が例示にすぎないことに注意されたい。これらの値は、ユーザの重量、輸送装置の重量、輸送装置の様々なセンサの正確度などによって変わるであろう。
【００９３】
上記の様々な切り換え処理は、各モード内の様々な安定化制御と共に、輸送装置の車輪およびクラスタの両方を駆動することによって実施することができる。各車輪を個別モータで独立的に駆動してもよい。あるいは、一部の車輪をモータで駆動しなかったり、共通軸に取り付けられた２つの車輪を単一のモータで駆動してもよい。また、クラスタは個別のモータを含むことができる。
【００９４】
輸送装置がどのような構造であるかに関係なく、強化モードのいずれのモードにおいても輸送装置が安定しているように、車輪およびクラスタを制御するコマンドは、それぞれ電圧ＶwおよびＶcとして表される、すなわち、
【００９５】
【数６】
2010094533.tif 000008
【００９６】
電圧は、出力トルクを発生するために電気モータの駆動部に印加される電圧を表す。もちろん、駆動部は電気的である必要はなく、また、いずれにしても、電圧以外の値を使用してもよい。変数Ｘは、輸送装置の水平位置誤差を表し、輸送装置の水平位置と輸送装置の所望水平位置との差である。’（プライム）記号は、時間微分を表す。係数Ｋ1〜Ｋ8は、輸送装置が強化モードのどのサブモードで作動しているかによって変わる。
【００９７】
各モードで制御ユニットが使用する利得係数Ｋ1〜Ｋ8の相対値の例が、次の表Ａに示されている。どの利得を使用するかに応じて、制御ユニットは適用可能なサブモードに対応した様々な方法で輸送装置を制御するであろう。
【００９８】
【表１】
2010094533.tif 000009
【００９９】
表Ａに列記されている各利得値の相対強さおよび符号は、各サブモードを区別するのに十分である。表Ａにおいて、＋＋の値は＋の値より大きい。ゼロ値は必ずしも正確にゼロでなくてもよく、むしろ非常に小さい値を表すことができる。
【０１００】
図１２Ａは、本発明に関連して使用することができる制御ユニット１２００のブロック図を示している。本実施形態の制御ユニット１２００は、クラスタおよびクラスタに取り付けられた車輪の両方を上記のＶcおよびＶwの等式に従って制御するであろう。クラスタの主たる役割は、重力に対するフレーム動力学に基づいたトルクを加えることである（すなわち、プラットフォームを重力に対して所望のピッチ角に保持するようにクラスタが回転する）。強化モードでは、２つの基準を監視しながら、車輪がユーザからのコマンドに従うはずである。重力に対するクラスタ位置が変化している（すなわち、地面傾斜が変化している）か、ｑ0が大きい場合、位置／速度制御の代わりに均衡化制御を使用することによって、車輪は、ユーザの制御から、クラスタがフレームを直立状態に保持するのを助けるように切り換わることができる。重力に対するクラスタの角度が減少する（すなわち、クラスタが垂直状態に接近していく）場合、目的は、移動距離を最小限に抑えながら、クラスタをより水平向きに降下させることである。これは、ユーザは輸送装置上に快適に支持されていることを確保するのに役立つ。
【０１０１】
制御ユニット１２００は、車輪制御器１２０２とクラスタ制御器１２０４とを含む。車輪制御器１２００は、（たとえば、ジョイスティックから受け取った）方向指示ユーザ入力と共に、輸送装置の現在の作動特性に関する様々な入力を受け取ることができる。入力から、車輪制御器１２０２は、車輪モータを制御する車輪制御電圧Ｖwを生成することができる。Ｖwの値によって車輪モータが輸送装置の様々な車輪にトルクを加えることによって、輸送装置を「駆動」して表面を進ませることができる。前述したように、輸送装置は、各車輪用にモータを含むことができ、各車輪のモータ用に個別の値Ｖwを生成することができる。このように、異なった車輪電圧を車輪に印加することによって、輸送装置の操縦を行うことができる。
【０１０２】
クラスタ制御器１２０４も、クラスタ特定情報と共に、一般的に輸送装置に関連した様々な位置入力を受け取ることができる。クラスタ制御器１２０４は、この情報をクラスタ・モータ制御電圧Ｖcに変換する。クラスタ・モータは、この信号Ｖcを受け取って、クラスタを軸中心に回転させる。
【０１０３】
１つの実施形態では、車輪制御器１２０２は、データ・ブロック１２０６からフレームのピッチ（θ1）を表すデータから入力を受け取ることができる。上記のデータは、確実に値として述べられていることに注意されたい。たとえば、フレーム・ピッチは、角度値として表されている。しかし、輸送装置の方向制御および安定性の両方を制御するために使用される値はいずれも、あるパラメータが所望位置からどれだけ離れているかを表す誤差項として、または多くの他の方法で表現することができる。たとえば、フレーム・ピッチは、現在のフレーム・ピッチが所望ピッチから異なっている値として表すことができる。すなわち、誤差信号は、現在フレーム・ピッチと重心をクラスタの中心点の真上に配置するフレーム・ピッチとの差に等しいであろう。また、ここでは様々な角度を度で表しているが、各角度をラジアンか、輸送装置がそのような値を受け取った時に所望の応答を行うように目盛りを定めた「計数」（自然数値）で表現することもできる。
【０１０４】
車輪制御器１２０２はまた、データ・ブロック１２０８からフレーム率(frame
rate)指示を受け取ることができる。フレーム率は、フレームが移動している回転率(rotational rate)を表し、データ・ブロック１２０８のフレーム・ピッチの時間導関数として表すことができる。また、フレームが移動する率は、クラスタに対するプラットフォームの高さによって決まるであろう。座部が上昇している時、輸送装置を、また最終的にユーザを転倒しないようにするために、フレーム率情報に対してもっと望ましい応答を行うように、フレーム率入力に適用される利得（後述する）を変更することができる。
【０１０５】
車輪制御器１２０２はまた、データ・ブロック１２１０から、各車輪が回転している現在速度を受け取ることができる。この速度は、たとえば増分単位で表すことができるが、回転率に基づいてωwheelsとして表すこともできる。
【０１０６】
車輪制御器１２０２はまた、ジョイスティックなどのユーザ入力部からの幾つかの入力を受け取ることができる。一般的に、これらの入力は、データ・ブロック１２１２内に含まれる所望車輪速度として表される。所望車輪速度は、所望移動方向および移動速度を含むことができるが、それに制限されない。車輪制御器１２０２はまた、データ・ブロック１２１４から現在車輪位置の表示を受け取ることができる。ブロック１２１２で得られた所望車輪位置を車輪制御器１２０２で現在車輪位置と比較することによって、ユーザ入力コマンドに応答するために車輪を駆動すべき差分速度および方向を決定することができる。方向差分情報によって、異なった車輪に取り付けられた異なったモータが異なった車輪電圧Ｖwを受け取ることによって、輸送装置を旋回させることができる。
【０１０７】
クラスタ制御器１２０４も、ブロック１２０６からのフレーム・ピッチと、車輪制御器１２０２が受け取ったブロック１２０８からのフレーム率とを受け取る。クラスタ制御器１２０４はまた、データ・ブロック１２１６からクラスタ位置を受け取る。このクラスタ位置は、φcとして記載した。繰り返すと、クラスタ制御器１２０４は、重心を輸送装置のフットプリントの上方に保持できるようにクラスタを回転しようとすることができる。
【０１０８】
クラスタ制御器１２０４はまた、データ・ブロック１２１８からクラスタ速度を受け取ることができる。クラスタ速度は、クラスタがクラスタを水平方向に通る回転軸中心に回転する率として表される。このクラスタ率は、データ・ブロック１２１８から受け取ったクラスタ位置の時間に対する導関数であろう。位置および速度の両方は、輸送装置内に含まれる適当なセンサによって決定することができる。適当なセンサとして、加速度計、速度センサおよび位置通報センサがあるが、これらに制限されない。
【０１０９】
また、制御ユニットは、モード制御器１２２０を含むことができる。モード制御器１２２０は、様々なモードから別のモードへの移行を制御することができる。モード制御器１２２０は、個別の制御器でもよいが、車輪制御器１２０２およびクラスタ制御器１２０４のいずれか一方または両方に組み込むこともできる。
【０１１０】
モード制御器１２２０は、現在モード１２２２を出力することができる。現在モードは、データ・ブロック１２２４から受け取ったユーザ選択モードに基づくことができる。現在モードはまた、車輪制御器１２０２およびクラスタ制御器１２０４が受け取った入力のいずれか又はすべてに基づいて、輸送装置が入っているとモード制御器が決定した強化モードの特定のサブモードを指定することができる。また、現在モードを制御ユニット１２００が使用して、それぞれ車輪およびクラスタ制御器１２０２および１２０４の両方またはいずれか一方の内部に存在する制御ループに加える適正利得を、またはどの制御アーキテクチャを選択すべきかを決定することができる。
【０１１１】
１つの実施形態では、計算された電圧ＶwおよびＶcを使用して電気モータを駆動することができる。しかし、油圧アクチュエータや燃焼式エンジンなどの他の形式のアクチュエータを使用してもよい。そのような実施形態では、アクチュエータの様々な作動パラメータを考慮に入れることができる上記等式または同様な等式に従って、電圧以外の制御信号を計算してアクチュエータに供給することができる。
【０１１２】
ＶwおよびＶcを使用して電気モータを駆動する実施形態では、電圧をバッテリ電圧で割り算することによって、車輪モータおよびクラスタ・モータの各々に取りつけられた増幅器に送るデューティサイクルコマンドを生成することができる。
【０１１３】
図１２Ｂは、制御ユニット１２００の機能ブロック図である。制御ユニット１２００は、マイクロプロセッサ１２５０を含む。 マイクロプロセッサ１２００は、バス１２５６を介して車輪制御ループ１２５２およびクラスタ制御ループ１２５４に連結されてそれらと通信することができる。マイクロプロセッサは、車輪制御ループ１２５２およびクラスタ制御ループ１２５４から様々なセンサ入力を受け取って、これらの入力から、図７Ａおよび図７Ｂに関連して説明した量のいずれも決定することができる。たとえば、マイクロプロセッサは、車輪およびクラスタ制御ループ１２５２および１２５４のいずれか一方または両方の速度センサから受け取ったデータに基づいて、輸送装置のピッチ率を決定することができる。これらの決定は、たとえば、マイクロプロセッサ１２５０内に含まれるソフトウェアまたはハードウェアによって行うことができる。また、マイクロプロセッサ１２５０は、後述するように、重心の位置と共に、それに基づいた所望の向きを決定する計算を実行することができる。
【０１１４】
マイクロプロセッサ１２５０は、電源１２５８（たとえば、バッテリ）から電力を受け取ることができる。一部の実施形態では、マイクロプロセッサ１２５０が、輸送装置の現在の作動モードなどに応じて、車輪およびクラスタ制御ループ１２５２および２５４が受け取る電力量を決定することができる。また、ユーザ入力をユーザ入力ブロック１２６０から受け取ることができる。これらのユーザ入力は、後述するように、輸送装置の特定の作動モードに応じて制御ユニット１２００によって考慮量を変更して与えることができる。
【０１１５】
図１３は、制御ユニット１３０２を含む制御ループ１３００である。制御ユニット１３０２は、図１２Ａおよび図１２Ｂの制御ユニット１２００と同様にすることができる。この実施形態では、制御ユニット１３０２が様々な入力を受け取り、車輪およびクラスタ制御電圧ＶwおよびＶcを出力する。
【０１１６】
制御ユニット１３０２は、ユーザ入力データ・ブロック１３０４からユーザ入力を受け取ることができる。前述したように、これらのユーザ入力は、ユーザ入力装置として機能するジョイスティックの方向偏差を感知することによって与えることができる。また、ユーザ入力は、前述のように、傾斜プラットフォーム上でのユーザの傾動を表すこともできる。制御ユニット１３０２はまた、車輪モータ１３０６およびクラスタ・モータ１３０８からフィードバック情報を受け取ることができる。作動モード、ユーザ入力の値、および車輪モータ１３０６およびクラスタ・モータ１３０８から受け取った情報に基づいて、制御ユニット１３０２は、それぞれ車輪モータおよびクラスタ・モータが車輪およびクラスタの相対位置の変更を行うための値ＶwおよびＶcを決定することができる。
【０１１７】
一部のモードでは、ユーザ入力を車輪モータ電流の制御より優先することが望ましい。そのようなモードの一例が、上記の標準モードである。そのようなモードでは、制御ユニット１３０２が、ユーザ入力コマンドに対して、利得テーブルまたは特定の制御アーキテクチャ１３１０から選択された高い感度を与える。このようにして、ユーザは輸送装置の大幅な制御を行うことができる。しかし、そのようなモードでは、輸送装置の安定性が低下する可能性がある。別のモードでは、輸送装置の安定性を高めることが望ましいであろう。そのようなモードでは、ユーザ入力に対する感度を低くして、安定化ルーチンに高い感度を与える。このように、制御ユニット１３１０内のソフトウェアまたはハードウェアのいずれかで具現できる制御パラメータに基づいて、輸送装置をさらに安定させることができる。
【０１１８】
図１４は、本発明の態様に従って使用することができる利得テーブル１４００の一例を示している。利得テーブル１４００は、３モード、すなわち、第１モード１４０２、第２モード１４０４および第３モード１４０６を有する装置用にすることができる。本実施形態では、各モードが３つの利得係数Ｃ1、Ｃ2およびＣ3を含むことができる。図１４の利得テーブル１４００は、例示のためのものであって、好適な利得値を反映するものではないことに注意されたい。すなわち、図１４の値およびモードは、必ずしも上記の様々なモードの各々の好適な係数を反映していない。
【０１１９】
これらの係数を制御ユニットが使用して、一部の実施形態では一定の入力の効果を増減させる。たとえば、係数Ｃ1に輸送装置の位置誤差項を掛け算することによって、位置誤差項が輸送装置の作動に与える効果を変化させることができる。
【０１２０】
図１４の例では、係数Ｃ1は、クラスタ・モータから受け取った値によって決定されるクラスタ位置に適用される係数に対応するであろう。値Ｃ2は、車輪モータから受け取った車輪位置の値に適用される係数に対応するであろう。値Ｃ3は、ユーザ入力部から受け取った方向ベクトルに適用される係数であろう。利得テーブル１４００において、特定係数に割り当てられた値が大きいほど、その利得が適用される入力が制御システム内で受け取る優先度が大きいであろう。たとえば、第１モードでは、クラスタ係数Ｃ1の値が１である。１のような低い値を有することは、第１モードではクラスタ位置が輸送装置の安定化にあまり利用されないことを意味するであろう。第１モードの係数Ｃ2の値は３である。このため、輸送装置の安定化において車輪がクラスタよりもっと活動的な部分である。同様に、第１モードのＣ3で値が７であることが示されている。Ｃ3がこのように大きい値であることは、第１モードがユーザ入力に非常によく応答することを意味する。このため、第１モードは、安定性があまりないモードであり、存在する安定性はすべて、車輪の回転によるものであって、ユーザの入力に対する応答に非常によく一致する。したがって、第１モードは、上記の標準モードに似たモードであろう。
【０１２１】
同様に、第２モードはクラスタ利得がゼロで、車輪利得が比較的小さく（Ｃ2＝５）、Ｃ3が比較的大きい値である（Ｃ3＝６）ため、ユーザ入力によく従う。このモードはまた、車輪が輸送装置の釣り合いの主たる責任を負い、クラスタが固定位置に留まる均衡モードに似ているであろう。ユーザ入力によって大きく妨害されることなく車輪が輸送装置を安定させるため、ユーザ入力Ｃ3に対する応答性は標準モード（すなわち、たとえば第１モード）より低い。しかし、均衡モードでは、車輪が輸送装置を釣り合わせてほぼ直立位置に維持しながら、ユーザが表面を通行できるようにすることが望ましいため、ユーザ入力がゼロにセットされていない。
【０１２２】
第３モードのクラスタおよび車輪利得は、クラスタ位置および車輪位置が輸送装置の安定性に関連し、それの自動制御に使用されるようなレベルに設定されている。ユーザ入力利得Ｃ3が非常に低いレベルまで減少しており、ユーザはまだ輸送装置をある程度は制御できるが、主に安定化がクラスタおよび車輪によって自動的に行われる。そのようなモードは、たとえば、輸送装置が比較的不安定であると決定された時、強化モードにすることができる。そのようなモードでは、輸送装置の重心がクラスタの端部点の間に維持されるように、クラスタおよび車輪が回転する。
制御スケジューリング
前述したように、強化モード制御器は、様々なモード間で切り換わることができる。モード間で切り換える理由の１つは、人輸送装置の安定化を図ることである。サブモード間の移行時に、制御ユニット内の制御ループに供給される利得を変化させるか、制御アーキテクチャ自体を変化させることができる。しかし、利得またはアーキテクチャを急激に変化させると、輸送装置の作動に急激な影響が生じるであろう。これによって、重心が急加速されて、輸送装置の乗り心地が悪くなるか、それが不安定さえなるであろう。また、急激な制御変化（利得またはアーキテクチャのいずれか）は、システムの摩耗を増加させるであろう。このため、モードの円滑な移行を行う何らかの方法が必要である。システムのモード間の円滑な移行を行うためにここに記載されたシステムおよび方法は、人輸送装置を制御する状況で効果的である。当業者であれば、円滑なモード間移行に関する教示が人輸送装置への適用に制限されることはなく、モード間の移行を行ういずれの多重モードシステムにも適用することができることを理解できるであろう。このため、以下の説明では、人輸送装置の代わりに「システム」と言う。一部の実施形態では、システムは、被制御装置からのフィードバックを含むシステムであるが、ここで説明するスケジューリングを制御するためにフィードバックは必要ない。
【０１２３】
他の状況でモード間の円滑な移行を行うために従来から使用されていた１つの方法は、利得が新しいモードの利得になるまで、最初のモードから利得をスルー変化させる(slew)ことであった。たとえば、第１作動モードで利得Ｋ1の値が４であるとする。第２モードでの利得係数Ｋ1が、たとえば、１０であるとする。この新しい利得値を直接的に適用すると、モードの変更時にシステムに急な外乱が生じるであろう。急な外乱は、システムの作動に影響を与え、システムを不安定にするであろう。このため、従来技術では、利得係数（たとえば、Ｋ1）の値を繰り返し増加させることによって、利得値を４から１０にゆっくりスルー変化させる。たとえば、時間Ｔ0で利得係数が４であり、時間Ｔ1で利得係数が５であり、時間Ｔ2で利得係数が６であるように、利得係数が最終的に１０に達するまで続ける。
【０１２４】
しかし、このような作動では、所望の新しいモードに合わせる(commiserate with)ように応答しながら、システムの作動を安定させるために利得値が適正状態に達するのに時間がかかりすぎることがわかっている。また、利得が新しい値にスルー変化する前に、システムのモードが再び切り換わる可能性がある。そのような場合、システムは決して新しい作動モードに真に達することはなく、予測不能であるモード間の準モードに留まる。予測不可能性は、システムの有効性を低下させるシステム・エラーの原因になるであろう。
【０１２５】
また、システムがモード変更を行っていない時でも、システムの制御コマンドを平滑化することが望ましいであろう。たとえば、モータ制御器から受け取った制御信号に大きい電圧不連続性があると、モータ駆動システムに損傷を与える可能性がある。
【０１２６】
このため、１つの実施形態では、制御ユニットからの制御コマンドを、被制御装置に加える前に平滑化する。平滑化は、たとえば、制御ユニットの出力部と制御ユニットによって制御される装置との間に配置されたスムーザによって行うことができる。スムーザは、たとえば、制御信号が変化する割合を制限するいずれかの形式のフィルタか、制御信号にオフセット値を加算する加算器にすることができる。
【０１２７】
図１５は、制御信号を被制御装置１５０２に印加する前に平滑化するために実行することができるシステムの一例である。システムは、制御信号を生成する制御ユニット１５０４を含むことができる。制御信号は、被制御装置の動作を制御するために使用される。制御信号は、多くの理由から急激な値の変化を受けるであろう。制御信号の急激な変化の一例は、システムの作動モードの変化によるものであろう。スムーザ１５０６は、被制御装置１５０２に最終的に供給される制御信号（すなわち、スムーザ１５０６の出力）が変化する割合を制限することができる。
【０１２８】
スムーザ１５０６は、たとえば、フィルタ、オフセット値（おそらくは減衰オフセット値）を制御信号に加える加算器、ヒステリシス制御回路などであるが、それらに制限されることはない。
【０１２９】
図１６は、制御信号を平滑化する方法のブロック図である。処理はブロック１６６０で始まり、ここで制御信号の値が決定される。制御信号は、ユーザ入力、制御ループ出力、プリセット値などによって生成することができる。制御信号の値は、電圧、電流、値のデジタル表示、アナログ信号などのいずれのタイプの単位にすることもできる。
【０１３０】
制御信号を決定した後、ブロック１６０２で移行処理が実行される。移行処理は、制御信号の平滑化、制御信号へのオフセットの加算、制御信号の変化率の決定、システムがモード間の移行を行ったかどうかの決定を含むことができるが、これらに制限されることはない。場合によっては、移行処理は、制御信号に何もしないステップを含むことができる。
【０１３１】
ブロック１６０２で制御信号を処理し、必要な変更をすべて制御信号に加えた後、変更制御信号を被制御装置システムに印加する。システムは、単一の被制御装置または幾つかの被制御装置を含むことができる。
【０１３２】
１つの実施形態では、本発明は、移行が円滑で、モード間の移行がほぼ瞬時であるようにモード間の移行を行うシステムおよび方法を含むことができる。１つの実施形態では、これは、第１係数を使用した時に被制御装置に印加される最後の制御信号（すなわち、変更された制御信号）と新しい係数を使用して生成された非変更制御信号との差を経時的に順次減衰させながら、新しい利得係数セットをシステムに瞬時にインストールすることによって達成することができる。別の実施形態では、システムが、モードの変化時に制御アーキテクチャを変化させて、制御信号の差を減衰できるようにする。オフセット（差）がどのように減衰されて制御信号に加えられるかについては詳細に後述する。
【０１３３】
図１７Ａは、円滑なモード間移行を行うために利得スケジューリング操作を実施するように構成された制御ループ１７００のブロック図を示している。制御ループ１７００は、フィードバックループの一部である制御ユニット１７０２を含む。制御ユニット１７０２は、データ・ブロック１７１０からユーザ入力を受け取ることができる。しかし、制御ユニットは、ユーザ入力を受け取る必要はなく、完全な自己調整式にすることができる。制御ユニットはまた、制御信号受信器１７１２から現在の作動特性を受け取ることができる。制御信号受信器１７１２は、入力信号に応答するいずれの装置でもよい。たとえば、制御信号受信器１７１２は、入力制御電圧のレベルに応じて回転する電気モータでもよい。この場合、制御信号は制御電圧であろう。
【０１３４】
制御ユニット１７００は、第１作動モード用の利得係数１７０４と、第２作動モード用の利得係数１７０６とを含むことができる。これらの係数は単一の利得テーブル内に記憶してもよいが、独自の個別テーブルにしてもよい。係数は、フロッピー・ディスク（登録商標）、ＲＯＭ、ＲＡＭなどのいずれのコンピュータ読み取り可能媒体に記憶してもよい。
【０１３５】
現在モード・データ・ブロック１７１４に表される現在作動モードに基づいて、セレクタ１７０８が第１モード用係数１７０４または第２モード用係数１７０６のいずれを適用するかを選択することができる。セレクタ１７０８は、適正な係数を選択して、それらを制御ユニット１７０２用の制御係数１７１６として印加する。制御係数は、たとえば、人輸送装置の作動に適用される現在モード利得係数を表すことができる。
【０１３６】
さらに具体的に言うと、制御係数は、ユーザから、または制御信号受信器１７１２から受け取られた様々な入力値に適用することができる。制御係数は、制御ユニット１７０２の制御サブシステム１７１８によって使用することができる。制御サブシステム１７１８は、制御係数１７１６を様々な入力に適用して制御信号を生成することができる様々な制御ループを含むことができる。たとえば、制御サブシステム１７１８は、上記のクラスタおよび車輪制御器を含むことができる。
【０１３７】
システムはまた、オフセット・データ・ブロック１７２０からオフセット値を受け取ることができる。オフセットの値は、システムがモードを切り換える直前に制御信号受信器１７１２に加えられた最後の制御コマンド（すなわち、最後の平滑化された制御信号）と、制御係数が変更された直後に生成された制御信号との値の差であろう。オフセット値をスムーザ１７２２が受け取って、オフセット・データ・ブロック１７２０から受け取った値の減衰したものに現在制御信号を繰り返し加算する。たとえば、平滑化された制御信号の、システムがモードを切り換える直前の値が１００で、システムがモードを切り換えた直後の制御信号値が１０である場合、システムがモードを切り換えた後に制御ループ１７００を最初に通過する時、９０の値を制御信号に加算する。制御ループ１７００を次に通過する時、この値を一定量だけ減衰して、再び制御信号に加算する。オフセット値がゼロに比較的近くなるように減衰するまで、これを繰り返すことができる。第１モード中に加えられる平滑化された制御信号および第２モードの開始時に生成される新しい制御信号の値に応じて、オフセット値が正負のいずれの数値でもよいことに注意されたい。
【０１３８】
図１７Ｂは、モード間の円滑な移行を行うことができる別の制御システムのブロック図を示している。この実施形態では、第１モードが第１制御アーキテクチャ１７５０を含み、第２モードが第２制御アーキテクチャ１７５２を含む。各制御アーキテクチャは、システムを異なった方法で制御する異なった制御信号を発生することができる。制御信号受信器（図示せず）からの入力（１７５４）が両制御アーキテクチャに加えられる。スイッチ１７５６は、現在モードに基づいて、システムを制御する第１または第２アーキテクチャを選択する。上記のものと同様にして、平滑化された制御信号を制御信号受信器（図示せず）に与えるために、スムーザ１７５８が減衰オフセットを加算する。
【０１３９】
前述したように、制御器スケジューリング技術によって、制御モード間の円滑な移行を行うことができる。輸送装置の作動を様々な形で参照しながら以上の説明を行った。しかし、制御スケジューリングに関する教示がいずれの制御システムにも適用可能であることは、容易に理解されるであろう。たとえば、航空機、ヘリコプター、電気モータ、油圧モータ、燃焼式エンジンまたはジェット・エンジンのモード移行を制御する時に、この形式の制御器スケジューリングを使用することができる。
【０１４０】
図１８は、システムを制御するためにフィード・バック・システムで実行できる制御スケジューリング・プロセスのフローチャートである。処理は、判断ブロック１８０２で始まり、ここで、プロセスを最後に通過した後にシステムのモードが変更されているかどうかを決定する。モードが変更されている場合、ブロック１８０４でオフセット値を決定する。前述したように、オフセット値は、制御信号受信器（図１７）へ送られた最後の制御信号からモード切り換え後に最初に生成された制御信号を引いた値に等しいであろう。しかし、処理は必ずしも新しいモードで最初に生成された制御信号を使用しなくてもよく、モード移行に近いある時点で生成された制御信号を使用してもよい。オフセット値を決定した後、ブロック１８０６で、減衰オフセット値を制御信号に加算する。減衰オフセットを生成する様々な方法を以下に説明する。
【０１４１】
ブロック１８０８で、平滑化された出力制御信号の値を記憶して、後に使用できるようにする。それから、処理はブロック１８０２に戻る。
ブロック１８０２で、モードが変更されていないと決定された場合、判断ブロック１８１０で、現時点でオフセット減衰があるかどうかを決定する。オフセットが減衰中である場合、ブロック１８０６で、減衰オフセットを制御信号に加算することが好ましい。しかし、オフセットが減衰していない場合、ブロック１８０８で処理が続く。オフセットが減衰しているかどうかを決定しなくてもよいことは、容易に理解されるであろう。その場合、判断ブロック１８０１を省き、ブロック１８０２で、モードが変更されていないことが決定された場合、処理が直接的にブロック１８０６に進む。
【０１４２】
オフセット値を減衰させることができる幾つかの異なった方法が存在するであろう。たとえば、オフセットの値にそれを減衰させる係数（たとえば、１未満の値）を掛けることができる。これは、先のオフセット値より小さい新しいオフセット値を生成する。この小さいオフセット値を更新して現在オフセット値にして、スムーザに送って次の制御信号に加算できるようにする。あるいは、オフセットから固定値を繰り返し減算することによって、オフセットを減衰することもできる。
【０１４３】
図１９は、図１７Ａおよび図１７Ｂの様々な位置に存在する様々な信号を示している。信号１９０２は、制御ユニットが生成すると考えられる制御信号を表す。時間ｔ0で、制御信号の値はｙ1である。時間ｔ1で、制御信号の値がｙ1からｙ2に急激に変化する。この変化は、システムのモード移行によって発生するであろう。信号１９０４は、制御信号１９０２に加算することができる減衰オフセット値を表す。ｔ0で、オフセット値はほぼ０である。時間ｔ1で、オフセット値がｙ1−ｙ2のレベルまで上昇する。即ち、もちろん、ｙ1は、時間ｔ1にシステムに加えられた値に等しいとする。オフセット値は経時的に減衰して、時間ｔ4でほぼ０になる。
【０１４４】
信号１９０６は、システムに加えられる平滑化された制御信号（すなわち、平滑化された制御信号）の値を表す。信号１９０６の値は、信号１９０２の値に信号１９０４の値を加えたものに等しい。信号１９０６は、制御信号が上昇し始める時間ｔ2まで、信号１９０４と同様に減衰する。制御信号１９０２が上昇するため、信号１９０６も上昇するであろう。制御信号１９０２が平坦になり始める時間ｔ3で、平滑化された出力信号１９０６が再び減衰オフセット信号１９０４に追従し始めて、減衰オフセット信号１９０４がほぼ０まで減衰する時間ｔ4まで続く。時間ｔ4では、点１９０８で示されているように、制御信号１９０２および平滑化された出力信号１９０６がほぼ同一である。
システム動作
図２０および図２１は、輸送装置のクラスタおよび車輪の位置を制御する制御ループの例を示している。これらの制御ループの例は、人輸送装置を安定させるために使用することができる。容易に理解できるように、制御ループは、クラスタおよび車輪制御コマンドの両方を生成する単一の制御ループに統合してもよい。また、輸送装置の機能的能力に応じて、これらの制御ループの様々な部分を省略したり、別の部分を追加することができる。さらに、当業者であれば、図２０および図２１に関連して説明する様々な制御ブロックをハードウェアまたはソフトウェアのいずれか、またはその両方の組み合わせで実行できることも容易に理解できるであろう。
【０１４５】
図２０を参照すると、車輪制御ループ２０００は、フレーム制御サブループ２００２、車輪制御サブループ２００４、ヨー制御サブループ２００６およびクラスタ速度監視制御サブループ２００８を含む。図２０の制御ループは、単一の車輪に関して与えられている。具体的に言うと、制御ループは、輸送装置の右車輪（ＲＷ）を作動させることができる。一部の実施形態では、輸送装置の各車輪に１つの制御器を設けることができる。しかし、単一の制御ループを使用して車輪のすべてを制御することもできる。
【０１４６】
フレーム制御サブループ２００２は、基準フレーム関連値および実際フレーム関連値に基づいて、車輪の回転を制御することによってフレームの安定化を図る信号を生成する。たとえば、輸送装置が縁石から落下したためにフレームが前傾している場合、輸送装置のフットプリントの上方に重心を保持するために、フレーム制御サブループ２００２は、車輪モータが車輪を高速で前方に駆動することができるようにする。
【０１４７】
車輪制御サブループ２００４は、輸送装置の性能を所望のユーザ入力に一致させようとするために使用することができる。すなわち、車輪制御サブループ２００４は、車輪がユーザ入力に厳密に従うことができるようにする。また、主たる安定化が車輪によって得られる車輪均衡モードおよび均衡モードにある時、車輪の位置が重要であろう。そのため、システムが車輪均衡モードである時、車輪制御サブループがユーザ入力２０１０から遮断されているであろう。
【０１４８】
輸送装置が確実に旋回できるようにするために、ヨー制御サブループ２００６を実行することができる。車輪モータ速度差およびユーザ入力に基づいて、ヨー制御サブループ２００６は、車輪モータの各々に異なった車輪制御電圧が印加されるようにする制御信号を発生することができる。
【０１４９】
クラスタ速度監視制御ループ２００８は、クラスタの運動学的状態に関する情報を使用して、車輪の動作に影響を与える。クラスタの車輪が地面から持ち上がり始めた場合、Ｌ2（cosφc）（ブロック２０７８）にローパス・フィルタリングされたクラスタ速度（ブロック２０８０）を掛けた値がゼロ未満である。本例では、クラスタ速度監視制御サブループ２００８が、重心をフットプリントの上方に保持するために車輪を加速する信号を発生するであろう。Ｌ2は、車輪軸からクラスタ・ピボットまでの距離である。
【０１５０】
車輪制御ループ２０００は、輸送装置のユーザからのユーザ入力２０１０をより多く受け取ることができる。ユーザ入力は、たとえば、ジョイスティックから受け取ることができる。ユーザ入力２０１０は、指令されたFORE/AFT速度２０１２と、指令されたヨー（YAW）速度２０１４とを含む。輸送装置が装置のピッチを補正中であるか、車輪均衡サブモードに入っている時、指令されたFORE/AFT速度２０１２および指令されたヨー（YAW）速度２０１４の両方がそれぞれスイッチ２０１６および２０１８によって遮断されるであろう。ピッチ補正中および車輪均衡モードでスイッチ２０１６および２１０８を切る理由は、いずれの場合も装置の安定化がユーザ入力コマンドに対する応答より重要になるからである。
【０１５１】
たとえば、１組の車輪が地面から離れている強化モード（たとえば、図７Ａを参照されたい）にある輸送装置の簡略化モデルによって、ピッチ加速度をそれぞれクラスタおよび車輪トルクτcおよびτwの関数とした関係が示される。
【０１５２】
【数７】
2010094533.tif 000010
【０１５３】
但し、Ｌ2は車輪軸からクラスタ・ピボットまでの距離であり、ｒwは車輪の半径である。クラスタ・トルクτcの前にある係数は、クラスタがピッチにどの程度の影響を与えるかをよく表している。輸送装置が釣り合い車輪から傾斜する程度が大きいほど、ピッチを正す際のクラスタの影響力が大きいであろう。反対に、重心が後輪の上方付近にある場合、Ｌ1sinθ1≒Ｌ2cosφcで、クラスタ・トルク係数がゼロに近くなる。車輪均衡制御器に入る基準は、クラスタ・トルク係数の大きさである。この係数が小さい時、車輪ＰＤおよび車輪ＰＯＣは、ピッチに影響を与える主要手段として車輪を使用する車輪均衡制御器ほど有効でないであろう。また、１組の車輪だけが地面上にある可能性が高くなるほどクラスタ角度を大きくしなければならない別の状態もある。このため、輸送装置を釣り合わせる主要手段は車輪である。したがって、ユーザ入力コマンドを考慮に入れた場合、輸送装置が輸送装置の安定化に対して有効でなくなるため、制御ループは、ユーザ入力コマンドを考慮に入れようとしない。
【０１５４】
再び図２０に戻ると、車輪均衡でピッチ補正しない時、FORE/AFT速度コマンド２０１６は速度スルー（slew）・リミッタ２０２０を通り、それが前進速度の量を制限する。たとえば、プラットフォームが高い位置にある時、速度を低くすることが望まれるであろう。
【０１５５】
指令されたFOR/AFT速度２０１２を加算器２０２２で指令されたヨー（YAW）速度２０１２と加算することによって、各車輪の所望速度を決定することができる。この所望車輪速度を車輪制御サブシステム２００４が使用して、車輪速度誤差、車輪位置誤差および車輪速度フィードフォワード入力を決定する。車輪速度誤差を決定するために、加算器２０２２の出力を加算器２０２４で現在車輪速度と組み合わされる。車輪速度誤差を誤差制限機能構成要素２０２６に通してから、フィルタ２０２８でローパス・フィルタリングする。次に、ローパス・フィルタリングされた車輪速度誤差の出力に車輪速度誤差利得定数２０３０を掛けることによって、車輪コマンドの一部を生成する。
【０１５６】
車輪位置誤差を決定するために、加算器２０２４の出力を積分器２０３２で積分してから、誤差リミッタ２０３４に通す。位置誤差に利得２０３６を掛けることによって、全車輪コマンドの一部を生成する。
【０１５７】
所望の速度値（加算器２０２２の出力）をロー・パス・フィルタ２０３８に通してから車輪速度フィードフォワード利得値２０４０を掛けることによって、車輪速度フィードフォワード値を決定することができる。車輪速度のフィードフォワードによって、制御システムは、大きい定常速度または位置誤差信号を処理しなくても、指令された速度に必要なモータ電圧を実質的に推定することができる。
【０１５８】
車輪制御サブ制御ループ２００４内で生成された誤差信号の各々を加算器２０４２に送り、他のすべての誤差決定値(determinations)に加えることによって、車輪電圧Ｖwが生成される。
【０１５９】
車輪制御ループ２００はまた、フレーム・ピッチ誤差およびピッチ率誤差を生成するフレーム・ピッチ・パラメータ関連サブ制御ループ２００２を含むことができる。フレーム・ピッチ誤差は、加算器２０４６で現在フレーム・ピッチを所望フレーム・ピッチと比較することによって生成される。所望フレーム・ピッチは、輸送装置のパラメータに基づいて推定することができる。１つの実施形態では、所望フレーム・ピッチ２０４４は、重心をクラスタの中心点の真上に配置することができるフレーム・ピッチである。この所望フレーム・ピッチは、以下の説明によって決定される重心の位置に基づくことができる。所望フレーム・ピッチと現在フレーム・ピッチとの間の差をロー・パス・フィルタ２０４８によってフィルタリングしてから、フレーム・ピッチ利得２０５０を掛けることによって、車輪コマンドの別の部分を決定することができる。
【０１６０】
ピッチ率誤差は、加算器２０５４で現在ピッチ率を所望ピッチ率２０５２と比較することによって決定することができる。１つの実施形態では、ピッチ率が０であり、これは輸送装置が完全に安定していることを表す。現在フレーム・ピッチと所望ピッチ率との差をロー・パス・フィルタ２０５６でフィルタリングしてから、ピッチ率利得２０５８を掛けることによって、車輪コマンドの別の部分を生成することができる。フレーム・ピッチおよびピッチ率誤差の両方が加算器２０４２に与えられる。
【０１６１】
輸送装置用のヨー誤差信号を制御するために、指令されたヨー（YAW）速度２０１８をヨー（YAW）サブ制御ループ２００６に与えることができる。ヨー（YAW）速度制御サブループ２００６で、ヨー（YAW）速度誤差およびヨー（YAW）位置誤差を決定することができる。（加算器２０６０によって決定される）指令されたヨー（YAW）速度２０１８と現在ヨー（YAW）速度との差をリミッタ２０６２およびロー・パス・フィルタ２０６４に通し、ロー・パス・フィルタ２０６４の出力にヨー（YAW）速度利得２０６６を掛けることによって、ヨー（YAW）速度制御信号が決定される。同様に、指令されたヨー（YAW）速度２０１８と現在ヨー（YAW）速度との差を積分器２０６８に通し、リミッタ２０７０で制限する。その制限信号にヨー（YAW）位置利得２０７２を掛けることによって、ヨー（YAW）位置コマンドを生成することができる。ヨー（YAW）速度コマンドおよびヨー（YAW）位置コマンドの両方が加算器２０４２に与えられる。
【０１６２】
車輪制御器２００はまた、クラスタ速度監視制御サブループ２００８を含み、これは、φcにロー・パス・フィルタ・クラスタ速度を掛けた値（ブロック２０８２で決定されるブロック２０７８および２０８０の積）がゼロ未満である場合、スイッチ２０７６によって遮断される。
【０１６３】
車輪コマンドのすべての部分をブロック２０４２で加算することによって、車輪制御電圧Ｖwが生成される。前述したように、平滑電圧制御信号Ｖwsを生成するために、この電圧をスムーザ２０８６によって平滑化する。減衰フィルタ・オフセット２０８８をロー・パス・フィルタ２０９０に通してから、スムーザ２０８６でＶwに加算することによって、上記のＶwsを生成することができる。Ｖwsはプラント２０９２へ送られる。プラントは、車輪モータおよびクラスタ・モータの両方を含むことができ、特に、現在フレーム・ピッチ、現在ピッチ率、右車輪（ＲＷ）速度、左車輪（ＬＷ）速度、クラスタ位置およびクラスタ速度を出力することができる。
【０１６４】
図２１は、クラスタ制御ループ２１００の一例を示している。車輪制御ループと同様に、クラスタ制御ループ２１００は、フレーム・ピッチ誤差およびピッチ率誤差を生成するフレーム関連サブ制御ループ２１０２を含むことができる。このフレーム関連サブ制御ループ２１０２は、上記のものと同一の制御ループでもよいが、クラスタ制御ループ２１００内に維持された個別の制御ループでもよい。
【０１６５】
また、クラスタ制御ループは、最大クラスタ位置サブループを含むことができる。このサブループは、強化モードで利用可能な最大クラスタ角度であるφc,stop angleの値を受け取る。クラスタがφc,stop angleより大きい角度である場合、クラスタ位置制御器がスイッチ２１０６で遮断される。スイッチ２１０６が開くと、加算器２１０８で現在クラスタ位置をφc,stop angleから減算する。次に、加算器２１０８の出力（クラスタ位置誤差）にクラスタ位置利得２１１０を掛けることによって、クラスタ位置コマンドの一部を決定することができる。
【０１６６】
クラスタ制御ループ２１００はさらに、クラスタ速度誤差を生成するクラスタ速度サブ制御ループを含むことができる。クラスタ速度サブ制御ループ２１１２では、加算器２１１６によって現在クラスタ速度を所望クラスタ速度２１１４から減算する。１つの実施形態では、所望クラスタ速度がゼロに設定されるであろう。加算器２１１６の出力をロー・パス・フィルタ２１１８に通した後、クラスタ速度利得２１２０を掛けてから、加算器２１２２に送る。それから、加算器２１１２の出力を前述したようにスムーザ２１２２で平滑化することによって、プラントに送られる信号Ｖcsを生成することができる。
強化モードの使用例
１つの実施形態では、強化モードが、凹凸地面で使用するように構成されている。この実施形態では、輸送装置は４つの接地車輪を使用することができ、FORE/AFT面上の牽引力を増加するために、それらのすべてを動力付きにすることができる。輸送装置が一例の強化モードでいかに作動するかの例を以下に示す。
【０１６７】
表面の通行
強化モードでは輸送装置を安定させるために、クラスタおよび車輪の両方を使用することができるので、強化モードは凸凹の平坦でない表面上でうまく働くことができる。１つの実施形態では、４つの車輪すべてを個別のモータで駆動することができ、そのような実施形態では、輸送装置は滑りやすい表面もうまくこなすことができる。たとえば、車輪の１つの車輪速度が大幅に増加した場合、制御ユニットは、その車輪の速度が他の車輪の速度と同様になるまで、その車輪に供給される動力量を減少させる。
【０１６８】
障害物
一部の実施形態では、強化モードは、輸送装置が縁石または石などの障害物を越えることができるようにする。たとえば、縁石を越える時、ユーザは輸送装置に（ユーザ入力装置を用いて）縁石と接触するように命令する。車輪が縁石と接触している時でも、ユーザが輸送装置に前進を命令し続けると、車輪位置誤差項（図２０を参照）が増加する。誤差項が増加すると、車輪に加えられるトルクによって前輪が縁石上に乗り上がる。前輪が縁石に上がった時、フレーム・ピッチをゼロ付近に保持するためにクラスタが回転する。上記動作がどの程度の速度で実施されるかによって、制御ユニットは車輪ＰＤモードおよび車輪ＰＯＣモード間で切り換わるであろう（クラスタが回転する率によって決まる）。後輪を縁石上に乗せるために、ユーザが前方向に駆動し続けると、クラスタが逆方向に回転する。
【０１６９】
１つの実施形態において、（たとえば）約１５．２４ｃｍ（６インチ）の縁石を登る場合、クラスタが回転するため、輸送装置は車輪均衡モードに切り換わる。移行が生じるので、輸送装置を安定化するために、車輪が逆方向に駆動されて縁石から離れる。このことは、越えようとしている縁石が大きすぎて回避すべきであることをユーザに気付かせる有効な方法であろう。
【０１７０】
縁石を降りるには、ユーザは縁石から離れるように輸送装置を簡単に駆動するだけである。ゆっくり行えば、輸送装置は車輪ＰＤモードに保たれるであろう。ユーザが高速で縁石から離れる場合、クラスタ回転が非常に大きくなって、少なくとも４つの車輪すべてが再び地面に載るまで、輸送装置は車輪ＰＯＣモードに移行する。縁石から高速で落下すると、輸送装置を車輪均衡モードに入れるほど大きいクラスタ回転が生じるであろう。その時、輸送装置は、重心が装置のフットプリントの上方に位置するように車輪を十分に前方向に駆動するために、それ自体の制御を優先する（すなわち、ユーザ入力コマンドを無視する）。
重心の推定
以上の説明で時々、重心の位置を参照してきた。一部の実施形態では、輸送装置は、直接的に重心の位置の推定値であろう。別の実施形態では、輸送装置は、重心の位置の推定値に基づいた所望の構成要素向きを使用するであろう。たとえば、図２０では、（ブロック２０４６で）現在フレーム・ピッチと比較した所望ピッチ（たとえば、ブロック２０４４）は、重心の位置の推定値に基づくことができるフレーム・ピッチである。すなわち、所望ピッチは、輸送装置の一定の構成要素が一定の向きにある時に重心を輸送装置のフットプリントの上方に位置させることがわかっているフレーム・ピッチであろう。
【０１７１】
装置の構成要素の所望の向きを決定するために、装置の重心をどのように推定できるかについて、以下に詳細に説明する。人輸送装置の状況で重心に触れるが、重心の位置の推定に関連した本説明の教示が、輸送装置用の重心の推定に制限されないことは、容易に明らかになるであろう。そのため、以下の説明は、人輸送装置に当てはまるのに加えて、重心の推定が必要ないずれの装置にも当てはまるであろう。そのような装置を以下の説明でシステムと呼ぶ。
【０１７２】
図２２Ａは、重心推定値を使用することができる制御ループの一例を示している。制御ループ２２００は、制御信号発生器２２０２と、幾つかの構成要素を有する装置２２０４とを含む。制御信号発生器２２０２は、装置２２０４内に含まれるアクチュエータ（図示せず）が装置２２０４の様々な構成要素の向きを変化させることができるようにする制御信号を発生する。制御信号発生器２２０２は、装置２２０４の構成要素の１つに包含してもよい。しかし、説明しやすくすると共に、構成要素の１つの向きを変更するために制御信号発生器２２０２が装置２２０４の少なくとも１つのアクチュエータに制御信号を与えることを明白に示すために、制御信号発生器２２０２を個別のブロックとして示している。制御信号発生器２２０２は、上記の輸送装置の制御ユニット（電子機器ボックス）と同様にすることができる。
【０１７３】
制御信号発生器２２０２への入力は、構成要素の１つの現在の向きと、所望の向き２２０６との差（すなわち、オフセット）である。オフセットは、オフセット値を生じるために現在の向きを所望の向き２２０６から減算する加算器２２０８の出力である。制御信号発生器２２０２は、オフセット値を受け取り、オフセット値に基づいて、オフセットを減少させるように装置が構成要素の向きを変更できるようにする制御信号を発生する。
【０１７４】
図２２Ｂは、システムの構成要素の所望の向きを表す値を生じることができるシステムのブロック図である。所望の向き決定器２２１２が幾つかの入力を受け取って、出力として構成要素の所望の向きを生成する。所望の向きは、制御されているシステムの作動モード（データブロック２２１３）に応じて変化するであろう。１つの実施形態では、所望の向きは、システムを釣り合い状態にすることがわかっている（または、計算されている）構成要素の向きに等しいであろう。この情報は、データ・セット２２１４に含まれるであろう。データ・セットは、おおまかには重心の位置の推定値と呼ぶことができる。すなわち、装置の一定の構成要素が一定の向きにある時、装置の重心が特定位置にあると仮定することができる。これは、重心の位置の推定値と同じである。このデータ・セット２２１４を作成する方法については後述する。
【０１７５】
所望位置決定器２２１２は、システムの現在モード２２１３も受け取る。一部のシステムには、重心の推定値を異なった方法で使用することができる異なった作動モードがある。たとえば、装置は、ユーザが輸送装置から落下しないようにするために自己安定化を行う人輸送装置にすることができる。そのようなシステムでは、重心の位置の推定値が、輸送装置を釣り合わせるように輸送装置を制御する際に使用されるであろう。再び図２０を参照すると、ブロック２０４６の所望フレーム・ピッチを決定するために、重心の推定値を使用することができる。この推定値をどのように決定して使用するかについては後述する。
【０１７６】
図２３は、重心２３０４が後輪２３０２の上方に変位している輸送装置の例を示している。重心の位置２３０４は、輸送装置、ユーザおよびユーザが持っているか、輸送装置に載置されている他のすべてのペイロードを含むシステム全体の重心の位置を表す推定量であろう。重心２３０４は、電子機器ボックス２３０５に対する座標値θ3と、クラスタ軸２３０６に対する長さＬ1とによって位置を定めることができる。一部の実施形態では、角度θ3が、使用される唯一の変数であろう。他の実施形態では、重心の位置を推定するためにθ3およびＬ1の両方が使用されるであろう。
【０１７７】
前述したように、電子機器ボックス２３０５（制御ユニット）は、クラスタ２３０８および電子機器ボックス２３０５の向きを測定することができる様々なセンサ、たとえば、ピッチセンサを含むであろう。また、クラスタ２３０８の向きは、クラスタ上か、電子機器ボックス２３０５内に配置されたクラスタ速度センサの出力を積分することによって決定するか、クラスタ・モータによって報告することができる。
【０１７８】
輸送装置は、中心点２３１０を有する接地部材２３０２（この実施形態では、車輪）を含むことができる。重心２３０４が中心点２３１０（または、安定性を与える接地部材上のいずれかの他の点）の上方に位置する時、輸送装置は釣り合う。
【０１７９】
図２３では、時計回り方向を指す角度を表す矢印が正の値になるように、角度を測定する。たとえば、電子機器ボックスに対するクラスタ位置θcには正の値が割り当てられるであろう。
【０１８０】
角度θ3は、Ｌ1と電子機器ボックス２３０５との間の角度である。電子機器ボックス２３０５は、輸送装置の様々な構成要素の向きを決定する傾斜センサを含むことができる。これらの傾斜センサは、直接的に水平線に対する電子機器ボックスの角度θeを測定することができる。制御器（図示せず）が、電子機器ボックス２３０５に対するクラスタの角度を監視することができる。距離Ｌ2は、クラスタの中心２３０８から地面と接触している車輪２３０２の中心点２３１０までの距離である。Ｌ2は、使用中の特定の輸送装置によって決まる既知のパラメータである。１つの実施形態では、車両の作動中にＬ2が変化しないが、輸送装置が用いるクラスタの形式によっては、Ｌ2が変化するであろう。
【０１８１】
重心２３０４が接地車輪の中心点２３１０の上方にある時、輸送装置をモデル化する１つの方法が、
【０１８２】
【数８】
2010094533.tif 000011
【０１８３】
である。この等式の項を展開して整理すると、次のようになる。
【０１８４】
【数９】
2010094533.tif 000012
【０１８５】
この等式を解くことによって、たとえば、電子機器ボックス２３０５の所望の向き（θe）を決定することができる。Ｌ1およびθ3は非線形三角関数であり、電子機器ボックス２３０５内にあるマイクロプロセッサの処理能力は限られているであろうから、三角関数を用いてθeを直接的に計算することを避ける方が効率的であろう。そのような場合、ルックアップ・テーブルと曲線当てはめスキームとを使用して、θeの補正値を発生する。展開して整理した等式に基づいて曲線当てはめを行うために、展開式を簡単にすると、
【０１８６】
【数１０】
2010094533.tif 000013
【０１８７】
となり、項を整理すると、
【０１８８】
【数１１】
2010094533.tif 000014
【０１８９】
になり、ここで、
【０１９０】
【数１２】
2010094533.tif 000015
【０１９１】
であり、そしてｈはプラットフォーム高さである。θeの２つの値がわかれば、この等式をＫ1（ｈ）およびＫ2（ｈ）について解くことができる。Ｋ1（ｈ）およびＫ2（ｈ）の値がわかれば、簡単な三角関数計算を使用して、Ｌ1およびθ3の両方の値を決定することができる。前述したように、Ｌ1およびθ3が与えられれば、重心の位置がわかる（もちろん、その位置は、輸送装置の場合、クラスタの中心点にすることができる基準位置を基準にしている。後述の曲線は、Ｋ1（ｈ）およびＫ2（ｈ）を、従ってＬ1およびθ3を決定するために使用されるθeの２つの値を決定する有効な方法を与える。
【０１９２】
あるいは、電子機器ボックスの角度を重力に対するクラスタ角度φcの関数として求めることができ、これによって次式が得られる。
【０１９３】
【数１３】
2010094533.tif 000016
【０１９４】
繰り返すと、輸送装置を上記等式によってφcに基づいてモデル化した場合、Ｌ1およびθ3を解くために、θeの２つの値が必要である。
輸送装置がどの作動モードで作動しているかに応じて、重心を推定するために電子機器ボックス角度またはクラスタ角度のいずれかを使用することができる。たとえば、階段モードで作動している時、φcに基づいた所望電子機器ボックス角度の推定値を使用することが好ましいであろう。
【０１９５】
図２４は、重心の位置を推定するために使用することができる基準データ・セットを作成することができる実施形態のフローチャートである。図２５Ａ〜図２５Ｃと関連させて図２４を説明する。そのような基準データ・セットを作成する理由は少なくとも２つある。第１に、データ・セットを個々のユーザに対してカスタマイズさせることができる。第２に、データ・セットは、後述するように、輸送装置の構成要素の所望の向きの効率的な計算を可能にする。
【０１９６】
本方法はステップ２４０２で始まり、ここで装置（たとえば、輸送装置）の構成要素を特定配置に構成し、様々な構成要素の向きを記録する。たとえば、輸送装置のクラスタを第１向きに配置して、この値を記録することができる。図２５Ａは、クラスタ２５０２の可能な第１向きを示し、本例では、電子機器ボックス２５０４およびクラスタが互いに平行であるため、これはθc＝０で表される。また、初期パラメータとして、座部高さを記録する。１つの実施形態では、プラットフォームの高さが可能な限り低いであろう。
【０１９７】
ステップ２４０４で、輸送装置を第１位置に移動させる。第１位置は、重心をクラスタの車輪の１つの上方に置く位置にすることができる。この時点で、重心は既知ではなくまたは推定されていないが、輸送装置を移動させている人によって安定化がほとんど、またはまったく必要とされない状態で輸送装置が均衡しているため、重心が車輪の軸の上方にあることは明らかである。
【０１９８】
ステップ２４０４で輸送装置を第１位置に置いた後、ステップ２４０６で構成要素の少なくとも１つの向きを記録する。向きの記録が行われる構成要素として、電気機器ボックスの向き（θ3）、重力に対するクラスタ位置（φc）および座部高さがあるが、これらに制限されない。角度を物理的に測定するか、あるいは電子機器ボックスのセンサを利用することによって、様々な向きの値を記録することができる。マイクロプロセッサからデータをサンプリングすることによって、または直接的にセンサの出力を読み取ることによって、センサを利用することができる。
【０１９９】
図２５Ｂは、第１位置にある輸送装置を示している。本例では、重心２５０６が輸送装置の前輪２５０８の上方に位置している。電子機器ボックスの角度θeは正の値であって、これを記録することができる。
【０２００】
ステップ２４０８で、輸送装置を第２位置に置く。第１位置と同様に、第２位置は、重心２５０６を輸送装置の後輪２５１０の上方に置いて、輸送装置を釣り合わせた位置（図２５Ｃを参照）にすることができる。ステップ２４１０で、第２位置にある装置の構成要素の向きを記録する。
【０２０１】
たとえば初期クラスタ位置を異なった向きにして、上記のステップ２４０２〜２４１０のすべてを繰り返すようにして、上記処理を繰り返すことができる。また、処理を行う毎に、プラットフォームの高さも調整することができる。
【０２０２】
図２６は、以上に概要を述べた処理を数回繰り返した結果のグラフである。重心を装置のフットプリント（すなわち、２つの車輪間）の上方に配置する場合について、横軸が相対クラスタ向き（θc）をラジアンで示し、縦軸が対応の電子機器ボックス向き（θe）をラジアンで示している。もちろん、θeをφcに関連させた同様なグラフを作成することができる。第１の線２６０２は、最低のプラットフォーム高さの場合の処理結果を表し、第２の線２６０４は、最高のプラットフォーム高さの場合の処理結果を表す。前述したように、これらの線は上記等式に比較的厳密に従う。そのため、これらの線をルックアップ・テーブルとして用いることによって、クラスタ向きに基づいてθeの２つの値を容易に決定することができる。前述したように、θeのこれらの２つの値によって、Ｌ1およびθ3をすぐに計算することができる。さらに、最高および最低プラットフォーム高さの両方について曲線が作成されているので、すべてのクラスタ位置ですべての座部高さについてすべての所望電子機器ボックス向きを決定することができる。Ｌ1およびθ3をこれらの２つの値の間で線形推定することができることがわかった。
【０２０３】
再び図２６を参照すると、現在クラスタ位置が２６０６である場合、記録された２つの電子機器ボックス位置は２６０８および２６１０である。これは、線２６１２（現在クラスタ位置）と２６１４および２６１６（可能な電子機器ボックス向き）とによってグラフに示されている。θeのこれらの２つの値を用いることによって、Ｌ1およびθ3について線形補間することができる。
【０２０４】
Ｌ1およびθ3の値は、例えば、システムが作動しているモードに応じて、様々な方法で使用することができる。たとえば、システムが輸送装置である場合、システムは、前述したように、均衡モード、階段モードおよび強化モードを含むことができる。強化モードでの電子機器ボックスの所望の向きをthetaref＿fourwheelsと呼ぶ。θ3の値だけに基づいて、thetaref＿fourwheelsについて解くことができる。図２３を参照すると、重心をクラスタ２３０８の中心点２３１０の上方に置く等式は、
【０２０５】
【数１４】
2010094533.tif 000017
【０２０６】
である。このため、θ3を決定するだけで、所望電子機器ボックス角度が容易に計算される。一部の実施形態では、この所望の向きをブロック２０４４（図２０）の所望ピッチ値として使用することができる。
【０２０７】
均衡モードにある時、Ｌ1およびθ3に基づいた重心の位置の推定値を使用して、車軸の重心を接地車輪の上方に置く電気機器ボックス向き（theta＿balance)を決定することができる。θ3およびＬ1が与えられれば、等式
【０２０８】
【数１５】
2010094533.tif 000018
【０２０９】
を解くことによって、電子機器ボックス向きを計算することができる。
以上に本発明の少なくとも説明的な実施形態を示してきたが、当業者には様々な変更および改良を容易に考えることができると思われ、それらは本発明の範囲に入るものとする。したがって、以上の説明は例示にすぎず、制限的ではないものとする。本発明は、特許請求の範囲およびそれと同等のものに定義されているものとして制限されるだけである。
【図１】
2010094533.tif 000019
【図２Ａ】
2010094533.tif 000020
【図２Ｂ】
2010094533.tif 000021
【図２Ｃ】
2010094533.tif 000022
【図２Ｄ】
2010094533.tif 000023
【図２Ｅ】
2010094533.tif 000024
【図２Ｆ】
2010094533.tif 000025
【図３】
2010094533.tif 000026
【図４】
2010094533.tif 000027
【図５】
2010094533.tif 000028
【図６】
2010094533.tif 000029
【図７】
2010094533.tif 000030
【図８】
2010094533.tif 000031
【図９】
2010094533.tif 000032
【図１０】
2010094533.tif 000033
【図１１】
2010094533.tif 000034
【図１２Ａ】
2010094533.tif 000035
【図１２Ｂ】
2010094533.tif 000036
【図１３】
2010094533.tif 000037
【図１４】
2010094533.tif 000038
【図１５】
2010094533.tif 000039
【図１６】
2010094533.tif 000040
【図１７Ａ】
2010094533.tif 000041
【図１７Ｂ】
2010094533.tif 000042
【図１８】
2010094533.tif 000043
【図１９】
2010094533.tif 000044
【図２０】
2010094533.tif 000045
【図２１】
2010094533.tif 000046
【図２２】
2010094533.tif 000047
【図２３】
2010094533.tif 000048
【図２４】
2010094533.tif 000049
【図２５Ａ】
2010094533.tif 000050
【図２５Ｂ】
2010094533.tif 000051
【図２５Ｃ】
2010094533.tif 000052
【図２６】
2010094533.tif 000053