JPH01304511A - サーボ制御装置 - Google Patents

サーボ制御装置

Info

Publication number
JPH01304511A
JPH01304511A JP63135928A JP13592888A JPH01304511A JP H01304511 A JPH01304511 A JP H01304511A JP 63135928 A JP63135928 A JP 63135928A JP 13592888 A JP13592888 A JP 13592888A JP H01304511 A JPH01304511 A JP H01304511A
Authority
JP
Japan
Prior art keywords
servo
filter
arithmetic
frequency
controller
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
JP63135928A
Other languages
English (en)
Inventor
Akira Shimada
明 島田
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.)
Seiko Instruments Inc
Original Assignee
Seiko Instruments Inc
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 Seiko Instruments Inc filed Critical Seiko Instruments Inc
Priority to JP63135928A priority Critical patent/JPH01304511A/ja
Priority to US07/359,570 priority patent/US4980625A/en
Publication of JPH01304511A publication Critical patent/JPH01304511A/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
    • G05B19/00Program-control systems
    • G05B19/02Program-control systems electric
    • G05B19/18Numerical 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 program data in numerical form
    • G05B19/19Numerical 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 program 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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Program-controlled manipulators
    • B25J9/16Program controls
    • B25J9/1628Program controls characterised by the control loop
    • B25J9/1638Program controls characterised by the control loop compensation for arm bending/inertia, pay load weight/inertia
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/41Servomotor, servo controller till figures
    • G05B2219/41166Adaptive filter frequency as function of oscillation, rigidity, inertia load

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Control Of Position Or Direction (AREA)
  • Control Of Electric Motors In General (AREA)
  • Feedback Control In General (AREA)

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 〔産業上の利用分野〕 ロボットマニピュレータ、工作機械、XY子テーブルの
位置、速度または力制装置に関する。
〔発明の概要〕
本発明はロボット、工作機械等のa微駆動による制御装
置において低剛性により生しやすい機械共振を、機械の
姿勢変化、負荷変動によって変化する固有振動数に適応
してカットオフ周波数またはノツチ周波数が適宜変化す
る適応フィルタを用いることにより、抑えるようにした
ものである。
〔従来の技術〕
一般に機械系が慣性負荷のみから構成される場合、入力
をトルクまたは力とし、出力を位置とした周波数特性は
第6図で表される。第6図に対して速度フィードバンク
、位置フィードバック等を施すことにより制御系を容易
に構成できる。しかしながら、機械系が減速機、支持系
、たわみ等の影響により低剛性である場合には第7図で
示されるような周波数特性を有する場合が多く、機械共
振が生じやすい。対応策としてサーボループの間ループ
ゲインを共振ピーク時においてOdBを越えないように
抑える必要がある。第7図。また、サーボループの前向
き伝達関数部分にローパスフィルタや第8図に示すよう
なノツチフィルタを挿入して第9図のように共振ピーク
をカットする方法がある。
〔発明が解決しようとする課題〕
しかしながら、前者ではゲインを高くできないために、
十分な連応性が得られない場合や外乱負荷に弱い等の欠
点があり、後者には第10図に見られるように機械系の
姿勢の変化または負荷変動により固有振動数、Q値が変
化した場合、固定周波数での特性しか持たないローパス
フィルタ、ノツチフィルタでは第11図のように共振ピ
ークを除去することができず十分に対応出来ない場合が
あった。
〔課題を解決するための手段〕
本発明は変化する固有振動数に対して、第12図のよう
に、追従してカットオフ周波数またはノツチ周波数がス
ライドすることによって機械共振を抑えることのできる
適応フィルタを有するサーボ制御装置に関する。
〔作用〕
ロボット工作機械等の機械系が低剛性である場合に、そ
の固有振動数で生じる機械共振が問題になる場合がある
固有振動数は、姿勢変化や負荷変動にあわせて変動する
性質を持つ。そこで常に固有振動数変化に沿ってカット
オフ周波数またはノツチ闇波数が変化する適応フィルタ
を直列に介してフィードバックループを構成することに
よって共振ピークをカットすることにより、見かけ1高
剛性な機械系として、改めて安定な制御を構成すること
ができる。
〔実施例〕
次に本発明の実施例について、図を参照して説明する。
図1が本発明の概要である。
位置指令7と現在位置8を入力しサーボ演算を行うサー
ボ演算部2と、演算結果5を入力し出力6を算出する適
応フィルタ3により、制御装置1が構成される。
制御出力6は機械系4に入力され、4の挙動が位置デー
タとして出力8に現れる。
第2図に低剛性なトルク伝達機構を介した2関節ロボッ
トマニピュレータによる実施例を示す。
第2図において制御装置1はメモリ内の位置指令と位置
検出手段9により検出された現在位置を比較してサーボ
演算を行い、演算結果を適応フィルタの入力データとし
て適応フィルタ演算を行い結果を出力手段10を介して
電力増幅用のパワーアンプ11に出力する。パワーアン
プ11はロボット駆動用モータ12の電流を制御し、駆
動用モータ12は電流に比例したトルクをロボットアー
ムI4に対して出力する。
モータ12とロボットアーム14との間にはベルト、減
速機または未知の低剛性構造物等から成り、弾性にと粘
性摩擦Cとでモデル化されるトルク伝達機構13が介さ
れる。
第1式はモータ12、トルク伝達機構13、ロボットア
ーム14の伝達関数である。パラメータは第2式で表さ
れ、固有振動数ωは弾性にとロボット及びモータとで表
される有効慣性Jeとの比で求められる。有効慣性Je
はモータ12の慣性J1とロボットアームの慣性J2か
ら成り、J2はロボットアームの姿勢θ2に応じて変化
する。ロボットアームはこの固有振動数ωにおいて機械
共振を生じ易いシステムとなっている。従って、固有振
動数ωはθ2の関数である。
但し、Je=JIJ2/(J1+J2)J1=cons
L、       (第2式)%式% ω−に/Je・・・・θの関数 第3図に従来からあるノツチフィルタのアナログ回路に
よる実施例を示す。
第3弐がノツチフィルタの伝達関数。適応フィルタを実
現するために同じ特性をソフトウェアに置き換える準備
が必要になる。第4式が第3式を双一次変換によりディ
ジクル化した伝達関数であり、Z変換で表される。パラ
メータは第5式。第6式は、第4式を時系列表現に書き
下したものであり、回路による実施例と同じフィルタ特
性を実現することができる。ここで、ノツチフィルタの
特性は第5弐のパラメータを設定することにより、−意
に定められる。つまり、第5式の右辺のωをアームの姿
勢変化に応じて第2弐に従って逐次に変更すればノツチ
フィルタの特性を動的に変化させることができる。
但し、ao =ω” +4/T”、 b −ω” +’
/r” +2ω”/QTa+ ” 2 ω” −8/T
” 、b =2 ω2−8/T”at = ω”  +
4/T”  、   1.  = ω2  十4772
 −2ωZ/口T (第5式)%式%(2) +a7bo ・u(k−2)  (k=O+1+2.・
・・)(第6式)制御装置1の制御の流れを示したのが
第4図。
第5図である。第4図において、制御装置1は一定のサ
ンプリングタイム毎にアームの現在位置θ1、θ2を9
から検出し、サーボ演算を行い、結果u (k)を適応
フィルタサブルーチンに出力し、フィルタ出力y (k
)をD/A変換器等IOからt=kT〜(k+l)Tの
聞出力保持する。ついで、サンプル回数kを更新し、次
のサンプリングを待つ。
第5図では、第2弐を用いてθ2から慣性J2を求め、
有効慣性Jeを求め、弾性にとから固有振動数ωを算出
し、第5式を用いてフィルタ係数を求め、第6式により
フィルタ出力y (k)を算出する。
〔発明の効果〕
本適応アクティブフィルタをロボット工作機械等の機械
制御系に利用することにより、機械体自身の低剛性によ
り生じる機械共振を制御できる他に、把持物の低剛性に
よって生じる振動の防振にも効果を持ち、全体として機
械体を安定制御させる働きを有する。
【図面の簡単な説明】
第1図に適応フィルタを挿入した制御装置の概略図を示
す。第2図に低剛性なトルク伝達機構を介した2関節ロ
ボットアームによる実施例を示す。 第3図に典型的なノツチフィルタのアナログ回路による
例を示す。第4図、第5図に制御の流れと適応フィルタ
のサブルーチンを示す。第6図から第12図に機械系及
び機械系にノツチフィルタを介した場合の入力をトルク
または力、出力を位置とした周波数特性を示す。 1・・・制御装置   2・・・サーボ演算部3・・・
適応フィルタ 4・・・機械系5・・・t=kT〜(k
+1)Tにおけるフィルタ人力 6・・・t =kT〜(k+1)Tにおけるフィルタ出
力 フ・・・指令位置 8・・・現在位置 9・・・位置検出手段 10・・・トルク指令出力手段 11・・・トルク制御型モータパワーアンプ12・・・
モータ 13・・・ヘルドまたは減速器 14・・・ロボットアーム Je・・・有効慣性モーメント Jl・・・モータ慣性 J2・・・アームの慣性 k・・・弾性 C・・・粘性 Q ・ ・ ・ 共振Qイ直 θ1・・第1軸の位置 θ2・・第2軸の位置 ω・・・固有振動数 T・・・サンプリングタイム aO−”!+ bO−b!  ” ’フィルタ係数k・
・・サンプリング回数(0,1,2−)S・・・ラプラ
ス変換演算子 2・・・2変換演算子 以上 出願人 セイコー電子工業株式会社 代理人 弁理士  林   敬 之 助う、u(kl 
     G、y(L)目7−。 J :![、+2’) 第20 実施例のハートウェイ上1丑違閏額戊明口第3
図 ノlチフィルタ回路口と式の説明図のサブルーチン
を11口 第6図 慣性j!L荷の特性説明図 第7図 周シ反波特性の説明図 竹・ビ虹にざ5月ひフ 一$ 10図  特性す変りす?Jの    第 12
図  付性変化にツマ4フイ説8F4閃       
     ル9が追従した肴柱の説明図

Claims (1)

    【特許請求の範囲】
  1. 機械系の慣性モーメントを検出または同定する手段を持
    ち、慣性モーメントの変動に応じて変化する固有振動数
    に対して、カットオフ周波数またはノッチ周波数が追従
    して変化する適応フィルタを設けることにより、機械共
    振を抑える機能を持つことを特徴としたサーボ制御装置
JP63135928A 1988-06-02 1988-06-02 サーボ制御装置 Pending JPH01304511A (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP63135928A JPH01304511A (ja) 1988-06-02 1988-06-02 サーボ制御装置
US07/359,570 US4980625A (en) 1988-06-02 1989-06-01 Apparatus and method for servo control system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP63135928A JPH01304511A (ja) 1988-06-02 1988-06-02 サーボ制御装置

Publications (1)

Publication Number Publication Date
JPH01304511A true JPH01304511A (ja) 1989-12-08

Family

ID=15163127

Family Applications (1)

Application Number Title Priority Date Filing Date
JP63135928A Pending JPH01304511A (ja) 1988-06-02 1988-06-02 サーボ制御装置

Country Status (2)

Country Link
US (1) US4980625A (ja)
JP (1) JPH01304511A (ja)

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0469617A1 (en) * 1990-08-01 1992-02-05 Mitsubishi Denki Kabushiki Kaisha Closed-loop feedback control system having an adaptive filter
JPH0678575A (ja) * 1992-05-07 1994-03-18 Sanyo Denki Co Ltd サーボ系のノッチフィルタ自動調整方法及び装置
JPH07123761A (ja) * 1993-10-28 1995-05-12 Toyo Electric Mfg Co Ltd 電動機駆動システムの軸トルク制御方法および軸トルク推定方法
JPH07302120A (ja) * 1994-04-21 1995-11-14 Gm Pfaff Ag 機械およびこの機械に連結された駆動要素を有する装置
JP2005038311A (ja) * 2003-07-18 2005-02-10 Fuji Electric Fa Components & Systems Co Ltd 機械制御装置
JP2005103739A (ja) * 2003-10-02 2005-04-21 Yaskawa Electric Corp 振動抑制制御装置
US6903529B2 (en) * 2002-10-02 2005-06-07 Siemens Aktiengesellschaft Method and apparatus for damping mechanical oscillations of a shaft in machine tools, manufacturing machines and robots
KR100675003B1 (ko) * 2006-01-14 2007-01-29 삼성전자주식회사 노치 필터의 특성 조정 방법 및 이를 이용한 디스크드라이브
JP2014096954A (ja) * 2012-11-12 2014-05-22 Kayaba Ind Co Ltd 駆動ユニット
JP2016051401A (ja) * 2014-09-01 2016-04-11 Kyb株式会社 サーボアクチュエータの制御システム

Families Citing this family (28)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3078009B2 (ja) * 1990-11-30 2000-08-21 本田技研工業株式会社 脚式移動ロボットの歩行制御装置
JP2997036B2 (ja) * 1990-11-30 2000-01-11 本田技研工業株式会社 脚式移動ロボットの歩行制御装置
US5276390A (en) * 1991-10-04 1994-01-04 Hewlett-Packard Company System for hybrid position and force control
JP2714905B2 (ja) * 1992-01-31 1998-02-16 富士通株式会社 位置決め制御装置
US5394071A (en) * 1993-02-19 1995-02-28 Mts Systems Corportion Control network with on-line iteration and adaptive filter
US5631824A (en) * 1994-05-26 1997-05-20 Polytechnic University Feedback control apparatus and method thereof for compensating for changes in structural frequencies
US6154000A (en) * 1994-09-07 2000-11-28 Omnitek Research & Development, Inc. Apparatus for providing a controlled deflection and/or actuator apparatus
US5604413A (en) * 1994-09-07 1997-02-18 Polytechnic University Apparatus for improving operational performance of a machine or device
US5816122A (en) * 1996-04-30 1998-10-06 General Dynamics Advanced Technology Systems, Inc. Apparatus and method for adaptive suppression of vibrations in mechanical systems
KR100373575B1 (ko) * 1998-07-20 2003-02-26 인터내셔널 비지네스 머신즈 코포레이션 데이터 기억 장치 내의 서보 시스템용 적응 진동 제어
DE19846637A1 (de) * 1998-10-09 2000-04-13 Heidenhain Gmbh Dr Johannes Verfahren und Schaltungsanordnung zur automatischen Parametrierung eines schnellen digitalen Drehzahlregelkreises
JP3703664B2 (ja) * 1998-12-28 2005-10-05 三菱電機株式会社 バックラッシ補正装置
JP2000322105A (ja) * 1999-05-07 2000-11-24 Toshiba Mach Co Ltd サーボ制御装置およびサーボ制御装置の安定化調整方法
FI109349B (fi) 2000-07-18 2002-07-15 Timberjack Oy Menetelmä puomin ohjaamiseksi ja puomin ohjausjärjestelmä
JP3975812B2 (ja) * 2001-08-17 2007-09-12 株式会社安川電機 電動機制御装置の共振周波数検出装置
US6710965B2 (en) 2001-10-02 2004-03-23 Seagate Technology Llc Phase-advanced filter for robust resonance cancellation
US6963184B2 (en) * 2002-09-26 2005-11-08 3M Innovative Properties Company Adaptable spatial notch filter
US6911792B2 (en) * 2003-05-20 2005-06-28 Hewlett-Packard Development Company, L.P. System and method for controlling movement
JP4647325B2 (ja) * 2004-02-10 2011-03-09 株式会社小松製作所 建設機械の作業機の制御装置、建設機械の作業機の制御方法、及びこの方法をコンピュータに実行させるプログラム
WO2006105677A2 (de) * 2005-04-07 2006-10-12 Belimo Holding Ag Unterdrückung von schwingungen
US7109670B1 (en) * 2005-05-25 2006-09-19 Rockwell Automation Technologies, Inc. Motor drive with velocity-second compensation
US7187142B2 (en) * 2005-05-25 2007-03-06 Rockwell Automation Technologies, Inc. Motor drive with velocity noise filter
US7973508B2 (en) * 2007-12-10 2011-07-05 XyZ Automation Inc. Automation systems diagnostics and predictive failure detection
EP3512092B1 (en) * 2016-09-08 2020-09-30 Panasonic Intellectual Property Management Co., Ltd. Motor control device, motor position control method, and industrial machine
US12350829B2 (en) 2020-03-26 2025-07-08 Auris Health, Inc. Systems and methods for constrained motion control of medical instruments
CN115360953B (zh) * 2022-08-24 2023-05-09 威胜能源技术股份有限公司 一种基于转子磁链定向的感应电机振荡抑制方法
US12372951B2 (en) * 2022-12-12 2025-07-29 Rockwell Automation Technologies, Inc. Dynamic command notch filter
CN117103335B (zh) * 2023-10-14 2026-03-27 福州大学 一种六自由度并联机构主动减振系统

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US3961234A (en) * 1972-12-29 1976-06-01 General Electric Company Adaptive filtering
US3872285A (en) * 1974-05-31 1975-03-18 Westinghouse Electric Corp Control system for sensing the vibration and lateral force on a cutting tool
US3917930A (en) * 1974-11-25 1975-11-04 Cincinnati Milacron Inc Method and apparatus for adaptively positioning a machine element
US4109189A (en) * 1976-11-02 1978-08-22 Xerox Corporation Phase-sensitive transducer apparatus with improved signal offset means
US4215298A (en) * 1978-06-16 1980-07-29 Lockheed Electronics Co., Inc. Servomechanism rate control system with compensation for motor-tachometer resonance
SE434573B (sv) * 1979-10-02 1984-07-30 Bofors Ab Sett och anordning for att hoja linjeriteten hos ett servosystem
US4458321A (en) * 1981-08-19 1984-07-03 The Charles Stark Draper Laboratory, Inc. Self-teaching robot feedback system
JPS58190286A (ja) * 1982-04-30 1983-11-07 Canon Inc モ−タ制御装置
JPS597964A (ja) * 1982-07-06 1984-01-17 Canon Inc 記録媒体駆動装置
GB2155657B (en) * 1983-10-13 1987-01-21 Ferranti Plc Position servo system
US4792737A (en) * 1987-06-15 1988-12-20 Performance Controls, Inc. Circuit for controlling the motion of a moving object

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0469617A1 (en) * 1990-08-01 1992-02-05 Mitsubishi Denki Kabushiki Kaisha Closed-loop feedback control system having an adaptive filter
JPH0678575A (ja) * 1992-05-07 1994-03-18 Sanyo Denki Co Ltd サーボ系のノッチフィルタ自動調整方法及び装置
JPH07123761A (ja) * 1993-10-28 1995-05-12 Toyo Electric Mfg Co Ltd 電動機駆動システムの軸トルク制御方法および軸トルク推定方法
JPH07302120A (ja) * 1994-04-21 1995-11-14 Gm Pfaff Ag 機械およびこの機械に連結された駆動要素を有する装置
US6903529B2 (en) * 2002-10-02 2005-06-07 Siemens Aktiengesellschaft Method and apparatus for damping mechanical oscillations of a shaft in machine tools, manufacturing machines and robots
JP2005038311A (ja) * 2003-07-18 2005-02-10 Fuji Electric Fa Components & Systems Co Ltd 機械制御装置
JP2005103739A (ja) * 2003-10-02 2005-04-21 Yaskawa Electric Corp 振動抑制制御装置
KR100675003B1 (ko) * 2006-01-14 2007-01-29 삼성전자주식회사 노치 필터의 특성 조정 방법 및 이를 이용한 디스크드라이브
JP2014096954A (ja) * 2012-11-12 2014-05-22 Kayaba Ind Co Ltd 駆動ユニット
JP2016051401A (ja) * 2014-09-01 2016-04-11 Kyb株式会社 サーボアクチュエータの制御システム

Also Published As

Publication number Publication date
US4980625A (en) 1990-12-25

Similar Documents

Publication Publication Date Title
JPH01304511A (ja) サーボ制御装置
US8335591B2 (en) Robot apparatus and method of controlling the same
US6243624B1 (en) Non-Linear muscle-like compliant controller
CN104334323B (zh) 多关节机器人的轨迹控制装置以及控制方法
Singer et al. Using acausal shaping techniques to reduce robot vibration
Izadbakhsh et al. Robust task-space control of robot manipulators using differential equations for uncertainty estimation
JPH02310609A (ja) マニピユレータの位置と力の協調制御装置
Kazerooni Constrained by a Rigid Environment
Adhikary et al. Inverse dynamics based robust control method for position commanded servo actuators in robot manipulators
JPH10309684A (ja) マニピュレータのコンプライアンス制御方式
Trung et al. High-performance positioning using decoupling controllers for flexible two-link robots with strain wave gears
Jlassi et al. An online trajectory generator-based impedance control for co-manipulation tasks
Kim Shared compliant control: A stability analysis and experiments
Chen Frequency response of discrete-time robot systems--Limitations of PD controllers and improvements by lag-lead compensation
Suh et al. Fuzzy adaptive force control of industrial robot manipulators with position servos
JP2019012458A (ja) 制御システム、制御方法、及び制御プログラム
Labrecque et al. Robotic force amplification with free space motion capability
WO1994017461A1 (fr) Dispositif de commande des mouvements alternes d'un robot
US20130197672A1 (en) Pass-Through Controller for Cascaded Proportional-Integral-Derivative Control Loops
JPS6190207A (ja) ロボツト制御装置
JPH05207769A (ja) サーボ制御方法
JPS61163406A (ja) ロボツト制御装置
Azenha Iterative learning in variable structure position/force hybrid control of manipulators
JPH04369004A (ja) マニピュレータのインピーダンス制御方法
JPS61217802A (ja) ロボツト制御装置