WO2018076937A1

WO2018076937A1 - Voice coil electric motor control method and system, and controller

Info

Publication number: WO2018076937A1
Application number: PCT/CN2017/100909
Authority: WO
Inventors: 李建伟; 潘奕; 彭世昌; 丁庆
Original assignee: 深圳市太赫兹系统设备有限公司; 深圳市太赫兹科技创新研究院
Priority date: 2016-10-31
Filing date: 2017-09-07
Publication date: 2018-05-03
Also published as: CN106533318A

Abstract

A voice coil electric motor (30) control method and system, and a controller (10). The voice coil electric motor (30) is electrically connected to a drive circuit (20) and is mechanically connected to a displacement sensor (40), and the drive circuit (20) and the displacement sensor (40) are both electrically connected to the controller (10). By means of using a digital signal to perform closed-loop control on a voice coil electric motor (30), interference from electromagnetic reflection and mechanical vibration of the voice coil electric motor (30) can be avoided, such that the reliability is high and a peripheral circuit is simple.

Description

Voice coil motor control method, system and controller

[0001] The embodiment of the invention belongs to the technical field of voice coil motor control, and in particular, to a voice coil motor control method, system and controller.

Background technique

[0002] Voice coil motors are widely used in optical delay devices of terahertz gamma spectrometers with high signal frequencies because of their high frequency response and high precision.

[0003] However, the current optical delay device usually uses an analog signal to perform closed-loop control on the voice coil motor, and the analog signal is susceptible to electromagnetic reflection and mechanical vibration interference of the voice coil motor, and the reliability is low, and the peripheral circuit is complicated.

technical problem

[0004] Embodiments of the present invention provide a voice coil motor control method, system, and controller, which use a digital signal to perform closed-loop control on a voice coil motor, thereby avoiding interference from electromagnetic reflection and mechanical vibration of a voice coil motor, and high reliability. And the peripheral circuit is simple.

Problem solution

Technical solution

[0005] An embodiment of the present invention provides a voice coil motor control method, the voice coil motor is electrically connected to a driving circuit and mechanically connected to a displacement sensor, and the driving circuit and the displacement sensor are electrically connected to a controller. The voice coil motor control method includes the following operations performed by the controller:

[0006] receiving a power-on start command, outputting two first preset duty ratio pulse width modulation signals to control the driving circuit to output a first preset current signal, to drive the voice coil motor to first The speed moves in the first direction;

[0007] detecting whether the zero point signal output by the displacement sensor is a high level signal, and the zero point signal is used to indicate whether the voice coil motor reaches a preset zero point position;

[0008] If the zero signal is a high level signal, outputting two second predetermined duty cycle pulse width modulation signals to control the driving circuit to output a second preset current signal to control the voice coil motor At the second speed Two-way movement;

[0009] counting the number of pulses output by the displacement sensor from a preset initial value, and detecting whether the number of pulses reaches a preset number;

[0010] if the number of pulses reaches a preset number, controlling the driving circuit to change a direction of the second preset current signal, and detecting whether the voice coil motor moves in the first direction;

[0011] if the voice coil motor moves in the first direction, the number of pulses output by the displacement sensor is counted up, the counted value is cleared and the counting is stopped, until the zero point signal is detected again. The high level signal 吋 returns the operation of outputting the pulse width modulation signals of the two second preset duty ratios.

[0012] An embodiment of the present invention further provides a controller, the voice coil motor is electrically connected to a driving circuit, and is mechanically connected to a displacement sensor, wherein the driving circuit and the displacement sensor are electrically connected to a controller, The controller includes:

[0013] a first motion control unit, configured to output a pulse width modulation signal of two first preset duty cycles to control the driving circuit to output a first preset current signal to drive The voice coil motor moves in a first direction at a first speed;

[0014] a zero point detecting unit, configured to detect whether a zero point signal output by the displacement sensor is a high level, and the zero point signal is used to indicate whether the voice coil motor reaches a zero point position;

[0015] a second motion control unit, configured to: if the zero signal is a high level signal, output a pulse width modulation signal of two second preset duty cycles to control the driving circuit to output a second preset current signal Controlling the voice coil motor to move in a second direction at a second speed;

[0016] a first counting unit, configured to count the number of pulses output by the displacement sensor from a preset initial value, and detect whether the number of pulses reaches a preset number;

[0017] a third motion control unit, configured to: if the number of the pulses reaches a preset number, control the driving circuit to change a direction of the second preset current signal, and detect whether the voice coil motor is along The first direction of motion;

