NON-SENSOR TYPE CLOSED-LOOP STABILIZATION CONTROL ALGORITHM AND APPLICATION CIRCUIT THEREOF

Abstract

A non-sensor type closed-loop stabilization control algorithm comprises the following steps: 1, reading all voltages V.sub.k−1 and currents I.sub.k−1 for driving a multi-axis stabilization motor; 2, calculating and outputting all coil resistances R.sub.k−1 in the multi-axis stabilization motor; 3, reading all the coil resistances, voltages and currents in the steps 1 and 2, and calculating and outputting counter electromotive force E.sub.k−1 of all the coils in the multi-axis stabilization motor; 4, reading an stabilization compensation angle θ.sub.k, each coil resistance and the counter electromotive force, and calculating and outputting a closed-loop stabilization control F.sub.k; and 5, then waiting for a time step k=k+1, and repeating the steps in the steps 1 to 4. It aims to add a closed-loop control element to a motor without a sensor to achieve an excellent stabilization effect and to reduce the risk of image blurring caused by resonance.

Claims

1. A non-sensor type closed-loop stabilization control algorithm, wherein the algorithm comprises the steps as follows: 1.1, reading all voltages V.sub.k−1 and currents I.sub.k−1 for driving a multi-axis stabilization motor through a resistance calculation module; 1.2, calculating and outputting all coil resistances R.sub.k−1 in the multi-axis stabilization motor through the step 1.1; 1.3, reading all the resistors, voltages and currents in the steps 1.1 and 1.2 through a counter electromotive force calculation module, and calculating and outputting counter electromotive force E.sub.k−1 of all the coils in the multi-axis stabilization motor; 1.4, reading a stabilization compensation angle θ.sub.k, each coil resistance and the counter electromotive force through a closed-loop stabilization control module, and calculating and outputting a closed-loop stabilization control F.sub.k; and 1.5, then waiting fora time step k=k+1, and repeating the steps in the steps 1.1 to 1.4.

2. An application circuit using the non-sensor type closed-loop stabilization control algorithm according to claim 1, wherein the application circuit comprises a driving circuit, an induced circuit and a multi-axis stabilization motor; the driving circuit outputs an stabilization control instruction according to the non-sensor type closed-loop stabilization control algorithm to drive the corresponding multi-axis stabilization motor; the induced circuit detects all voltages and currents output to the multi-axis stabilization motor by the driving circuit, and outputs all the voltages and currents to the non-sensor type closed-loop stabilization control algorithm; the non-sensor type closed-loop stabilization control algorithm calculates and outputs a closed-loop stabilization control module according to the input stabilization compensation angle and the voltages and currents.

3. The application circuit of the non-sensor type closed-loop stabilization control algorithm according to claim 2, wherein the multi-axis stabilization motor is a voice coil motor or a servo motor, which comprises a plurality of groups of coils and magnets.

4. The application circuit of the non-sensor type closed-loop stabilization control algorithm according to claim 2, wherein the stabilization control output by the closed-loop stabilization control module is the voltage F.sub.k=V.sub.k, that is, the voltage is used to drive the multi-axis stabilization motor to perform stabilization motion.

5. The application circuit of the non-sensor type closed-loop stabilization control algorithm according to claim 2, wherein the stabilization control output by the closed-loop stabilization control module is the current F.sub.k=I.sub.k, that is, the current is used to drive the multi-axis stabilization motor to perform stabilization motion.

6. The application circuit of the non-sensor type closed-loop stabilization control algorithm according to claim 2, wherein the non-sensor type closed-loop stabilization control algorithm stores the output voltage V.sub.k or current I.sub.k in the closed-loop stabilization control module in at least one memory for calculation of the algorithm in a next time step.

7. The application circuit of the non-sensor type closed-loop stabilization control algorithm according to claim 2, wherein the multi-axis stabilization motor is further provided with a spring oscillator system, and a damping ratio of a part of the spring oscillator system in the multi-axis stabilization motor is between 0.4 and 1.4 by adjusting a gain a.sub.i in the closed-loop stabilization control module.

