JP6037890B2 - 多点境界値問題を解くことに基づいたシステム制御の最適化 - Google Patents

Description

この発明は、包括的には、システムの動作の制御の最適化に関し、より詳細には、多重境界値問題を解くことによって制御軌跡(control trajectory)を求めることに関する。

最適制御問題は、航空宇宙における最小燃料着陸、及び製造における時間最適動作等の多岐にわたる用途に適用される。例として、時間最適運動制御システムは、位置決め用途、例えば単軸位置決め又は多軸位置決めにおいて広く用いられる。単軸位置決め運動制御システムは、運動制御装置と、サーボ増幅器と、モーターとを備える。運動システムの最適制御は通常、設計の複雑度を低減する２つのステップにおいて解かれる。第１のステップは、モーターが運動システムの状態制約又は制御制約、すなわち加速度、速度、ジャークを制御するための制御軌跡を求める。第２のステップは、モーターがこの制御軌跡に追従することを確実にする制御装置を設計する。

制御軌跡は、モーターの運動によって生じる振動、及び特定のタスクの位置決め時間又はエネルギー消費等の他の性能メトリックを低減するように求めることもできる。運動制御システムの性能に対する制御軌跡の影響に起因して、複数の対立する目的を最適化する制御軌跡を求めることは困難である。

動的計画法及び最小原理は、最適制御問題を解くのに用いられる２つの主要な技法である。動的計画法は、最適制御問題を、ハミルトン−ヤコビ−ベルマン方程式と呼ばれる１組の偏微分方程式に簡約する。最小原理によって、境界値に対する条件を有する１組の微分方程式、すなわち境界値問題が得られる。境界値問題は、１組の境界条件と合わせた１組の微分方程式である。境界値問題の解は、境界条件も満たす微分方程式の解である。

境界値問題を解くことは難しく、通例、微分方程式の推測初期条件を用いて初期値問題(ＩＶＰ)を解くことに頼る。ＩＶＰは、解の領域内の所与の点における未知の関数の、初期条件と呼ばれる特定の値と合わせた１組の微分方程式である。ＩＶＰを用いて境界値問題を解くために、初期値に対応する軌跡が境界条件を満たすまで、初期値が反復的に更新される。

システムの動作が状態制約又は制御制約を受けるとき、制約された最適制御問題の結果、多点境界値問題(ＭＢＶＰ)が得られる。多点境界値問題は、１組の順序付けされた区分的微分方程式及び対応する境界条件である。通常、境界条件は、ＭＢＶＰの解の領域内の少なくとも３つの点について指定される。ＭＢＶＰは最も困難な一部の境界値問題のうちの１つである。

ＭＢＶＰは、以下の形式をとることができる。

ここで、ｘは状態変数のベクトルであり、λは共状態変数のベクトルであり、ｕは制御変数のベクトルであり、Ｈは適切に定義されたハミルトニアン演算子であり、μ、ｖ、πはラグランジュ乗数であり、ｍは定数であり、ｔ_０及びｔ_ｍはそれぞれ初期時点及び最終時点を表し、ｆ、ｇ、ｈは区分的関数である。開示を単純にするために、ｘ、λ、ｕはそれぞれ、状態変数、共状態変数、及び制御変数と呼ばれる。微分方程式は、状態変数及び共状態変数が経時的にどのように展開するかを定義する。代数方程式は、時点ｔ_ｋにおける状態変数及び共状態変数並びに制御変数の値を、ｘ、λ、及びｔの関数として指定する。初期時点はｔ_０＝０であり、最終時点はｔ_ｍ＝Ｔである。

図１は、１組の順序付けされた微分方程式１２０と、１組の境界条件(ＢＣ)１３０と、特定される１組の未知のパラメーター１４０とを含む従来のＭＢＶＰ１１０を示している。パラメーターは、ＭＢＶＰの定義と無関係であるが、この説明を単純にするためにＭＢＶＰの一構成要素として扱われる。境界条件は通例、代数方程式の形態をとる。

図２は、３つのセグメントＡＢ_１２１０、Ｂ_１Ｂ_２２２０、及びＢ_２Ｂ２３０を有する制御軌跡を含むＭＢＶＰの例示的な解を示している。図２において、ｘ(ｔ)及びλ(ｔ)は、状態変数及び共状態変数の軌跡を表し、(オーバーバー)ｔ_１は制御軌跡が第１の１組の微分方程式から第２の１組の微分方程式に切り替わる時点であり、(オーバーバー)ｔ_２は制御軌跡が第２の１組の微分方程式から第３の１組の微分方程式に切り替わる時点である。制御軌跡の各セグメントは、異なる１組の微分方程式を満たし、すなわち、ＭＢＶＰは、それぞれ間隔[０，(オーバーバー)ｔ_１]、[(オーバーバー)ｔ_１，(オーバーバー)ｔ_２]、及び[(オーバーバー)ｔ_２，Ｔ]にわたって定義される３組の微分方程式を有し、セグメントＡＢ_１は[０，(オーバーバー)ｔ_１]にわたって定義される第１の１組の微分方程式を満たし、セグメントＢ_１Ｂ_２は[(オーバーバー)ｔ_１，(オーバーバー)ｔ_２]にわたって定義される第２の１組の微分方程式を満たし、セグメントＢ_２Ｂは[(オーバーバー)ｔ_２，Ｔ]にわたって定義される第３の１組の微分方程式を満たす。

単一シューティング及び多重シューティングを含むシューティング法は、ＭＢＶＰを初期値問題として解く、古典的であるが効果的な方法である。

単一シューティング法
図３は単一シューティング法の原理を示している。曲線ＡＢ３１０は、探索されるＭＢＶＰの真の解である。点Ａにおける状態ｘ(０)及び共状態λ(０)の値は、部分的に未知であるので、点Ｂにおけるｘ(Ｔ)及びλ(Ｔ)の値に関する情報を用いて、点Ａにおける状態値及び共状態値が特定される。点Ａにおける状態値及び共状態値を所与とすると、ＭＢＶＰは初期値問題として解くことができるので、ＭＢＶＰの解は一意に定義される。

点Ａにおける真の状態値及び共状態値を探索する方法は以下の通りである。まず、この方法は、ｘ(０)及びλ(０)の初期値を意味する、軌跡の初期位置Ａ’３３０を推定する。次に、ＭＢＶＰは、初期値問題に簡約され、曲線Ａ’Ｂ’３２０によって表されるこの初期値問題の解は、微分方程式の積分によって得ることができる。Ａ’から開始する初期値問題の解は、最後は最終位置Ｂ’３４０となる。これは、予測位置Ｂから距離δＦにある。シューティング誤差δＦを用いて、Ａ’の位置の推定値が更新される。

単一シューティング法は、１つの時点におけるパラメーター、通例、初期時点における共状態値を定義し、別の時点において境界条件、通例、最終時点における状態値及び共状態値の組合せが課される。例として、図３のＭＢＶＰは境界条件を有し、すなわちδＦ＝０であるか又は点Ｂ’がＢと一致する。単一シューティングは、パラメーターが少なく、実施が容易であるが、特に、微分方程式が非線形であるか又は大きな時間間隔にわたって定義される場合に収束が不良である等の特性を有する。

単一シューティング法はまた、必要条件が意味する最適軌跡を十分活用せず、このため、未知のパラメーターの初期推定値の品質に、より依存する。パラメーターに対する境界条件の感度に起因して、単一シューティング法の解は、限られたクラスの境界値問題、例えば線形境界値問題、又は非常に短い時間間隔にわたって定義された境界値問題についてのみ機能する。単一シューティング法を用いてＭＢＶＰを解くときに通常観察されるのは、特異勾配問題(singular gradient issue)である。

多重シューティング法
多重シューティング法は、単一シューティング法の幾つかの限界に対処し、通常、微分方程式における初期推測、非線形性、及び大きな時間間隔を所与とすると、単一シューティング法よりも正確である。多重シューティング法は、単一シューティング法の不良な収束特性を改善する。