[0018] a second counting unit, configured to: if the voice coil motor moves in the first direction, perform inverse counting on the number of pulses output by the displacement sensor, clear the counted value, and stop counting until It is detected again that the zero signal is a high level signal 吋, and the operation of outputting the pulse width modulation signals of the two second preset duty ratios is returned. [0019] Embodiments of the present invention also provide a voice coil motor control system including a controller, a driving circuit, a voice coil motor, and a displacement sensor;

[0020] the first signal output end of the controller is connected to the first signal input end of the driving circuit, and the second signal output end of the controller is connected to the second signal input end of the driving circuit; a first signal output end of the circuit is connected to one end of the moving coil winding of the voice coil motor, and a second signal output end of the driving circuit is connected to the other end of the moving coil winding of the voice coil motor; The coil mover is mechanically connected to one end of the movable portion of the displacement sensor; the signal acquisition output end of the displacement sensor is connected to the first signal input end of the controller;

[0021] the controller is configured to output two pulse width modulation signals with adjustable duty cycles to the driving circuit;

[0022] the driving circuit is configured to output a forward or reverse current signal according to the two pulse width modulation signals to control forward or reverse movement of the voice coil motor;

[0023] the displacement sensor is configured to detect the number of movements of the coil mover of the voice coil motor to reciprocate, and feed back the number of motions to the controller in the form of a pulse signal, and is also used for Detecting, when detecting that the coil mover reaches a preset zero position, outputting a high level signal to the controller;

[0024] The controller is further configured to execute the voice coil motor control method described above.

Advantageous effects of the invention

Beneficial effect

[0025] In the embodiment of the present invention, the closed loop control of the voice coil motor by using the digital signal can avoid interference of electromagnetic reflection and mechanical vibration of the voice coil motor, high reliability, and simple peripheral circuit.

Brief description of the drawing

DRAWINGS

[0026] In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the drawings used in the description of the embodiments will be briefly described below. Obviously, the drawings in the following description are some implementations of the present invention. For example, other drawings may be obtained from those of ordinary skill in the art in light of the inventive work.

1 is a block diagram showing the structure of a voice coil motor control system according to an embodiment of the present invention;

2 is a schematic diagram of a mechanical connection structure between a voice coil motor, a grating displacement sensor, and a stroke switch according to an embodiment of the present invention; 3 is a flow chart showing a method of controlling a voice coil motor according to an embodiment of the present invention;

4 is a block diagram showing the structure of a controller according to an embodiment of the present invention.

Embodiments of the invention

The technical solutions in the embodiments of the present invention will be clearly described in conjunction with the drawings in the embodiments of the present invention, and the embodiments are described. It is an embodiment of the invention, but not all of the embodiments. All other embodiments obtained by a person of ordinary skill in the art based on the embodiments of the present invention without departing from the inventive scope are intended to fall within the scope of the invention.

[0032] The term "comprising" and variations of the invention in the specification and claims of the invention and the above description are intended to cover a non-exclusive inclusion. For example, a process, method or system, product or device comprising a series of steps or units is not limited to the listed steps or units, but optionally also includes steps or units not listed, or alternatively also includes Other steps or units inherent to these processes, methods, products or equipment. Further, the terms "first", "second", "third", etc. are used to distinguish different objects, and are not intended to describe a particular order.

As shown in FIG. 1, an embodiment of the present invention provides a voice coil motor control system including a controller 10, a drive circuit 20, a voice coil motor 30, and a displacement sensor 40. In Figure 1, the solid line with arrows indicates the direction of signal transmission, and the solid line without arrows indicates the mechanical connection.

[0034] The first signal output end of the controller 10 is connected to the first signal input end of the driving circuit 20, and the second signal output end of the controller 10 is connected to the second signal input end of the driving circuit 20.

[0035] In this embodiment, the controller 10 can be implemented by a Field Programmable Gate Array (FPGA). The high-speed signal processing capability and powerful parallel processing capability of the field programmable logic device enable the controller to quickly and closed-loop control the voice coil motor through digital signals, improving data processing efficiency. In a specific application, the controller 10 can also be implemented by a general-purpose integrated circuit, such as a CPU (Central Processing Unit), or by an ASIC (Application Specific Integrated Circuit).

