WO1990003603A1 - Servo controller - Google Patents

Servo controller Download PDF

Info

Publication number
WO1990003603A1
WO1990003603A1 PCT/JP1989/000969 JP8900969W WO9003603A1 WO 1990003603 A1 WO1990003603 A1 WO 1990003603A1 JP 8900969 W JP8900969 W JP 8900969W WO 9003603 A1 WO9003603 A1 WO 9003603A1
Authority
WO
WIPO (PCT)
Prior art keywords
acceleration
backlash
speed
output
amount
Prior art date
Application number
PCT/JP1989/000969
Other languages
English (en)
French (fr)
Japanese (ja)
Inventor
Yasusuke Iwashita
Original Assignee
Fanuc 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 Fanuc Ltd filed Critical Fanuc Ltd
Priority to KR1019900701096A priority Critical patent/KR930003181B1/ko
Priority to EP89910656A priority patent/EP0389641B1/de
Priority to DE68921606T priority patent/DE68921606T2/de
Publication of WO1990003603A1 publication Critical patent/WO1990003603A1/ja

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D3/00Control of position or direction
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-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 programme data in numerical form
    • G05B19/404Numerical 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
    • 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/41078Backlash acceleration compensation when inversing, reversing direction
    • 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/41082Timer, speed integration to control duration of backlash correction
    • 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/41084Compensation speed axis with changing, reversing direction, quadrant circle
    • 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/41085Compensation pulses on inversion of direction of rotation, movement