8. The application circuit of the non-sensor type closed-loop stabilization control algorithm according to claim 2, wherein the application circuit is further provided with a control chip, the control chip is further provided with a micro controller, a control circuit, and an induced circuit; and the control circuit comprises the non-sensor type closed-loop stabilization control algorithm.

9. The application circuit of the non-sensor type closed-loop stabilization control algorithm according to claim 8, wherein the control chip is further provided with an amplifier and an analog-to-digital converter to form one induced circuit.

10. The application circuit of the non-sensor type closed-loop stabilization control algorithm according to claim 8, wherein the control chip is provided with at least one resistor outside to form at least one induced circuit.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0034] FIG. 1 shows a block diagram of an operation step of the algorithm in accordance with the technical solution;

[0035] FIG. 2 shows a first application circuit of the algorithm in accordance with the technical solution;

[0036] FIG. 3 shows a second application circuit of the algorithm in accordance with the technical solution;

[0037] FIG. 4 shows a third application circuit of the algorithm in accordance with the technical solution;

[0038] FIG. 5 shows a fourth application circuit of the algorithm in accordance with the technical solution.

DESCRIPTION OF THE EMBODIMENTS

[0039] The content of the present disclosure is further described below with reference to the accompanying drawings and preferred specific embodiments of the present invention. The examples set forth are merely illustrative of the present invention and are not intended to limit the scope of the present invention.

[0040] As shown in FIG. 1 to FIG. 5, a non-sensor type closed-loop stabilization control algorithm in an embodiment 1 of the solution comprises a resistance calculation module, a counter electromotive force calculation module, and a closed-loop stabilization control module.

[0041] As shown in FIG. 1, the non-sensor type closed-loop stabilization control algorithm in the embodiment 1 comprises the following steps: reading, by the resistance calculation module, all voltages V.sub.k−1 and currents I.sub.k−1 of one multi-axis stabilization motor, and calculating and outputting all coil resistances R.sub.k−1 in the multi-axis stabilization motor; reading, by the counter electromotive force calculation module, all the resistances, voltages and currents, and calculating and outputting counter electromotive force E.sub.k−1 of all coils in the multi-axis stabilization motor; reading, by the closed-loop stabilization control module, a stabilization compensation angle or/and distance θ.sub.k, and each coil resistance and the counter electromotive force, and calculating and outputting a closed-loop stabilization control F.sub.k; and then waiting for a time step k=k+1, and continuously repeating the steps.

[0042] As shown in FIG. 2, the embodiment 1 further comprises an application circuit of the algorithm, which comprises a driving circuit, an induced circuit, and a multi-axis stabilization motor; the driving circuit outputs a stabilization control according to the algorithm to drive the multi-axis stabilization motor; the induced circuit detects all voltages and currents output to the multi-axis stabilization motor by the driving circuit, and outputs the voltages and currents to the algorithm; and the algorithm calculates and outputs the closed-loop stabilization control according to the input stabilization compensation angle and the voltages and currents.

[0043] In the embodiment 1, the movement speed {dot over (x)}.sub.k of a plurality of coils of the multi-axis stabilization motor with respect to the magnets may affect the counter electromotive force E.sub.k in the driving circuit, as well as a relationship between the voltage V.sub.k and the current I.sub.k. When the movement speed rises, an absolute value of the counter electromotive force may also increase.

[0044] The algorithm and the application circuit in the embodiment 1 can drive the multi-axis stabilization motor for stabilization motion, thus compensating image blurring caused by vibration and improving image definition.

[0045] FIG. 3 is a non-sensor type closed-loop stabilization control algorithm in the embodiment 2 of the present invention, and an application circuit thereof. Different from the embodiment 1, a stabilization compensation angle calculation module is added in the embodiment 2 to read a signal of a vibration sensor, calculate a multi-axis stabilization compensation angle and/or distance, and output the multi-axis stabilization compensation angle and/or distance to the closed-loop stabilization control module. Moreover, the non-sensor type closed-loop stabilization control algorithm in the embodiment 2 comprises a memory capable of storing a control signal (current or voltage) of the closed-loop stabilization control module to be used by the resistance calculation module and the counter electromotive force calculation module at a next time step; and there is no need to read a related signal through the induced circuit, thus a more simplified induced circuit is achieved.