[0036] The first signal output end of the drive circuit 20 is connected to one end of the moving coil winding of the voice coil motor 30, and the second signal output end of the drive circuit 20 is connected to the other end of the moving coil winding of the voice coil motor 30. [0037] In this embodiment, the driving circuit 20 selects an H-bridge circuit, the first AC end of the H-bridge circuit is a first signal input end of the driving circuit, and the second AC end of the H-bridge circuit is a a second signal input end of the driving circuit, a first DC output end of the H-bridge circuit is a first signal output end of the driving circuit, and a second DC output end of the H-bridge circuit is the driving circuit The second signal output. In specific applications, other types of drive circuits can be used for the drive circuit.

[0038] The coil mover of the voice coil motor 30 is mechanically coupled to one end of the movable portion of the displacement sensor 40.

[0039] The signal acquisition output of the displacement sensor 40 is terminated to the first signal input terminal of the controller 10;

[0040] In this embodiment, the displacement sensor 40 is a grating displacement sensor. The grating displacement sensor can achieve nanometer position accuracy, ensuring that the voice coil motor control system is applied to the optical delay device of the terahertz gamma spectrometer, and the collected terahertz spectrum has good repeatability.

[0041] As shown in FIG. 2, the movable portion of the displacement sensor 40 is a sliding guide 41 of the grating displacement sensor, and the grating scale 42 of the grating displacement sensor is fixed to the sliding guide of the grating displacement sensor by mechanical fixing or pasting. At 41, the signal acquisition output of the displacement sensor 40 is the readhead 43 of the raster displacement sensor. In Fig. 2, 44 is the zero-point line position of the grating displacement sensor, and 31 is the coil mover of the voice coil motor 30.

[0042] As shown in FIG. 2, in the embodiment, the voice coil motor control system further includes a stroke switch 50, and the moving end of the stroke switch 50 is mechanically connected with the other end of the slide rail 41, and the stroke is 50 The fixed end is connected to the high level signal, and the signal output end of the stroke switch 50 (not shown) is connected to the second signal input end of the controller 10. In the present embodiment, the fixed end of the stroke switch 50 is connected to a 3.3V high level signal.

[0043] The stroke switch 50 is configured to output a high level signal to the second signal input end of the controller 10 through its signal output end in contact with the movable end and the stationary end thereof, so that the controller knows that the The controller knows that the operating states of the drive circuit, the voice coil motor and the movement sensor are normal.

[0044] In this embodiment, the principle of detecting whether each device in the voice coil motor control system works normally by the stroke threshold 50 is:

[0045] If the devices in the voice coil motor control system are normally powered on, the drive circuit 20 normally drives the coil mover 31 of the voice coil motor 30 to reciprocate mechanically, thereby causing the slide rail 41 of the motion sensor 40 to move normally. , causing the moving end of the travel switch 50 to contact with the fixed end, transmitting a high level signal to the second signal input end of the controller 10, so that the controller 10 receives the high level signal; otherwise, if the voice coil Motor control The controller 10 is unable to receive a high level signal transmitted via the stroke switch 50 if the devices in the system are not operating normally. Therefore, the stroke threshold 50 can be used to detect whether each device in the voice coil motor control system is normally powered up.

[0046] In a specific application, the read head 43 is connected to the controller 10 through a DB15 connector, and the signal outputted by the grating displacement sensor mainly includes two differential signals with a phase difference of 90 degrees and the detected voice coil motor reaches its zero mark. The zero signal of the position.

As shown in FIG. 2, in the present embodiment, the zero-dotted line position 44 is disposed on the side of the scale 42 adjacent to the coil mover 31.

[0048] The working principle of the voice coil motor control system provided by this embodiment is:

[0049] the controller is configured to output two pulse width modulation signals (PWM signals) with adjustable duty cycles to the driving circuit;

[0050] the driving circuit is configured to output a forward or reverse current signal according to the two pulse width modulation signals to control forward or reverse movement of the voice coil motor;

[0051] the displacement sensor is configured to detect the number of movements of the coil mover of the voice coil motor to reciprocate, and feed back the number of motions to the controller in the form of a pulse signal, and is also used for The detecting outputs a high level signal to the controller upon detecting that the coil mover reaches the preset zero position.

[0052] In a specific application, in the two pulse width modulation signals output by the controller, when the first signal is a high level signal and the second signal is a low level signal, the direction of the current signal output by the driving circuit is Forward; when the first signal is a low level signal and the second signal is a high level signal 吋, the direction of the current signal output by the driving circuit is negative (ie, reverse).

