Method of controlling a motor driven system, apparatus for controlling a motor driven system and a motor driven system controlled in accordance with the disclosed method
View Patent ↗Actuators are used to move a variety of objects to desired positions. It is generally desirable that they can do this quickly without exhibiting overshoot or ringing. Some actuators are required to respond very quickly and examples of these are voice coil drivers used to move lenses in autofocus cameras provided in everyday devices such as smart phones and tablets. A rapid two step controller scheme had already been disclosed by Analog Devices Inc. While the scheme works well, it can only be used reliably if the resonant frequency of the actuator is known to within 2 or 3%. The inventors have discovered that the resonant frequency of an actuator unexpectedly changes as a function of position. This disclosure provides ways of modifying the control scheme to cope with changes in resonant frequency.
1. A method of driving a motor driven mechanical system from a first position to a second position, the method comprising:
i) calculating a change in a drive signal to move the motor driven mechanical system from the first position to the second position;
ii) dividing the change in the drive signal into a plurality of drive steps so as to form at least a first intermediate drive signal value and a final drive signal value;
iii) applying, to a motor of the motor driven mechanical system, the first intermediate drive signal value for a time t u , and then applying the final drive signal value;
further comprising:
inspecting data relating to a measured resonance frequency or a parameter based thereon at the second position, and using the measured resonance frequency or the parameter based thereon to set the time t u .
2. A method as claimed in claim 1 , wherein the time t u is inversely proportional to F R (c) where F R (c) is an estimated resonance frequency for a demanded second position represented by an input value C.
3. A method as claimed in claim 1 , in which the data comprises a data table listing the resonance frequency or a parameter based thereon versus a position code (c) for a plurality of second positions.
4. A method as claimed in claim 1 , in which the data comprises a parameterized response of the resonance frequency or the parameter based thereon.
5. A method as claimed in claim 1 , in which the parameter is a time offset or clock offset to be added to a base time value or a base clock count.
6. A method as claimed in claim 1 , in which the data is captured during a manufacturing based calibration step.
7. A method as claimed in claim 1 , in which the data is captured during an in-situ calibration step.
8. A method as claimed in claim 1 , comprising obtaining orientation data for the mechanical system, and modifying at least the first intermediate drive signal value based on the orientation data.
9. A method as claimed in claim 8 , in which the first intermediate drive signal value is modified to account for an orientation induced current change required to cause the mechanical system to move.
10. A method as claimed in claim 1 , in which the first intermediate drive signal value is modified to take account of a Q factor of the mechanical system at the second position.
11. A method as claimed in claim 10 , in which the magnitude of a step size to reach the first intermediate value is increased as the Q factor decreases.
12. A method as claimed in claim 1 , comprising acquiring temperature data and varying t u as a function of the temperature data.
13. A method as claimed in claim 1 , comprising acquiring actuator orientation and varying the time t u as a function of orientation.