図４は、多重シューティング法の基本的な着想を示している。曲線ＡＢはＭＢＶＰの解を表し、これは３つのセグメントを含む。第１のセグメントは[０，(オーバーバー)ｔ_１]にわたって定義される第１の１組の微分方程式を満たす。第２のセグメントは、[(オーバーバー)ｔ_１，(オーバーバー)ｔ_２]にわたって定義される第２の１組の微分方程式を満たす。第３のセグメントは、[(オーバーバー)ｔ_２，Ｔ]にわたって定義される第３の１組の微分方程式を満たす。区分的微分方程式を積分するために、多重シューティング法は、時間間隔［０，Ｔ］を、例としてＮ個の部分間隔［ｔ_ｋ，ｔ_Ｋ＋１］(０≦ｋ≦Ｎ−１)に離散化する。ここで、ｔ_０＝０及びｔ_Ｎ＝Ｔである。

図４に示すように、Ａ’_０，…，Ａ’_Ｎ−１は、時点ｔ_０，…，ｔ_Ｎ−１における軌跡の推定値であり、(オーバーバー)ｔ_１，(オーバーバー)ｔ_２は推定切替え時点であり、すなわち、パラメーターは、点Ａ’_０，…，Ａ’_Ｎ−１及び切替え時点(オーバーバー)ｔ_１，(オーバーバー)ｔ_２における軌跡の値として定義される。ｔ_ｋ(０≦ｋ≦Ｎ−１)におけるｘ及びλの初期値を所与とすると、微分方程式はそれぞれ［ｔ_ｋ，ｔ_Ｋ＋１］にわたって積分され、次の時点ｔ_ｋ＋１におけるｘ及びλの値が得られ、対応する境界条件は、δＦ_ｋ＝０(ここで、１≦ｋ≦Ｎ−１)及びδＦ＝０である。多重シューティング法は通常、離散した時点ｔ_ｋ(１≦ｋ≦Ｎ−１)におけるパラメーター及び境界条件、並びに制御軌跡が切り替わる時点、例えば(オーバーバー)ｔ_１，(オーバーバー)ｔ_２を定義する。

単一シューティング法と対照的に、多重シューティング法は、はるかに短い時間間隔［ｔ_ｋ，ｔ_ｋ＋１］にわたって積分を実行し、境界条件の勾配は、推定パラメーターに関して、感度方程式によってはるかに正確に近似することができる。多重シューティング法は、単一シューティング法よりも良好な収束特性を有する。しかしながら、この改善は、追加のパラメーターを導入することと引き換えに達成され、これによって計算効率が下がる。多重シューティング法は、状態が制約された最適制御問題を扱うこともできる。しかしながら、多重シューティング法は、ＭＢＶＰを大きな非線形計画問題に変換し、対応するソルバーは計算的に複雑となる。このため、多重シューティング法は、高速の産業用途、例えば運動制御システムの軌跡計画の目標完了時間を常に満たすことができるとは限らない。

図５は、所与のパラメーター及び境界条件についてＭＢＶＰを解くための従来の反復手順のブロック図を示している。パラメーターは初期推定され(５１０)、パラメーターの初期推定値に基づいて、ＭＢＶＰは微分方程式の初期値問題として解かれる(５２０)。解は境界条件に対して試験される(５３０)。境界条件が満たされない場合、パラメーターは更新され(５５０)、そうでない場合、この方法は制御軌跡を出力する(５４０)。

この発明の様々な実施の形態の目的は、動作コストが最適化されるようにシステムの動作を制御するための方法を提供することである。通常、動作コストは、動的制約、加速度制約、及び速度制約等の動作の様々な制約を受ける。システムの動作の最適化は、開ループ最適制御問題として定式化され、この開ループ最適制御問題は、これらの制約を条件としてコスト関数を最適化する制御軌跡に対応する多重境界値問題(ＭＢＶＰ)の解に更に簡約される。

幾つかの実施の形態は、ＭＢＶＰの解の処理時間を低減する混合シューティング法を開示する。１つの実施の形態では、本方法は、特定の位置決めタスクを実行しながらエネルギーを最小限しか消費しない、エネルギー効率のよい運動制御システムの制御軌跡を設計するために適用される。

この発明の幾つかの実施の形態による混合シューティング法は、ＭＢＶＰのパラメーター及び境界条件が、例えばＭＢＶＰの構造に関して様々なタイプを有するという認識に基づいている。このため、パラメーター及び境界条件は２つ以上の組に分割することができ、各組は別個に求めることができる。例えば、各組は、現在の反復について固定された別の組の値に基づいて反復的にかつ交互に求めることができる。例えば、第１の１組のパラメーターが、第１の１組の境界条件が満たされるまで更新され、次いで、第２の１組のパラメーターが、第２の１組の境界条件を満たすように調整される。

例えば、１つの実施の形態では、第１の１組のパラメーターは、或る特定の時点における運動システムの状態値及び共状態値を含み、第２の１組のパラメーターは微分方程式の切替え時点を含む。

混合シューティング法は、切替え時点に対する境界条件の感度と、状態値及び共状態値、並びに切替え時点の、境界条件に対する結合効果とに起因して、従来の方法の収束問題を著しく克服する。混合シューティング法は、パラメーター数を低減して処理時間を最適化するとともに、先験的条件として最適軌跡の構造を組み込むことによって収束特性を改善する。

この発明の幾つかの実施の形態は、運動制御システムの動作の総コストが低減されるような、運動制御システムのエネルギー消費と生産性との間の効果的なトレードオフの必要性を動機としている。様々な因子の中から、サーボモーターが運動制御システムのエネルギー消費を低減するために従うエネルギー効率のよい軌跡が求められる。さらに、エネルギー効率のよい軌跡は、速度、加速度、及び電流制約を含む、運動制御システムの様々な制約を検討する。この発明の様々な実施の形態は、エネルギー効率のよい運動制御システムのエネルギー効率のよい軌跡を、ＭＢＶＰのクラスとして定式化することができる最適制御問題として求め、混合シューティング法を用いてこのＭＢＶＰを解く。

したがって、この発明の１つの実施の形態は、境界条件を満たす１組の微分方程式の解によって表される制御軌跡に従ってシステムの動作を制御するための方法であって、前記１組の微分方程式は順序付けされた区分的微分方程式を含む、境界条件を満たす１組の微分方程式の解によって表される制御軌跡に従ってシステムの動作を制御するための方法を開示する。該方法は、
前記１組の微分方程式をパラメーター化することであって、切替え時点における前記解の値を表す第１の１組のパラメーターと、前記切替え時点の値を表す第２の１組のパラメーターとを得る、パラメーター化することと、
前記境界条件が満たされるまで前記第１の１組のパラメーター及び前記第２の１組のパラメーターを交互に求めることであって、前記解を得る、求めることと、
前記解に基づいて、前記システムの前記動作を制御する前記制御軌跡を生成することと、
を含み、該方法のステップはプロセッサによって実行される。

例えば、この実施の形態の１つの変形形態では、前記システムはモーターを含む運動制御システムであり、該システムの前記動作は制約を受け、前記第１の１組のパラメーターの前記値は前記システムの状態及び共状態を表し、前記１組の微分方程式及び前記境界条件は、前記制約を満たす前記解を有し、かつ前記動作中の前記システムのエネルギー消費を表すコスト関数を最適化する多重境界値問題(ＭＢＶＰ)を形成する。

この発明の別の実施の形態は、境界条件を満たす１組の微分方程式によって形成される多重境界値問題(ＭＢＶＰ)を解くための方法であって、前記１組の微分方程式は順序付けされた区分的微分方程式を含み、前記ＭＢＶＰの解は制御軌跡を表す、境界条件を満たす１組の微分方程式によって形成される多重境界値問題を解くための方法を開示する。該方法は、
前記１組の微分方程式をパラメーター化することであって、切替え時点における前記解の値を表す第１の１組のパラメーターと、前記切替え時点の値を表す第２の１組のパラメーターとを得る、パラメーター化することと、
固定した前記第２の１組のパラメーターの前記値を有する前記１組の微分方程式を解くことによって第１の１組の境界条件を満たす前記第２の１組のパラメーターの前記値を求めることと、
固定した前記第１の１組のパラメーターの前記値を有する前記１組の微分方程式を解くことによって第２の１組の境界条件を満たす前記第１の１組のパラメーターの値を求めることと、
第１の１組の境界条件及び前記第２の１組の境界条件の双方が満たされるまで、前記第１の１組のパラメーターの値を求めること及び前記第２の１組のパラメーターの値を求めることを繰り返すことと、
を含み、該方法のステップはプロセッサによって実行される。

