US5331264A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Method and device for generating an input command for a motion control system
Assignee: Fanuc Robotics North America Inc
•
Filing: 1993-04-15
•
Granted: 1994-07-19
•
Expires: 2013-04-15
Abstract
Abstract A method and device of achieving motion cycle time reduction that takes motor capabilities, load inertia and gravity into account and, at the same time, produces acceptable tool tip vibration upon stopping. This cycle time reduction is especially applicable to short motions of a robot where the entire motion consists of acceleration and deceleration and there is no constant velocity region. The method and device provide open loop limiting factors for axis jerk, acceleration and velocity, taking into account robot position, payload and inertia.
Inventors
- 👤 Sai-Kai Cheng
- 👤 H. Dean McGee
- 👤 Chi-Ken Tsai
- 👤 Hadi A. Akeel
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-10-25 23:15
CPC Classifications
G; G05; G05B; G05B19/00; G05B19/02; G05B19/18; G05B19/416; G05B2219/00; G05B2219/30; G05B2219/39; G05B2219/39195; G05B2219/43; G05B2219/43029; G05B2219/43099; G05B2219/45; G05B2219/45104
Claims Analysis
Total Claims: 28
Claim 1
Independent Claim
135 words
A method for generating an input command for a motion control system, the system including a servo amplifier, a servo motor having motor parameters defining operating limits for torque and velocity and a feedback loop, the servo motor moving a load having a starting inertia at a starting position and a destination inertia at a destination position as seen by the servo motor due to load position and gravity, the method comprising the steps of: storing the motor parameters in memory; and calculating an entire third order position profile as a function of the starting and destination positions and inertias motion planning wherein the servo motor parameters include motor torque/velocity for acceleration and deceleration and wherein the step of calculating includes the step of a) defining motor torque/velocity equations for defining limits of motor torque/velocity.
Claim 2
Independent Claim
135 words
A method for generating an input command for a motion control system, the system including a servo amplifier, a servo motor having motor parameters defining operating limits for torque and velocity and a feedback loop, the servo motor moving a load having a starting inertia at a starting position and a destination inertia at a destination position as seen by the servo motor due to load position and gravity, the method comprising the steps of: storing the motor parameters in memory; and calculating an entire third order position profile as a function of the starting and destination positions and inertias motion planning wherein the servo motor parameters include motor torque/velocity for acceleration and deceleration and wherein the step of calculating includes the step of a) defining motor torque/velocity equations for defining limits of motor torque/velocity.
Claim 3
Dependent Claim
19 words
The method of claim 1 wherein the entire third order position profile includes an asymmetric acceleration and deceleration profile.
Claim 4
Dependent Claim
22 words
The method of claim 1 wherein the load includes at least a part of a robot and a payload of the robot.
Claim 5
Dependent Claim
32 words
The method of claim 1 wherein the step of calculating further includes the step of b) adjusting the motor torque/velocity equations based on gravity effect of the load on the servo motor.
Claim 6
Dependent Claim
28 words
The method of claim 4 wherein the step of calculating further includes the steps of c) defining and scaling a gravity equation to obtain adjusted gravity effect compensation.
Claim 7
Dependent Claim
28 words
The method of claim 5 wherein the step of calculating further includes the step of d) adjusting the motor torque/velocity equations based on the adjusted gravity effect compensation.
Claim 8
Dependent Claim
24 words
The method of claim 6 wherein the step of calculating further includes the steps of e) determining starting position inertia and load gravity effect.
Claim 9
Dependent Claim
39 words
The method of claim 7 wherein the step of calculating further includes the step of f) determining a starting position motor acceleration/velocity curve based on the adjusted motor torque/velocity equations, the starting position inertia and the load gravity effect.
Claim 10
Dependent Claim
26 words
The method as claimed in claim 8 wherein the step of calculating further includes the step of g) determining destination position inertia and load gravity effect.
Claim 11
Dependent Claim
40 words
The method as claimed in claim 9 wherein the step of calculating further includes the step of h) determining a destination position motor torque/velocity curve based on the adjusted motor torque/velocity equations, the destination position inertia and load gravity effect.
Claim 12
Dependent Claim
34 words
The method as claimed in claim 10 wherein the step of calculating further includes the step of i) determining an amount of motion required to move from the starting position to the destination position.
Claim 13
Dependent Claim
39 words
The method as claimed in claim 11 wherein the step of calculating further includes the step of j) determining acceleration and deceleration parameters based on the required amount of motion and the starting and destination position motor torque/velocity curves.
Claim 14
Dependent Claim
46 words
The method as claimed in claim 12 wherein the step of calculating further includes the steps of repeating steps a) through j) and adjusting the acceleration and deceleration parameters so that load vibration is within a predetermined range for all of the required amount of motion.
Claim 15
Independent Claim
142 words
A device for generating an input command for a motion control system, the system including a servo amplifier, a servo motor having motor parameters defining operating limits for torque and velocity and a feedback loop, the servo motor moving a load having a starting inertia at a starting position and a destination inertia at a destination position as seen by the servo motor due to load position and gravity, the device comprising: means for storing the motor parameters; and means for calculating an entire third order position profile as a function of the starting and destination positions and inertias and the motor parameters outside of the feedback loop during motion planning wherein the servo motor parameters include motor torque/velocity for acceleration and deceleration and wherein the means for calculating includes means for defining motor torque/velocity equations for defining limits of motor torque/velocity.
Claim 16
Independent Claim
142 words
A device for generating an input command for a motion control system, the system including a servo amplifier, a servo motor having motor parameters defining operating limits for torque and velocity and a feedback loop, the servo motor moving a load having a starting inertia at a starting position and a destination inertia at a destination position as seen by the servo motor due to load position and gravity, the device comprising: means for storing the motor parameters; and means for calculating an entire third order position profile as a function of the starting and destination positions and inertias and the motor parameters outside of the feedback loop during motion planning wherein the servo motor parameters include motor torque/velocity for acceleration and deceleration and wherein the means for calculating includes means for defining motor torque/velocity equations for defining limits of motor torque/velocity.
Claim 17
Dependent Claim
19 words
The device of claim 14 wherein the entire third order position profile includes an asymmetric acceleration and deceleration profile.
Claim 18
Dependent Claim
22 words
The device of claim 14 wherein the load includes at least a part of a robot and a payload of the robot.
Claim 19
Dependent Claim
30 words
The device of claim 14 wherein the means for calculating further includes means for adjusting the motor torque/velocity equations based on gravity effect of the load on the servo motor.
Claim 20
Dependent Claim
26 words
The device of claim 17 wherein the means for calculating further includes means for defining and scaling a gravity equation to obtain adjusted gravity effect compensation.
Claim 21
Dependent Claim
26 words
The device of claim 18 wherein the means for calculating further includes means for adjusting the motor torque/velocity equations based on the adjusted gravity effect compensation.
Claim 22
Dependent Claim
22 words
The device of claim 19 wherein the means for calculating further includes means for determining starting position inertia and load gravity effect.
Claim 23
Dependent Claim
37 words
The device of claim 20 wherein the means for calculating further includes means for determining a starting position motor acceleration/velocity curve based on the adjusted motor torque/velocity equations, the starting position inertia and the load gravity effect.
Claim 24
Dependent Claim
24 words
The device as claimed in claim 21 wherein the means for calculating further includes means for determining destination position inertia and load gravity effect.
Claim 25
Dependent Claim
38 words
The device as claimed in claim 22 wherein the means for calculating further includes means for determining a destination position motor torque/velocity curve based on the adjusted motor torque/velocity equations, the destination position inertia and load gravity effect.
Claim 26
Dependent Claim
32 words
The device as claimed in claim 23 wherein the means for calculating further includes means for determining an amount of motion required to move from the starting position to the destination position.
Claim 27
Dependent Claim
37 words
The device as claimed in claim 24 wherein the means for calculating further includes means for determining acceleration and deceleration parameters based on the required amount of motion and the starting and destination position motor torque/velocity curves.
Claim 28
Dependent Claim
44 words
The device as claimed in claim 25 wherein the means for calculating further includes means for repeating the above steps and adjusting the acceleration and deceleration parameters so that load vibration is within a predetermined range for all of the required amount of motion.
References Cited (Backward Citations)
US4718078A
Cited
US4908559A
Cited
US4819184A
Cited
US4906907A
Cited
US5057995A
Cited
US4769583A
Cited
US4956594A
Cited
US5115179A
Cited
US5025385A
Cited
US5102289A
Cited
US5057756A
Cited
US5144211A
Cited
US5216342A
Cited
US5089758A
Cited
US4985668A
Cited
US5049797A
Cited
US5101472A
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 1997-07-18 | 1998-01-17 | 1998-07-19 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 2001-07-18 | 2002-01-17 | 2002-07-19 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 2005-07-18 | 2006-01-17 | 2006-07-19 | $7700.00 | Window Closed / Lapsed |