Automatic drift compensation method and device for position-loop controller
AssigneeMicrotek International Inc.
InventorTing P. Chung
Life of this patent
Estimating the term…
Abstract
By means of a timer and by setting the compensation for the lag error, the correctness of automatic drift compensation in a position-loop controller is enhanced and the accuracy of position control is also improved. In the present invention, a method and a device for automatic drift compensation in a position-loop controller are disclosed which enable accurate displacement control so as to avoid inadvertent shutdowns of the system.
Claims8
An automatic drift compensation device for a position-loop controller that generates position instruction signals to control displacement of a working machine, the compensating device comprising:
- instruction detection means to detect the position instruction signals;
- a timer;
- timer control means to start the timer for a predetermined period in response to the detection of a predetermined position instruction signal by the instruction detection means;
- accumulated instruction calculating means for calculating an accumulated instruction position value, .SIGMA.PC, from the position instruction signals;
- feedback means to generate feedback signals in response to actual displacement of the working machine, and to transmit said feedback signals to the position-loop controller;
- accumulated feedback position calculating means for calculating an accumulated feedback position value, .SIGMA.PF, from the feedback signals;
- compensation lag error setting means for setting a compensation lag error value, PE', by means of a first formula:
- PE'=.SIGMA.PC-.SIGMA.PF+vF, wherein vF represents actual drift of the position-loop controller;
- lag error calculating means for calculating a current lag error value, PE, in response to the timer control means starting the timer, and according to a second formula:
- PE=.SIGMA.PC-.SIGMA.PF;
- reset detection means for detecting the value of PE', and for generating an arrive signal when the value of PE' is less than or equal to a given value;
- and
- compensation lag error resetting means for receiving the arrive signal from the reset detection means and for resetting the compensation lag error value at the end of said predetermined period if no arrive signal has been received from the reset detection means during the predetermined period;
- wherein after the compensation lag error resetting means resets the compensation lag error value, the lag error calculating means resets the lag error value, PE, according to a third formula:
- PE=-vF.
A drift compensation method for a position-loop controller that generates position instruction signals to control displacement of a working machine, the method comprising:
- calculating an accumulated instruction position value, .SIGMA.PC, from the position instruction signals;
- generating a feedback signal in response to actual displacement of the working machine;
- calculating an accumulated feedback position value, .SIGMA.PF, from the feedback signals;
- setting a compensation lag error value, PE', by means of a first formula:
- PE'=.SIGMA.PC-.SIGMA.PF+vF, wherein vF represents actual drift of the position-loop controller;
- detecting the position instruction signals;
- starting a timer for a predetermined period in response to the detection of a predetermined position instruction signal;
- calculating a current lag error value, PE, in response to starting the timer for the predetermined period, and according to a second formula:
- PE=.SIGMA.PC-.SIGMA.PF;
- comparing the compensation lag error value with a given value, and generating an arrive signal when the compensation lag error value is less than or equal to said given value;
- resetting the compensation lag error value at the end of said predetermined period if no arrive signal has been generated during said predetermined period;
- and
- after the step of resetting the compensation lag error value, resetting the lag error value, PE, according to a third formula:
- PE=-vF.
Dependencies are inferred from the claim text.