[0053] In the embodiment of the invention, the closed loop control of the voice coil motor by using the digital signal can avoid interference of electromagnetic reflection and mechanical vibration of the voice coil motor, high reliability, and simple peripheral circuit.

[0054] As shown in FIG. 3, an embodiment of the present invention further provides a voice coil motor control method, which is based on FIG. 1 or

The hardware structure in the corresponding embodiment is implemented, and the voice coil motor control method includes the following operations performed by the controller 10:

[0055] S101: if receiving a power-on start command, outputting two first preset duty ratio pulse width modulation signals to control the driving circuit to output a first preset current signal to drive the voice coil motor to The first speed moves in the first direction. [0056] In a specific application, the first preset duty ratio may be set according to actual needs. In this embodiment, one of the pulse width modulation signals is set to a +5V high level signal, and the other pulse width modulation signal is a -5V low level signal, and the first preset duty ratio is 50%. Taking FIG. 2 as an example, the first direction in this embodiment is rightward. In this embodiment, the first preset current signal is a forward current signal.

[0057] In an embodiment, based on the hardware structure in the embodiment corresponding to FIG. 2, step S101 specifically includes

[0058] if a power-on start command is received, detecting whether the switch signal becomes a high level signal, and if so, outputting two first preset duty ratio pulse width modulation signals to control the driving circuit to output the first A current signal is preset to drive the voice coil motor to move in a first direction at a first speed.

[0059] In this embodiment, the signal is transmitted to the controller 10 by the stroke switch 50. When the moving end of the stroke switch 50 contacts the fixed end to close the stroke switch 50, the 幵The off signal becomes a high level signal. When the moving end and the fixed end of the stroke switch 50 are not in contact to make the stroke switch 50 off, the off signal is 0, that is, there is no signal.

[0060] S102: Detect whether the zero point signal output by the displacement sensor is a high level signal, and the zero point signal is used to indicate whether the voice coil motor reaches a preset zero point position.

[0061] Taking FIG. 2 as an example, in this embodiment, the zero point signal is the reading position of the grating displacement sensor is read to the zero point line position of the grating ruler, and the representation of the voice coil motor to the controller reaches the preset. The signal at the zero position. In this embodiment, the preset zero position is the zero-point line position of the grating displacement sensor.

[0062] S103: if the zero signal is a high level signal, outputting two second preset duty ratio pulse width modulation signals to control the driving circuit to output a second preset current signal to control the sound The ring motor moves in a second direction at a second speed.

[0063] In a specific application, the second preset duty ratio may be set according to actual needs. In this embodiment, one of the pulse width modulation signals is set to a +5V high level signal, and the other pulse width modulation signal is a -5V low level signal, and the second preset duty ratio is 90%. Taking FIG. 2 as an example, the second direction in this embodiment is to the left. In this embodiment, the second predetermined current signal is a negative (reverse) current signal.

[0064] S104: Count the number of pulses output by the displacement sensor from a preset initial value, and detect whether the number of pulses reaches a preset number.

[0065] In a specific application, the preset initial value and the preset number may be set as needed, in this embodiment. The preset number is set to 60000. To facilitate counting, set the preset initial value to 0.

[0066] S105: if the number of pulses reaches a preset number, controlling the driving circuit to change a direction of the second preset current signal, and detecting whether the voice coil motor moves in the first direction ;

[0067] S106: if the voice coil motor moves in the first direction, inversely count the number of pulses output by the displacement sensor, clear the counted value, and stop counting until the detected value is detected again. The zero signal is a high level signal 吋, returning to S103.

[0068] In this embodiment, the inverse count refers to counting in descending order of numerical values from large to small, for example, originally

1 counts up to 10, and countdown counts from 10 to 1. In a specific application, the zero signal is detected as a high level signal 吋 again, and the counter value of the counter should be 0, that is, by changing the direction of the second preset current signal, the voice coil motor is along the The first direction of motion causes the voice coil motor to return to the preset zero position, the counter is cleared and stops counting, and returns to S103 and restarts counting.

[0069] In the embodiment, when the zero signal is detected, the counted value is cleared and the counting is stopped and the counting is stopped: the movement of the voice coil motor to the right of the preset zero position is prevented, so that the preset of the detected pulse is made. If the number exceeds the preset number of presets, the motion sequence of the voice coil motor detected by the controller is disordered.