更に別の実施の形態は、制御信号に基づいてシステムを制御するための運動制御装置を開示する。該運動制御装置は、
軌跡生成モジュール及び制御モジュールを実行するように構成されたプロセッサを備え、
前記軌跡生成モジュールは、混合シューティング法を用いて多重境界値問題(ＭＢＶＰ)を解くことによって制御軌跡を求め、
前記制御モジュールは、前記制御軌跡に基づいて前記制御信号を生成する。

従来技術の多重境界値問題(ＭＢＶＰ)のブロック図である。 従来技術による、ＭＢＶＰの区分的解のグラフである。 従来技術による、ＭＢＶＰを解く単一シューティング法のグラフである。 従来技術による、ＭＢＶＰを解く多重シューティング法のグラフである。 従来技術による、ＭＢＶＰの解を探索するシューティング法のフローチャートである。 この発明の幾つかの実施の形態による、システムの動作を制御するための方法のブロック図である。 この発明の幾つかの実施の形態による、システムの動作を制御するための制御システムのブロック図である。 この発明の幾つかの実施の形態による、ＭＢＶＰを求めるための方法のブロック図である。 この発明の幾つかの実施の形態による、ＭＢＶＰの構造を求めるための方法のブロック図である。 この発明の幾つかの実施の形態による、ＭＢＶＰを解くための混合シューティング法のグラフである。 この発明の幾つかの実施の形態による混合シューティング法のブロック図である。 この発明の幾つかの実施の形態による、ＭＢＶＰの境界条件及びパラメーターの分割の概略図である。 この発明の幾つかの実施の形態による、ＭＢＶＰを解くための２ステップ再帰のブロック図である。 この発明の幾つかの実施の形態による、ＭＢＶＰを解くための方法のブロック図である。 この発明の幾つかの実施の形態による、特定の問題データと関連付けられたＭＢＶＰの最適制御軌跡のグラフである。 この発明の幾つかの実施の形態による、特定の問題データと関連付けられたＭＢＶＰの最適制御軌跡のグラフである。

図６Ａは、この発明の幾つかの実施の形態による、システムの動作を制御するための方法を示している。図６Ａの方法は説明の目的のみで用いられ、この発明の範囲を限定することを意図するものではない。

本方法のステップは、プロセッサ６９９によって実行することができる。システム６００の動作コストはコスト関数６０１によって表され、システムの物理的構造及び制限、並びにシステムの特定のタスクに関する詳細は、動作の制約６０２によって表される。制約６０２は、システムのモデルを表す動的制約、状態制約及び制御制約、タスクの実行時間及び距離を含むがこれらに限定されない。

１つの実施の形態では、状態制約は、加速度制約及び速度制約のうちの少なくとも一方を含む。コスト関数６０１及び制約６０２に基づいて、多重境界値問題(ＭＢＶＰ)の解によって、制約６０２を満たしながらコスト関数６０１を最適化する制御軌跡が得られるように、ＭＢＶＰが求められる(６０３)。

混合シューティング法を用いてＭＢＶＰが解かれ(６０４)、解６０９が得られる。混合シューティング法は以下でより詳細に説明される。解を任意選択で処理し(６０５)、例えばローパスフィルターを用いて解の高周波数成分を除去し、制御軌跡６１０を生成することができる。

１つの実施の形態では、図６Ａの方法の少なくとも一部を実施するシステムは、モーターを備える運動制御システムである。システムの動作は制約を受け、第１の１組のパラメーターの値はシステムの状態及び共状態を表し、１組の微分方程式及び境界条件によって、制約を満たし、かつコスト関数を最適化する解を有する多重境界値問題(ＭＢＶＰ)が形成される。

例として、運動制御システムにおいて、制御軌跡６１０は、モーターの加速度、速度、及び位置軌跡のうちの１つ又はそれらの組合せを含むことができる。制御モジュール６０６は、制御軌跡６１０に基づいて制御信号６１２を生成し、システムのアクチュエーター６０７に制御信号を出力し、これによってシステムの最適な動作を制御する。

図６Ｂは、図６Ａの方法の少なくとも一部を実施する運動制御装置６２０の一例を示している。例えば、軌跡生成器モジュール６２１が、システムの動作の制約を条件としてコスト関数を最適化する制御軌跡に対応するＭＢＶＰを求め、混合シューティング法を用いてＭＢＶＰを解き、制御軌跡６１０を生成する。この実施の形態の１つの変形形態では、軌跡生成器モジュール６２１は、ブロック６０３、６０４、及び６０５の関数を実行する。制御モジュール６０６は、制御軌跡を用いて、例えば、フィードバック信号６２２及び制御軌跡６１０に基づいて制御信号６１２を生成することによって、システムを制御する。

１つの実施の形態では、コスト関数は、動作中のシステムのエネルギー消費を表す。例えば、コスト関数は以下の積分であり

ここで、Ｅは動作の時間Ｔ中のシステムのエネルギー消費であり、Ｐ(ｘ，ｕ)はシステムの瞬間エネルギー消費であり、ｘはモーターの状態であり、ｕはモーターへの制御入力であり、瞬間エネルギー消費Ｐは、モーターの抵抗巻線の銅損、増幅器の切替え損失、及びモーターの機械的作業のうちの少なくとも１つから得られる。

ＭＢＶＰの決定
図７は、この発明の幾つかの実施の形態による、ハミルトニアン解析７００に基づいて１組のＭＢＶＰを求めるための方法を示している。ハミルトニアン解析７００によって、コスト関数６０１及び制約６０２について最適制御軌跡が満たさなくてはならない必要条件７０２が得られる。必要条件７０２は、例えば式(１)に従って、１組の区分的微分方程式及び区分的代数方程式の組合せに更に簡約することができる。必要条件７０２及び微分方程式の達成可能な順序に基づいて、ブロック７０１は１組のＭＢＶＰを確立する。

時間間隔にわたって定義された微分方程式の順序は、ＭＢＶＰの解の構造に等しい。本明細書において用いられるとき、ＭＢＶＰの構造は、様々なタイプの微分方程式の順序を定義する。切替え時点は、微分方程式の１つのタイプから別のタイプへの切替えを示す。通常、微分方程式の１つのタイプは、制御軌跡の１つのセグメントに対応する。微分方程式のタイプの例には、加速度制約タイプ又は減速度制約タイプ、速度制約タイプ、ゼロ電力タイプ、制約無しタイプの微分方程式が含まれるが、これらに限定されない。

制約の存在に起因して、必要条件を満たす制御軌跡は１つ又は複数のセグメントを含む。制御軌跡の各セグメントは、異なる１組の微分方程式及び境界条件を満たすことができる。異なる制約に対応する制御軌跡は、異なるセグメントで構成することができる。例えば、１つの問題データについて、１つの制約が最適制御軌跡に沿ってアクティブでなく、他方で、別の問題データについて、同じ制約が最適制御軌跡に沿ってアクティブである。このため、必要条件は通常、特有の構造を有する様々なタイプの制御軌跡に対応する１組のＭＢＶＰ７０１となる。例として、ＭＢＶＰ７０１はＭ個のＭＢＶＰを含むことができ、各ＭＢＶＰは特定の構造を有する制御軌跡のクラスに対応する。

例えば、１つの実施の形態は、運動制御システムの特定のクラスを制御し、ここで、サーボモーターのモデルは以下の式である。

ここで、ｘ＝(ｘ_１，ｘ_２)^Ｔ＝(θ，ω)^Ｔは、それぞれモーターの位置及び角速度を表すモーターの状態であり、ｄは粘性摩擦係数であり、ｃはクーロン摩擦であり、ｕはサーボモーターへの制御入力(電流)であり、単一ドットは一次導関数を示し、二重ドットは二次導関数を示す。モーターへの制御入力はモーターのタイプに依拠する。１つの実施の形態では、モーターへの制御入力は、モーターへの電流入力を含む。付加的に又は代替的に、制御入力は、モーターへの電圧の制御信号を含むことができる。

例えば、運動制御システムの動作コストは、電力コスト、すなわち消費されるエネルギーである。このため、１つの実施の形態は、運動制御システムのエネルギー消費が最小になるように制御軌跡を求める。時間間隔内で点間追跡タスクを実行する運動制御システムの総エネルギー消費は、以下のコスト関数によって抽出される。

