JP4139658B2 - 機構制御系設計方法 - Google Patents
機構制御系設計方法 Download PDFInfo
- Publication number
- JP4139658B2 JP4139658B2 JP2002267351A JP2002267351A JP4139658B2 JP 4139658 B2 JP4139658 B2 JP 4139658B2 JP 2002267351 A JP2002267351 A JP 2002267351A JP 2002267351 A JP2002267351 A JP 2002267351A JP 4139658 B2 JP4139658 B2 JP 4139658B2
- Authority
- JP
- Japan
- Prior art keywords
- control system
- design
- model
- response
- control
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Description
【０００１】
【発明の属する技術分野】
本発明は、非線形機構を有する機構系及び制御系や、プリンタやロボットマニュピレータなどの高精度位置決めを要求される機構系及び制御系において、設計パラメータを効率よく設計仕様を満足させる機構制御システムを設計するための機構制御系設計方法に関する。
【０００２】
【従来の技術】
従来、機構系の設計では、機構の構成要素を剛体と仮定し、その挙動の解析を行っていた。近年、高精度の位置決めを要求される機構制御設計において、機構系の挙動予測だけでは対応できなくなる可能性が出てきており、機構系と制御系とを同時に設計することが強く要求されている。
【０００３】
さらに、機構制御系全体の動挙動を予測しても、設計仕様を満足する最適な設計パラメータは求められない。
【０００４】
機構系と制御系とを同時最適設計する従来技術としては、特許文献１に開示される「機構制御系設計システム装置」がある。
【０００５】
【特許文献１】
特開平６−３２４７１１号公報
【０００６】
【発明が解決しようとする課題】
特許文献１に記載された発明では、機構系モデルを基にして線形制御系の伝達関数を導出し、この伝達関数を用いて、設計パラメータの最適設計を行っている。このため、線形時不変系（linear time invariable system ）においては、十分な精度で挙動を解析できる。
【０００７】
しかしながら、非線形時変系（nonlinear time varying system ）においては、システムの伝達関数は解析時間の進行に伴って変化するため、上記特許文献１に記載された発明では、十分な解析精度を得られなかった。
【０００８】
本発明はかかる問題に鑑みてなされたものであり、非線形時変系において、非線形機構要素を含む機構モデルと制御モデルとを用いて解析手段ごとに機構系の状態方程式を書き出して、これに基づいて制御モデルから全体系の応答を算出し、予め設定された目的関数に満足するように、機構系と制御系との設計パラメータを同時最適設計し、短時間にしかも効率よく機構制御パラメータを決定する機構制御系設計方法を提供することを目的とする。
【０００９】
【課題を解決するための手段】
上記目的を達成するため、本発明は、第１の態様として、機構系をモデル化した機構モデルと制御系をモデル化した制御モデルとを、少なくとも一つの解析手段により解析した結果に基づいて、機構系と制御系とからなる全体系の応答を計算する機構制御系設計方法であって、演算装置が、機構モデルを基に各解析手段に機構系の挙動の状態方程式を書き出すステップと、状態方程式に基づいて、演算装置が、制御モデルを基に各解析手段に全体系の応答を出力するステップと、状態方程式及び全体系の応答を基に、演算装置が、予め設定された目的関数を満足するように、機構系と制御系との設計パラメータを同時最適設計する同時最適設計ステップとを有し、同時最適設計ステップは、機構系と制御系との設計パラメータのそれぞれについて、制約条件の下に解空間を等分割し、各等分点における全体系の応答をサンプリングし、サンプリングした各等分点における全体系の応答に基づいて、目的関数を最も満足する等分点を各設計パラメータごとに探索して決定する第一最適化工程を有することを特徴とする機構制御系設計方法を提供するものである。これにより、機構系と制御系との設計パラメータを同時最適設計することが可能となる。
【００１１】
また、上記のいずれの構成においても、制御系モデルにおいて、機構系の状態方程式に基づいて、制御モデルから各解析手段に全体系の応答を出力することが好ましい。これにより、機構系を含む全体系のモデルから応答を算出することができる。
【００１２】
また、上記のいずれの構成においても、機構モデルと制御モデルとの間で、各解析手段に機構系の状態方程式を受け渡すことにより、機構系の解析と制御系の解析とを同時に行うことが好ましい。これにより、各解析手段の非線形機構要素の挙動を含め、全体系の応答を考慮できる。
【００１３】
また、上記のいずれの構成においても、全体系の応答が予め目的関数として設定され、該目的関数が所定の値となるように機構系と制御系との設計パラメータを同時最適設計することが好ましい。これにより、目的関数を満足させることで、機構系と制御系との設計パラメータを同時最適設計することができる。
【００１４】
また、上記のいずれの構成においても、同時最適設計ステップは、第一最適化工程の後段に、第１最適化工程で決定した等分点の近傍において、目的関数を最も満足する最適値を各設計パラメータごとに探索する第二最適化工程をさらに有することが好ましい。これにより、機構制御系の設計パラメータの厳密な最適解を得ることができる。
【００２１】
【発明の実施の形態】
〔第１の実施形態〕
本発明を好適に実施した第１の実施形態について説明する。
図１に、本実施形態による機構制御系設計方法の処理の流れを示す。
予め機構系モデルを設定する（ステップＳ１０１）。この機構系モデルを用いて各解析手段ごとに機構系の状態方程式を書き出す（ステップＳ１０２）。制御系は、この状態方程式によって機構系を制御する。
【００２２】
次に、制御系を含む全体系モデルを設定し（ステップＳ１０３）、各解析手段ごとに機構系から書き出した状態方程式に基づいて、全体系の応答結果を算出する（ステップＳ１０４）。
【００２３】
続いて、目的関数を用いて応答結果の評価を行う（ステップＳ１０５、Ｓ１０６）。応答結果が目的関数（設計仕様）を満足すれば（ステップＳ１０７／Ｙｅｓ）、機構制御設計パラメータを出力し（ステップＳ１０８）、処理を終了する。
【００２４】
一方、応答結果が設計仕様を満足しなければ、各制御設計パラメータを制約条件下で変更させる（ステップＳ１０９）。機構系の設計パラメータを変更した場合は（ステップＳ１１０／Ｙｅｓ）ステップＳ１０１に、変更しなかった場合はステップＳ１０３に進み、設計仕様を満たす応答結果が得られるまで、上記の処理を繰り返し実行する。
【００２５】
本実施形態による機構制御設計方法を具体例を挙げて説明する。
図２に、２慣性機構系の一例を示す。機構系は駆動側（モータ軸側）、従動側（従動軸側）及び駆動伝達部で構成される。
駆動伝達部の機械荷重−ひずむ特性曲線を図３に示す。駆動伝達部は低ひずみ領域に非線形特性を持っている。
図４に、駆動軸に駆動源とするＤＣモータを設置した構成の駆動側の制御モデルを示す。
コントローラは、入力された指令速度プロファイルと従動側での回転数の検出結果とに基づいて、従動側における回転数が指令速度プロファイルで指定された回転数となるようにＤＣモータの駆動トルクを制御する。
機構制御系の設計パラメータとしては、例えば、駆動伝達部の初期テンション、モータの制御指令速度プロファイルを挙げられる。
【００２６】
目的関数（設計仕様）は、図５に示すように、従動側の立ち下げ位置偏差が速く収束し、かつオーバシュートが少なくなるように設計される。換言すると、図５におけるＴＩＭＥとＯＶＥＲＳＨＯＯＴとがともに最小となるように設計される。制約条件としては、例えば、モータの速度限界が挙げられる。
【００２７】
機構系モデルにおける解析処理について説明する。
まず、式（１）のラグランジュの方程式から式（２）の運動方程式に書き換える。
【００２８】
【数１】
【００２９】
【数２】
【００３０】
式（２）の運動方程式を状態方程式に書き換えると、式（３）となる。
【００３１】
【数３】
【００３２】
式（３）を用いて、各解析手段に、駆動伝達部の非線形特性を考慮した状態方程式を制御モデルに出力する。
すなわち、式（３）の状態方程式は、式（４）として機構系の解析処理から制御系の解析処理に受け渡す。
【００３３】
【数４】
【００３４】
次に、制御系モデルにおける解析処理について説明する。
制御系モデルは、指令速度プロファイルの初期値に基づいて、従動側の立ち下げ位置偏差を算出する。その結果の一例を図６のＡに示す。
【００３５】
次に、従動側の立ち下げ位置偏差の計算結果に基づいて、図７に示す処理を行う。
パラメータの評価基準となる目的関数を予め算出しておく（ステップＳ２０１）。目的関数は、各設計パラメータの理想値及び制約条件下での最大値・最小値なとに基づいて算出される。そして、第一最適化処理として、上記の設計パラメータ、例えば、速度プロファイルにおける減速加速度を、制約条件下で、モータの加速限界とする４０ｍ／ｓｅｃ2まで、１ｍ／ｓｅｃ2間隔で順次変化させ、それぞれの従動側の立ち下げ位置偏差を算出する（ステップＳ２０２）。
これらの計算結果の中で、目的関数が最も良い結果になる立ち下げ位置偏差を基に、各設計パラメータを決定し、第一最適化結果を得る（ステップＳ２０３）。
【００３６】
次に、第二最適化処理での解析を行う。
第一最適化結果を用いて、まず、その値の近辺に目的関数と各設計の勾配を式（５）で計算し、これによって適切な探索方向を決定する。
すなわち、最適な設計パラメータを得るためには、第一最適化結果の値を増加させる方向に変化させるべきであるか減少させる方向に変化させるべきであるかを各設計パラメータごとに判断する。
【００３７】
【数５】
【００３８】
次に、式（５）に基づいて決定した探索方向に沿って、新しい設計パラメータを設定し（ステップＳ２０４）、算出された値が最小となるまで上記計算を繰り返し実行する（ステップＳ２０５）。
【００３９】
上記の機構制御系設計方法によって、決定されたモータの指令速度プロファイルを図８に示す。
また、この際の従動側の立ち下げ位置偏差は図６のＢに示す。上記の機構制御系設計方法によって得られた設計パラメータの最適値では、初期値と比較して良好な応答結果が得られている。
【００４０】
このように、本実施形態にかかる機構制御系設計方法によれば、機構系と制御系との設計パラメータを、短時間にしかも効率よく同時最適設計できる。
【００４１】
〔第２の実施形態〕
本発明を好適に実施した第２の実施形態について説明する。
図９に、本実施形態にかかる機構制御系設計システムの構成を示す。このシステムは、入力装置１０、演算装置２０及び表示装置３０で構成される。
演算装置２０は、機構解析部２１、制御解析部２２及び最適化部２３を有する。なお、最適化部２３は、第一最適化部２３１と第二最適化部２３２とを有する。
これらの各部は、予め演算装置２０に組み込まれている。なお、演算装置２０は、各部がハードウエアで構成された装置であっても良いし、一般的なコンピュータ端末にソフトウエアによって各部の機能を実現させても良い。
【００４２】
まず、演算装置２０は、機構モデル及び制御モデルを取得し、設計パラメータの初期値を設定する。
次に、非線形機構要素を含む機構モデルを基に、機構解析部２１によって各解析手段に機構系の状態方程式を算出し、目的関数を構成する。
【００４３】
そして、目的関数を第一最適化部２３１によって、各設計パラメータを制約条件下に均等に分割し、順次変化させ、目的関数を用いて評価を行い、目的関数が良好な値を出力する場合の各設計パラメータを第二最適化部２３２に出力する。
【００４４】
換言すると、各設計パラメータに設定されている仕様（例えば、モータ回転数３００〜９００ｒｐｍ）の範囲を等分割し、各等分点での解析結果を目的関数によって評価し、目的関数が最も良い結果を示す等分点の値を第二最適化部２３２に出力する。
具体的には、上記のようにモータ回転数３００〜９００ｒｐｍという仕様であれば、仕様に６０ｒｐｍの幅があるため、例えばこれを十等分した６０ｒｐｍピッチ（３００、３６０、４２０、・・・、７８０、８４０、９００）で解析を行い、最も良い解析結果が得られた値を第二最適化部２３２に出力する。
【００４５】
第二最適化部２３２は、各設計パラメータを座標軸として示される多次元空間（二次元平面、一次元直線を含む）において、第一最適化部２３１の出力値の近傍の空間内で各設計パラメータの値の組合せを変え、設計仕様に最も適した最適解を探索する。すなわち、第一最適化部の２３１出力値を中心とする所定範囲内の空間の中から、設計仕様に最も適する座標を探索する。
探索によって得られた最適値は、表示装置３０へ出力され、表示装置３０においてユーザに表示される。
【００４６】
具体的には、上記の例で、第一最適化部２３１においてモータ回転数４２０ｒｐｍの場合に最も良い解析結果が得られたとすると、第二最適化部２３２はモータ回転数を３６０ｒｐｍから４８０ｒｐｍまで１０ｍｍピッチで変化させながら各値での解析結果を目的関数で評価し、最も適する値を取得する。探索の結果得られた最適値が表示装置３０へ送信され、表示装置３０においてユーザに提示される。
【００４７】
なお、ここでは、設計パラメータの具体例として「モータ回転数」をあげたが、実際には機構制御系には複数の設計パラメータが存在するため、第一最適化部２３１及び第二最適化部２３２は、複数の設計パラメータをそれぞれ変化させながら最適な組合せを探索することとなる。
【００４８】
このように、本実施形態にかかる機構制御系設計システムは、非線形時変系において、機構系及び制御系の設計パラメータを容易に同時最適設計することが可能である。
【００４９】
なお、上記各実施形態は、本発明の好適な実施の一例であり、本発明はこれに限定されるものではない。
例えば、上記実施形態では、２慣性の機構系を例に説明を行ったが、これに限定されるものではない。
このように、本発明は様々な変形が可能である。
【００５０】
【発明の効果】
以上の説明によって明らかなように、本発明によれば、非線形時変系において、非線形機構要素を含む機構モデルと制御モデルとを用いて解析手段ごとに機構系の状態方程式を書き出して、これに基づいて制御モデルから全体系の応答を算出し、予め設定された目的関数に満足するように、機構系と制御系との設計パラメータを同時最適設計し、短時間にしかも効率よく機構制御パラメータを決定する機構制御系設計方法を提供できる。
【図面の簡単な説明】
【図１】本発明を好適に実施した第１の実施形態による機構制御系設計方法の処理の流れを示すフローチャートである。
【図２】２慣性機構系の構成の一例を示す図である。
【図３】２慣性機構系の駆動伝達部の機械荷重とひずみ特性との関係を示す図である。
【図４】２慣性機構系におけるモータの制御モデルの一例を示す。
【図５】目的関数の設定例を示す図である。
【図６】２慣性機構系における従動側の立ち下げ位置偏差を示す図である。
【図７】最適化ステップの処理の流れの一例を示す図である。
【図８】２慣性機構系におけるモータの指令速度プロファイルを示す図である。
【図９】本発明を好適に実施した第２の実施形態にかかる機構制御系設計システムの構成を示す図である。
【符号の説明】
１０ 入力装置
２０ 演算装置
２１ 機構解析部
２２ 制御解析部
２３ 最適化部
３０ 表示装置
２３１ 第一最適化部
２３２ 第二最適化部
【発明の属する技術分野】
本発明は、非線形機構を有する機構系及び制御系や、プリンタやロボットマニュピレータなどの高精度位置決めを要求される機構系及び制御系において、設計パラメータを効率よく設計仕様を満足させる機構制御システムを設計するための機構制御系設計方法に関する。
【０００２】
【従来の技術】
従来、機構系の設計では、機構の構成要素を剛体と仮定し、その挙動の解析を行っていた。近年、高精度の位置決めを要求される機構制御設計において、機構系の挙動予測だけでは対応できなくなる可能性が出てきており、機構系と制御系とを同時に設計することが強く要求されている。
【０００３】
さらに、機構制御系全体の動挙動を予測しても、設計仕様を満足する最適な設計パラメータは求められない。
【０００４】
機構系と制御系とを同時最適設計する従来技術としては、特許文献１に開示される「機構制御系設計システム装置」がある。
【０００５】
【特許文献１】
特開平６−３２４７１１号公報
【０００６】
【発明が解決しようとする課題】
特許文献１に記載された発明では、機構系モデルを基にして線形制御系の伝達関数を導出し、この伝達関数を用いて、設計パラメータの最適設計を行っている。このため、線形時不変系（linear time invariable system ）においては、十分な精度で挙動を解析できる。
【０００７】
しかしながら、非線形時変系（nonlinear time varying system ）においては、システムの伝達関数は解析時間の進行に伴って変化するため、上記特許文献１に記載された発明では、十分な解析精度を得られなかった。
【０００８】
本発明はかかる問題に鑑みてなされたものであり、非線形時変系において、非線形機構要素を含む機構モデルと制御モデルとを用いて解析手段ごとに機構系の状態方程式を書き出して、これに基づいて制御モデルから全体系の応答を算出し、予め設定された目的関数に満足するように、機構系と制御系との設計パラメータを同時最適設計し、短時間にしかも効率よく機構制御パラメータを決定する機構制御系設計方法を提供することを目的とする。
【０００９】
【課題を解決するための手段】
上記目的を達成するため、本発明は、第１の態様として、機構系をモデル化した機構モデルと制御系をモデル化した制御モデルとを、少なくとも一つの解析手段により解析した結果に基づいて、機構系と制御系とからなる全体系の応答を計算する機構制御系設計方法であって、演算装置が、機構モデルを基に各解析手段に機構系の挙動の状態方程式を書き出すステップと、状態方程式に基づいて、演算装置が、制御モデルを基に各解析手段に全体系の応答を出力するステップと、状態方程式及び全体系の応答を基に、演算装置が、予め設定された目的関数を満足するように、機構系と制御系との設計パラメータを同時最適設計する同時最適設計ステップとを有し、同時最適設計ステップは、機構系と制御系との設計パラメータのそれぞれについて、制約条件の下に解空間を等分割し、各等分点における全体系の応答をサンプリングし、サンプリングした各等分点における全体系の応答に基づいて、目的関数を最も満足する等分点を各設計パラメータごとに探索して決定する第一最適化工程を有することを特徴とする機構制御系設計方法を提供するものである。これにより、機構系と制御系との設計パラメータを同時最適設計することが可能となる。
【００１１】
また、上記のいずれの構成においても、制御系モデルにおいて、機構系の状態方程式に基づいて、制御モデルから各解析手段に全体系の応答を出力することが好ましい。これにより、機構系を含む全体系のモデルから応答を算出することができる。
【００１２】
また、上記のいずれの構成においても、機構モデルと制御モデルとの間で、各解析手段に機構系の状態方程式を受け渡すことにより、機構系の解析と制御系の解析とを同時に行うことが好ましい。これにより、各解析手段の非線形機構要素の挙動を含め、全体系の応答を考慮できる。
【００１３】
また、上記のいずれの構成においても、全体系の応答が予め目的関数として設定され、該目的関数が所定の値となるように機構系と制御系との設計パラメータを同時最適設計することが好ましい。これにより、目的関数を満足させることで、機構系と制御系との設計パラメータを同時最適設計することができる。
【００１４】
また、上記のいずれの構成においても、同時最適設計ステップは、第一最適化工程の後段に、第１最適化工程で決定した等分点の近傍において、目的関数を最も満足する最適値を各設計パラメータごとに探索する第二最適化工程をさらに有することが好ましい。これにより、機構制御系の設計パラメータの厳密な最適解を得ることができる。
【００２１】
【発明の実施の形態】
〔第１の実施形態〕
本発明を好適に実施した第１の実施形態について説明する。
図１に、本実施形態による機構制御系設計方法の処理の流れを示す。
予め機構系モデルを設定する（ステップＳ１０１）。この機構系モデルを用いて各解析手段ごとに機構系の状態方程式を書き出す（ステップＳ１０２）。制御系は、この状態方程式によって機構系を制御する。
【００２２】
次に、制御系を含む全体系モデルを設定し（ステップＳ１０３）、各解析手段ごとに機構系から書き出した状態方程式に基づいて、全体系の応答結果を算出する（ステップＳ１０４）。
【００２３】
続いて、目的関数を用いて応答結果の評価を行う（ステップＳ１０５、Ｓ１０６）。応答結果が目的関数（設計仕様）を満足すれば（ステップＳ１０７／Ｙｅｓ）、機構制御設計パラメータを出力し（ステップＳ１０８）、処理を終了する。
【００２４】
一方、応答結果が設計仕様を満足しなければ、各制御設計パラメータを制約条件下で変更させる（ステップＳ１０９）。機構系の設計パラメータを変更した場合は（ステップＳ１１０／Ｙｅｓ）ステップＳ１０１に、変更しなかった場合はステップＳ１０３に進み、設計仕様を満たす応答結果が得られるまで、上記の処理を繰り返し実行する。
【００２５】
本実施形態による機構制御設計方法を具体例を挙げて説明する。
図２に、２慣性機構系の一例を示す。機構系は駆動側（モータ軸側）、従動側（従動軸側）及び駆動伝達部で構成される。
駆動伝達部の機械荷重−ひずむ特性曲線を図３に示す。駆動伝達部は低ひずみ領域に非線形特性を持っている。
図４に、駆動軸に駆動源とするＤＣモータを設置した構成の駆動側の制御モデルを示す。
コントローラは、入力された指令速度プロファイルと従動側での回転数の検出結果とに基づいて、従動側における回転数が指令速度プロファイルで指定された回転数となるようにＤＣモータの駆動トルクを制御する。
機構制御系の設計パラメータとしては、例えば、駆動伝達部の初期テンション、モータの制御指令速度プロファイルを挙げられる。
【００２６】
目的関数（設計仕様）は、図５に示すように、従動側の立ち下げ位置偏差が速く収束し、かつオーバシュートが少なくなるように設計される。換言すると、図５におけるＴＩＭＥとＯＶＥＲＳＨＯＯＴとがともに最小となるように設計される。制約条件としては、例えば、モータの速度限界が挙げられる。
【００２７】
機構系モデルにおける解析処理について説明する。
まず、式（１）のラグランジュの方程式から式（２）の運動方程式に書き換える。
【００２８】
【数１】
【数２】
式（２）の運動方程式を状態方程式に書き換えると、式（３）となる。
【００３１】
【数３】
式（３）を用いて、各解析手段に、駆動伝達部の非線形特性を考慮した状態方程式を制御モデルに出力する。
すなわち、式（３）の状態方程式は、式（４）として機構系の解析処理から制御系の解析処理に受け渡す。
【００３３】
【数４】
次に、制御系モデルにおける解析処理について説明する。
制御系モデルは、指令速度プロファイルの初期値に基づいて、従動側の立ち下げ位置偏差を算出する。その結果の一例を図６のＡに示す。
【００３５】
次に、従動側の立ち下げ位置偏差の計算結果に基づいて、図７に示す処理を行う。
パラメータの評価基準となる目的関数を予め算出しておく（ステップＳ２０１）。目的関数は、各設計パラメータの理想値及び制約条件下での最大値・最小値なとに基づいて算出される。そして、第一最適化処理として、上記の設計パラメータ、例えば、速度プロファイルにおける減速加速度を、制約条件下で、モータの加速限界とする４０ｍ／ｓｅｃ2まで、１ｍ／ｓｅｃ2間隔で順次変化させ、それぞれの従動側の立ち下げ位置偏差を算出する（ステップＳ２０２）。
これらの計算結果の中で、目的関数が最も良い結果になる立ち下げ位置偏差を基に、各設計パラメータを決定し、第一最適化結果を得る（ステップＳ２０３）。
【００３６】
次に、第二最適化処理での解析を行う。
第一最適化結果を用いて、まず、その値の近辺に目的関数と各設計の勾配を式（５）で計算し、これによって適切な探索方向を決定する。
すなわち、最適な設計パラメータを得るためには、第一最適化結果の値を増加させる方向に変化させるべきであるか減少させる方向に変化させるべきであるかを各設計パラメータごとに判断する。
【００３７】
【数５】
次に、式（５）に基づいて決定した探索方向に沿って、新しい設計パラメータを設定し（ステップＳ２０４）、算出された値が最小となるまで上記計算を繰り返し実行する（ステップＳ２０５）。
【００３９】
上記の機構制御系設計方法によって、決定されたモータの指令速度プロファイルを図８に示す。
また、この際の従動側の立ち下げ位置偏差は図６のＢに示す。上記の機構制御系設計方法によって得られた設計パラメータの最適値では、初期値と比較して良好な応答結果が得られている。
【００４０】
このように、本実施形態にかかる機構制御系設計方法によれば、機構系と制御系との設計パラメータを、短時間にしかも効率よく同時最適設計できる。
【００４１】
〔第２の実施形態〕
本発明を好適に実施した第２の実施形態について説明する。
図９に、本実施形態にかかる機構制御系設計システムの構成を示す。このシステムは、入力装置１０、演算装置２０及び表示装置３０で構成される。
演算装置２０は、機構解析部２１、制御解析部２２及び最適化部２３を有する。なお、最適化部２３は、第一最適化部２３１と第二最適化部２３２とを有する。
これらの各部は、予め演算装置２０に組み込まれている。なお、演算装置２０は、各部がハードウエアで構成された装置であっても良いし、一般的なコンピュータ端末にソフトウエアによって各部の機能を実現させても良い。
【００４２】
まず、演算装置２０は、機構モデル及び制御モデルを取得し、設計パラメータの初期値を設定する。
次に、非線形機構要素を含む機構モデルを基に、機構解析部２１によって各解析手段に機構系の状態方程式を算出し、目的関数を構成する。
【００４３】
そして、目的関数を第一最適化部２３１によって、各設計パラメータを制約条件下に均等に分割し、順次変化させ、目的関数を用いて評価を行い、目的関数が良好な値を出力する場合の各設計パラメータを第二最適化部２３２に出力する。
【００４４】
換言すると、各設計パラメータに設定されている仕様（例えば、モータ回転数３００〜９００ｒｐｍ）の範囲を等分割し、各等分点での解析結果を目的関数によって評価し、目的関数が最も良い結果を示す等分点の値を第二最適化部２３２に出力する。
具体的には、上記のようにモータ回転数３００〜９００ｒｐｍという仕様であれば、仕様に６０ｒｐｍの幅があるため、例えばこれを十等分した６０ｒｐｍピッチ（３００、３６０、４２０、・・・、７８０、８４０、９００）で解析を行い、最も良い解析結果が得られた値を第二最適化部２３２に出力する。
【００４５】
第二最適化部２３２は、各設計パラメータを座標軸として示される多次元空間（二次元平面、一次元直線を含む）において、第一最適化部２３１の出力値の近傍の空間内で各設計パラメータの値の組合せを変え、設計仕様に最も適した最適解を探索する。すなわち、第一最適化部の２３１出力値を中心とする所定範囲内の空間の中から、設計仕様に最も適する座標を探索する。
探索によって得られた最適値は、表示装置３０へ出力され、表示装置３０においてユーザに表示される。
【００４６】
具体的には、上記の例で、第一最適化部２３１においてモータ回転数４２０ｒｐｍの場合に最も良い解析結果が得られたとすると、第二最適化部２３２はモータ回転数を３６０ｒｐｍから４８０ｒｐｍまで１０ｍｍピッチで変化させながら各値での解析結果を目的関数で評価し、最も適する値を取得する。探索の結果得られた最適値が表示装置３０へ送信され、表示装置３０においてユーザに提示される。
【００４７】
なお、ここでは、設計パラメータの具体例として「モータ回転数」をあげたが、実際には機構制御系には複数の設計パラメータが存在するため、第一最適化部２３１及び第二最適化部２３２は、複数の設計パラメータをそれぞれ変化させながら最適な組合せを探索することとなる。
【００４８】
このように、本実施形態にかかる機構制御系設計システムは、非線形時変系において、機構系及び制御系の設計パラメータを容易に同時最適設計することが可能である。
【００４９】
なお、上記各実施形態は、本発明の好適な実施の一例であり、本発明はこれに限定されるものではない。
例えば、上記実施形態では、２慣性の機構系を例に説明を行ったが、これに限定されるものではない。
このように、本発明は様々な変形が可能である。
【００５０】
【発明の効果】
以上の説明によって明らかなように、本発明によれば、非線形時変系において、非線形機構要素を含む機構モデルと制御モデルとを用いて解析手段ごとに機構系の状態方程式を書き出して、これに基づいて制御モデルから全体系の応答を算出し、予め設定された目的関数に満足するように、機構系と制御系との設計パラメータを同時最適設計し、短時間にしかも効率よく機構制御パラメータを決定する機構制御系設計方法を提供できる。
【図面の簡単な説明】
【図１】本発明を好適に実施した第１の実施形態による機構制御系設計方法の処理の流れを示すフローチャートである。
【図２】２慣性機構系の構成の一例を示す図である。
【図３】２慣性機構系の駆動伝達部の機械荷重とひずみ特性との関係を示す図である。
【図４】２慣性機構系におけるモータの制御モデルの一例を示す。
【図５】目的関数の設定例を示す図である。
【図６】２慣性機構系における従動側の立ち下げ位置偏差を示す図である。
【図７】最適化ステップの処理の流れの一例を示す図である。
【図８】２慣性機構系におけるモータの指令速度プロファイルを示す図である。
【図９】本発明を好適に実施した第２の実施形態にかかる機構制御系設計システムの構成を示す図である。
【符号の説明】
１０ 入力装置
２０ 演算装置
２１ 機構解析部
２２ 制御解析部
２３ 最適化部
３０ 表示装置
２３１ 第一最適化部
２３２ 第二最適化部
Claims (5)
- 機構系をモデル化した機構モデルと制御系をモデル化した制御モデルとを、少なくとも一つの解析手段により解析した結果に基づいて、前記機構系と前記制御系とからなる全体系の応答を計算する機構制御系設計方法であって、
演算装置が、前記機構モデルを基に各解析手段に前記機構系の挙動の状態方程式を書き出すステップと、
前記状態方程式に基づいて、前記演算装置が、前記制御モデルを基に各解析手段に前記全体系の応答を出力するステップと、
前記状態方程式及び前記全体系の応答を基に、前記演算装置が、予め設定された目的関数を満足するように、前記機構系と前記制御系との設計パラメータを同時最適設計する同時最適設計ステップとを有し、
前記同時最適設計ステップは、前記機構系と前記制御系との設計パラメータのそれぞれについて、制約条件の下に解空間を等分割し、
各等分点における前記全体系の応答をサンプリングし、
サンプリングした各等分点における前記全体系の応答に基づいて、前記目的関数を最も満足する等分点を各設計パラメータごとに探索して決定する第一最適化工程を有することを特徴とする機構制御系設計方法。 - 前記制御系モデルにおいて、前記機構系の状態方程式に基づいて、前記制御モデルから各解析手段に全体系の応答を出力することを特徴とする請求項１記載の機構制御系設計方法。
- 前記機構モデルと前記制御モデルとの間で、各解析手段に前記機構系の状態方程式を受け渡すことにより、前記機構系の解析と前記制御系の解析とを同時に行うことを特徴とする請求項１又は２記載の機構制御系設計方法。
- 前記全体系の応答が予め目的関数として設定され、該目的関数が所定の値となるように前記機構系と前記制御系との設計パラメータを同時最適設計することを特徴とする請求項１から３のいずれか１項記載の機構制御系設計方法。
- 前記同時最適設計ステップは、前記第一最適化工程の後段に、前記第１最適化工程で決定した等分点の近傍において、前記目的関数を最も満足する最適値を各設計パラメータごとに探索する第二最適化工程をさらに有することを特徴とする請求項１から４のいずれか１項記載の機構制御系設計方法。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2002267351A JP4139658B2 (ja) | 2002-09-12 | 2002-09-12 | 機構制御系設計方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2002267351A JP4139658B2 (ja) | 2002-09-12 | 2002-09-12 | 機構制御系設計方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2004102938A JP2004102938A (ja) | 2004-04-02 |
| JP4139658B2 true JP4139658B2 (ja) | 2008-08-27 |
Family
ID=32265903
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2002267351A Expired - Fee Related JP4139658B2 (ja) | 2002-09-12 | 2002-09-12 | 機構制御系設計方法 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP4139658B2 (ja) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106951634B (zh) * | 2017-03-20 | 2019-10-11 | 南京航空航天大学 | 一种航空发动机鲁棒跟踪控制器设计方法 |
| WO2022244142A1 (ja) * | 2021-05-19 | 2022-11-24 | 三菱電機株式会社 | 機構制御系設計装置および機構制御系設計方法 |
-
2002
- 2002-09-12 JP JP2002267351A patent/JP4139658B2/ja not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JP2004102938A (ja) | 2004-04-02 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| EP1956447A2 (en) | Apparatus and method for proportional-integral-derivative control | |
| KR100739586B1 (ko) | 정보처리장치 및 그 제어방법 | |
| CN107921964A (zh) | 确定牵引系统是否处于故障状况的诊断监督程序 | |
| US11087509B2 (en) | Output device, control device, and evaluation function value output method | |
| US10953891B2 (en) | Method and system for providing an optimized control of a complex dynamical system | |
| JP2021000672A (ja) | 調整支援装置 | |
| CN109571432A (zh) | 一种基于力传感器的机器人直接示教方法 | |
| JP7404723B2 (ja) | 制御方法及びコンピュータプログラム | |
| JP4139658B2 (ja) | 機構制御系設計方法 | |
| JP2017502390A (ja) | データに基づく関数モデルを定めるための方法及び装置 | |
| TWI578172B (zh) | 消耗電能推定裝置 | |
| JP7097268B2 (ja) | プレス装置、端末装置、ボールねじ推定寿命算出方法およびプログラム | |
| JP2013206408A (ja) | フィードバック制御器設計装置、フィードバック制御装置、及びフィードバック制御器設計方法 | |
| JP4570207B2 (ja) | ３次元モデル解析装置および記録媒体 | |
| JP5178287B2 (ja) | 解析装置及び解析方法 | |
| US11185983B2 (en) | Position control method for servo, computer readable storage medium, and robot | |
| JP7119759B2 (ja) | 設定支援装置 | |
| JP7014094B2 (ja) | 設定支援装置 | |
| JP7014095B2 (ja) | 設定支援装置 | |
| JP4210921B2 (ja) | サーボ制御装置の指令作成方法および装置 | |
| JP2005346497A (ja) | 接触部品の形状設計支援システム、その支援プログラム及び該プログラムを記録したコンピュータ読み取り可能な記録媒体 | |
| US6477454B1 (en) | Method and apparatus for controlling a power window system using a motor torque parameter | |
| WO2021187268A1 (ja) | 機械学習装置、数値制御システム、設定装置、数値制御装置、及び機械学習方法 | |
| EP2927766A2 (en) | System for Generating or Modifying Cams | |
| US20240345547A1 (en) | Operation rule determination device, operation rule determination method, and recording medium |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20050210 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20071204 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20080201 |
|
| A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20080226 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20080402 |
|
| A911 | Transfer to examiner for re-examination before appeal (zenchi) |
Free format text: JAPANESE INTERMEDIATE CODE: A911 Effective date: 20080509 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20080603 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20080609 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110613 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110613 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120613 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130613 Year of fee payment: 5 |
|
| LAPS | Cancellation because of no payment of annual fees |