US5406182A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Method for controlling a servomotor
Assignee: Fanuc Corp
•
Filing: 1993-01-26
•
Granted: 1995-04-11
•
Expires: 2013-01-26
Abstract
Abstract A method for controlling a servomotor, in which the differences in dynamic characteristics among machines are absorbed by the controller so as to substantially equalize the response characteristics of the machines. An advance smoothing processing is executed before each position-speed loop processing cycle. The position feedforward amount FFp is calculated according to the following equation: FFp=α{(1-K) SMD.sub.0 +kSMD.sub.1 }. Where, SMD 0 represents a smoothing data of the present cycle; SMD 1 , a smoothing data of the preceding cycle; and α, a position feedback coefficient. The parameter k given in the above equation is adjusted to adjust the response characteristics of the individual machines, as well as the response characteristic of the mechanical system including controller with respect to an operation command. With this adjustment, the dynamic characteristics can be equalized between two or more machines even when such machines are simultaneously interpolated.
Inventors
- 👤 Yasusuke Iwashita
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-11-08 15:19
CPC Classifications
G; G05; G05B; G05B19/00; G05B19/02; G05B19/18; G05B19/19; G05B2219/00; G05B2219/30; G05B2219/41; G05B2219/41429; G05B2219/41441; G05B2219/43; G05B2219/43048
Claims Analysis
Total Claims: 6
Claim 1
Independent Claim
215 words
A method for controlling a servomotor by executing both a position loop processing and a speed loop processing, in a position and speed loop cycle, on the basis of a shift command supplied from a numerical control apparatus in each distribution cycle, comprising the steps of: (a) obtaining a smoothing data for each of a plurality of position and speed loop cycles by executing an advance smoothing processing including averaging a plurality of successive shift commands corresponding to said plurality of position and speed loop cycles; (b) calculating a position feedforward amount FFp according to the following equation: FFp=α{(1-k) SMD.sub.0 +k.SMD.sub.1 } where SMD 0 represents the obtained smoothing data corresponding to a present said position and speed loop cycle of the position-speed loop processing, SMD 1 represents the obtained smoothing data corresponding to a preceding said position and speed loop cycle of the position-speed loop processing, α represents a feedforward coefficient, and k represents a parameter which is determined to obtain desired dynamic characteristics of a machine to be driven with the servomotor in response to a shift command; (c) correcting a speed command obtained in the position loop processing based on the position feedforward amount FFp obtained in said step (b); and (d) transmitting said corrected speed command to the speed loop processing.
Claim 2
Independent Claim
215 words
A method for controlling a servomotor by executing both a position loop processing and a speed loop processing, in a position and speed loop cycle, on the basis of a shift command supplied from a numerical control apparatus in each distribution cycle, comprising the steps of: (a) obtaining a smoothing data for each of a plurality of position and speed loop cycles by executing an advance smoothing processing including averaging a plurality of successive shift commands corresponding to said plurality of position and speed loop cycles; (b) calculating a position feedforward amount FFp according to the following equation: FFp=α{(1-k) SMD.sub.0 +k.SMD.sub.1 } where SMD 0 represents the obtained smoothing data corresponding to a present said position and speed loop cycle of the position-speed loop processing, SMD 1 represents the obtained smoothing data corresponding to a preceding said position and speed loop cycle of the position-speed loop processing, α represents a feedforward coefficient, and k represents a parameter which is determined to obtain desired dynamic characteristics of a machine to be driven with the servomotor in response to a shift command; (c) correcting a speed command obtained in the position loop processing based on the position feedforward amount FFp obtained in said step (b); and (d) transmitting said corrected speed command to the speed loop processing.
Claim 3
Dependent Claim
48 words
A method for controlling a servomotor in accordance with claim 1, further comprising the steps of: differentiating the smoothing data obtained in said step (a) to obtain a speed feedforward amount; and correcting a torque command obtained by the speed loop processing based on the speed feedforward amount.
Claim 4
Independent Claim
205 words
A method for controlling a servomotor by executing both a position loop processing and a speed loop processing, in a position and speed loop cycle, on the basis of a shift command supplied from a numerical control apparatus in each distribution cycle, comprising the steps of: (a) obtaining a smoothing data for each of a plurality of position and speed loop cycles by executing an advance smoothing processing including averaging a plurality of successive shift commands corresponding to said plurality of position and speed loop cycles; (b) calculating a position feedforward amount FFp according to the following equation: FFp=α{(1-k) SMD.sub.0 +k.SMD.sub.-1 } where SMD 0 represents the obtained smoothing data corresponding to a present said position and speed loop cycle, SMD -1 represents the obtained smoothing data corresponding to a delayed said position and speed loop cycle, α represents a feedforward coefficient, and k represents a parameter which is determined to obtain desired dynamic characteristics of a machine to be driven with the servomotor in response to a shift command; (c) correcting a speed command obtained in the position loop processing based on the position feedforward amount FFp obtained in said step (b); and (d) transmitting said corrected speed command to the speed loop processing.
Claim 5
Independent Claim
205 words
A method for controlling a servomotor by executing both a position loop processing and a speed loop processing, in a position and speed loop cycle, on the basis of a shift command supplied from a numerical control apparatus in each distribution cycle, comprising the steps of: (a) obtaining a smoothing data for each of a plurality of position and speed loop cycles by executing an advance smoothing processing including averaging a plurality of successive shift commands corresponding to said plurality of position and speed loop cycles; (b) calculating a position feedforward amount FFp according to the following equation: FFp=α{(1-k) SMD.sub.0 +k.SMD.sub.-1 } where SMD 0 represents the obtained smoothing data corresponding to a present said position and speed loop cycle, SMD -1 represents the obtained smoothing data corresponding to a delayed said position and speed loop cycle, α represents a feedforward coefficient, and k represents a parameter which is determined to obtain desired dynamic characteristics of a machine to be driven with the servomotor in response to a shift command; (c) correcting a speed command obtained in the position loop processing based on the position feedforward amount FFp obtained in said step (b); and (d) transmitting said corrected speed command to the speed loop processing.
Claim 6
Dependent Claim
48 words
A method for controlling a servomotor in accordance with claim 3, further comprising the steps of: differentiating the smoothing data obtained in said step (a) to obtain a speed feedforward amount; and correcting a torque command obtained in the speed loop processing based on the speed feedforward amount.
References Cited (Backward Citations)
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 1998-04-10 | 1998-10-10 | 1999-04-11 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 2002-04-10 | 2002-10-10 | 2003-04-11 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 2006-04-10 | 2006-10-10 | 2007-04-11 | $7700.00 | Window Closed / Lapsed |