JP6017595B2 - 振動を抑制するモータ制御装置 - Google Patents
振動を抑制するモータ制御装置 Download PDFInfo
- Publication number
- JP6017595B2 JP6017595B2 JP2015007219A JP2015007219A JP6017595B2 JP 6017595 B2 JP6017595 B2 JP 6017595B2 JP 2015007219 A JP2015007219 A JP 2015007219A JP 2015007219 A JP2015007219 A JP 2015007219A JP 6017595 B2 JP6017595 B2 JP 6017595B2
- Authority
- JP
- Japan
- Prior art keywords
- filter
- position command
- elastic deformation
- correction
- command
- 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
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P29/00—Arrangements for regulating or controlling electric motors, appropriate for both AC and DC motors
- H02P29/02—Providing protection against overload without automatic interruption of supply
- H02P29/024—Detecting a fault condition, e.g. short circuit, locked rotor, open circuit or loss of load
- H02P29/026—Detecting a fault condition, e.g. short circuit, locked rotor, open circuit or loss of load the fault being a power fluctuation
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/404—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control arrangements for compensation, e.g. for backlash, overshoot, tool offset, tool wear, temperature, machine construction errors, load, inertia
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/19—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41145—Digital filter for compensation of servo loop
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41251—Servo with spring, resilient, elastic element, twist
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41427—Feedforward of position
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Power Engineering (AREA)
- Control Of Electric Motors In General (AREA)
Description
まず、本発明の実施例1に係るモータ制御装置について説明する。本発明の実施例1に係るモータ制御装置では、最も簡単な振動モデルである二慣性系に対して、軌跡制御であることをふまえた指令補正を行う。本発明の実施例1に係るモータ制御装置で扱う二慣性系のモデルは図1のように表される。
次に、本発明の実施例2に係るモータ制御装置について説明する。制御ソフトウェアの実装の容易さを考えれば、位置指令に直接フィルタ処理を施すより、位置指令に加算する補正量として計算する方が容易な場合がある。そこで、実施例1で求めたフィルタ特性を、補正量の形に変更する。
・加速度指令(s2(ラプラス演算子つまり微分演算子の2乗)が付いているため、位置指令に対して2階微分した値)に、
・機械のイナーシャJLと弾性部のバネ定数Kから決まるゲインJL/Kを乗じた上で、
・ダンパ定数Cとバネ定数Kから決まる時定数τ=C/Kの1次ローパスフィルタを施す
という方法が考えられる。
次に本発明の実施例3に係るモータ制御装置について説明する。
2 サーボ制御部
3 第1減算器
4 位置制御器
5 フィードフォワード制御器
6 微分器
7 加算器
8 第2減算器
9 速度制御器
10 トルクからモータ速度までの伝達特性
11 第1積分器(モータ速度とモータ位置を結ぶ運動学的積分器)
12 トルクから機械速度までの伝達特性
13 第2積分器(機械速度と機械位置を結ぶ運動学的積分器)
30 バネ
40 ダンパ
100 モータ
101 モータ制御装置
200 機械
Claims (4)
- 弾性変形部により被駆動部と繋がれたサーボモータを制御するモータ制御装置において、
モータの位置を指令する位置指令作成部と、
前記位置指令作成部により作成された位置指令を補正する補正フィルタと、
前記補正フィルタにより補正された位置指令である補正後位置指令に基づいてモータの移動を制御するサーボ制御部と、を備え、
前記補正フィルタは、前記被駆動部のイナーシャJL、前記弾性変形部の剛性係数K、前記弾性変形部のダンパ係数Cをフィルタ係数の要素とするフィルタF(s)を含み、
前記補正フィルタに含まれるフィルタF(s)が
F(s)=(J L × s 2 + C × s + K)/(C × s + K)
で表される、
ことを特徴とするモータ制御装置。 - 前記位置指令にフィルタ
F(s)−1=(JL × s2 )/(C × s + K)
を施すことで演算する補正量差分を前記位置指令に加算することで、前記補正後位置指令を求める、請求項1に記載のモータ制御装置。 - 前記補正フィルタは、
位置指令から加速度指令を演算する加速度指令演算部と、
前記加速度指令演算部により出力される加速度指令に、被駆動部のイナーシャJLと弾性変形部の剛性係数Kとから求まるゲインJL/Kを乗じる第1補正量演算部と、
前記第1補正量演算部により出力される第1補正量に、弾性変形部のダンパ係数Cと弾性変形部の剛性係数Kとから求まる時定数C/Kの1次ローパスフィルタを施す第2補正量演算部と、を有し、
前記第2補正量演算部により出力される第2補正量を位置指令に加算することにより、前記フィルタF(s)を実現する、請求項2に記載のモータ制御装置。 - 被駆動部のイナーシャJLと弾性変形部の剛性係数Kとから求まるゲインJL/K及び弾性変形部のダンパ係数Cと弾性変形部の剛性係数Kとから求まる時定数C/Kの代わりに、周波数ω及び振動の減衰係数ζを入力することにより前記フィルタF(s)を実現する、請求項3に記載のモータ制御装置。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015007219A JP6017595B2 (ja) | 2015-01-16 | 2015-01-16 | 振動を抑制するモータ制御装置 |
DE102016000265.4A DE102016000265B4 (de) | 2015-01-16 | 2016-01-08 | Motorsteuervorrichtung mit Schwingungsunterdrückung |
CN201610027741.8A CN105811817B (zh) | 2015-01-16 | 2016-01-15 | 电动机控制装置 |
US14/996,515 US9766614B2 (en) | 2015-01-16 | 2016-01-15 | Motor controlling apparatus for suppressing vibrations |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015007219A JP6017595B2 (ja) | 2015-01-16 | 2015-01-16 | 振動を抑制するモータ制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2016134975A JP2016134975A (ja) | 2016-07-25 |
JP6017595B2 true JP6017595B2 (ja) | 2016-11-02 |
Family
ID=56293841
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2015007219A Active JP6017595B2 (ja) | 2015-01-16 | 2015-01-16 | 振動を抑制するモータ制御装置 |
Country Status (4)
Country | Link |
---|---|
US (1) | US9766614B2 (ja) |
JP (1) | JP6017595B2 (ja) |
CN (1) | CN105811817B (ja) |
DE (1) | DE102016000265B4 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10303152B2 (en) | 2017-06-21 | 2019-05-28 | Fanuc Corporation | Motor controller |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2016106047A1 (en) * | 2014-12-22 | 2016-06-30 | The Regents Of The University Of Michigan | Vibration-assisted positioning stage |
JP6386492B2 (ja) * | 2016-04-28 | 2018-09-05 | ファナック株式会社 | 高速計算される比例項にフィルタを付加したサーボ制御装置、サーボ制御方法及びサーボ制御プログラム |
JP6469171B2 (ja) * | 2017-06-14 | 2019-02-13 | ファナック株式会社 | 電動機の制御装置 |
JP6827565B2 (ja) * | 2017-12-20 | 2021-02-10 | 三菱電機株式会社 | 電動機の制御装置 |
WO2019138808A1 (ja) * | 2018-01-09 | 2019-07-18 | パナソニックIpマネジメント株式会社 | 電動機の制御装置 |
WO2021022146A1 (en) * | 2019-07-31 | 2021-02-04 | Ohio State Innovation Foundation | Device and method for controlling vibration with piecewise-linear nonlinearity |
JP7390643B2 (ja) * | 2019-10-30 | 2023-12-04 | ブラザー工業株式会社 | 振動抑制方法及び振動抑制装置 |
EP3825795A1 (en) * | 2019-11-19 | 2021-05-26 | Siemens Aktiengesellschaft | Online multi-force-adaption during machining |
JP7049729B2 (ja) * | 2020-03-30 | 2022-04-07 | 国立大学法人東海国立大学機構 | 切削装置および切削方法 |
DE102022129291A1 (de) | 2022-11-07 | 2024-05-08 | Arburg Gmbh + Co Kg | Verfahren zum Bewegen wenigstens eines Endeffektors |
Family Cites Families (33)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4139811A (en) * | 1976-10-26 | 1979-02-13 | Xerox Corporation | Method and means for increasing the stiffness of limited frequency servo systems |
JPH0199485A (ja) * | 1987-10-09 | 1989-04-18 | Toshiba Corp | サーボ電動機の制御装置 |
JPH01186182A (ja) * | 1988-01-19 | 1989-07-25 | Fanuc Ltd | サーボモータの制御装置 |
JPH07120216B2 (ja) * | 1988-10-21 | 1995-12-20 | 新技術事業団 | 位置制御方法 |
US5220262A (en) * | 1992-02-25 | 1993-06-15 | Cincinnati Milacron, Inc. | Method and apparatus for reducing cross-coupled movement through the structural dynamics of a computer numerically controlled machine |
JPH0683403A (ja) * | 1992-07-17 | 1994-03-25 | Fanuc Ltd | 適応pi制御方式 |
SE509443C2 (sv) * | 1997-05-15 | 1999-01-25 | Asea Brown Boveri | Förfarande för övervakning av en manipulators rörelsestyrning |
JP3802692B2 (ja) * | 1998-11-06 | 2006-07-26 | 日立ビアメカニクス株式会社 | サーボ制御装置 |
KR100450455B1 (ko) * | 2001-04-19 | 2004-10-01 | 도시바 기카이 가부시키가이샤 | 서보 제어 방법 |
US8050780B2 (en) * | 2001-11-06 | 2011-11-01 | Claude Tessier | Apparatus and method for controlling a force-activated controller |
JP4391218B2 (ja) | 2003-02-20 | 2009-12-24 | 三菱電機株式会社 | サーボ制御装置 |
JP4658181B2 (ja) * | 2003-02-20 | 2011-03-23 | 三菱電機株式会社 | サーボ制御装置 |
JP4340846B2 (ja) * | 2003-03-11 | 2009-10-07 | 株式会社安川電機 | 位置決め制御装置 |
US7265511B2 (en) * | 2003-03-17 | 2007-09-04 | Sanyo Denki Co., Ltd. | Motor control device |
JP2005174082A (ja) | 2003-12-12 | 2005-06-30 | Yaskawa Electric Corp | 位置決め制御装置 |
WO2008075558A1 (ja) * | 2006-12-21 | 2008-06-26 | Kabushiki Kaisha Yaskawa Denki | 位置制御装置 |
JP5112100B2 (ja) | 2008-01-09 | 2013-01-09 | 三菱重工業株式会社 | サーボ制御装置 |
JP5092831B2 (ja) * | 2008-03-21 | 2012-12-05 | 富士電機株式会社 | 位置決め制御装置 |
JP4737222B2 (ja) * | 2008-04-18 | 2011-07-27 | トヨタ自動車株式会社 | 車両用サスペンションシステム |
US8076893B2 (en) * | 2008-09-04 | 2011-12-13 | The Board Of Trustees Of The University Of Illinois | Displacement actuation and sensing for an electrostatic drive |
US8120303B2 (en) | 2008-09-29 | 2012-02-21 | Oriental Motor Co., Ltd. | Method and apparatus for controlling inertial system |
RU2605816C9 (ru) * | 2008-10-09 | 2017-05-10 | Ньюкасл Инновейшн Лимитед | Система и способ позиционирования |
GB2467184A (en) * | 2009-01-27 | 2010-07-28 | Illinois Tool Works | Load testing apparatus |
JP5308249B2 (ja) | 2009-06-22 | 2013-10-09 | 三菱重工業株式会社 | サーボ制御装置 |
DE112011104448B4 (de) * | 2010-12-20 | 2021-05-06 | Mitsubishi Electric Corp. | Motorsteuerungsvorrichtung |
US8855826B2 (en) * | 2011-04-25 | 2014-10-07 | Mitsubishi Electric Research Laboratories, Inc. | Controller for reducing vibrations in mechanical systems |
CN102570956B (zh) * | 2012-02-17 | 2014-08-20 | 南京国电环保设备有限公司 | 一种基于谐振抑制的直流电机控制方法 |
US8860352B2 (en) * | 2012-05-10 | 2014-10-14 | Mitsubishi Electric Research Laboratories, Inc. | System and method for controlling actuators |
JP6322195B2 (ja) * | 2012-08-31 | 2018-05-09 | シエル・インターナシヨネイル・リサーチ・マーチヤツピイ・ベー・ウイShell Internationale Research Maatschappij Besloten Vennootshap | 可変速度駆動システム、可変速度駆動システムの運転方法、および炭化水素流の冷却方法 |
JP6037888B2 (ja) * | 2013-02-22 | 2016-12-07 | 三菱重工メカトロシステムズ株式会社 | 制振装置 |
JP5689491B2 (ja) * | 2013-03-05 | 2015-03-25 | ファナック株式会社 | サーボモータの制御装置 |
US9529341B2 (en) * | 2013-10-25 | 2016-12-27 | Mitsubishi Electric Research Laboratories, Inc. | Motion-control system for performing different tasks |
JP6209176B2 (ja) * | 2014-04-14 | 2017-10-04 | オークマ株式会社 | 位置制御装置 |
-
2015
- 2015-01-16 JP JP2015007219A patent/JP6017595B2/ja active Active
-
2016
- 2016-01-08 DE DE102016000265.4A patent/DE102016000265B4/de active Active
- 2016-01-15 CN CN201610027741.8A patent/CN105811817B/zh active Active
- 2016-01-15 US US14/996,515 patent/US9766614B2/en active Active
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10303152B2 (en) | 2017-06-21 | 2019-05-28 | Fanuc Corporation | Motor controller |
DE102018209284B4 (de) * | 2017-06-21 | 2020-10-01 | Fanuc Corporation | Motorsteuereinrichtung |
Also Published As
Publication number | Publication date |
---|---|
CN105811817A (zh) | 2016-07-27 |
US20160209829A1 (en) | 2016-07-21 |
DE102016000265B4 (de) | 2022-08-04 |
JP2016134975A (ja) | 2016-07-25 |
DE102016000265A1 (de) | 2016-07-21 |
CN105811817B (zh) | 2018-02-09 |
US9766614B2 (en) | 2017-09-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6017595B2 (ja) | 振動を抑制するモータ制御装置 | |
JP4391218B2 (ja) | サーボ制御装置 | |
JP3739749B2 (ja) | 制御装置 | |
JP5374613B2 (ja) | 多関節ロボットの弾性変形補償制御装置および制御方法 | |
JP5791815B2 (ja) | 工作機械の送り軸制御方法および送り軸制御装置 | |
JP4944806B2 (ja) | 位置制御装置 | |
US20090160389A1 (en) | Method and device for guiding the movement of a moveable machine element of a machine | |
JP2017175890A (ja) | 振動を抑制する機能を有するモータ制御装置 | |
CN111095132B (zh) | 伺服控制装置 | |
JP2016163397A (ja) | 振動を抑制する機能を備えたモータ制御装置 | |
JP4867105B2 (ja) | 数値制御装置 | |
WO2013140679A1 (ja) | 軌跡制御装置 | |
JP5943650B2 (ja) | サーボ制御装置及びサーボ制御方法 | |
JP6412071B2 (ja) | モータ制御装置、モータ制御方法及びモータ制御用プログラム | |
JP5642214B2 (ja) | 多関節ロボットの弾性変形補償制御装置 | |
JP2016045549A (ja) | 位置制御装置 | |
JP4658181B2 (ja) | サーボ制御装置 | |
JP2014007900A (ja) | モータ制御装置 | |
JP3943061B2 (ja) | サーボ制御装置 | |
JP6496167B2 (ja) | タンデム位置制御装置 | |
JP6340160B2 (ja) | 送り駆動系の設計方法 | |
US12064843B2 (en) | Motor control device and industrial machine for suppressing vibration | |
JP2022134526A (ja) | 工作機械および工作機械用制御装置 | |
JP5084196B2 (ja) | 電動機制御装置および電動機制御方法 | |
JP7183489B1 (ja) | 電動機制御装置及び機械装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20160524 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20160714 |
|
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: 20160906 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20160928 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6017595 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |