Final servo control in NC systems
First Claim
1. In a method of controlling the velocity and position of a member movable along an axis wherein a primary position command signal (XCP) is changed by incremental amounts Δ
- X during each of successive time periods, the improvement which comprises;
a. producing a secondary position command signal,b. changing said secondary command signal at a rate which is proportional to the difference between the primary and secondary command signals, andc. utilizing said secondary command signal (XSCP) to excite servo power means to keep the actual position of said member substantially in agreement with the position represented by said secondary command signal.
1 Assignment
0 Petitions
Accused Products
Abstract
An improved final servo control for numerical control systems of the type which perform linear and/or circular interpolation by iterative updating of commanded position signals. The improvements are embodied in means to sense when the servo loop has had an offset error introduced by drift or aging of the final amplifier or similar components, together with means for progressively and automatically removing such error; and by means to avoid attempts at extreme acceleration or deceleration beyond the ability of the servo power element (motor) to accomplish, --by creating from an iteratively updated primary position command signal, whose rate of change may suddenly alter by a wide margin, a secondary position command signal which varies ultimately by the same amount but at a lesser rate of change.
19 Citations
24 Claims
-
1. In a method of controlling the velocity and position of a member movable along an axis wherein a primary position command signal (XCP) is changed by incremental amounts Δ
- X during each of successive time periods, the improvement which comprises;
a. producing a secondary position command signal, b. changing said secondary command signal at a rate which is proportional to the difference between the primary and secondary command signals, and c. utilizing said secondary command signal (XSCP) to excite servo power means to keep the actual position of said member substantially in agreement with the position represented by said secondary command signal. - View Dependent Claims (2)
- X during each of successive time periods, the improvement which comprises;
-
3. In a system for controlling the velocity and position of a member movable along an axis to track the position represented by a primary command signal (XCP) which is changed by amounts Δ
- X during successive time periods Δ
T, and wherein the magnitude of the amount Δ
X may abruptly change, the improvement which comprises in combination;a. means for producing a secondary command signal (XSCP), b. means responsive to said primary and secondary command signals for producing an increment signal (Δ
XS) proportional to the difference (XCP - XSCP) therebetween,c. means for changing said secondary command signal (XSCP) by an amount represented by said increment signal once during each period Δ
T, andd. power servo means responsive to said secondary signal (XSCP) for moving said member to keep its position substantially in agreement therewith. - View Dependent Claims (4, 5)
- X during successive time periods Δ
-
6. In a system for controlling the velocity and position of a member movable along an axis, the combination comprising:
-
a. means for producing a first signal (Δ
X) designating an ideal desired velocity, such signal being abruptly and widely changeable from time to time,b. means for producing a second signal (XCP) designating an ideal desired position of the member, c. means responsive to said first signal for changing said second signal in a sense and at a rate corresponding to the sign and magnitude of the first signal, d. servo means responsive to a changeable input for moving said member to keep its actual position dynamically in substantial agreement with said input signal, e. means for producing a third signal (XSCP) designating a desired position of the member, f. means for changing said third signal at a rate proportional to, and in a sense corresponding to the sign of, the difference (XCP - XSCP) between the values of said second and third signals, and g. means for supplying said third signal as the input to said servo means (d). - View Dependent Claims (7, 8, 9, 10)
-
-
11. In a system for controlling the velocity and position of a member movable along an axis, the combination comprising:
-
a. means for measuring off successive periods Δ
T in actual time,b. means for producing a primary commanded position signal (XCP) which by sign and magnitude represents the desired position of said member, c. means for producing a velocity increment signal (Δ
X) which by sign and magnitude represents the desired velocity (Δ
X/Δ
T) of said member,d. means for algebraically combining said position and velocity signals to iteratively update the former during each period Δ
T, such that XCPi = XCPi-1 + Δ
X,e. means for producing a secondary position signal (XSCP), f. means for algebraically subtracting said secondary signal from said primary signal to produce an auxiliary velocity signal (Δ
XS) during each period Δ
T, so that Δ
XS = GF (XCP - XSCP) where GF is a gain factor less than 1.0,g. means for algebraically combining said auxiliary signal and said secondary signal during each period Δ
T to iteratively update the latter, such that XSCPi = XSCPi-1 + Δ
XS, andh. position servo means responsive to said secondary position signal XSCP to keep the controlled member dynamically positioned substantially in accordance therewith, whereby abrupt or wide changes in said velocity signal (XCP) result in more gradual changes in said secondary signal so as to permit said servo means more accurately to accelerate or decelerate the controlled member.
-
-
12. In a method for controlling the velocity and position of a member movable along an axis, wherein a position command signal (XSCP) is periodically changed by a variable increment amount (Δ
- XS), and the position error (XPER) is signaled as the difference between the actual position of the member and the commanded position represented by said command signal (XSCP - XAP), and a servo power means is excited with a signal which is a function of said error to drive said member along the axis in a direction to reduce such error toward zero, the means for exciting the servo power means being susceptible to offset drift, the improvement comprising;
a. producing a compensating signal (XBAL), b. exciting said servo power means to run at a speed proportional to an additive function of said signaled error (XPER) and the compensating signal (GPX·
XPER + XBAL), andc. changing said compensating signal (XBAL) periodically by amounts which are proportional to the then-signaled error. - View Dependent Claims (13, 23, 24)
- XS), and the position error (XPER) is signaled as the difference between the actual position of the member and the commanded position represented by said command signal (XSCP - XAP), and a servo power means is excited with a signal which is a function of said error to drive said member along the axis in a direction to reduce such error toward zero, the means for exciting the servo power means being susceptible to offset drift, the improvement comprising;
-
14. In a servo system which comprises:
-
a. a member movable along a path, b. means for producing a first signal (XAP) indicative of the actual position of the member, c. means for producing a second signal (XSCP) indicative of the desired position of the member, d. means responsive to said first and second signals for producing a third signal (XPER) which is proportional to the error difference between the desired and actual positions of the member, e. means responsive to an input signal for driving said member along the path in a direction corresponding to the sign of such input signal, and f. means for coupling said third signal into said means (e) as said input signal, such means (f) being susceptible to spurious influences so as possibly to introduce into said input signal undesired offsets, whereupon the member'"'"'s actual position is offset from the desired position when the input signal is reduced to zero by the closed loop servo action, the improvement which is characterized by 1. means for producing a fourth (XBAL) signal which is changeable in magnitude and sign, 2. means for algebraically combining said fourth signal with said third signal and applying the resultant (XVC) to said means (f), and 3. means for changing said fourth signal progressively whenever said third signal is not substantially zero, whereby said fourth signal is automatically adjusted to eliminate any undesired offset between the desired and actual positions of said member. - View Dependent Claims (15, 16)
-
-
17. In a servo system for keeping a movable member dynamically positioned substantially in agreement with a changeable commanded position signal. the combination comprising:
-
a. means for producing a changeable position command signal (XSCP), b. means for producing an acutal position signal (XAP) representing the actual position of the member, c. means responsive to said command and actual position signals as inputs for producing a position error signal (XPER) proportional to the difference (XSCP - XAP) between such inputs, d. means for driving said member is a direction and at a speed corresponding to the sign and magnitude of an input signal (XVC), e. means for producing a balance signal (XBAL), f. means responsive to said error signal and said balance signal for producing said input signal and applying it to said means (d), said input signal normally being proportional to the algebraic sum of said error and balance signals (XPER + XBAL) but such means (f) being susceptible of aging, drift and the like so as to create spurious offsets in said input signal causing it to depart from proportionality to said sum, and g. means for progressively increasing or decreasing said balance signal whenever said command signal is unchanging and said error signal is positive or negative and not substantially zero, thereby to compensate for said spurious offsets. - View Dependent Claims (18, 19)
-
-
20. In a servo system for keeping a movable member dynamically positioned substantially in agreement with a changeable commanded position signal, the combination comprising:
-
a. means for producing a first changeable digital signal (XSCP) numerically representing a desired, commanded position, b. means for producing a second changeable digital signal (Δ
XS) numerically representing a changeable incremental distance,c. means for measuring off successive equal periods (Δ
T) in actual time,d. means for algebraically adding during each said period (Δ
T) said second signal (Δ
XS) to said first signal (XSCP) to cause the represented commanded position to change at a rate (Δ
XS/Δ
T) determined by the magnitude of said incremental distance,e. means physically coupled to said member for producing a third changeable digital signal (XAP) numerically representing the actual position of said member, f. means for algebraically subtracting during each period (Δ
T) the third signal from the first signal to produce a fourth digital signal (XPER) numerically representing the error difference (XPER = XSCP - XAP) between the commanded and actual positions,g. means responsive to an input signal for driving said member in a direction and at a velocity corresponding to the sign and magnitude of such input signal, h. means for producing a fifth changeable digital signal (XBAL) representing a balance term, i. means for algebraically adding during each period (Δ
T) a changeable increment quantity of GBX·
XPER to said fourth signal, where such quantity is proportional to the error difference represented by said fourth signal, so that said balance term changes at a rate and in a sense proportional to said error difference,j. means for inhibiting the operation of said means (i) except when said incremental distance represented by said second signals (Δ
XS) is substantially zero,k. means for algebraically combining said fourth and fifth signals during each period (Δ
T) to create a sixth digital signal (XVC) representing a compensated position error, andl. means for converting and coupling said sixth digital signals into an input signal applied to said means (g), whereby any spurious offsets introduced into said input signal by said means (1) are balanced out by changes in said fifth signals.
-
-
21. In a system for controlling the velocity and position of a member movable along an axis to track the position represented by a primary command signal (XCP) which is periodically changed by amounts Δ
- X, the improvement which comprises in combination;
a. means for producing a secondary command signal (XSCP), b. means responsive to said primary and secondary command signals for producing an auxiliary signal (Δ
XS) which varies according to the difference (XCP - XSCP) between said command signals,c. means for changing said secondary command signal at a rate and in a sense corresponding to the magnitude and sign of said auxiliary signal, d. means for producing a feedback signal (XAP) which by its value represents the instantaneous actual position of the controlled member, e. means for producing an arror signal (XPER) proportional to the difference (XSCP - XAP) between the secondary command signal and the feedback signal, f. means for producing a balance signal (XBAL), g. means for changing the balance signal in a sense and at a rate corresponding to the sign and magnitude of said error signal whenever said auxiliary signal is substantially zero, and h. power means responsive to an algebraic sum function of said error and balance signals (XPER + XBAL) for driving said member at a velocity corresponding in magnitude and direction.
- X, the improvement which comprises in combination;
-
22. In a system for controlling the velocity and position of a member movable along an axis to track the position represented by a primary command signal (XCP) which is changed by amounts Δ
- X during successive time priods Δ
T, the improvement which comprises in combination;a. means for producing a secondary command signal (XSCP), b. means responsive to said primary and secondary command signals for producing an increment signal (Δ
XS) proportional by a factor of less than 1.0 to the difference (XCP - XSCP) therebetween,c. means for changing said secondary signal by the amount represented by the increment signal during each period Δ
T, so that XSCPi = XSCPi-1 + Δ
XS,d. means for producing a feedback signal (XAP) which by its value represents the instantaneous actual position of the controlled member, e. means for producing an error signal (XPER) proportional to the difference (XSCP - XAP), between the secondary command signal and the feedback signal, f. means for producing a balance signal (XBAL), g. means for changing said balance signal by an amount proportional to the error signal (XPER) during each period Δ
T whenever said increment signal (Δ
XS) is substantially zero, so that XBALi = XBALi-1 + GBX·
XPER, andh. power means responsive to the algebraic combination of said error and balance signals for driving said member at a velocity substantially proportional to such combination (XPER + XBAL).
- X during successive time priods Δ
Specification