ここで、Ｔはタスクの実行時間であり、通例、ユーザーによって指定され、Ｒはモーターの巻線の抵抗であり、Ｋ_Ｓは、増幅器の切替えに起因する切替え損失の定係数であり、Ｋ_τはモーターのトルク定数である。式(３)のコスト関数は、銅損Ｒｕ^２、増幅器損失Ｋ_Ｓ｜ｕ｜、及び機械的作業Ｋ_τｘ_２ｕを含めることによって、運動制御システムの大きなクラスのエネルギー消費を表す。

運動制御システムは、様々な制約も含むことができる。動的制約は式(２)によって示され、モーターの角加速度に対する制約は

によって示され、ここでａ_ｍａｘは正の定数であり、モーターの角速度に対する制約は０≦ｘ_２≦ｖ_ｍａｘによって示され、ここでｖ_ｍａｘは正の定数であり、モーターの初期位置に対する制約はｘ(０)＝(０，０)であり、モーターの最終位置に対する制約はｘ(Ｔ)＝(ｒ，０)であり、タスクの実行時間はＴである。軌跡生成において制約を考慮することによって、設計段階において制約が存在しないことによって生じる制限を取り除き、これによって運動制御システムのエネルギー効率を改善することができる。

コスト関数及び制約を所与とすると、区分的ハミルトニアン演算子Ｈは以下の式となる。

ここで、以下の式が成り立つ。

ラグランジュ乗数λは、共状態変数とも呼ばれ、動的制約に対応する。ラグランジュ乗数μ、ｖはそれぞれ、速度制約及び加速度制約に対応する。

ブロック７００は、ハミルトニアン演算子を最小にすることによって、制約されたセグメントに対する制御を求める。

制約されていない正の制御及び負の制御は、∂Ｈ_１１／∂ｕ＝０、∂Ｈ_１２／∂ｕ＝０から同等に、ハミルトニアンを最小にすることによって求めることができる。

状態ｘ及び共状態λを所与とすると、制御信号ｕ及びｘ動力が明確に定義される。ｘに関するＨの偏導関数が明確に定義されているので、共状態動力は以下の式となる。

ブロック７００は、軌跡に沿ってラグランジュ乗数μ、ｖの値を更に求め、経時的な共状態の展開を定義する微分方程式を導出する。制御軌跡が制約されていないセグメントに沿っているとき、μ＝ｖ＝０である。

加速度制約がアクティブである場合、ｖは以下の式によって解かれる。

これらの式の解は以下である。

速度制約ｘ_２−ｖ_ｍａｘ≦０の場合、ラグランジュ乗数μはＨ_１１ｕ＝０から求められ、ここで、ｕ＝ｕ_ｐｖｅｌである。

ブロック７００は、タスクの初期時点及び終了時点、並びに制御軌跡が切り替わる時点ｔ_ｋ(１≦ｋ≦ｍ−１)において制御軌跡が満たさなくてはならない必要条件を更に求める。初期時点及び最終時点における制御軌跡の必要条件は

ｘ(０)＝(０，０)，ｘ(Ｔ)＝(ｒ，０) (１２)

であり、軌跡が切り替わる時点ｔ_ｋにおいて以下である。

ブロック７００は、最終的に、式(４)〜式(１３)を含む必要条件７０２を導出する。

式(４)〜式(１３)における必要条件を所与として、ブロック７０１は１組のＭＢＶＰを求める。例えば、式(４)〜式(１３)は式(１)の形態に再構成することができる。制御変数ｕ及びラグランジュ乗数μ、ｖが定義されているので、共状態動力が導出され、微分方程式(１)が確立される。

式(１２)及び式(１３)の必要条件も以下の形式に適合する。

ブロック７０１は、必要条件を解析することによって、様々なセグメントを含むことができる制御軌跡を求める。様々なセグメントとは、制御が制約されておらず、正である場合、制約されていない正の制御セグメント(Ｕ^＋)と、制御が制約されておらず、負である場合、制約されていない負の制御セグメント(Ｕ⁻)と、制御がゼロをとる場合、ゼロ制御セグメント(Ｕ^０)と、正の加速度制約がアクティブである場合、正の加速度制約された制御セグメント(Ａ^＋)と、負の加速度制約がアクティブである場合、負の加速度制約された制御セグメント(Ａ⁻)と、最大速度制約がアクティブである場合、速度制約された制御セグメント(Ｖ^＋)とである。

セグメントのタイプの識別情報を所与として、ブロック７０１は必要条件を更に解析し、１組のＭＢＶＰを導出する。この１組のＭＢＶＰは、制約されていない正の制御セグメント、ゼロ制御セグメント、及び制約されていない負の制御セグメントを含む制御軌跡に対応するＭＢＶＰ；正の加速度制約されたセグメント、制約されていない正の制御セグメント、ゼロ制御セグメント、及び制約されていない負の制御セグメントを含む制御軌跡に対応するＭＢＶＰ；正の加速度制約されたセグメント、制約されていない正の制御セグメント、ゼロ制御セグメント、制約されていない負の制御セグメント、及び負の加速度制約されたセグメントを順に含む制御軌跡に対応するＭＢＶＰ；制約されていない正の制御セグメント、速度制約されたセグメント、制約されていない正の制御セグメント、ゼロ制御セグメント、及び制約されていない負の制御セグメントを含む制御軌跡に対応するＭＢＶＰ；正の加速度制約されたセグメント、制約されていない正の制御セグメント、速度制約されたセグメント、制約されていない正の制御セグメント、ゼロ制御セグメント、及び制約されていない負の制御セグメントを含む制御軌跡に対応するＭＢＶＰ；正の加速度制約されたセグメント、制約されていない正の制御セグメント、速度制約されたセグメント、制約されていない正の制御セグメント、ゼロ制御セグメント、制約されていない負の制御セグメント、及び負の加速度制約されたセグメントを含む制御軌跡に対応するＭＢＶＰ、のうちの１つ又はそれらの組合せを含むことができる。

図８は、１つの実施の形態による、ＭＢＶＰの解が、制約を条件としてコスト関数を最適化する制御軌跡であるようにＭＢＶＰを求めるための方法のブロック図である。図７に示すように、システムの動作のコスト関数及び制約のハミルトニアン解析に基づいて求められた１組のＭＢＶＰ７０１からＭＢＶＰ８０５が選択される(８００)。通常、ＭＢＶＰを選択する順序は、ＭＢＶＰの構造の複雑度に基づく。例えば、制御軌跡の初期構造は、ＭＢＶＰ７０１の全ての可能な構造のうちの最も単純な構造として選択することができる。ＭＢＶＰ８０５が解かれ(８０１)、解８０６が得られる。ブロック８０２は、ＭＢＶＰの解８０６が何らかの制約に違反している(８０７)か否かを検証する。ＭＢＶＰの解は、制約を満たす場合、制御軌跡を表すように割り当てられる。

何らかの制約に違反している場合、ＭＢＶＰの選択が繰り返される。例えば、ＭＢＶＰの構造が、例えば違反している制約８０７のうちの１つに対応する制約されたセグメントをＭＢＶＰの現在の構造に加えて、次の反復のために選択されたＭＢＶＰの新たな構造８０８を得ることによって更新される(８０３)。そうではなく、全ての制約に違反していない場合(８０９)、反復は停止し、ＭＢＶＰの解が制御軌跡を表すように割り当てられる(８０４)。

この実施の形態は、ＭＢＶＰが境界条件について解かれるので有利である。ＭＢＶＰによって表される制御軌跡は当然境界条件を満たすが、依然として解の領域の他の点において制約に違反する可能性がある。このため、この実施の形態は、最も単純な構造を有する制御機構が境界条件及び制約の双方を満たすことを確実にする。

混合シューティング法
混合シューティング法は、１組の微分方程式を、切替え時点における解の値を表す第１の１組のパラメーターと、切替え時点の値を表す第２の１組のパラメーターとにパラメーター化することに基づいてＭＢＶＰを解くための方法である。１つの実施の形態では、解の値は、運動システムの状態値及び共状態値を含む。ＭＢＶＰは順序付けされた区分的微分方程式によって表すことができ、切替え時点は、ＭＢＶＰの構造の変化、すなわち、例えば順序に従った、制御軌跡の１つのセグメントに対応する１つの１組の微分法方程式(differentiation equation)から、制御軌跡の別のセグメントに対応する別の１組の微分法方程式への切替えを表すことができる。