Definitions

  • the present invention relates to a servo control device, and more particularly to a servo control device, which can quickly perform a bush and a jiglash correction, and also produces a quadrant projection caused by friction and a backlash. Servo control devices that can be reduced.
  • an appropriate acceleration amount (X It has been proposed to add a certain amount of acceleration, such as the amount of acceleration of a class or a fish.)
  • the NC unit delivers the backlash correction data to the servo side and performs the backlash acceleration at the same time, the delay between the command and the servo system will occur. If the motor is not completely inverted, it may cause problems such as cutting into the inside of the c. For this reason, the motor rotation direction is actually monitored, and the backlash acceleration is performed at the timing when the rotation direction is reversed. If such a backlash acceleration control is performed when the rotation direction of the motor is reversed, the generation of quadrant protrusions due to mechanical backlash and friction is considerable. Can be reduced.
  • the optimal parameters vary depending on the cutting speed, workpiece weight, temperature, cutting surface conditions, and the like. For this reason, even if the quadrant projections can be very small under certain conditions, cutting them under other conditions will increase the size of the quadrant projections or cut them inward. Failure occurs.
  • the object of the present invention is to provide the same object even when the machine conditions and cutting conditions are changed.
  • the purpose of the present invention is to provide a servo control device capable of canceling the knock lash with a radiator and eliminating the quadrant projection c.
  • Another object of the present invention is to allow the backlash acceleration to be terminated at an optimal timing, thereby enabling the amount of the backlash acceleration to be moderated. It is an object of the present invention to provide a servo control device that can set a constant value and eliminate a quadrant projection.
  • the above problem is monitored by monitoring the integrated value of a speed feed back, and when the integrated value becomes equal to a predetermined value, the backlash acceleration is increased. Achieved by stopping.
  • Fig. 1 is a block diagram of the servo control device of the present invention
  • Fig. 2 is a case where the machine tool performs a perfect circular cutting using the servo control device of the present invention. This is the measurement result.
  • FIG. 1 is a block diagram of a servo control device according to the present invention.
  • 1 Ri Ah in the NC unit, if you generate move command P c for each predetermined sub emission Prin grayed time T s together, click rats push from the correction amount motion command direction Tsu preparative you inversion Output B c .
  • 1 2 position error calculator you calculating a difference of the movement command P c and the detected amount of movement P A of ⁇ at Sa down Prin grayed, 1 3 the following formula
  • Ba click rats push from correction Timing of discriminator 1 8, the NC unit 1 1 or et given that backed rats push from the correction amount B c when the mobile directive direction is reversed Kioku
  • the backlash correction amount Bc is output to the addition unit 20 by the rotation direction inversion detection, and the rotation direction inversion signal RDI is output to the acceleration amount output unit 21. Outputs counter reset signal RST.
  • the difference between the movement command P c for each sampling time T s and the detected movement amount P A calculated by the calculation unit 12 is integrated by the error counter 13.
  • Ri Do a position deviation E r the Ri Do and Po di Shi Yo emissions gain Lee emissions ⁇ is multiplied by the ⁇ and speed command V C [1 D after tooth that either speed have us in the subsequent speed control unit 1 5 deviation is output to best match for Torque Directive T c t1 D you rotate the mono- ball ⁇ one data.
  • the acceleration amount output unit 2 1 outputs a rotation direction reversing signal constant back-La Ri by the RDI Tsu accelerating amount B ACC.
  • the adder 22 adds the backlash acceleration amount B ACC and the speed command V CMD, sets the addition result as a true speed command V CMD ′, and sets the speed controller 15 Enter in.
  • the speed control unit 15 calculates the speed deviation, outputs a torque command T CMD corresponding to the speed deviation, rotates the servo motor 17, and promptly executes the backlash. Correct.
  • mosquitoes c te 1 9 de di data Le mono-volume processing each service down Prin grayed Pulse that occur Pulse da mosquito> et al. Do not want to shown during the time T s of The speed is input as the speed dog dog and integrated.
  • the acceleration stop instruction section 20 monitors the integrated value of the counter 19, and outputs an acceleration stop signal ASP when the integrated value reaches 23 when the integrated value reaches a predetermined value, and outputs an acceleration amount output section. 2. Perform 1 to stop the output of the backlash acceleration amount B ACC , and complete the backlash acceleration control.
  • the reason for stopping the backlash acceleration when the integrated value reaches 23 is as follows.
  • the interim resolution depends on the resolution of the pulse coder, ⁇ ⁇ , ⁇ ⁇
  • the integrated value of the velocity feedback VA is monitored, and when the integrated value becomes 2 to S, the backlash acceleration is terminated. That's how it works. By doing so, the end of the backlash acceleration can be quickly performed regardless of a slight change in the load condition or a change in the cutting speed. There can be no mistake, no delay, and a time when the amount of backlash acceleration reaches an appropriate value.
  • FIG. 2 shows the measurement results when a machine tool was used to perform a perfect circular cutting using the servo control device according to the present invention, where the dotted line is a perfect circle, and 1 and 2 are clockwise and This is the measurement result when cutting in the counterclockwise direction, in which the quadrant projections and inward cuts were removed at the quadrant switching points 3a to 3d. Then, when the rotation direction of the servo motor is reversed, the pulse acceleration is started, and the integrated value of the speed feedback becomes equal to the predetermined value of 2-3. Since the backlash acceleration is configured to end at a certain time, the backlash acceleration can be performed regardless of slight changes in the machine or load conditions, changes in the cutting speed, etc. The backlash acceleration amount was set to an appropriate value without premature or late ending timing. And and the child you are Ki de, ⁇ You can in this and force you remove the lump Ri switch to the quadrant projections or inside.

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Control Of Position Or Direction (AREA)
  • Numerical Control (AREA)
  • Automatic Control Of Machine Tools (AREA)
PCT/JP1989/000969 1988-09-30 1989-09-25 Servo controller WO1990003603A1 (en)

Priority Applications (3)

Application Number Priority Date Filing Date Title
KR1019900701096A KR930003181B1 (ko) 1988-09-30 1989-09-25 서보 제어장치
EP89910656A EP0389641B1 (de) 1988-09-30 1989-09-25 Servoregelungseinheit
DE68921606T DE68921606T2 (de) 1988-09-30 1989-09-25 Servoregelungseinheit.

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP63243990A JP2703575B2 (ja) 1988-09-30 1988-09-30 サーボ制御装置
JP63/243990 1988-09-30

Publications (1)

Publication Number Publication Date
WO1990003603A1 true WO1990003603A1 (en) 1990-04-05

Family

ID=17112073

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP1989/000969 WO1990003603A1 (en) 1988-09-30 1989-09-25 Servo controller

Country Status (6)

Country Link
US (1) US5015935A (de)
EP (1) EP0389641B1 (de)
JP (1) JP2703575B2 (de)
KR (1) KR930003181B1 (de)
DE (1) DE68921606T2 (de)
WO (1) WO1990003603A1 (de)

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2709969B2 (ja) * 1989-12-12 1998-02-04 ファナック株式会社 サーボモータの制御方法
JPH03246707A (ja) * 1990-02-26 1991-11-05 Fanuc Ltd 系統別位置補正方式
JP2801064B2 (ja) * 1990-03-20 1998-09-21 東芝機械株式会社 Nc装置
JP2826391B2 (ja) * 1991-05-24 1998-11-18 ファナック株式会社 バックラッシ加速制御方法
JP2875646B2 (ja) * 1991-07-04 1999-03-31 ファナック株式会社 バックラッシ加速補正装置
WO1997031750A1 (fr) * 1994-09-29 1997-09-04 Kitamura Machinery Co., Ltd. Machine-outil commandee numeriquement
JP3215067B2 (ja) * 1997-03-21 2001-10-02 ファナック株式会社 移動方向反転時の位置補正方法
JP3805309B2 (ja) 2003-01-30 2006-08-02 ファナック株式会社 サーボモータ駆動制御装置
US8251484B2 (en) 2010-05-14 2012-08-28 Xerox Corporation Method and system for measuring and compensating for sensitivity and backlash in electrical motors that laterally move printheads in a continuous web inkjet printer
JP5788560B1 (ja) 2014-04-24 2015-09-30 ファナック株式会社 回転方向反転時に補正処理を行うモータ制御装置
JP6392726B2 (ja) * 2015-10-30 2018-09-19 ファナック株式会社 バックラッシを補正するモータ制御装置
GB201603283D0 (en) * 2016-02-25 2016-04-13 Johnson Electric Sa Method of reducing noise from a HVAC system

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS49128211A (de) * 1973-04-12 1974-12-09
JPS58214906A (ja) * 1982-06-08 1983-12-14 Yaskawa Electric Mfg Co Ltd バツクラツシユを有する移動機械の制御方法
JPS61178157A (ja) * 1985-01-31 1986-08-09 Mitsubishi Electric Corp 数値制御装置
JPS63156639A (ja) * 1986-12-08 1988-06-29 マホ アクチエンゲゼルシャフト Nc及びcnc工作機械のモータ駆動要素の位置制御方法及び装置
JPH0666694A (ja) * 1991-07-30 1994-03-11 Zenkoku Nama Concrete Kogyo Kumiai Rengokai モルタルの促進強度試験用供試体の作製方法

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0310867Y2 (de) * 1985-06-21 1991-03-18
JP2694827B2 (ja) * 1985-10-17 1997-12-24 東芝機械株式会社 バックラッシュ補正方法
JPS6375907A (ja) * 1986-09-19 1988-04-06 Fanuc Ltd フルクロ−ズフイ−ドバツクncシステムにおける追従遅れの除去方法
JPS63148314A (ja) * 1986-12-12 1988-06-21 Fanuc Ltd セミクロ−ズドル−プサ−ボ制御系の制御装置
JPS63148315A (ja) * 1986-12-12 1988-06-21 Fanuc Ltd サ−ボモ−タ制御装置
US4857816A (en) * 1987-02-05 1989-08-15 Joseph Rogozinski Precise positioning apparatus
JPS63219009A (ja) * 1987-03-07 1988-09-12 Fanuc Ltd フルクロ−ズドル−プ制御でのバツクラツシ補正方式

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS49128211A (de) * 1973-04-12 1974-12-09
JPS58214906A (ja) * 1982-06-08 1983-12-14 Yaskawa Electric Mfg Co Ltd バツクラツシユを有する移動機械の制御方法
JPS61178157A (ja) * 1985-01-31 1986-08-09 Mitsubishi Electric Corp 数値制御装置
JPS63156639A (ja) * 1986-12-08 1988-06-29 マホ アクチエンゲゼルシャフト Nc及びcnc工作機械のモータ駆動要素の位置制御方法及び装置
JPH0666694A (ja) * 1991-07-30 1994-03-11 Zenkoku Nama Concrete Kogyo Kumiai Rengokai モルタルの促進強度試験用供試体の作製方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
See also references of EP0389641A4 *
Utility Model Application No. 81688/1980 (Utility Model Laid-Open No. 10008/1982 (JP, U, 57-10008)) no Gansho ni Saisho ni Tenpusareta Specification and Drawing no Microfilm, Hitachi, Ltd. 19 January 1982 (19. 01. 82), page 4, line 2 to page 7, line 19, (Family: None) *

Also Published As

Publication number Publication date
KR900702440A (ko) 1990-12-07
EP0389641A4 (de) 1994-02-16
DE68921606D1 (de) 1995-04-13
US5015935A (en) 1991-05-14
DE68921606T2 (de) 1995-07-06
EP0389641A1 (de) 1990-10-03
JP2703575B2 (ja) 1998-01-26
KR930003181B1 (ko) 1993-04-23
EP0389641B1 (de) 1995-03-08
JPH0293711A (ja) 1990-04-04

Similar Documents

Publication Publication Date Title
US10095244B2 (en) Motor control apparatus, motor control method, control system, and position estimation method to be used in control system
WO1990003603A1 (en) Servo controller
JPH03228106A (ja) サーボモータの制御方法
WO1988004446A1 (en) Servo motor controller
JPS63148314A (ja) セミクロ−ズドル−プサ−ボ制御系の制御装置
JPH0552146B2 (de)
JP3370845B2 (ja) アブソリュートエンコーダ
WO1993015876A1 (en) Spindle positioning method
JPS59106009A (ja) バツクラツシユ補正方法
CN209930173U (zh) 丢步检测装置
JPH03110603A (ja) サーボモータのバックラッシュ補正制御方法
JP2664432B2 (ja) サーボ制御装置
EP3678290B1 (de) Motoransteuerungsvorrichtung
JP2819411B2 (ja) 定位置停止制御装置
JPS6337597B2 (de)
JPH0344506B2 (de)
JPS63190582A (ja) エンコ−ダ欠相検出装置
JP2546881B2 (ja) 静止最大摩擦トルク測定方法
JPH05104466A (ja) 多関節ロボツトの原点復帰制御装置
US2907222A (en) Servo system having precision reversiblity
JPS63103681A (ja) サ−ボモ−タの速度制御装置
JPH02213902A (ja) ロボットの制御装置
JPH01268498A (ja) ステップモータ制御装置
JPH05205415A (ja) モータ位置決め制御回路
JPH03285586A (ja) サーボモータの制御装置

Legal Events

Date Code Title Description
AK Designated states

Kind code of ref document: A1

Designated state(s): KR US

AL Designated countries for regional patents

Kind code of ref document: A1

Designated state(s): AT BE CH DE FR GB IT LU NL SE

WWE Wipo information: entry into national phase

Ref document number: 1989910656

Country of ref document: EP

WWP Wipo information: published in national office

Ref document number: 1989910656

Country of ref document: EP

WWG Wipo information: grant in national office

Ref document number: 1989910656

Country of ref document: EP