[0070] As shown in FIG. 4, an embodiment of the present invention provides a controller 10 for performing operations S101 to S106 in the embodiment corresponding to FIG. 3, including:

The first motion control unit 101 is configured to: if a power-on start command is received, output a pulse width modulation signal of the first preset duty ratio to control the driving circuit to output the first preset current signal, to Driving the voice coil motor to move in a first direction at a first speed;

[0072] The zero point detecting unit 102 is configured to detect whether a zero point signal output by the displacement sensor is a high level, and the zero point signal is used to indicate whether the voice coil motor reaches a zero point position;

[0073] The second motion control unit 103 is configured to: if the zero signal is a high level signal, output a pulse width modulation signal of two second preset duty cycles to control the driving circuit to output a second preset current a signal to control the voice coil motor to move in a second direction at a second speed;

[0074] The first counting unit 104 is configured to count the number of pulses output by the displacement sensor from a preset initial value, and detect whether the number of pulses reaches a preset number;

[0075] The third motion control unit 105 is configured to: if the number of the pulses reaches a preset number, control the driving circuit to change a direction of the second preset current signal, and detect whether the voice coil motor is Along the first Directional movement

[0076] The second counting unit 106 is configured to: if the voice coil motor moves in the first direction, perform inverse counting on the number of pulses output by the displacement sensor, clear the counted value, and stop counting, Until the detection of the zero signal as the high level signal 再次 again, the operation of outputting the pulse width modulation signals of the two second preset duty ratios is returned.

[0077] In a specific application, the first counting unit 104 and the second counting unit 106 may be the same counter.

[0078] In an embodiment, the first motion control unit 101 is specifically configured to:

[0079] if a power-on start command is received, detecting whether the switch signal becomes a high level signal, and if so, outputting two first preset duty ratio pulse width modulation signals to control the driving circuit to output the first A current signal is preset to drive the voice coil motor to move in a first direction at a first speed.

[0080] In a specific application, all the units in the embodiments of the present invention may be through a single general-purpose integrated circuit, such as a CPU (Central Processing Unit), or an ASIC (Application Specific Integrated Circuit). ) to realise. In this embodiment, all the units in the embodiments of the present invention are implemented by an internal control circuit or device of the controller.

[0081] The operations in the method of the embodiment of the present invention may be sequentially adjusted, merged, and deleted according to actual needs.

[0082] The units in the controller of the embodiment of the present invention may be combined, divided, and deleted according to actual needs.

[0083] Those skilled in the art can understand that all or part of the process of implementing the above embodiments may be completed by a computer program to instruct related hardware, and the program may be stored in a computer readable storage medium. The program, after execution, may include the flow of an embodiment of the methods as described above. The storage medium may be a magnetic disk, an optical disk, or a read-only storage memory (Read-Only)

Memory, ROM) or Random Access Memory (RAM).

The above description is only the preferred embodiment of the present invention, and is not intended to limit the present invention. Any modifications, equivalent substitutions and improvements made within the spirit and principles of the present invention should be included in the present invention. Within the scope of protection of the invention.

Claims

Claim

[Claim 1] A voice coil motor control method, wherein the voice coil motor is electrically connected to a driving circuit and mechanically connected to a displacement sensor, and the driving circuit and the displacement sensor are electrically connected to a controller, The voice coil motor control method includes the following operations performed by the controller:

If a power-on start command is received, outputting two first preset duty ratio pulse width modulation signals to control the driving circuit to output a first preset current signal to drive the voice coil motor to the first speed One direction of movement;

Detecting whether the zero point signal output by the displacement sensor is a high level signal, the zero point signal is used to indicate whether the voice coil motor reaches a preset zero point position; if the zero point signal is a high level signal, then outputting two ways The pulse width modulation signal of the second preset duty ratio controls the driving circuit to output a second preset current signal to control the voice coil motor to move in the second direction at the second speed;

Counting the number of pulses output by the displacement sensor from a preset initial value, and detecting whether the number of pulses reaches a preset number;

And if the number of the pulses reaches a preset number, controlling the driving circuit to change a direction of the second preset current signal, and detecting whether the voice coil motor moves in the first direction; When the ring motor moves in the first direction, the number of pulses output by the displacement sensor is counted up, the counted value is cleared and the counting is stopped, until the zero signal is detected as a high level signal again. Returning the operation of outputting the pulse width modulation signals of the two second preset duty ratios.