混合シューティング法は、１組の境界条件が満たされるまで、第１の１組のパラメーター及び第２の１組のパラメーターの値を交互に求める。混合シューティング法は、切替え時点に対する境界条件の感度と、状態値及び共状態値、並びに切替え時点の、境界条件に対する結合効果とに起因して、従来の方法の収束問題を著しく克服する。混合シューティング法は、パラメーター数を低減して処理時間を最適化するとともに、収束特性を改善する。混合シューティング法のステップの様々な組合せが、以下でより詳細に説明される。

図９は、曲線ＡＢによって表されるＭＢＶＰの解の一例を示している。曲線ＡＢは、３つのセグメントＡＢ_１９１０、Ｂ_１Ｂ_２９２０、及びＢ_２Ｂ９３０を含む。期間[０，(オーバーバー)ｔ_１]９１５にわたって定義された第１のタイプの第１の１組の微分方程式はセグメントＡＢ_１に対応し、期間[(オーバーバー)ｔ_１，(オーバーバー)ｔ_２]９２５にわたって定義された第２のタイプの第２の１組の微分方程式はセグメントＢ_１Ｂ_２に対応し、期間[(オーバーバー)ｔ_２，Ｔ]９３５にわたって定義された第３のタイプの第３の１組の微分方程式はセグメントＢ_２Ｂに対応する。したがって、第１のタイプ、第２のタイプ、及び第３のタイプの微分方程式は、順序付けされた区分的微分方程式であり、対応する境界条件と合わせてＭＢＶＰを形成する。ＭＢＶＰの解は制御軌跡を表し、この例では曲線ＡＢとして示される。

幾つかの実施の形態では、混合シューティング法は、１組の微分方程式をパラメーター化して、切替え時点における解の値を表す第１の１組のパラメーターと、切替え時点の値を表す第２の１組のパラメーターとを得る。例えば、図９の例では、パラメーター化は、第１の１組のパラメーターを解の値、例えば位置９４２、９４４、及び９４６、すなわち位置Ａ’_０、Ａ’_１、Ａ’_２における状態及び共状態として定義し、第２の１組のパラメーターを、切替え時点(オーバーバー)ｔ_１，(オーバーバー)ｔ_２の値として定義する。

同様に、境界条件は、第１の１組のパラメーターに対応する第１の１組の境界条件と、第２の１組のパラメーターに対応する第２の１組の境界条件とに分割することもできる。例えば、切替え時点(オーバーバー)ｔ_１，(オーバーバー)ｔ_２の境界条件は、誤差９５２、９５４、及び９５６、すなわち、誤差δＦ_１、δＦ_２、δＦ_３として定義することができる。例えば、１つの実施の形態では、第１の１組の境界条件は、切替え時点におけるシステムの状態及び共状態の連続性に基づいて求められる。

様々な実施の形態による１組の微分方程式のパラメーター化によって、用いられるパラメーター数が低減することに起因して、従来の多重シューティング法と比べてＭＢＶＰの解の高速な計算が可能になる。また、パラメーター化によって、解の構造の知識を探求して微分方程式をより短い時間間隔にわたって解くことにより、収束特性が改善する。

図１０Ａは、混合シューティング法のブロック図を示している。ＭＢＶＰ１０１０を所与として、１０２０においてＭＢＶＰ１０１０のパラメーター化が達成される。ここで、ＭＢＶＰの解は、順序付けされた区分的微分方程式の初期条件及び切替え時点によってパラメーター化される。切替え時点は、様々な組の微分方程式が定義される時間間隔を指定する。１組の選択されたパラメーターの値を所与として、ＭＢＶＰの解、又は順序付けされた微分方程式の解は一意に計算することができる。この１組のパラメーターは、第１の１組のパラメーター１０２４及び第２の１組のパラメーター１０２６に更に分割される。パラメーター化されたＭＢＶＰ及び分割を所与として、ＭＢＶＰの解は１０３０において交互に解かれる。１組のパラメーターを分割することによって、２組のパラメーターが交互に更新されることが可能になり、ＭＢＶＰを解いて例えば制御軌跡１０４０を得るアルゴリズムの収束特性が改善する。

図１０Ｂは、パラメーター及び境界条件を少なくとも２つの組に分割する例を示している。例えば、パラメーターは第１の１組のパラメーターと第２の１組のパラメーターとに分割することができ、境界条件は、第１の１組のパラメーターに対応する第１の１組の境界条件と、第２の１組のパラメーターに対応する第２の１組の境界条件とに分割することができる。

例えば、パラメーター化されたＭＢＶＰ１０００は、順序付けされた微分方程式１００１、境界条件１００２、及び未知のパラメーター１００３によって表される。境界条件１００２は第１の１組の境界条件ＢＣ_１１００４と、第２の１組の境界条件ＢＣ_２１００５とに分割される。パラメーター１００３は、２つの異なる組、すなわち第１の１組のパラメーターβ_１１００６と、第２の１組のパラメーターβ_２１００７とに分割される。

図９に示す実施の形態では、第１の１組のパラメーターβ_１は、時点における制御軌跡の値を含み、第２の１組のパラメーターβ_２は、制御軌跡の構造の変数を含む。通常、第１の１組のパラメーターは、システムの状態値及び共状態値を含み、第２の１組のパラメーターは微分方程式の切替え時点を含む。

この発明の様々な実施の形態において、第１の１組のパラメーター及び第２の１組のパラメーターは、第１の１組の境界条件及び第２の１組の境界条件が満たされるまで交互に求められる。例えば、パラメーターは再帰的に求めることができ、ここで、反復ごとに、第１の１組のパラメーターは第２の１組のパラメーターの固定値に基づいて求められ、第２の１組のパラメーターは第１の１組のパラメーターの固定値に基づいて求められる。

図１１は、図１０Ｂの実施の形態等の幾つかの実施の形態に従ってパラメーター及び境界条件が分割された後にＭＢＶＰを解くための２ステップの再帰的な方法を示している。ここで、β_１及びβ_２は２組のパラメーターであり、ＢＣ_１及びＢＣ_２は２組の境界条件である。

図１１に示すように、本方法は、パラメーターの値の初期推定１１００から開始する。これによって第１の１組のパラメーター及び第２の１組のパラメーターの推定値１１０８が生成される。ＭＢＶＰの初期推定値は通常、必要条件を定性的に解析することによって、又はＭＢＶＰよりも簡単な境界値問題を解くことによって生成される。より簡単な境界値問題の自然な選択は、何らかの制約に違反しているセグメントを無視することによってＭＢＶＰから得ることができる。ブロック１１０１は、第２の１組のパラメーターの値を固定し、パラメーターの推定値又は更新値１１０９をブロック１１０２に出力する。ブロック１１０２は、ＭＢＶＰにおいて定義された微分方程式の初期値問題を解き、解１１１０をブロック１１０３に出力する。

ブロック１１０３は第１の１組の境界条件を検査する。第１の１組のパラメーターが第１の１組の境界条件を満たす場合、ブロック１１０５は第２の１組の境界条件を評価する。そうでない場合、第１の１組のパラメーターが更新される(１１０４)。例えば、ブロック１１０４は第１の１組のパラメーターに関する第１の１組の境界条件の勾配１１１１を求め、この勾配１１１１に基づいて第１の１組のパラメーターを更新する。感度方程式が線形時不変である場合、第１の１組の境界条件の勾配１１１１は解析的に求めることができる。そうではなく、感度方程式が時変である場合、勾配１１１１は感度方程式を積分することによって求めることができる。

ブロック１１０５において第２の１組の境界条件が満たされた場合、ブロック１１０７は制御軌跡を出力し、そうでない場合、ブロック１１０６は、代数方程式の零点(zero:ゼロ点)を解くための様々な方法によって第２の１組のパラメーターを更新する。例えば、ブロック１１０６は、第２の１組のパラメーターに関する第２の１組の境界条件の勾配１１１３を求め、勾配１１１３に基づいて第２の１組のパラメーターを更新する。第１の１組のパラメーター及び第２の１組のパラメーターは、第１の１組の境界条件及び第２の１組の境界条件が満たされるまで交互に更新される。

例として、ＭＢＶＰの解の構造がｍ個のセグメントを含むと仮定する。ＭＢＶＰの解は時点ｔ_ｋ(１≦ｋ≦ｍ−１)において切り替わり、ｔ_０＝０及びｔ_ｍ＝Ｔはそれぞれ、タスクの初期時点及び最終時点である。ｋ番目のセグメントのパラメーターは(β_ｋ１，β_ｋ２)(ここで、１≦ｋ≦ｍ)である。

