JP4139658B2 - 機構制御系設計方法 - Google Patents

機構制御系設計方法 Download PDF

Info

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
Application number
JP2002267351A
Other languages
English (en)
Other versions
JP2004102938A (ja
Inventor
兪  波
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Ricoh Co Ltd
Original Assignee
Ricoh Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Ricoh Co Ltd filed Critical Ricoh Co Ltd
Priority to JP2002267351A priority Critical patent/JP4139658B2/ja
Publication of JP2004102938A publication Critical patent/JP2004102938A/ja
Application granted granted Critical
Publication of JP4139658B2 publication Critical patent/JP4139658B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

Description

【0001】
【発明の属する技術分野】
本発明は、非線形機構を有する機構系及び制御系や、プリンタやロボットマニュピレータなどの高精度位置決めを要求される機構系及び制御系において、設計パラメータを効率よく設計仕様を満足させる機構制御システムを設計するための機構制御系設計方法に関する。
【0002】
【従来の技術】
従来、機構系の設計では、機構の構成要素を剛体と仮定し、その挙動の解析を行っていた。近年、高精度の位置決めを要求される機構制御設計において、機構系の挙動予測だけでは対応できなくなる可能性が出てきており、機構系と制御系とを同時に設計することが強く要求されている。
【0003】
さらに、機構制御系全体の動挙動を予測しても、設計仕様を満足する最適な設計パラメータは求められない。
【0004】
機構系と制御系とを同時最適設計する従来技術としては、特許文献1に開示される「機構制御系設計システム装置」がある。
【0005】
【特許文献1】
特開平6−324711号公報
【0006】
【発明が解決しようとする課題】
特許文献1に記載された発明では、機構系モデルを基にして線形制御系の伝達関数を導出し、この伝達関数を用いて、設計パラメータの最適設計を行っている。このため、線形時不変系(linear time invariable system )においては、十分な精度で挙動を解析できる。
【0007】
しかしながら、非線形時変系(nonlinear time varying system )においては、システムの伝達関数は解析時間の進行に伴って変化するため、上記特許文献1に記載された発明では、十分な解析精度を得られなかった。
【0008】
本発明はかかる問題に鑑みてなされたものであり、非線形時変系において、非線形機構要素を含む機構モデルと制御モデルとを用いて解析手段ごとに機構系の状態方程式を書き出して、これに基づいて制御モデルから全体系の応答を算出し、予め設定された目的関数に満足するように、機構系と制御系との設計パラメータを同時最適設計し、短時間にしかも効率よく機構制御パラメータを決定する機構制御系設計方法を提供することを目的とする。
【0009】
【課題を解決するための手段】
上記目的を達成するため、本発明は、第1の態様として、機構系をモデル化した機構モデルと制御系をモデル化した制御モデルとを、少なくとも一つの解析手段により解析した結果に基づいて、機構系と制御系とからなる全体系の応答を計算する機構制御系設計方法であって、演算装置が、機構モデルを基に各解析手段に機構系の挙動の状態方程式を書き出すステップと、状態方程式に基づいて、演算装置が、制御モデルを基に各解析手段に全体系の応答を出力するステップと、状態方程式及び全体系の応答を基に、演算装置が、予め設定された目的関数を満足するように、機構系と制御系との設計パラメータを同時最適設計する同時最適設計ステップとを有し、同時最適設計ステップは、機構系と制御系との設計パラメータのそれぞれについて、制約条件の下に解空間を等分割し、各等分点における全体系の応答をサンプリングし、サンプリングした各等分点における全体系の応答に基づいて、目的関数を最も満足する等分点を各設計パラメータごとに探索して決定する第一最適化工程を有することを特徴とする機構制御系設計方法を提供するものである。これにより、機構系と制御系との設計パラメータを同時最適設計することが可能となる。
【0011】
また、上記のいずれの構成においても、制御系モデルにおいて、機構系の状態方程式に基づいて、制御モデルから各解析手段に全体系の応答を出力することが好ましい。これにより、機構系を含む全体系のモデルから応答を算出することができる。
【0012】
また、上記のいずれの構成においても、機構モデルと制御モデルとの間で、各解析手段に機構系の状態方程式を受け渡すことにより、機構系の解析と制御系の解析とを同時に行うことが好ましい。これにより、各解析手段の非線形機構要素の挙動を含め、全体系の応答を考慮できる。
【0013】
また、上記のいずれの構成においても、全体系の応答が予め目的関数として設定され、該目的関数が所定の値となるように機構系と制御系との設計パラメータを同時最適設計することが好ましい。これにより、目的関数を満足させることで、機構系と制御系との設計パラメータを同時最適設計することができる。
【0014】
また、上記のいずれの構成においても、同時最適設計ステップは、第一最適化工程の後段に、第1最適化工程で決定した等分点の近傍において、目的関数を最も満足する最適値を各設計パラメータごとに探索する第二最適化工程をさらに有することが好ましい。これにより、機構制御系の設計パラメータの厳密な最適解を得ることができる。
【0021】
【発明の実施の形態】
〔第1の実施形態〕
本発明を好適に実施した第1の実施形態について説明する。
図1に、本実施形態による機構制御系設計方法の処理の流れを示す。
予め機構系モデルを設定する(ステップS101)。この機構系モデルを用いて各解析手段ごとに機構系の状態方程式を書き出す(ステップS102)。制御系は、この状態方程式によって機構系を制御する。
【0022】
次に、制御系を含む全体系モデルを設定し(ステップS103)、各解析手段ごとに機構系から書き出した状態方程式に基づいて、全体系の応答結果を算出する(ステップS104)。
【0023】
続いて、目的関数を用いて応答結果の評価を行う(ステップS105、S106)。応答結果が目的関数(設計仕様)を満足すれば(ステップS107/Yes)、機構制御設計パラメータを出力し(ステップS108)、処理を終了する。
【0024】
一方、応答結果が設計仕様を満足しなければ、各制御設計パラメータを制約条件下で変更させる(ステップS109)。機構系の設計パラメータを変更した場合は(ステップS110/Yes)ステップS101に、変更しなかった場合はステップS103に進み、設計仕様を満たす応答結果が得られるまで、上記の処理を繰り返し実行する。
【0025】
本実施形態による機構制御設計方法を具体例を挙げて説明する。
図2に、2慣性機構系の一例を示す。機構系は駆動側(モータ軸側)、従動側(従動軸側)及び駆動伝達部で構成される。
駆動伝達部の機械荷重−ひずむ特性曲線を図3に示す。駆動伝達部は低ひずみ領域に非線形特性を持っている。
図4に、駆動軸に駆動源とするDCモータを設置した構成の駆動側の制御モデルを示す。
コントローラは、入力された指令速度プロファイルと従動側での回転数の検出結果とに基づいて、従動側における回転数が指令速度プロファイルで指定された回転数となるようにDCモータの駆動トルクを制御する。
機構制御系の設計パラメータとしては、例えば、駆動伝達部の初期テンション、モータの制御指令速度プロファイルを挙げられる。
【0026】
目的関数(設計仕様)は、図5に示すように、従動側の立ち下げ位置偏差が速く収束し、かつオーバシュートが少なくなるように設計される。換言すると、図5におけるTIMEとOVERSHOOTとがともに最小となるように設計される。制約条件としては、例えば、モータの速度限界が挙げられる。
【0027】
機構系モデルにおける解析処理について説明する。
まず、式(1)のラグランジュの方程式から式(2)の運動方程式に書き換える。
【0028】
【数1】
Figure 0004139658
【0029】
【数2】
Figure 0004139658
【0030】
式(2)の運動方程式を状態方程式に書き換えると、式(3)となる。
【0031】
【数3】
Figure 0004139658
【0032】
式(3)を用いて、各解析手段に、駆動伝達部の非線形特性を考慮した状態方程式を制御モデルに出力する。
すなわち、式(3)の状態方程式は、式(4)として機構系の解析処理から制御系の解析処理に受け渡す。
【0033】
【数4】
Figure 0004139658
【0034】
次に、制御系モデルにおける解析処理について説明する。
制御系モデルは、指令速度プロファイルの初期値に基づいて、従動側の立ち下げ位置偏差を算出する。その結果の一例を図6のAに示す。
【0035】
次に、従動側の立ち下げ位置偏差の計算結果に基づいて、図7に示す処理を行う。
パラメータの評価基準となる目的関数を予め算出しておく(ステップS201)。目的関数は、各設計パラメータの理想値及び制約条件下での最大値・最小値なとに基づいて算出される。そして、第一最適化処理として、上記の設計パラメータ、例えば、速度プロファイルにおける減速加速度を、制約条件下で、モータの加速限界とする40m/sec2まで、1m/sec2間隔で順次変化させ、それぞれの従動側の立ち下げ位置偏差を算出する(ステップS202)。
これらの計算結果の中で、目的関数が最も良い結果になる立ち下げ位置偏差を基に、各設計パラメータを決定し、第一最適化結果を得る(ステップS203)。
【0036】
次に、第二最適化処理での解析を行う。
第一最適化結果を用いて、まず、その値の近辺に目的関数と各設計の勾配を式(5)で計算し、これによって適切な探索方向を決定する。
すなわち、最適な設計パラメータを得るためには、第一最適化結果の値を増加させる方向に変化させるべきであるか減少させる方向に変化させるべきであるかを各設計パラメータごとに判断する。
【0037】
【数5】
Figure 0004139658
【0038】
次に、式(5)に基づいて決定した探索方向に沿って、新しい設計パラメータを設定し(ステップS204)、算出された値が最小となるまで上記計算を繰り返し実行する(ステップS205)。
【0039】
上記の機構制御系設計方法によって、決定されたモータの指令速度プロファイルを図8に示す。
また、この際の従動側の立ち下げ位置偏差は図6のBに示す。上記の機構制御系設計方法によって得られた設計パラメータの最適値では、初期値と比較して良好な応答結果が得られている。
【0040】
このように、本実施形態にかかる機構制御系設計方法によれば、機構系と制御系との設計パラメータを、短時間にしかも効率よく同時最適設計できる。
【0041】
〔第2の実施形態〕
本発明を好適に実施した第2の実施形態について説明する。
図9に、本実施形態にかかる機構制御系設計システムの構成を示す。このシステムは、入力装置10、演算装置20及び表示装置30で構成される。
演算装置20は、機構解析部21、制御解析部22及び最適化部23を有する。なお、最適化部23は、第一最適化部231と第二最適化部232とを有する。
これらの各部は、予め演算装置20に組み込まれている。なお、演算装置20は、各部がハードウエアで構成された装置であっても良いし、一般的なコンピュータ端末にソフトウエアによって各部の機能を実現させても良い。
【0042】
まず、演算装置20は、機構モデル及び制御モデルを取得し、設計パラメータの初期値を設定する。
次に、非線形機構要素を含む機構モデルを基に、機構解析部21によって各解析手段に機構系の状態方程式を算出し、目的関数を構成する。
【0043】
そして、目的関数を第一最適化部231によって、各設計パラメータを制約条件下に均等に分割し、順次変化させ、目的関数を用いて評価を行い、目的関数が良好な値を出力する場合の各設計パラメータを第二最適化部232に出力する。
【0044】
換言すると、各設計パラメータに設定されている仕様(例えば、モータ回転数300〜900rpm)の範囲を等分割し、各等分点での解析結果を目的関数によって評価し、目的関数が最も良い結果を示す等分点の値を第二最適化部232に出力する。
具体的には、上記のようにモータ回転数300〜900rpmという仕様であれば、仕様に60rpmの幅があるため、例えばこれを十等分した60rpmピッチ(300、360、420、・・・、780、840、900)で解析を行い、最も良い解析結果が得られた値を第二最適化部232に出力する。
【0045】
第二最適化部232は、各設計パラメータを座標軸として示される多次元空間(二次元平面、一次元直線を含む)において、第一最適化部231の出力値の近傍の空間内で各設計パラメータの値の組合せを変え、設計仕様に最も適した最適解を探索する。すなわち、第一最適化部の231出力値を中心とする所定範囲内の空間の中から、設計仕様に最も適する座標を探索する。
探索によって得られた最適値は、表示装置30へ出力され、表示装置30においてユーザに表示される。
【0046】
具体的には、上記の例で、第一最適化部231においてモータ回転数420rpmの場合に最も良い解析結果が得られたとすると、第二最適化部232はモータ回転数を360rpmから480rpmまで10mmピッチで変化させながら各値での解析結果を目的関数で評価し、最も適する値を取得する。探索の結果得られた最適値が表示装置30へ送信され、表示装置30においてユーザに提示される。
【0047】
なお、ここでは、設計パラメータの具体例として「モータ回転数」をあげたが、実際には機構制御系には複数の設計パラメータが存在するため、第一最適化部231及び第二最適化部232は、複数の設計パラメータをそれぞれ変化させながら最適な組合せを探索することとなる。
【0048】
このように、本実施形態にかかる機構制御系設計システムは、非線形時変系において、機構系及び制御系の設計パラメータを容易に同時最適設計することが可能である。
【0049】
なお、上記各実施形態は、本発明の好適な実施の一例であり、本発明はこれに限定されるものではない。
例えば、上記実施形態では、2慣性の機構系を例に説明を行ったが、これに限定されるものではない。
このように、本発明は様々な変形が可能である。
【0050】
【発明の効果】
以上の説明によって明らかなように、本発明によれば、非線形時変系において、非線形機構要素を含む機構モデルと制御モデルとを用いて解析手段ごとに機構系の状態方程式を書き出して、これに基づいて制御モデルから全体系の応答を算出し、予め設定された目的関数に満足するように、機構系と制御系との設計パラメータを同時最適設計し、短時間にしかも効率よく機構制御パラメータを決定する機構制御系設計方法を提供できる。
【図面の簡単な説明】
【図1】本発明を好適に実施した第1の実施形態による機構制御系設計方法の処理の流れを示すフローチャートである。
【図2】2慣性機構系の構成の一例を示す図である。
【図3】2慣性機構系の駆動伝達部の機械荷重とひずみ特性との関係を示す図である。
【図4】2慣性機構系におけるモータの制御モデルの一例を示す。
【図5】目的関数の設定例を示す図である。
【図6】2慣性機構系における従動側の立ち下げ位置偏差を示す図である。
【図7】最適化ステップの処理の流れの一例を示す図である。
【図8】2慣性機構系におけるモータの指令速度プロファイルを示す図である。
【図9】本発明を好適に実施した第2の実施形態にかかる機構制御系設計システムの構成を示す図である。
【符号の説明】
10 入力装置
20 演算装置
21 機構解析部
22 制御解析部
23 最適化部
30 表示装置
231 第一最適化部
232 第二最適化部

Claims (5)

  1. 機構系をモデル化した機構モデルと制御系をモデル化した制御モデルとを、少なくとも一つの解析手段により解析した結果に基づいて、前記機構系と前記制御系とからなる全体系の応答を計算する機構制御系設計方法であって、
    演算装置が、前記機構モデルを基に各解析手段に前記機構系の挙動の状態方程式を書き出すステップと、
    前記状態方程式に基づいて、前記演算装置が、前記制御モデルを基に各解析手段に前記全体系の応答を出力するステップと、
    前記状態方程式及び前記全体系の応答を基に、前記演算装置が、予め設定された目的関数を満足するように、前記機構系と前記制御系との設計パラメータを同時最適設計する同時最適設計ステップとを有し、
    前記同時最適設計ステップは、前記機構系と前記制御系との設計パラメータのそれぞれについて、制約条件の下に解空間を等分割し、
    各等分点における前記全体系の応答をサンプリングし、
    サンプリングした各等分点における前記全体系の応答に基づいて、前記目的関数を最も満足する等分点を各設計パラメータごとに探索して決定する第一最適化工程を有することを特徴とする機構制御系設計方法。
  2. 前記制御系モデルにおいて、前記機構系の状態方程式に基づいて、前記制御モデルから各解析手段に全体系の応答を出力することを特徴とする請求項1記載の機構制御系設計方法。
  3. 前記機構モデルと前記制御モデルとの間で、各解析手段に前記機構系の状態方程式を受け渡すことにより、前記機構系の解析と前記制御系の解析とを同時に行うことを特徴とする請求項1又は2記載の機構制御系設計方法。
  4. 前記全体系の応答が予め目的関数として設定され、該目的関数が所定の値となるように前記機構系と前記制御系との設計パラメータを同時最適設計することを特徴とする請求項1からのいずれか1項記載の機構制御系設計方法。
  5. 前記同時最適設計ステップは、前記第一最適化工程の後段に、前記第1最適化工程で決定した等分点の近傍において、前記目的関数を最も満足する最適値を各設計パラメータごとに探索する第二最適化工程をさらに有することを特徴とする請求項1からのいずれか1項記載の機構制御系設計方法。
JP2002267351A 2002-09-12 2002-09-12 機構制御系設計方法 Expired - Fee Related JP4139658B2 (ja)

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)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106951634B (zh) * 2017-03-20 2019-10-11 南京航空航天大学 一种航空发动机鲁棒跟踪控制器设计方法
WO2022244142A1 (ja) * 2021-05-19 2022-11-24 三菱電機株式会社 機構制御系設計装置および機構制御系設計方法

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) 調整支援装置
JP4139658B2 (ja) 機構制御系設計方法
JP7404723B2 (ja) 制御方法及びコンピュータプログラム
JP7097268B2 (ja) プレス装置、端末装置、ボールねじ推定寿命算出方法およびプログラム
EP1418533A3 (en) Image-forming device
TWI578172B (zh) 消耗電能推定裝置
JP2013206408A (ja) フィードバック制御器設計装置、フィードバック制御装置、及びフィードバック制御器設計方法
JP4570207B2 (ja) 3次元モデル解析装置および記録媒体
EP4019899B1 (en) Method and apparatus for creating driving route of autonomous vehicle and computer program therefor
JP5178287B2 (ja) 解析装置及び解析方法
US11185983B2 (en) Position control method for servo, computer readable storage medium, and robot
JP7119759B2 (ja) 設定支援装置
JP7014094B2 (ja) 設定支援装置
CN108693841B (zh) 制造系统以及制造方法
JP2005346497A (ja) 接触部品の形状設計支援システム、その支援プログラム及び該プログラムを記録したコンピュータ読み取り可能な記録媒体
WO2021187268A1 (ja) 機械学習装置、数値制御システム、設定装置、数値制御装置、及び機械学習方法
EP2927766A2 (en) System for Generating or Modifying Cams
JP4801134B2 (ja) 振動試験装置及び振動試験方法
JP2004171144A (ja) 製品の特性解析方法、装置およびプログラム
JP2008197062A (ja) 転写ベルト駆動機構のモデル化方法及びそのモデル化方法を用いた制御系の設計支援方法

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