[Claim 2] The voice coil motor control method according to claim 1, wherein the displacement sensor is a grating displacement sensor, and the zero position is a zero point on the grating scale of the grating displacement sensor Line position.

[Claim 3] The voice coil motor control method according to claim 1, wherein the controller is a field programmable logic device, and the drive circuit is an H-bridge circuit.

[Claim 4] A controller, wherein the voice coil motor is electrically connected to a driving circuit and mechanically coupled to a displacement sensor, wherein the driving circuit and the displacement sensor are electrically connected to a controller The controller includes:

a first motion control unit, configured to output two first preset duty ratio pulse width modulation signals to control the driving circuit to output a first preset current signal to drive the sound if a power-on start command is received The ring motor moves in a first direction at a first speed; a zero point detecting unit is configured to detect whether a zero point signal output by the displacement sensor is a high level, and the zero point signal is used to indicate whether the voice coil motor reaches a zero point position; a second motion control unit, configured to: if the zero signal is a high level signal, output two second preset duty ratio pulse width modulation signals to control the driving circuit to output a second preset current signal to control The voice coil motor moves in a second direction at a second speed;

a first counting unit, configured to count the number of pulses output by the displacement sensor from a preset initial value, and detect whether the number of pulses reaches a preset number; and the third motion control unit is configured to: When the number of the pulses reaches a preset number, the driving circuit is controlled to change the direction of the second preset current signal, and detecting whether the voice coil motor moves in the first direction;

a second counting unit, configured to: if the voice coil motor moves in the first direction, perform inverse counting on the number of pulses output by the displacement sensor, clear the counted value, and stop counting until the detection is performed again. The zero signal is a high level signal 吋, and returns an operation of outputting the pulse width modulation signals of the two second preset duty ratios.

[Claim 5] The voice coil motor control system according to claim 4, wherein the displacement sensor is a grating displacement sensor, and the zero position is a zero point on the grating scale of the grating displacement sensor Line position.

[Claim 6] The voice coil motor control system according to claim 4, wherein the controller is a field programmable logic device, and the driving circuit is an H-bridge circuit.

[Claim 7] A voice coil motor control system, wherein the voice coil motor control system includes a controller, a drive circuit, a voice coil motor, and a displacement sensor;

a first signal output end of the controller is connected to a first signal input end of the driving circuit, and a second signal output end of the controller is connected to a second signal input end of the driving circuit; a signal output terminal connected to one end of the moving coil winding of the voice coil motor, a second signal output end of the driving circuit is connected to the other end of the moving coil winding of the voice coil motor; a coil mover of the voice coil motor is mechanically connected to one end of the movable portion of the displacement sensor; The signal acquisition output is connected to the first signal input end of the controller; the controller is configured to output two pulse width modulation signals with adjustable duty cycles to the driving circuit;

The driving circuit is configured to output a forward or reverse current signal according to the two pulse width modulation signals to control forward or reverse movement of the voice coil motor; and the displacement sensor is configured to detect the a number of motions of the coil motor of the voice coil motor reciprocating, and feeding back the number of motions to the controller in the form of a pulse signal, and also for detecting that the coil mover reaches a preset zero position吋, outputting a high level signal to the controller;

The controller is further configured to execute the voice coil motor control method of claim 1.

[Claim 8] The voice coil motor control system according to claim 7, wherein the voice coil motor control system further includes a stroke switch, the displacement sensor is a grating type displacement sensor, and the displacement sensor is The movable portion is a sliding guide of the grating displacement sensor, the grating guide is fixed with a grating ruler, and the signal acquisition output end of the displacement sensor is a reading head of the grating displacement sensor; One end is mechanically connected to the moving end of the stroke, the fixed end of the stroke is connected to a high level signal, and the signal output end of the stroke is connected to the second signal input end of the controller; The stroke is closed for transmitting a high level signal to the controller at the movable end and the non-moving end thereof, so that the controller knows the driving circuit, the voice coil motor, and the The motion sensor is working properly.

[Claim 9] The voice coil motor control system according to claim 7, wherein the driving circuit is an H-bridge circuit, and the first AC terminal of the H-bridge circuit is a first signal of the driving circuit An input end, a second AC end of the H-bridge circuit is a second signal input end of the driving circuit, and a first DC output end of the H-bridge circuit is a first signal output end of the driving circuit, The second DC output terminal of the H-bridge circuit is the second signal output mountain of the driving circuit [Claim 10] The voice coil motor control system according to claim 7, wherein the controller is a field programmable logic device.