[0046] FIG. 4 is an application circuit in an embodiment 3 of the present invention. The application circuit corresponds to an algorithm in the embodiment 2, and comprises a current driving circuit, two induced circuits, a micro controller, a vibration sensor, and a multi-axis stabilization motor; the induced circuit 1 comprises a plurality of resistors and capacitors to form a plurality of low-pass filters which are connected to the output of the current driving circuit to filter out high-frequency noise in the output; the current driving circuit, the induced circuit 1 and the micro controller are integrated into one stabilization control chip; the induced circuit 2 comprises a plurality of amplifiers and a multi-channel analog-to-digital converter;

[0047] the input of the induced circuit 2 is connected to the filter in the induced circuit 1 and then output; the output of the induced circuit 2 is connected to the input of the micro controller; the micro controller can read a plurality of output voltages of the current driving circuit through the induced circuits 1 and 2; and through the memory, the micro controller stores the current of the multi-axis stabilization motor at the previous time step; after reading the vibration sensor and performing the stabilization compensation angle calculation algorithm and the non-sensor type closed-loop stabilization control algorithm, the micro controller calculates and outputs a control signal to the current driving circuit, and stores the current in the memory in the micro controller to be used by the two algorithms at the next time step.

[0048] FIG. 5 is an application circuit in an embodiment 4 of the present invention, which is similar to the application circuit in the embodiment 3. Except that the embodiment 4 employs a voltage driving circuit, capacitance and resistance combinations of different induced circuits 1, the micro controller reads a plurality of currents of the voltage driving circuit through the induced circuits 1 and 2, and the micro controller calculates and outputs the driving voltage, and stores a related signal in the memory in the micro controller.

[0049] As the stabilization control chips in the embodiments 3 and 4 are similar to control chips popular in the market at present, when the algorithms and circuits in the embodiments 3 and 4 are applied, the traditional stabilization control chip can be adopted, external electronic parts and circuits are simplified, and the cost and volume are reduced.

[0050] A damping coefficient of a spring oscillator system in the multi-axis stabilization motor can be changed by adjusting a.sub.i (the gain of the corresponding coil group i in the closed-loop stabilization control) of the equation 9 in the non-sensor type closed-loop stabilization control algorithm in the micro processor. The large damping coefficient and damping ration can be achieved by improving a.sub.i.

[0051] Preferably, when the damping ratio is adjusted to be between 0.4 and 1.4 (Near Critical Damping), the multi-axis stabilization motor can reach an approximate excellent stabilization effect, thus reducing the risk of image blurring caused by the resonance.

[0052] As the algorithm and the application circuit thereof in the embodiment do not require an additional sensor in the motor, the motor and the module can be effectively simplified, and the size and cost of the motor and module are reduced.

[0053] In other embodiments, relevant resistances in the driving circuit and the induced circuit are added when the coil resistance R.sub.k−1 is calculated; the number of multi-axis vibration motors or the number of input channels are changed; no control output signal is stored to the memory; the number and combination of the resistance calculation modules, the counter electromotive force calculation modules or the closed-loop stabilization control modules are changed; the number and combination of inducted circuits or driving circuits are changed; the number and combination of analog-to-digital converters, amplifiers and resistors or capacitors in the induced circuit are changed; all capacitors in the induced circuit are removed; and a vibration sensor is also removed, all of which is also within the scope of protection of the present invention.

[0054] The foregoing is only preferred exemplary embodiments of the present invention and is not intended to be limiting of the present invention, and any modifications, equivalent substitutions, improvements and the like within the spirit and principles of the present invention are intended to be embraced by the protection range of the present invention.