JP5156886B2 - 位置制御装置 - Google Patents
位置制御装置 Download PDFInfo
- Publication number
- JP5156886B2 JP5156886B2 JP2007052143A JP2007052143A JP5156886B2 JP 5156886 B2 JP5156886 B2 JP 5156886B2 JP 2007052143 A JP2007052143 A JP 2007052143A JP 2007052143 A JP2007052143 A JP 2007052143A JP 5156886 B2 JP5156886 B2 JP 5156886B2
- Authority
- JP
- Japan
- Prior art keywords
- disturbance
- jerk
- acceleration
- command
- circuit
- 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
- 230000001133 acceleration Effects 0.000 claims description 43
- 230000036461 convulsion Effects 0.000 claims description 40
- 230000002068 genetic effect Effects 0.000 claims description 8
- 230000006870 function Effects 0.000 description 25
- 238000000034 method Methods 0.000 description 13
- 230000004044 response Effects 0.000 description 9
- 238000010586 diagram Methods 0.000 description 8
- 230000001629 suppression Effects 0.000 description 3
- 238000012546 transfer Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 238000000354 decomposition reaction Methods 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000006866 deterioration Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 230000001902 propagating effect Effects 0.000 description 1
- 230000001052 transient effect Effects 0.000 description 1
Images
Landscapes
- Feedback Control In General (AREA)
- Control Of Position Or Direction (AREA)
- Control Of Electric Motors In General (AREA)
- Numerical Control (AREA)
Description
このように、帯域制限を受けることのない外乱推定を行い、それをあらゆる駆動条件下で補償する制御手法は今日まで存在していない。
まず、図1に基づいてボールねじ駆動テーブル装置の構成を説明する。
本システムでは、ボールねじ10によってテーブル11(移動体)を駆動する駆動手段としてACサーボモータ12を使用し、このモータ2の端部に設置されたエンコーダ13(例えば17bit絶対値シリアルエンコーダ)によって得られるモータ位置情報を用いて、テーブル11上に設置された負荷装置14の位置決め制御を実施する。テーブル11は、リニアガイド15に沿って移動する際に摩擦力を受け、負荷装置14に機構振動が発生すると共に、高加減速を実現するモータトルクの反力が機台振動を励起し、位置決め性能を低下させる。
反復学習とは、目標応答と実際の応答との誤差に対し、指令更新則を施して繰り返し試行することで、制御系の応答を目標応答に一致させる指令を生成する手法である。特徴として、周波数領域におけるオフライン演算を行うため、各信号のゲイン、位相情報に対して任意の処理を施すことができ、位相遅れのないフィルタを実現できる。その反面、この手法は同一条件下の動作時のみに適用可能という制約がある。
図3に示す推定トルクの波形は、図10に示す反復学習による外乱推定システムによって算出された推定トルクと、移動体の位置との関係を示したものである。
図3に示す外乱補償量の波形は、上記推定トルクから遺伝的アルゴリズムを用いて、図9に示す外乱補償回路21で使用するパラメータを同定し、その同定結果を代入した外乱補償回路21の出力Disを示したものである。
図3に示す位置成分の波形は、図9に示す外乱補償回路21内の位置外乱推定回路22の出力を示したものである。
尚、図3より、各目標位置に整定後も作用している一定の外乱は非線形ばね要素によるものであり、過渡応答時には位置に依存した複雑な特性を示す。この複雑な特性を示す複雑なモデルを汎用的な関数に置換することは困難であるため、上記位置成分を次の(1)式で示す位置外乱推定回路22に実装された時間関数モデルによって近似する。
次に、図4を用いて推定外乱の速度特性を説明する。図4は、移動体(テーブル11)を20mmストローク駆動した場合と100mmストローク駆動した場合の推定トルク、外乱補償量及び速度成分を、横軸を速度[rad/s]、縦軸をトルク[Nm]としてグラフ化したものである。
図4に示す推定トルクの波形は、図10に示す反復学習による外乱推定システムによって算出された推定トルクと、移動体の速度との関係を示したものである。
図4に示す外乱補償量の波形は、上記推定トルクから遺伝的アルゴリズムを用いて、図9に示す外乱補償回路21で使用するパラメータを同定し、その同定結果を代入した外乱補償回路21の出力Disを示したものである。
図4に示す速度成分の波形は、図9に示す外乱補償回路21内の速度外乱推定回路23の出力を示したものである。
尚、図4より、速度に比例した外乱(粘性摩擦力に相当)が作用していることが分かる。図4から、完全な比例特性ではなく指数関数的な速度特性と捉えることができるため、上記速度成分を次の(2)式で示す速度外乱推定回路22に実装された速度関数モデルによって近似する。
次に、図5を用いて推定外乱の加速度特性を説明する。図5は、移動体(テーブル11)を20mmストローク駆動した場合と100mmストローク駆動した場合の推定トルク、外乱補償量及び加速度成分を、横軸を加速度[rad/s 2 ]、縦軸をトルク[Nm]としてグラフ化したものである。
図5に示す推定トルクの波形は、図10に示す反復学習による外乱推定システムによって算出された推定トルクと、移動体の加速度との関係を示したものである。
図5に示す外乱補償量の波形は、上記推定トルクから遺伝的アルゴリズムを用いて、図9に示す外乱補償回路21で使用するパラメータを同定し、その同定結果を代入した外乱補償回路21の出力Disを示したものである。
図5に示す加速度成分の波形は、図9に示す外乱補償回路21内の加速度外乱推定回路24の出力を示したものである。
尚、図5より、加速度が負の領域から正の領域に向けて推定外乱が右肩下がりに傾いていることが分かる。この傾きは、既約分解表現に基づくフィードフォワード補償器設計モデルと実際の制御対象の慣性値及びトルク定数の誤差の影響によるものである。そこで、上記加速度成分を次の(3)式で示す加速度外乱推定回路24に実装された加速度関数モデルによって近似する。
次に、図6を用いて推定外乱の加加速度特性を説明する。図6は、移動体(テーブル11)を20mmストローク駆動した場合と100mmストローク駆動した場合の推定トルク、外乱補償量及び加加速度成分を、横軸を加加速度[rad/s 3 ]、縦軸をトルク[Nm]としてグラフ化したものである。
図6に示す推定トルクの波形は、図10に示す反復学習による外乱推定システムによって算出された推定トルクと、移動体の加加速度との関係を示したものである。
図6に示す外乱補償量の波形は、上記推定トルクから遺伝的アルゴリズムを用いて、図9に示す外乱補償回路21で使用するパラメータを同定し、その同定結果を代入した外乱補償回路21の出力Disを示したものである。
図6に示す加加速度成分の波形は、図9に示す外乱補償回路21内の加加速度外乱推定回路25の出力を示したものである。
本実施例では、推定外乱の位置特性を近似した上記(1)式の時間関数モデルを実装した位置外乱推定回路22と、推定外乱の速度特性を近似した上記(2)式の速度関数モデルを実装した速度外乱推定回路23と、推定外乱の加速度特性を近似した上記(3)式の加速度関数モデルを実装した加速度外乱推定回路24と、推定外乱の加加速度特性を近似した上記(4)式の加加速度関数モデルを実装した加加速度外乱推定回路25とを組み合わせて外乱補償回路21を構成する。例えば、外乱補償回路21の出力値である外乱補償量Disは次式(5)で表される。
Claims (2)
- 移動体を駆動する駆動手段を制御する位置制御装置において、
あらゆる動作条件下で得られる外乱補償量を算出できるように遺伝的アルゴリズムを用いて同定されたパラメータを持ち、前記位置制御装置への入力である位置指令、速度指令、加速度指令及び加加速度指令を入力して、前記外乱補償量を関数モデルにより算出して前記駆動手段への入力に足し合わせることで外乱を補償する外乱補償回路を備え、
前記外乱補償回路は、外乱の位置特性を近似した時間関数モデルを実装した位置外乱推定回路と、外乱の速度特性を近似した速度関数モデルを実装した速度外乱推定回路と、外乱の加速度特性を近似した加速度関数モデルを実装した加速度外乱推定回路と、外乱の加加速度特性を近似した加加速度関数モデルを実装した加加速度外乱推定回路とから構成され、前記各推定回路は、それぞれ前記位置制御装置への入力である位置指令、速度指令、加速度指令、加加速度指令を入力とし、各推定回路の出力の和を前記外乱補償量とすることを特徴とする位置制御装置。 - 前記あらゆる動作条件下で得られる各々の外乱補償量を算出するパラメータの同定は、オフラインで実行することを特徴とする請求項1に記載の位置制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007052143A JP5156886B2 (ja) | 2007-03-02 | 2007-03-02 | 位置制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007052143A JP5156886B2 (ja) | 2007-03-02 | 2007-03-02 | 位置制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2008217279A JP2008217279A (ja) | 2008-09-18 |
JP5156886B2 true JP5156886B2 (ja) | 2013-03-06 |
Family
ID=39837266
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2007052143A Active JP5156886B2 (ja) | 2007-03-02 | 2007-03-02 | 位置制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5156886B2 (ja) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5411687B2 (ja) * | 2009-12-28 | 2014-02-12 | 川崎重工業株式会社 | ロボットの制御装置 |
JP6091523B2 (ja) * | 2012-12-11 | 2017-03-08 | 三菱電機株式会社 | サーボ制御装置 |
JP6255716B2 (ja) * | 2013-05-24 | 2018-01-10 | 株式会社ノーリツ | 制御装置および給湯システムの制御装置 |
JP6417231B2 (ja) * | 2015-02-04 | 2018-10-31 | オークマ株式会社 | 位置制御装置 |
JP7219115B2 (ja) * | 2018-08-13 | 2023-02-07 | Thk株式会社 | 外乱抑止制御装置 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06274227A (ja) * | 1993-03-19 | 1994-09-30 | Nippon Telegr & Teleph Corp <Ntt> | 制御対象物の補償トルク算出方法 |
JP3805309B2 (ja) * | 2003-01-30 | 2006-08-02 | ファナック株式会社 | サーボモータ駆動制御装置 |
JP4301491B2 (ja) * | 2003-02-05 | 2009-07-22 | 富士機械製造株式会社 | 電動機制御システムの自律設計方法及び自律設計装置並びに電動機制御システム |
US7209219B2 (en) * | 2003-03-06 | 2007-04-24 | Asml Netherlands B.V. | System for controlling a position of a mass |
JP2006042473A (ja) * | 2004-07-26 | 2006-02-09 | Fuji Mach Mfg Co Ltd | 電動機制御システムの自律設計方法 |
-
2007
- 2007-03-02 JP JP2007052143A patent/JP5156886B2/ja active Active
Also Published As
Publication number | Publication date |
---|---|
JP2008217279A (ja) | 2008-09-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5028630B2 (ja) | 位置決め機構の制御方法および制御装置 | |
US9166512B2 (en) | Motor control device provided with feedforward control | |
JP5156886B2 (ja) | 位置制御装置 | |
JP4697139B2 (ja) | サーボ制御装置 | |
JP2013128387A (ja) | イナーシャと摩擦係数とばね定数を同時に推定する機能を備える電動機の制御装置 | |
JP5302639B2 (ja) | サーボ制御装置 | |
JP2014136260A (ja) | 制御装置 | |
WO2021225150A1 (en) | Method and computing system for estimating parameter for robot operation | |
JP2006227793A (ja) | 電動機制御装置の制御パラメータ感度解析装置および電動機制御装置の制御パラメータ設定方法 | |
JP2006227793A5 (ja) | ||
TWI516888B (zh) | 伺服控制裝置 | |
JP5441944B2 (ja) | モータ制御装置 | |
JP5924290B2 (ja) | モータ制御装置 | |
Mitsantisuk et al. | Parameter estimation of flexible robot using multi-encoder based on disturbance observer | |
JP7120821B2 (ja) | 制御装置、制御方法及びプログラム | |
JP2002258922A (ja) | 数値制御システム | |
US6975086B1 (en) | Positioning control method | |
Hur et al. | Joint torque servo of a high friction robot manipulator based on time-delay control with feed-forward friction compensation | |
JP5017720B2 (ja) | 位置制御装置 | |
JP4038659B2 (ja) | サーボ制御装置 | |
CN109844477B (zh) | 外力检测方法 | |
JP4078396B2 (ja) | 位置決め制御装置 | |
Mamani et al. | Robust position control of a DC motor by sliding mode | |
KR102558850B1 (ko) | 모터 구동 장치 | |
Yoo et al. | Identification of mechanical parameters for position-controlled servo systems using sinusoidal commands |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20091204 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20100707 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20100730 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20100910 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20110223 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20110404 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20111011 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20111122 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20111129 |
|
A911 | Transfer to examiner for re-examination before appeal (zenchi) |
Free format text: JAPANESE INTERMEDIATE CODE: A911 Effective date: 20111220 |
|
A912 | Re-examination (zenchi) completed and case transferred to appeal board |
Free format text: JAPANESE INTERMEDIATE CODE: A912 Effective date: 20120224 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20120730 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20120824 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5156886 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20151221 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20151221 Year of fee payment: 3 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
S533 | Written request for registration of change of name |
Free format text: JAPANESE INTERMEDIATE CODE: R313533 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |