JPH10275003A - 2慣性共振系を制御する方法及びその装置 - Google Patents

2慣性共振系を制御する方法及びその装置

Info

Publication number
JPH10275003A
JPH10275003A JP10078095A JP7809598A JPH10275003A JP H10275003 A JPH10275003 A JP H10275003A JP 10078095 A JP10078095 A JP 10078095A JP 7809598 A JP7809598 A JP 7809598A JP H10275003 A JPH10275003 A JP H10275003A
Authority
JP
Japan
Prior art keywords
load
speed
estimated
torque
motor
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.)
Pending
Application number
JP10078095A
Other languages
English (en)
Inventor
Jun Hyok Kang
俊赫 姜
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.)
Samsung Electronics Co Ltd
Original Assignee
Samsung Electronics 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 Samsung Electronics Co Ltd filed Critical Samsung Electronics Co Ltd
Publication of JPH10275003A publication Critical patent/JPH10275003A/ja
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B11/00Automatic controllers
    • G05B11/01Automatic controllers electric
    • G05B11/36Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
    • G05B11/42Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B5/00Anti-hunting arrangements
    • G05B5/01Anti-hunting arrangements electric
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D19/00Control of mechanical oscillations, e.g. of amplitude, of frequency, of phase
    • G05D19/02Control of mechanical oscillations, e.g. of amplitude, of frequency, of phase characterised by the use of electric means

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Control Of Electric Motors In General (AREA)
  • Feedback Control In General (AREA)

Abstract

(57)【要約】 【課題】 駆動手段及び負荷が柔軟性と強性を有する軸
に連結された2慣性共振系での振動を抑制する。 【解決手段】 駆動手段のトルクと位置をそれぞれ検出
して負荷側の速度及び外乱トルクを推定し、該推定され
た負荷側の速度と外乱トルクにより負荷の加速度を推定
し、且つ負荷の基準速度と推定された負荷側の速度との
差を用いてPI制御して2慣性共振系を振動なしに安定
に制御する。

Description

【発明の詳細な説明】
【0001】
【発明の属する技術分野】本発明は、2慣性共振系を制
御する方法及びその装置に係るもので、特に状態観測器
を用いて2慣性共振系の振動を抑制する方法及びその装
置に関する。
【0002】
【従来の技術】図2に示したように、二つの慣性モーメ
ント、即ちモータと負荷が柔軟性(spring)と強性を有
する軸に連結された2慣性共振系はロボットの柔軟関
節、フレキシブルアーム、及び宇宙構造物などで第1近
似モデルとして相当に重要である。この図において、θ
はモータ軸の位置、ωはモータ軸の速度、θLは負荷の
位置、ωLは負荷の速度、そしてTeはモータのトルクを
示している。
【0003】前記2慣性共振系の動的モデルは図3に示
したようである。ここで、モータの位置と実際負荷の位
置との差により発生されるねじりトルク(Torsional To
rque:TT)がモータ側に負荷トルクとして作用し、モ
ータの電気的な発生トルク(u)とねじりトルク
(TT)との差がモータの実際回転速度(ω)を決定す
る。又、前記ねじりトルク(TT)は負荷側に負荷トル
クとして作用するため、ねじりトルク(TT)が外部か
ら印加する外乱トルク(TL)に加算されて実際負荷速
度(ωL)が決定される。
【0004】このような2慣性系はモータと実際の負荷
が柔軟性と強性を有する軸に連結されるに従い急激な加
速及び減速をする場合、モータの位置及び速度と、実際
負荷の位置及び速度が相互異なるようになる。それで、
通常の方法によりモータの駆動速度を制御すると、シス
テムの安定性が低下し、振動が発生する。
【0005】図4は、PI(Proportional Integral)
制御器を使用した従来2慣性共振系の制御システムを示
した図である。ここで、符号20は前記図3においてモ
デリングされた2慣性共振系で、符号10はPI制御器
である。前記PI制御器10に帰還される速度は制御対
象の実際負荷側の速度(ωL)でなく、センサにより検
出されたモータ側の速度(ω)である場合が大部分であ
る。
【0006】即ち、従来PI制御器10は、モータ側に
付着されたセンサにより検出されたモータの速度(ω)
が帰還されて負荷側の基準速度(ω*)との誤差が演算
され、該演算された誤差はPI制御器10を通過して誤
差に比例する成分KPと誤差の積分に比例する成分KI
の和が演算される。該演算されたPI制御器10の出力
はモータが発生するトルク命令として入力される。
【0007】前記モータがトルク命令に該当するトルク
(u)を発生すると、負荷側の実際速度(ωL)とモー
タの速度(ω)が図3に示した2慣性共振系のダイナミ
ックスにより決定され、再びモータの速度(ω)はセン
サにより検出されて負荷側の基準速度(ω*)との誤差
演算のため帰還される。
【0008】このような従来の制御方式においてPI制
御器10に帰還される速度が制御対象の実際負荷側の速
度でなく、駆動部のモータ側に付着されたセンサにより
検出されたモータの速度である。
【0009】
【発明が解決しようとする課題】従って、モータと実際
負荷が柔軟性と強性を有する軸に連結されるに従い急激
な加速及び減速をする場合、モータの位置及び速度と、
実際負荷の位置及び速度との差が発生し、該発生された
差によりねじりトルクがモータに負荷トルクとして作用
して振動が発生することにより、システムが不安定にな
るという問題点があった。
【0010】本発明の目的は、上述のようにPI制御器
のみを用いた2慣性共振系の制御に際して、振動発生に
よりシステム性能が低下される問題点を解決するため、
状態観測器を通じて負荷側速度及び外乱トルクを推定
し、該推定された負荷側情報により振動発生を抑制させ
得る2慣性共振系の振動抑制方法及びその装置を提供し
ようとするものである。
【0011】
【課題を解決するための手段】このような目的を達成す
るため本発明は、駆動手段のトルクと位置をそれぞれ検
出して負荷側の速度及び外乱トルクを推定し、該推定さ
れた負荷側の速度と外乱トルクにより負荷の加速度を推
定し、且つ負荷の基準速度と推定された負荷側の速度と
の差を用いてPI制御して2慣性共振系を振動なしに安
定に制御するものであって、その振動制御方法は、駆動
手段の電気的な発生トルク及び位置をそれぞれ検出して
負荷側の速度及び外乱トルクを推定する推定段階と、前
記負荷側の速度及び外乱トルク推定段階で推定された負
荷側速度及び外乱トルク情報により負荷の加速度を推定
し該推定された駆動手段の速度と負荷基準速度との差を
用いてPI制御するPI制御段階と、前記負荷の加速度
推定及びPI制御段階で推定された負荷加速度とPI制
御された負荷基準速度との差を用いて前記駆動手段を制
御する制御段階と、からなり、振動抑制装置は、駆動手
段及び負荷が柔軟性と強性を有する軸に連結された2慣
性共振系と、前記駆動手段のトルクと駆動手段の位置を
検出して負荷側の速度及び外乱トルクを推定する状態観
測器と、該状態観測器を通じて推定された負荷側の速度
と外乱トルクにより負荷の加速度を推定する負荷加速度
推定器と、負荷基準速度と推定された負荷側の速度との
差をPI制御するPI制御器と、を具備することを特徴
とする。
【0012】
【発明の実施の形態】以下、本発明の実施の形態を説明
する。図1は、本発明に係る振動抑制装置が具備された
2慣性共振系の動的モデルを示した図である。ここで、
符号110は二つの慣性モーメントが柔軟性と強性を有
する軸に連結された2慣性共振系、符号120はモータ
のトルク(u)と位置を検出して負荷側の速度(ωL
及び外乱トルク(TL)を推定する状態観測器、符号1
30は前記状態観測器120を通じて推定された外乱ト
ルクと推定されたねじりトルクにより負荷の加速度を推
定する負荷加速度推定器、符号140は負荷の基準速度
(ω*)と負荷の推定された速度(ωL)との差によりP
I制御するPI制御器をそれぞれ示す。
【0013】このような発明は2慣性共振系110の外
乱トルク(TL)が時間に対し一定で、負荷速度
(ωL)、外乱トルク(TL)、モータ速度(ω)、及び
ねじりトルク(TT)を状態変数に取り、モータの発生
トルク(Te)を入力とし、モータ速度(ω)を検出の
可能な出力として仮定すると、2慣性共振系は数1のよ
うな状態方程式に示すことができる。
【0014】
【数1】
【0015】前記数1の常数及び変数は数2のようであ
る。
【0016】
【数2】 前記数2でJはモータ慣性モーメントを示し、JLは負
荷慣性モーメントを示し、Kは強性(stiffness)係数
を示す。
【0017】上述の2慣性共振系110の状態方程式で
本発明に従う全次元観測器(Full order observer)を
包含した状態方程式は次の数3のようである。
【0018】
【数3】
【0019】数3でx^・(”x”の上に”^”を、さ
らにその上に”・”をつけた記号を表すものとする)は
推定状態で、Lは観測者利得行列であって、x^・及び
Lは数4のように定義することができる。
【0020】
【数4】
【0021】前記数4の定義下で数2及び数3を用いて
数4を数5のように示すことができる(ここで、BL
非常に小さい値であるから無視する。)
【0022】
【数5】
【0023】前記数4において観測者利得行列Lの設定
方法を説明する。まず、行列A−LCTの特性多項式△
(s)は数6のように求めることができる。
【0024】
【数6】
【0025】ここで、特性多項式△(s)が4重根s=
−λ及びλ>0を有するように観測者利得を設定する。
すると、次の数7の関係が満足されるべきである。
【0026】
【数7】
【0027】
【数8】
【0028】前記数5で演算されたねじりトルク推定値
T^(”TT”の上に”^”をつけた記号を表すものと
する)及び外乱トルク推定値TL^(”TL”の上に”
^”をつけた記号を表すものとする)と前記数1を用い
て負荷加速度推定値ωL^・・(”ω”の上に”^”を、
さらにその上に”・・”をつけた記号を表すものとする)
を求めると、数9のようである。
【0029】
【数9】
【0030】前記数5及び数9から演算された負荷速度
推定値ωL^(”ωL”の上に”^”をつけた記号を表す
ものとする)と負荷加速度推定値ωL^・・(”ω”の上
に”^”を、さらにその上に”・・”をつけた記号を表す
ものとする)を用いて2慣性共振系の振動を減らす本発
明の制御器は既存のPI制御器と、負荷加速度微分値帰
還分と、観測速度の帰還分とが結合された形態として次
の数10に与えられる。
【0031】
【数10】 ここで、KP、KI、KLはそれぞれ速度比例利得、積分
利得、及び負荷加速度微分値帰還利得を示す。
【0032】前記数10で実際計算速度帰還分に比べ観
測速度帰還分は速度計算上の誤差による高周波振動を減
衰させる役割をし、−KLωL^・・(”ω”の上に”^”
を、さらにその上に”・・”をつけた記号を表すものとす
る)は外乱トルクに起因する振動現象、及びモータ位置
と負荷位置間の差によりモータに印加されるねじりトル
クに起因する振動現象を減らす役割をする。
【0033】結局、2慣性共振系の振動を減らすための
制御器は数5、数8、数9、及び数10に与えられる。
【0034】
【発明の効果】以上説明したように本発明は、観測者理
論を用いて負荷側の速度及び外乱トルクを推定し、該推
定された負荷側の情報を用いて2慣性共振系を振動なし
に安定に制御できるから、各種産業用電気機器に適用す
るとき最も安定な性能を有することができるという効果
がある。
【図面の簡単な説明】
【図1】 本発明によるPI制御器を用いた2慣性共振
系の動的モデルを示した図である。
【図2】 一般の2慣性共振系を示した図である。
【図3】 図2に示した2慣性共振系の動的モデルを示
した図である。
【図4】 従来PI制御器を用いた2慣性共振系の動的
モデルを示した図である。
【符号の説明】
110 2慣性共振系 120 状態観測器 130 負荷加速度推定器 140 PI制御器 整理番号 F04996A1

Claims (2)

    【特許請求の範囲】
  1. 【請求項1】 駆動手段の電気的な発生トルク及び位置
    をそれぞれ検出して負荷側の速度及び外乱トルクを推定
    する推定段階と、 前記推定段階で推定された負荷側速度及び外乱トルク情
    報により負荷の加速度を推定し該推定された負荷側の速
    度と負荷基準速度との差を用いてPI制御するPI制御
    段階と、 前記推定段階及びPI制御段階で推定された負荷加速度
    とPI制御された負荷基準速度との差を用いて前記駆動
    手段を制御する制御段階と、からなることを特徴とする
    2慣性共振系の振動抑制方法。
  2. 【請求項2】 駆動手段及び負荷が柔軟性と強性(stif
    fness)を有する軸に連結された2慣性共振系と、 前記駆動手段のトルクと駆動手段の位置を検出して負荷
    側の速度及び外乱トルクを推定する状態観測器と、 該状態観測器を通じて推定された負荷側の速度と外乱ト
    ルクにより負荷の加速度を推定する負荷加速度推定器
    と、 負荷基準速度と推定された負荷側の速度との差をPI制
    御するPI制御器と、を具備することを特徴とする2慣
    性共振系の振動抑制装置。
JP10078095A 1997-03-25 1998-03-25 2慣性共振系を制御する方法及びその装置 Pending JPH10275003A (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
KR1019970010313A KR100237306B1 (ko) 1997-03-25 1997-03-25 2관성 공진계의 진동 억제방법 및 장치
KR199710313 1997-03-25

Publications (1)

Publication Number Publication Date
JPH10275003A true JPH10275003A (ja) 1998-10-13

Family

ID=19500693

Family Applications (1)

Application Number Title Priority Date Filing Date
JP10078095A Pending JPH10275003A (ja) 1997-03-25 1998-03-25 2慣性共振系を制御する方法及びその装置

Country Status (3)

Country Link
US (1) US5959422A (ja)
JP (1) JPH10275003A (ja)
KR (1) KR100237306B1 (ja)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6876168B1 (en) * 1999-05-20 2005-04-05 National University Of Singapore Disturbance attenuation in a precision servomechanism by a frequency-separated acceleration soft sensor
CN112405554A (zh) * 2020-11-06 2021-02-26 上海傅利叶智能科技有限公司 用于机器人低刚度运动控制的方法、装置和康复机器人
CN108762083B (zh) * 2018-06-13 2021-04-02 长春萨米特光电科技有限公司 一种基于加速度观测器的自动控制系统

Families Citing this family (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4131079B2 (ja) * 2000-07-12 2008-08-13 株式会社安川電機 インバータ装置およびその電流制限方法
JP3815545B2 (ja) * 2001-02-07 2006-08-30 株式会社安川電機 振動抑制位置決め制御装置
US6900609B2 (en) * 2001-03-14 2005-05-31 Siemens Aktiengesellschaft Method and control structure for damping low-frequency load oscillations in drives with a motor and load
FR2825485B1 (fr) * 2001-05-29 2005-02-18 Alstom Procede et dispositif de controle de vitesse angulaire d'une chaine electromecanique peu amortie
DE10135220B4 (de) * 2001-07-24 2007-06-14 Fisw Steuerungstechnik Gmbh Antriebssystem sowie Verfahren zur Bestimmung der Bandbreite eines solchen Antriebssystems
US6844693B2 (en) * 2002-03-29 2005-01-18 Matsushita Electric Industrial Co., Ltd. Position control apparatus for motor
US7960931B2 (en) * 2007-06-15 2011-06-14 Illinois Institute Of Technology Digital control of motor drives
JP4540727B2 (ja) * 2008-07-31 2010-09-08 山洋電気株式会社 モータ制御装置
US8251279B2 (en) * 2009-06-30 2012-08-28 Hewlett-Packard Development Company, L.P. Variable data barcode
AT510041B1 (de) * 2011-02-09 2012-01-15 Seibt Kristl & Co Gmbh Verfahren und vorrichtung zur simulation eines translatorisch oder rotatorisch bewegten körpers
JP6399866B2 (ja) * 2014-09-03 2018-10-03 オークマ株式会社 サーボ制御装置
CN107450588B (zh) * 2017-09-29 2018-06-22 北京航空航天大学 一种挠性航天器姿态控制系统的强抗扰控制方法
CN108628329B (zh) * 2018-03-19 2020-06-09 北京航空航天大学 一种测控链路受回放攻击的航天器抗干扰姿控方法
CN110134004B (zh) * 2019-04-09 2022-08-23 上海电力学院 一种基于电力弹簧电路结构的pi控制参数整定方法
CN114204866B (zh) * 2021-12-16 2024-01-16 上海氢恒汽车电子有限公司 一种永磁同步电机的转子速度和位置确定方法

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05176580A (ja) * 1991-10-15 1993-07-13 Hitachi Ltd モータの制御装置
JPH06161507A (ja) * 1992-11-25 1994-06-07 Toyo Electric Mfg Co Ltd 制御装置
JPH0715991A (ja) * 1993-06-25 1995-01-17 Hitachi Ltd モータ制御装置

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05216504A (ja) * 1992-02-06 1993-08-27 Fanuc Ltd バネ系を含む制御対象に対する適応的スライディングモード制御方式
JP3235242B2 (ja) * 1992-11-30 2001-12-04 株式会社明電舎 2慣性ねじり振動系の速度制御におけるイナーシャ推定方法
JP3227000B2 (ja) * 1993-01-21 2001-11-12 株式会社日立製作所 モータの速度制御装置
JPH07170777A (ja) * 1993-12-14 1995-07-04 Fuji Electric Co Ltd 電動機の振動抑制制御装置
EP0676681B1 (en) * 1994-04-04 1999-11-10 Kabushiki Kaisha Meidensha Inertia lowering control apparatus for suppressing axial torsional vibration in two-mass resonant system

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05176580A (ja) * 1991-10-15 1993-07-13 Hitachi Ltd モータの制御装置
JPH06161507A (ja) * 1992-11-25 1994-06-07 Toyo Electric Mfg Co Ltd 制御装置
JPH0715991A (ja) * 1993-06-25 1995-01-17 Hitachi Ltd モータ制御装置

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6876168B1 (en) * 1999-05-20 2005-04-05 National University Of Singapore Disturbance attenuation in a precision servomechanism by a frequency-separated acceleration soft sensor
CN108762083B (zh) * 2018-06-13 2021-04-02 长春萨米特光电科技有限公司 一种基于加速度观测器的自动控制系统
CN112405554A (zh) * 2020-11-06 2021-02-26 上海傅利叶智能科技有限公司 用于机器人低刚度运动控制的方法、装置和康复机器人
CN112405554B (zh) * 2020-11-06 2022-07-01 上海傅利叶智能科技有限公司 用于机器人低刚度运动控制的方法、装置和康复机器人

Also Published As

Publication number Publication date
KR19980074456A (ko) 1998-11-05
KR100237306B1 (ko) 2000-01-15
US5959422A (en) 1999-09-28

Similar Documents

Publication Publication Date Title
JPH10275003A (ja) 2慣性共振系を制御する方法及びその装置
JP2003009566A (ja) 電動モータを用いた車両の制振制御装置
US5929587A (en) Method and apparatus for controlling servomotor in two inertial systems
JP3981773B2 (ja) ロボット制御装置
JP5262036B2 (ja) シャシーダイナモメータシステムの制御方法
JP5200715B2 (ja) 動力計システムの電気慣性制御装置
JPH09121580A (ja) 低慣性化制御による2慣性共振系の振動抑制装置
JPH10217173A (ja) ロボットの非干渉化制御装置
JPH08278821A (ja) サーボ制御系の制振方法
JPH05252779A (ja) ロボットのサーボ制御装置
JP3220589B2 (ja) メカニカルシステムの制御装置
JPH07121239A (ja) ロボット装置の制御方法
JPH09191678A (ja) サーボモータの速度制御方法
JP2838578B2 (ja) モータ制御装置、外乱負荷トルク推定装置
JP4289275B2 (ja) 多関節型ロボットの制御方法
JP2003271246A (ja) 速度制御装置
JPH08147038A (ja) モータの駆動制御装置
JP3307564B2 (ja) サーボ系の駆動制御装置
CN1194369A (zh) 二惯性共振系统的控制方法及其装置
JP3283662B2 (ja) 状態推定オブザーバ装置
JP3826286B2 (ja) 電動パワーステアリング装置
JP5200714B2 (ja) 電気慣性制御装置
JPH1131015A (ja) 減速機構付きサーボ制御系の制振方法
JP4565426B2 (ja) モータ制御装置
JPH07181113A (ja) 操作フィーリング呈示装置