β_１＝(β_１１,…β_ｍ１)
β_２＝(β_１２,…β_ｍ２)

とする。ここで、１つの実施の形態では、第１の１組のパラメーターβ_１は、制御軌跡が切り替わる時点における状態値及び共状態値を含み、第２の１組のパラメーターβ_２は解の切替え時点のパラメーターを含む。β＝(β_１，β_２)はパラメーターの全集合を表す。同様に、ｋ番目のセグメントの境界条件は、(ＢＣ_ｋ１，ＢＣ_ｋ２)によって表され、それぞれ２組のパラメーターβ_ｋ１及びβ_ｋ２に対応する。ＢＣによって表されるＭＢＶＰの境界条件は、(ＢＣ_ｋ１，ＢＣ_ｋ２)(ここで、１≦ｋ≦ｍ)の和集合であり、以下の式の通りである。

ＢＣ＝(ＢＣ_１１,ＢＣ_１２,…,ＢＣ_ｍ１,ＢＣ_ｍ２)

したがって、境界条件ＢＣは、それぞれパラメーター組β_１及びβ_２に対応する２組の境界条件ＢＣ_１及びＢＣ_２に分割することができ、すなわち、以下の式となる。

ＢＣ_１＝(ＢＣ_１１,…,ＢＣ_ｍ１)、及び
ＢＣ_２＝(ＢＣ_１２,…,ＢＣ_ｍ２)

Ｆ_ｋ１及びＦ_ｋ２によって表されるＢＣ_ｋ１及びＢＣ_ｋ２に対応する残差値は、ブロック１１０２によって計算された解１１１０から得ることができる。β_１、β_２に対応する(正：corresponding)残差は以下である。

Ｆ_１＝(Ｆ_１１,…,Ｆ_ｍ１)、及び
Ｆ_２＝(Ｆ_１２,…,Ｆ_ｍ２)

混合シューティング法は、それぞれ２組の境界条件ＢＣ_１及びＢＣ_２に基づいて、２組のパラメーターβ_１、β_２を交互に更新する。これによって、解の収束が改善する。反復プロセスの目的は、１組の代数方程式である

Ｆ_１(β_１ ^＊)＝０、Ｆ_２(β_２ ^＊)＝０、

となるようにパラメーター組

β^＊＝(β_１ ^＊,β_２ ^＊)＝０、

を求めることである。１つの実施の形態では、ニュートン法を用いて、残差とパラメーターに関するその勾配とに基づいてβの推定値を更新する。

ここで、β_ｋ ^ｉ,ｋ＝｛１，２｝)はｉ番目の反復におけるパラメーター組β_ｋの推定値であり、ρ_１、ρ_２はパラメーター更新のステップ長であり、∂Ｆ_ｋ／∂β_ｋ(ｋ＝｛１，２｝)はパラメーター組β_ｋに関する境界条件組ＢＣ_ｋの勾配である。∂ｘ／∂β、∂λ／∂βを所与とすると、パラメーターに関するＦ_１、Ｆ_２の勾配の計算は、当業者には明解である。

１つの実施の形態では、ＢＣを満たすパラメーターを求める手順は、パラメーターβに関するＢＣの勾配の計算を含む。勾配は以下の成分を含む。

パラメーターβに関するＢＣの勾配は、感度方程式から得ることができる。例として、ｋ番目のセグメントについて、λ(ｔ_ｋ−１)に関するｘ(ｔ_ｋ)の感度方程式は以下である。

ここで、ｆ_ｘ及びｆ_ｕはそれぞれ状態ｘ及び制御ｕに関する関数ｆの偏導関数であり、ｕ_ｘ、ｕ_λは、それぞれ状態及び共状態に関する制御ｕの偏導関数である。λ(ｔ_ｋ−１)に関するλ(ｔ)の感度方程式を同様に導出することができる。感度方程式の初期条件は当業者には明解であり、したがって明確にする目的で本開示において省かれる。

この発明の実施の形態は、様々な方法を用いて∂ｘ／∂β_２、∂λ／∂β_２を求める。１つの実施の形態では、第２の１組のパラメーターは切替え時点ｔ_ｋ(１≦ｋ≦ｍ−１)であり、実施の形態は以下を求める。

別の実施の形態では、β_２に関するＢＣの勾配は以下のように近似することができる。

ここで、Ｈ_ｘ ^Ｔは状態に関するハミルトニアン演算子の偏導関数の転置である。

多重シューティング法と比較して、混合シューティング法は、パラメーター数を減らして処理時間を減らす。単一シューティング法と比較して、混合シューティングシューティング法は、最適な軌跡の構造を先験的条件として組み込むことによって、ソルバーの収束特性を改善する。単一シューティング法における収束問題を矯正するために、幾つかの実施の形態によって、２ステップ再帰を用いて、境界条件に対する異なる組のパラメーターの影響を切り離す。

図１２は、混合シューティング法を用いて現在のＭＢＶＰを解くための方法のブロック図である。現在のＭＢＶＰのパラメーター及び境界条件が、現在のＭＢＶＰの現在の構造１２１０に基づいて求められる(１２２０)。現在の構造は、例えば、図８に関連して説明された方法に従って求めることができる。パラメーターは、第１の１組のパラメーターと第２の１組のパラメーターとに分割される(１２３０)。同様に、境界条件は第１の１組のパラメーターに対応する第１の１組の境界条件と、第２の１組のパラメーターに対応する第２の１組の境界条件とに分割される(１２４０)。次に、本方法は、第２の１組のパラメーターの固定値に基づいて第１の１組のパラメーターの値と、第１の１組のパラメーターの固定値に基づいて第２の１組のパラメーターの値とを再帰的に求める(１２５０)。

例えば、再帰１２５０の反復によって、第１の１組の境界条件が満たされるまで第１の１組のパラメーターの値が更新され(１２７０)、第２の１組の境界条件を満たすように第２の１組のパラメーターの値が更新される(１２８０)。反復は、第１の１組の境界条件及び第２の１組の境界条件の双方が満たされる(１２６０)まで反復的に繰り返される。１つの実施の形態では、第１の１組のパラメーターは、現在の制御軌跡の状態値及び共状態値を含み、第２の１組のパラメーターは現在の制御軌跡の切替え時点を含む。

エネルギー効率のよい運動制御システムのための軌跡計画法
この発明の幾つかの実施の形態は、運動制御システムの動作の総コストが低減されるような、運動制御システムのエネルギー消費と生産性との間の効果的なトレードオフの必要性を動機としている。様々な因子の中から、サーボモーターが運動制御システムのエネルギー消費を低減するために従うエネルギー効率のよい軌跡が求められる。さらに、エネルギー効率のよい軌跡は、速度、加速度、及び電流制約を含む、運動制御システムの様々な制約を検討する。この発明の様々な実施の形態は、エネルギー効率のよい運動制御システムのエネルギー効率のよい軌跡を、ＭＢＶＰのクラスとして定式化することができる最適制御問題として求め、混合シューティング法を用いてこのＭＢＶＰを解く。

例えば、ＭＢＶＰの区分的微分方程式は、式(２)、式(７)、式(５)、及び式(６)の組合せとして定義される。上述したように、最適制御軌跡は様々なセグメントを含むことができ、その構造はＴ、ｒ、ａ_ｍａｘ、ｖ_ｍａｘ等の問題データに依拠する。異なる構造は特有のＭＢＶＰに対応する。

混合シューティング法を用いてエネルギー効率のよい軌跡を求めることは、以下の問題データ(ＰＤＡＴＡ)に対応するＭＢＶＰを解くことによって説明される。

ここで、ｕ_ｍａｘはモーターの入力電流の最大値である。問題データＰＤＡＴＡ_１と関連付けられた解の構造は、例えば図８に示す方法に基づいて求めることができる。例えば、制御軌跡は、以下のセグメント、すなわち、正の加速度制約されたセグメント；制約されていない正の制御セグメント；速度制約されたセグメント；制約されていない正の制御セグメント；ゼロ制御セグメント；制約されていない負の制御セグメント；負の加速度制約されたセグメントを連続して含むことができる。

最適制御軌跡の構造を所与とし、混合シューティング法のパラメーター及び境界条件の定義に従うと、１つの実施の形態は、ｋ番目のセグメント(ここで、１≦ｋ≦７)についてパラメーターを定義し、

第１の１組のパラメーター及び第２の１組のパラメーターを以下のように定義する。

ｋ番目のセグメント(１≦ｋ≦７)のＢＣは以下であり、
ＢＣ_１：状態及び共状態のパラメーター組に対応する

ＢＣ_２：切替え時点パラメーター組に対応する

ここで、φ_ｘ(・)及びφ_λ(・)は状態軌跡及び共状態軌跡であり、ｘ(ｔ_０)＝ｘ_０、λ(ｔ_０)＝λ_０である。ＭＢＶＰは３０個のパラメーター及びＢＣを有する。代替的に、パラメーター数は、制約されたセグメントのエントリにおける共状態を取り除くことによって減らすことができる。このため、パラメーター組及び境界条件は単純にすることができる。

感度方程式は、β_１及びβ_２に関するＢＣの勾配、すなわち以下を計算するように定義される。

式(１６)に対応する感度方程式は、以下のように要約される。

ここで、ｘ_ａ＝［ｘ，λ］及び

である。

関数

は、当業者によって、動的制約及び必要条件から容易に導出することができる。このため、α_１，…，α_４はｘ及びλから計算することができる。切替え時点に対するＢＣ_２の感度も同様に容易に計算することができる。

パラメーター及び境界条件の定義及び分割と、感度方程式とを所与として、図１１の２ステップ方法を用いて、問題データＰＤＡＴＡ_１と関連付けられたＭＢＶＰの解が求められる。

最適制御軌跡は図１３に示されている。β_２を更新する反復は図１４に示されている。ここで、この反復はβ_２の各反復中の制御軌跡によって示される。

加えて、１つの実施の形態は、混合シューティング法を用いて、以下のコスト関数を最小にするエネルギー効率のよい運動制御システムの軌跡を解く。

ここで、Ｅはシステムのエネルギー消費であり、ｕはモーターへの制御入力であり、Ｒはモーターの巻線の抵抗であり、ｘ_２はモーターの角速度を表すモーターの状態ｘの第２の成分であり、Ｋ_ｓは増幅器における切替え損失の定係数であり、Ｋ_τはモーターのトルク定数である。幾つかの実施の形態では、切替え損失は考慮されず、例えばＫ_ｓ＝０である。

この発明の上述した実施の形態は、数多くの方法のいずれにおいても実施することができる。例えば、実施の形態は、ハードウェア、ソフトウェア又はそれらの組合せを用いて実施することができる。ソフトウェアで実施される場合、ソフトウェアコードは、単一のコンピューターに設けられるのか又は複数のコンピューター間に分散されるのかにかかわらず、任意の適したプロセッサ又はプロセッサの集合体において実行することができる。そのようなプロセッサは、１つ又は複数のプロセッサを集積回路部品に有する集積回路として実装することができる。ただし、プロセッサは、任意の適したフォーマットの回路類を用いて実装することができる。

さらに、コンピューターは、ラックマウント型コンピューター、デスクトップコンピューター、ラップトップコンピューター、ミニコンピューター又はタブレットコンピューター等の複数の形態のいずれにおいても具現化できることが理解されるべきである。また、コンピューターは、１つ又は複数の入力デバイス及び出力デバイスを有することもできる。これらのデバイスは、中でも、ユーザーインターフェースを提示するのに用いることができる。ユーザーインターフェースを提供するのに用いることができる出力デバイスの例には、出力を視覚提示するためのプリンター又は表示スクリーン、及び出力を可聴提示するためのスピーカー又は他の音発生デバイスが含まれる。ユーザーインターフェースに用いることができる入力デバイスの例には、キーボード、並びにマウス、タッチパッド及びデジタイジングタブレット等のポインティングデバイスが含まれる。別の例として、コンピューターは、音声認識を通じて又は他の可聴フォーマットで入力情報を受け取ることもできる。

そのようなコンピューターは、ローカルエリアネットワーク又はワイドエリアネットワークとしてエンタープライズネットワーク又はインターネット等を含む１つ又は複数のネットワークによって任意の適した形態で相互接続することができる。そのようなネットワークは、任意の適した技術に基づくことができ、任意の適したプロトコルに従って動作することができ、無線ネットワーク、有線ネットワーク又は光ファイバーネットワークを含むことができる。

また、本明細書において概説される様々な方法又はプロセスは、様々なオペレーティングシステム又はプラットフォームのうちの任意のものを用いる１つ又は複数のプロセッサに対して実行可能なソフトウェアとして符号化することができる。加えて、そのようなソフトウェアは、複数の適切なプログラミング言語及び／又はプログラミングツール若しくはスクリプティングツールのうちの任意のものを用いて書くことができ、フレームワーク又は仮想マシン上で実行される実行可能な機械語コード又は中間コードとしてコンパイルすることもできる。

これに関して、この発明は、単数又は複数のコンピューター可読記憶媒体、例えばコンピューターメモリ、コンパクトディスク(ＣＤ)、光ディスク、デジタルビデオディスク(ＤＶＤ)、磁気テープ、及びフラッシュメモリとして実現することができる。代替的に又は付加的に、この発明は、伝播信号等の、コンピューター可読記憶媒体以外のコンピューター可読媒体として実施することもできる。

「プログラム」又は「ソフトウェア」という用語は、本明細書において、包括的な意味で、上記で検討したこの発明の様々な態様を実施するようにコンピューター又は他のプロセッサをプログラムするのに用いることができる任意のタイプのコンピューターコード又は１組のコンピューター実行可能命令を指す。

コンピューター実行可能命令は、１つ若しくは複数のコンピューター又は他のデバイスによって実行された、プログラムモジュール等の多くの形式をとることができる。一般に、プログラムモジュールは、特定のタスクを実行するか又は特定の抽象データタイプを実装するルーチン、プログラム、オブジェクト、コンポーネント、データ構造を含む。通常、プログラムモジュールの機能は、様々な実施の形態において所望に応じて組み合わせることも分散することもできる。

また、この発明の実施の形態は、例が提供された方法として実施することができる。本方法の一部として実行される動作は、任意の適切な方法で順序付けすることができる。したがって、動作が示したものと異なる順序で実行される実施の形態を構築することができ、これには、例示の実施の形態では一連の動作として示されたにもかかわらず、幾つかの動作を同時に実行することを含めることもできる。

特許請求の範囲における、特許請求の範囲の要素を修飾する「第１の」、「第２の」等の順序を示す用語の使用は、それ自体では、優先度も、優先順位も、１つの特許請求の範囲の要素の別の要素に対する順序も、方法の動作が実行される時間順序も一切暗示するものではなく、単に、或る特定の名称を有する１つの特許請求要素を、(順序を示す用語の使用を除いて)同じ名称を有する別の要素と区別して、それらの特許請求要素を区別するためのラベルとして用いられる。

Claims (20)

1. 境界条件を満たす１組の微分方程式の解によって表される制御軌跡に従ってシステムの動作を制御するための方法であって、前記１組の微分方程式は順序付けされた区分的微分方程式を含み、該方法は、
   前記１組の微分方程式をパラメーター化するステップであって、切替え時点における前記解の値を表す第１の１組のパラメーターと、前記切替え時点の値を表す第２の１組のパラメーターとを得るものと、
   前記境界条件が満たされるまで前記第１の１組のパラメーター及び前記第２の１組のパラメーターを交互に求めるステップであって、前記解を得るものと、
   前記解に基づいて、前記システムの前記動作を制御する前記制御軌跡を生成するステップと、
   を含み、
   該方法のステップはプロセッサによって実行される、境界条件を満たす１組の微分方程式の解によって表される制御軌跡に従ってシステムの動作を制御するための方法。
2. 前記交互に求めるステップは、
   固定した前記第２の１組のパラメーターの前記値を有する前記１組の微分方程式を解くことによって第１の１組の境界条件を満たす前記第１の１組のパラメーターの値を求めるステップと、
   固定した前記第１の１組のパラメーターの前記値を有する前記１組の微分方程式を解くことによって第２の１組の境界条件を満たす前記第２の１組のパラメーターの前記値を求めるステップと、
   前記第１の１組の境界条件及び前記第２の１組の境界条件の双方が満たされるまで、前記第１の１組のパラメーターの値を求めること及び前記第２の１組のパラメーターの値を求めることを繰り返すステップであって、前記制御軌跡を得るものと、
   を含む、請求項１に記載の方法。
3. 前記第１の１組のパラメーター及び前記第２の１組のパラメーターを初期化するステップと、
   前記第１の１組の境界条件が満たされるまで、初期値問題を解くことによって前記第１の１組のパラメーターの前記値を反復的に更新するステップと、
   前記第１の１組のパラメーターの前記更新された値及び前記第２の１組の境界条件に基づいて、前記第２の１組のパラメーターの前記値を更新するステップと、
   を更に含む、請求項２に記載の方法。
4. 前記境界条件を、前記第１の１組のパラメーターに対応する前記第１の１組の境界条件と、前記第２の１組のパラメーターに対応する前記第２の１組の境界条件とに分割するステップを更に含む、請求項３に記載の方法。
5. 前記切替え時点における前記システムの状態及び共状態の連続性に基づいて前記第１の１組の境界条件を求めるステップを更に含む、請求項４に記載の方法。
6. 前記システムはモーターを含む運動制御システムであり、該システムの前記動作は制約を受け、前記第１の１組のパラメーターの前記値は前記システムの状態及び共状態を表し、前記１組の微分方程式及び前記境界条件は、前記制約を満たす前記解を有し、かつ前記動作中の前記システムのエネルギー消費を表すコスト関数を最適化する多重境界値問題(ＭＢＶＰ)を形成する、請求項１に記載の方法。
7. 前記コスト関数は以下の積分であり
   

   

   ここで、Ｅは前記動作の時間Ｔ中の前記システムの前記エネルギー消費であり、Ｐ(ｘ，ｕ)は前記システムの瞬間エネルギー消費であり、ｘは前記モーターの状態であり、ｕは前記モーターへの制御入力であり、前記瞬間エネルギー消費Ｐは、前記モーターの抵抗巻線の銅損、増幅器の切替え損失、及び前記モーターの機械的作業のうちの少なくとも１つから得られる、請求項６に記載の方法。
8. 前記システムの前記動作の前記コスト関数及び前記制約のハミルトニアン解析に基づいて前記ＭＢＶＰを求めるステップであって、前記制約は、前記モーターの加速度制約、該モーターの速度制約、該モーターの入力電流制約、該モーターの動的制約、追跡時間、該モーターの初期条件、及び該モーターの最終状態のうちの１つ又はそれらの組合せを含むものを更に含む、請求項６に記載の方法。
9. 前記コスト関数は以下の式であり、
   

   

   ここで、Ｅは前記動作の時間Ｔ中の前記システムの前記エネルギー消費であり、ｕは前記モーターへの制御入力であり、Ｒは前記モーターの巻線の抵抗であり、ｘ_２は前記モーターの角速度を表す該モーターの前記状態ｘの第２の成分であり、Ｋ_ｓは増幅器における切替え損失の定係数であり、Ｋ_τは前記モーターのトルク定数である、請求項６に記載の方法。
10. 前記ＭＢＶＰが線形時不変ＭＢＶＰとなるように、前記システムの前記動作の前記コスト関数及び制約のハミルトニアン解析に基づいて前記ＭＢＶＰを求めるステップと、
    前記第１の１組のパラメーター及び前記第２の１組のパラメーターを初期化するステップと、
    前記第１の１組の境界条件が満たされるまで、初期値問題を解析的に解くことによって前記第１の１組のパラメーターの前記値を反復的に更新するステップと、
    前記第１の１組のパラメーターの前記更新された値及び前記第２の１組の境界条件に基づいて、前記第２の１組のパラメーターの前記値を更新するステップと、
    を更に含む、請求項９に記載の方法。
11. 前記システムの前記動作の前記コスト関数及び前記制約のハミルトニアン解析に基づいて１組のＭＢＶＰを求めるステップと、
    前記１組のＭＢＶＰから前記ＭＢＶＰを選択するステップと、
    前記ＭＢＶＰの解が前記制約を満たす場合、該解を前記制御軌跡を表すように割り当てるステップと、そうでない場合、前記解が前記制約を満たすまで前記選択すること及び前記割り当てることを繰り返すステップと、
    を更に含む、請求項６に記載の方法。
12. 前記ＭＢＶＰを選択する順序は、該ＭＢＶＰの構造の複雑度に基づく、請求項１１に記載の方法。
13. 境界条件を満たす１組の微分方程式によって形成される多重境界値問題(ＭＢＶＰ)を解くための方法であって、前記１組の微分方程式は順序付けされた区分的微分方程式を含み、前記ＭＢＶＰの解は制御軌跡を表し、該方法は、
    前記１組の微分方程式をパラメーター化するステップであって、切替え時点における前記解の値を表す第１の１組のパラメーターと、前記切替え時点の値を表す第２の１組のパラメーターとを得るものと、
    固定した前記第２の１組のパラメーターの前記値を有する前記１組の微分方程式を解くことによって第１の１組の境界条件を満たす前記第１の１組のパラメーターの値を求めるステップと、
    固定した前記第１の１組のパラメーターの前記値を有する前記１組の微分方程式を解くことによって第２の１組の境界条件を満たす前記第２の１組のパラメーターの前記値を求めるステップと、
    第１の１組の境界条件及び前記第２の１組の境界条件の双方が満たされるまで、前記第１の１組のパラメーターの値を求めること及び前記第２の１組のパラメーターの値を求めることを繰り返すステップと、
    を含み、該方法のステップはプロセッサによって実行される、境界条件を満たす１組の微分方程式によって形成される多重境界値問題を解くための方法。
14. 前記第１の１組のパラメーター及び前記第２の１組のパラメーターを初期化するステップと、
    前記境界条件を、前記第１の１組のパラメーターに対応する前記第１の１組の境界条件と、前記第２の１組のパラメーターに対応する前記第２の１組の境界条件とに分割するステップと、
    前記第１の１組の境界条件が満たされるまで、初期値問題を解くことによって前記第１の１組のパラメーターの前記値を反復的に更新するステップと、
    前記第１の１組のパラメーターの前記更新された値及び前記第２の１組の境界条件に基づいて、前記第２の１組のパラメーターの前記値を更新するステップと、
    を更に含む、請求項１３に記載の方法。
15. 前記第１の１組の境界条件及び前記第２の１組の境界条件が満たされるまで、前記第１の１組のパラメーターの前記値を更新すること及び前記第２の１組のパラメーターの前記値を更新することを再帰的に繰り返すステップを更に含む、請求項１４に記載の方法。
16. 前記初期値問題は解析的に解かれる、請求項１４に記載の方法。
17. 制御信号に基づいてシステムを制御するための運動制御装置であって、
    軌跡生成モジュール及び制御モジュールを実行するように構成されたプロセッサを備え、
    前記軌跡生成モジュールは、混合シューティング法を用いて多重境界値問題(ＭＢＶＰ)を解くことによって制御軌跡を求め、
    前記制御モジュールは、前記制御軌跡に基づいて前記制御信号を生成する、
    制御信号に基づいてシステムを制御するための運動制御装置。
18. 前記軌跡生成モジュールは、切替え時点における前記制御軌跡の値を表す第１の１組のパラメーターと、前記切替え時点の値を表す第２の１組のパラメーターとを初期化し、前記第１の１組の境界条件及び前記第２の１組の境界条件が満たされるまで前記第１の１組のパラメーター及び前記第２の１組のパラメーターを交互に更新する、請求項１７に記載の装置。
19. 前記システムの動作は制約を受け、前記第１の１組のパラメーターの前記値は前記システムの状態及び共状態を表し、ＭＢＶＰへの解は、前記動作中の前記システムのエネルギー消費を表すコスト関数を最適化する、請求項１７に記載の装置。
20. 前記コスト関数は以下の積分であり
    

    

    ここで、Ｅは前記動作の時間Ｔ中の前記システムの前記エネルギー消費であり、Ｐ(ｘ，ｕ)は前記システムの瞬間エネルギー消費であり、ｘはモーターの状態であり、ｕは前記モーターへの制御入力であり、前記瞬間エネルギー消費Ｐは、前記モーターの抵抗巻線の銅損及び前記モーターの機械的作業のうちの少なくとも１つから得られる、請求項１９に記載の装置。

Images