JP6966062B2 - 周波数応答解析アルゴリズム - Google Patents
周波数応答解析アルゴリズム Download PDFInfo
- Publication number
- JP6966062B2 JP6966062B2 JP2017015031A JP2017015031A JP6966062B2 JP 6966062 B2 JP6966062 B2 JP 6966062B2 JP 2017015031 A JP2017015031 A JP 2017015031A JP 2017015031 A JP2017015031 A JP 2017015031A JP 6966062 B2 JP6966062 B2 JP 6966062B2
- Authority
- JP
- Japan
- Prior art keywords
- friction
- force
- frequency response
- plant
- input
- 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.)
- Active
Links
Images
Landscapes
- Feedback Control In General (AREA)
Description
即ち、従来技術2において、入出力に存在する遅れ要素を考慮していないため、線形ダイナミクスの解析誤差を生ずる。また、その解析誤差を補正するための加振力や摩擦モデルパラメータの調整・更新に多大な労力が必要となる。
なお、上記及び特許請求の範囲における括弧内の符号は、特許請求の範囲に記載された用語と後述の実施形態に記載されて当該用語の例となる具体物等との対応関係を示すものである。
また、加振力や摩擦モデル入出力の遅れ要素の影響を考慮しているため、加振力や摩擦モデルパラメータ更新・調整が不要である。従って、機構システムの線形ダイナミクスを同定する周波数応答解析において、人的労力や時間の削減が可能である。
機構システム1は、機器部(可動部を備える揺動あるいは直動機械、可動部に対する推力を発生するアクチュエータ、アクチュエータを駆動するためのサーボアンプ及び可動部位置を検出するセンサ等、制御演算を行う補償器)と周波数応答解析(以下、FRA)部によって構成される。
本実施形態は、このような摩擦を内在するメカトロニクス機器の線形ダイナミクスに対する、周波数応答解析を用いた周波数応答解析アルゴリズムに関するものである。
FRAシステム3より、一定周波数の加振力usinを出力されると、加振力usinは、第1加算器8を経由してオブザーバ10とプラント20への入力uとなる。入力uによってプラント20が変位y’を生じる。変位y’は、FRAシステム3のサーボアナライザ5とオブザーバ10へ入力されると共に、第2加算器9に入力され、位置指令r(例えばr=0)との差分が計算されて補償器C(z)7に入力される。
補償器C(z)7では、制御アルゴリズムに基づき変位の次元から力の次元に変換し、FRAシステム3からの加振力usinに加算されプラントへの入力uとなる。
本実施形態は、オブザーバ10にて、入力uと変位y’から更新された実入力ueの推定uobが出力され、サーボアナライザ5に入力される。ここで、実入力ueの推定uobでは、機構システム1の機器部の摩擦の影響が除かれている。
即ち、同定対象となるプラント20における実入力ueの推定uobと出力y’をサーボアナライザ3に入力する。サーボアナライザ3では、離散フーリエ変換等の周波数解析アルゴリズムによってuobとy’の周波数応答を算出し、ゲイン及び位相を計算する。uobには、実際の機器部の摩擦力の影響が除かれているので線形特性のみで構成される。よって、本実施形態は、線形プラント特性に対する高精度なFRAを用いた周波数応答解析アルゴリズムとなる。
プラント20において、線形ダイナミクスP(s)への実入力ueは、入力uと、実制御対象中の入力に存在する力次元の遅れ要素Gdi(s)の積から、第4加算器27にてシステム1の摩擦力fを差し引くことで表される。ここで、力次元の遅れ要素Gdi(s)は、伝達関数である。
次に、実入力ueとプラント特性P(s)との積にて変位yを得る。ここで、プラント特性P(s)は、機構システム(1)の線形ダイナミクスを表す伝達関数であり、例えば数式(1)で示される。
オブザーバ10においては、まず入力uと、力次元の遅れ要素モデルGdim(s)と、位置次元の遅れ要素モデルGdom(s)と、の積を算出する。一方、プラント20の出力である変位y’に対し、摩擦モデル15により摩擦力fobを求める。実入力ueの推定uobは、第3加算器17にて、uとGdim(s)とGdom(s)の積から摩擦力fobを引いて求める。この関係を数式(2)に示す。
ここで、モデル化によりGdo(s)=Gdom(s)とみなせるとき、数式(2)、(3)より数式(4)が成立する。
機構システム1の可動部に内在する各種案内・軸受機構で発生する摩擦を対象とする。具体的には、可動部に用いられる案内・軸受部の実機データ、計算から摩擦モデルを構築する。例えば転がり摩擦は、転がり要素を用いた案内・軸受で発生する摩擦力であり、粗動・微動によって非線形に摩擦挙動が変化する。数10〜数100μmの微動領域では非線形ばね特性を示し、それ以上の粗動領域ではクーロン摩擦による静的特性を示す。転がり摩擦に限らず、すべり案内・軸受などの摺動部でも摩擦に対しても同様にモデル化すれば、FRAシステムにおける摩擦モデルとして使用することができる。
図3(a)は、ころがり摩擦の全体サイクル(ア)〜(エ)を示す。横軸を変位、縦軸を摩擦力である。(ア)より右側へ移動する際、変位に対して摩擦力が非線形かつ急峻に増加して(イ)に移る。(イ)から(ウ)へは、変位の増加に対して摩擦力の増加は緩やかである。(ウ)より左側へ移動する際、変位に対して摩擦力は急峻に減少して(エ)に移動する。(エ)から(ア)へは、変位の減少(減少量)に対して摩擦力の減少は緩やかである。
図3(b)は、(ア)から(イ)の変化を拡大して示す。
微動は(ア)から(イ)及び(ウ)から(エ)であり、ころがり案内・軸受機構で供されるころがり要素が有効に転動するまでを指す。粗動は(イ)から(ウ)及び(エ)から(ア)であり、ころがり要素が完全に転動している状態を指す。
(ア)の太い破線は、同定すべき実線形プラント特性P(s)であり、目標値に相当する。本実施形態の結果を、(エ)の太い実線(振幅A=75N)、及び(オ)の太い破線(振幅A=12N)で示す。振幅Aは、加振力の最大値に相当する。以上の3つの線である(ア)、(エ)、及び(オ)は、位相、ゲインともよく一致し、一本の太線で示され良く同定できている。特に、本実施形態は、加振力が12Nと小さくでも実線形プラント特性P(s)を同定できている。
また、従来技術1のFRA法による結果(遅れ要素を考慮しない、摩擦を考慮しない)を、(イ)の細い破線(振幅A=75N)、及び(ウ)の細い破線(振幅A=12N)で示すが、(ア)の太い破線の同定すべき実線形プラント特性P(s)には一致しておらず同定できていない。なお、差が大きいほうが小さな加振力(振幅A=12N)の場合である。
(ア)の太い破線は、同定すべき実線形プラント特性P(s)であり、目標値に相当する。本実施形態の結果を、(ウ)の太い実線(振幅A=12N)で示す。振幅Aは、加振力の最大値に相当する。以上の2つの線である(ア)及び(ウ)は、位相、ゲインともよく一致し、一本の太線で示され良く同定される。ここで、本実施形態は、加振力が12Nと小さくでも実線形プラント特性P(s)を再現できている。
同時に従来技術2のFRA法による結果(遅れ要素を考慮しない、摩擦を考慮)を、(イ)の実線(振幅A=75N)で示すが、加振力を大きくしても、(ア)の太い破線の同定すべき実線形プラント特性P(s)には一致せず同定できていない。
更に、解析誤差を補正するための加振力や摩擦モデルパラメータの調整・更新に多大な労力を必要としないので、人的労力や時間の削減が可能である。
よって、本実施形態は、小さな適正な加振力にて効率的に高精度で、機構システム1の線形ダイナミクスの周波数特性を同定する周波数応答解析アルゴリズムを提供することができる。
(ア)の太い破線は、目標値である。(イ)に本実施形態の周波数応答を制御器モデルに用いた結果を示す。(ア)及び(イ)はよく一致している。これは、図6、7で示されるように、同定すべき実線形プラント特性P(s)を、本実施形態が良く同定しているからである。
一方、(ウ)の従来技術1(遅れ要素を考慮しない、摩擦を考慮しない)では、オ−バーシュートが発生しており、目標値とも良く一致していない。これは、同定すべき実線形プラント特性P(s)を、従来技術1は精度良く同定していないからである。このような同定誤差が生じた場合、機構システムの位置決め精度は劣化する。従来技術2(遅れ要素を考慮しない、摩擦を考慮)の場合もこれと同様の結果となる。よって、実線形プラント特性P(s)の同定精度を上げるために、加振力や摩擦モデルパラメータの調整・更新に多大な労力を必要とし、その人的労力や時間も多大となる。
図8は、従来のFRAシステム101の構成を示すブロック線図である。FRAシステム103にサーボアナライザ105を有するが、オブザーバ10は有しない。
3 FRAシステム
5 サーボアナライザ
7 補償器C(z)
8 第1加算器
9 第2加算器
10 オブザーバ
Gdim(S) 力次元の遅れ要素モデル(伝達関数)
Gdom(S) 位置次元の遅れ要素モデル(伝達関数)
15 摩擦モデル(FM)
17 第3加算器
20 プラント
Gdi(S) 力次元の遅れ要素(伝達関数)
Gdo(S) 位置次元の遅れ要素(伝達関数)
P(s) プラント特性(伝達関数)
27 第4加算器
Claims (1)
- 加振により非線形な摩擦と線形なダイナミクスを有する機構システム(1)の線形ダイナミクスを同定する周波数応答解析アルゴリズムにおいて、
前記機構システム(1)のブロック線図に、プラント(20)及びオブザーバ(10)を有し、
前記プラント(20)において、
前記機構システム(1)への力次元の入力(u)に対し、
可動部の位置や速度に依存した非線形な摩擦により生じる摩擦力(f)、プラント特性(P(s))、力次元の遅れ要素(Gdi(s))と位置次元の遅れ要素(Gdo(s))より位置(y’)を出力し、
前記オブザーバ(10)において、
前記入力(u)と、力次元の遅れ要素モデル(Gdim(s))と、位置次元の遅れ要素モデル(Gdom(s))と、の積と、
前記位置(y’)を用いて摩擦モデル(15)から算出した摩擦力(fob)との差より前記力次元の遅れ要素(Gdi(s))と前記摩擦力(f)の影響を受けたプラント特性(P)への入力の推定(uob)を出力し、
前記入力の推定(uob)と前記位置(y’)からプラント特性(P)の周波数応答を解析する周波数応答解析アルゴリズム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017015031A JP6966062B2 (ja) | 2017-01-31 | 2017-01-31 | 周波数応答解析アルゴリズム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017015031A JP6966062B2 (ja) | 2017-01-31 | 2017-01-31 | 周波数応答解析アルゴリズム |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2018124699A JP2018124699A (ja) | 2018-08-09 |
JP6966062B2 true JP6966062B2 (ja) | 2021-11-10 |
Family
ID=63108946
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2017015031A Active JP6966062B2 (ja) | 2017-01-31 | 2017-01-31 | 周波数応答解析アルゴリズム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6966062B2 (ja) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6973282B2 (ja) * | 2018-05-09 | 2021-11-24 | 株式会社Ihi | 振動試験装置及び振動試験方法 |
WO2024047974A1 (ja) * | 2022-08-31 | 2024-03-07 | 株式会社豊田自動織機 | 周波数応答関数同定システム |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005073476A (ja) * | 2003-08-28 | 2005-03-17 | Yaskawa Electric Corp | 機械の特性抽出方法 |
EP1993007B1 (en) * | 2006-03-07 | 2011-08-31 | National University Corporation Nagoya Institute of Technology | Control method and controller of positioning mechanism |
JP4784826B2 (ja) * | 2006-04-25 | 2011-10-05 | 株式会社安川電機 | システム同定装置およびそれを備えたモータ制御装置 |
JP5067656B2 (ja) * | 2007-05-31 | 2012-11-07 | 株式会社安川電機 | ディジタル制御装置 |
US20160123796A1 (en) * | 2013-06-03 | 2016-05-05 | Mitsubishi Electric Corporation | Frequency-response measurement device |
-
2017
- 2017-01-31 JP JP2017015031A patent/JP6966062B2/ja active Active
Also Published As
Publication number | Publication date |
---|---|
JP2018124699A (ja) | 2018-08-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Xue et al. | Performance analysis of active disturbance rejection tracking control for a class of uncertain LTI systems | |
JP6483775B2 (ja) | 座標測定機の可動部の位置決定 | |
JP5028630B2 (ja) | 位置決め機構の制御方法および制御装置 | |
JP7348977B2 (ja) | 変化するシステムパラメーターのリアルタイム補償を有する検査システム | |
CN103968789A (zh) | 利用递归滤波对坐标测量机的动态监视 | |
EP2985907B1 (en) | Motor drive device | |
Won et al. | Disturbance observer based backstepping for position control of electro-hydraulic systems | |
JP6966062B2 (ja) | 周波数応答解析アルゴリズム | |
Otto et al. | Real-time trajectory control of an overhead crane using servo-constraints | |
Dong et al. | An experimental investigation of the effects of the compliant joint method on feedback compensation of pre-sliding/pre-rolling friction | |
Wos et al. | Practical parallel position-force controller for electro-hydraulic servo drive using on-line identification | |
Vazquez et al. | Second order sliding mode control of a mobile hydraulic crane | |
Yang et al. | Spline adaptive filter with fractional-order adaptive strategy for nonlinear model identification of magnetostrictive actuator | |
Li et al. | Identification and adaptive robust precision motion control of systems with nonlinear friction | |
Marques et al. | Parameter estimation and performance comparison of friction models for pneumatic valves | |
Baeza et al. | Friction compensation in pneumatic control valves through feedback linearization | |
Kuresangsai et al. | Control of a nonlinear flexure-jointed XY positioning stage using LTV-FIR command prefiltering for finite-time error cancellation | |
JP6697313B2 (ja) | 送り軸制御装置における周波数特性測定方法 | |
Karim et al. | Control-based compensation of friction and backlash within rack-and-pinion drives | |
Ruderman et al. | On identification and sensorless control of nonlinear torsion in elastic robotic joints | |
Hoogerkamp et al. | Attenuation of disturbances introduced by dynamic links in precision motion systems using model-based observers | |
CN101943889A (zh) | 使电气传动系统调节器自动启动和/或运行的方法及装置 | |
JP6989099B2 (ja) | 周波数不感帯を抑制する周波数応答解析システム | |
Wang et al. | Vibration cancellation of semiconductor manufacturing robots | |
Ruderman et al. | Impact of hysteresis lost motion on the sensorless torsion control of elastic robotic joints |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20200108 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20201119 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20201201 |
|
A601 | Written request for extension of time |
Free format text: JAPANESE INTERMEDIATE CODE: A601 Effective date: 20210113 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20210311 |
|
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: 20211005 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20211014 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6966062 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |