CN106887990B - A kind of voice coil motor position motion control device - Google Patents
A kind of voice coil motor position motion control device Download PDFInfo
- Publication number
- CN106887990B CN106887990B CN201710250592.6A CN201710250592A CN106887990B CN 106887990 B CN106887990 B CN 106887990B CN 201710250592 A CN201710250592 A CN 201710250592A CN 106887990 B CN106887990 B CN 106887990B
- Authority
- CN
- China
- Prior art keywords
- current
- voice coil
- motor
- electric
- coil motor
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P25/00—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details
- H02P25/02—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details characterised by the kind of motor
- H02P25/032—Reciprocating, oscillating or vibrating motors
- H02P25/034—Voice coil motors
Abstract
The invention discloses a kind of voice coil motor position motion control devices.Position by detecting voice coil motor obtains motor position information, motor speed information and current of electric information；Then according to target position and motor position information calculating position error；If the absolute value of location error, which is greater than position, adjusts threshold values, actuating motor aligning step；The motor calibration step includes: according to positional information calculation current of electric direction DrWith motor speed given value Vn；According to motor speed given value VnCalculate current of electric given value Ipn；According to current of electric given value IpnCalculate output electric current In；According to current of electric direction DrWith output electric current InVoice coil motor is driven, to realize the high-speed, high precision control of voice coil motor.
Description
Technical field
The present invention relates to voice coil motor field more particularly to voice coil motor position motion control devices.
Background technique
Currently, as Industry Control develops, it is higher and higher to high speed, high-accuracy position system requirement, thus voice coil motor
Utilization it is also more and more.Such as the positioning of lens in optical system；The multi-coordinate locating platform of machine tool；It is smart in medical apparatus
Close electron tube, vacuum tube control；In flexible robot, for make end effector quickly, be accurately positioned, can also with voice coil electricity
Machine effectively inhibits to vibrate.In short, voice coil motor is on many various forms of high speeds, high precision position, high frequency pumping
It is widely used.
The control device of voice coil motor at present, the bridge circuit being mainly made up of MOSFET, by changing accounting for for pulse
For sky than changing driving current, this mode is relatively suitble to that voltage is high, electric current is big, be not very high occasion to status requirement, with
And motor does simple round-trip movement.In the control strategy of some voice coil motors, position ring is utilized in some improvement strategies
Electric current loop is controlled with speed ring parallel connection, the quick response to position can be reached, but for position precision, range ability
Short, in the fast occasion of the speed of service, position precision will be reduced, and the phenomenon that toning often occur, therefore this scheme is suitable for
Some pairs of position accuracy demands are not high, in the quick round-trip environment of voice coil motor.
Summary of the invention
The present invention, which is that solution is existing, requires position precision height, range ability short voice coil motor, and the speed of service waits environment fastly,
It is particularly suitable for dynamic Laser and focuses occasion, proposes a kind of voice coil motor position motion control device comprising: station acquisition mould
Block, the motor position information E that the position for detecting voice coil motor obtains initial time to current time00~En0, wherein En0For
Current motor positions；Speed acquisition module, the motor that the speed for detecting voice coil motor obtains initial time to current time
Velocity information V00~Vn0, wherein Vn0For current motor speed；Current acquisition module, the electric current for detecting voice coil motor obtain
Current of electric information I of the initial time to current time00~In0, wherein In0For current motor electric current；Control unit is configured to
Execute following steps:
According to positional information calculation current of electric direction DrWith motor speed given value Vn；
According to motor speed given value VnCalculate current of electric given value Ipn；
According to current of electric given value IpnCalculate output electric current In；
According to current of electric direction DrWith output electric current InDrive voice coil motor；
According to current of electric direction DrWith output electric current InIt generates the control parameter of voice coil motor and is transferred to analog-to-digital conversion mould
Block.
Further, according to positional information calculation motor speed given value VnWith current of electric direction DrFormula are as follows:
Vn=Kp1*ΔEn+Ki1*∑E；
Wherein Δ En=En-En0；∑ E=Δ E0+ΔE1+……+ΔEn；Kp1For speed proportional gain, Ki1For rate integrating
Gain, EnFor the motor position of previous moment, En0For current motor positions；
Also, according to location error Δ EnCalculate current of electric direction DrFormula are as follows:
Further, the current of electric given value IpnCalculation formula are as follows:
Ipn=Kp2*ΔVn+Ki2*∑V；
Wherein Δ VnFor present speed deviation, ∑ V is velocity deviation aggregate-value, and Δ Vn=Vn-Vn0；∑ V=Δ V0+Δ
V1+……+ΔVn；Kp2For speed proportional gain, Ki2For rate integrating gain.
Further, according to current of electric IpnCalculate output electric current InCalculation formula are as follows:
In=Kp3*ΔIpn+Ki3*∑I；
Wherein Δ InFor current flow deviation, ∑ I is current deviation aggregate-value, and Δ Ipn=Ipn-In0, ∑ I=Δ I0+Δ
I1+……+ΔIn, Kp3For current ratio gain, Ki2For current integration gain.
Preferably, the station acquisition module includes grating scale or one-dimensional position sensor.
Preferably, the D/A converter module includes first switching device for generating the first driving voltage and one
Generate the second switching device of the second driving voltage.
Preferably, the constant-current driven module include one first with phase operational amplification circuit and one second with phase operation
Amplifying circuit, the voice coil motor are connected to described first with phase operational amplification circuit and described second with phase operational amplification circuit
Output end between.
Preferably, the current acquisition module includes sampling resistor or Hall sensor.
Preferably, described device further includes data communication module, for receiving the target position parameter of voice coil motor.
The beneficial effects of the present invention are: the present invention controls the electric current of voice coil motor using analog circuit control mode, change
Pulse mode is become and has interfered big disadvantage, has greatly improved the control precision of whole system, valve is increased on traditional algorithm
The strategies such as control, control range restriction, enable whole system fast convergence.
Detailed description of the invention
Fig. 1 voice coil motor of embodiment of the present invention position motion control device structure chart；
Fig. 2 constant-current driven module circuit diagram of the embodiment of the present invention；
Fig. 3 voice coil motor of embodiment of the present invention position motion control method flow chart；
The timing diagram of aligning step in the motion control method of Fig. 4 voice coil motor of embodiment of the present invention position.
Specific embodiment
Below in conjunction with attached drawing in the embodiment of the present invention, technical solution in the embodiment of the present invention carries out clear, complete
Ground description, it is clear that described embodiments are only a part of the embodiments of the present invention, instead of all the embodiments.Usually exist
The component of the embodiment of the present invention described and illustrated in attached drawing can be arranged and be designed with a variety of different configurations herein.Cause
This, is not intended to limit claimed invention to the detailed description of the embodiment of the present invention provided in the accompanying drawings below
Range, but it is merely representative of selected embodiment of the invention.Based on the embodiment of the present invention, those skilled in the art are not doing
Every other embodiment obtained under the premise of creative work out, shall fall within the protection scope of the present invention.
Fig. 1 shows a kind of voice coil motor position motion control device structure chart of the invention.With reference to Fig. 1, voice coil motor
Position motion control device includes: station acquisition module 12, speed acquisition module 13, current acquisition module 14, digital-to-analogue conversion mould
Block 16, constant-current driven module 18 and control unit 10.Wherein, the position that station acquisition module 12 is used to detect voice coil motor obtains
Motor position information, it is preferable that the station acquisition module may include grating scale or one-dimensional position sensor；Speed acquisition mould
The speed that block 13 is used to detect voice coil motor obtains motor speed information；Current acquisition module 14 is used to detect the electricity of voice coil motor
Stream obtains current of electric information, and the current acquisition module 14 may include sampling resistor or Hall sensor；
D/A converter module 16 is used to for the control parameter of voice coil motor being converted into analog voltage control signal.The number
Mould conversion module 16 may include the first switching device and second driving voltage of generation of first driving voltage of generation
The second switching device.First and second switching devices can pass through High Speed Analog digital quantizer (AD) and orthogonal encoder arteries and veins
Rush device realization.
In combination with Fig. 2, Fig. 2 shows the circuit diagrams of constant-current driven module of the present invention.Constant-current driven module 18
The driving current of driving voice coil motor is generated according to analog voltage control signal.As shown in Fig. 2, the constant-current driven module can wrap
One first is included with phase operational amplification circuit A1 and one second with phase operational amplification circuit B1 and resistance R1, R2, R3, R4.
Voice coil motor Motor is serially connected with described first with phase operational amplification circuit A1 and described second with the defeated of phase operational amplification circuit B1
Between outlet.First driving voltage A_BUF can be accessed to the first non-inverting input terminal with phase operational amplification circuit A1, second drives
Non-inverting input terminal of the dynamic voltage B_BUF access second with phase operational amplification circuit B1.Resistance R1 and R2 ratio is the first same Xiang Yun
Magnification ratio coefficient of the amplifying circuit A1 with respect to A_BUF input signal is calculated, resistance R3 and R4 ratio is that operational amplifier B1 is opposite
The magnification ratio coefficient of B_BUF input signal.Work as A_BUF > 0, B_BUF=0, be at this moment added in the both ends voice coil motor Motor is
Forward voltage, voice coil motor Motor forward motion.By the speed of the size control voice coil motor Motor of A_BUF；When working as B_BUF
> 0, A_BUF=0, be at this moment added in the both ends voice coil motor Motor is backward voltage, when voice coil motor Motor counter motion, by
The speed of the size control voice coil motor Motor of B_BUF.
Preferably, described device further includes data communication module 19, for receiving the target position parameter of voice coil motor.Number
According to communication module 19 mould can be communicated for SPI communication module, CAN communication module, serial communication modular or bluetooth communication etc.
Block receives the information such as target position parameter from external upper calculating main frame by wired or wireless connection.
Control unit 10 is configured to execute following steps: according to positional information calculation current of electric direction DrAnd motor speed
Given value Vn；According to motor speed given value VnCalculate current of electric given value Ipn；According to current of electric given value IpnIt calculates defeated
Electric current I outn；According to current of electric direction DrWith output electric current InDrive voice coil motor；According to current of electric direction DrWith output electricity
Flow InIt generates the control parameter of voice coil motor and is transferred to analog-to-digital conversion module.Specific calculation method will be explained in detail below
It states.
Fig. 3 shows a kind of voice coil motor position motion control method flow chart of the invention.With reference to Fig. 3, this method packet
Include following steps:
Step S301 receives target position parameter E using data communication modulen。
Step S302 obtains motor position information using the position of station acquisition module detection voice coil motor；Specifically, can
With the position of multi collect voice coil motor at any time, the motor position sequence of acquisition initial time to the n-th moment (current time)
E00~En0, wherein En0For the current motor position of motor；
Step S303 obtains motor speed information using the speed of speed acquisition module detection voice coil motor；Specifically, may be used
With multi collect motor speed at regular intervals at any time, motor speed sequence V is obtained00~Vn0, wherein VI0For current motor speed
Degree；It should be noted that the process of acquisition motor speed may is that time interval and adjacent moment using detection motor position
The difference of motor position calculates motor speed.
The electric current that step S304 current acquisition module detects voice coil motor obtains current of electric information；Specifically, can be with
Time multi collect current of electric at regular intervals obtains current of electric sequence I00~In0, wherein In0For current motor electric current.
Step S305 is using control unit according to target position parameter EnWith current motor positions En0Current location is calculated to miss
Poor Δ En；Wherein Δ En=En-En0
Step S306 judges that absolute value of the difference is missed in current location | Δ En| whether it is greater than position and adjusts threshold values Emax, if so,
Then actuating motor aligning step S307；If it is not, then can enter step S308 terminates process or continues to test subsequent time
Location error.
In combination with Fig. 4, the motor calibration step S307 may include:
Step S3071, according to positional information calculation current of electric direction DrWith motor speed given value Vn；
Step S3072, according to motor speed given value VnCalculate current of electric given value Ipn；
Step S3073, according to current of electric given value IpnCalculate output electric current In；
Step S3074, according to current of electric direction DrWith output electric current InVoice coil motor is driven by constant-current driven module.
Further, according to positional information calculation motor speed given value VnWith current of electric direction DrFormula are as follows:
Vn=Kp1*ΔEn+Ki1*∑E；
Wherein Δ En=En-En0；∑ E=Δ E0+ΔE1+……+ΔEn；Kp1For speed proportional gain, Ki1For rate integrating
Gain, EnFor the motor position of previous moment, En0For current motor positions；
Also, according to location error Δ EnCalculate current of electric direction DrFormula are as follows:
It should be known that above-mentioned calculating current of electric direction DrFormula in 1 and 0 for indicate current direction forward and reverse
Two logical values, this is that this field field is well-known to the ordinarily skilled artisan.Further, the current of electric given value Ipn
Calculation formula are as follows:
Ipn=Kp2*ΔVn+Ki2*∑V；
Wherein Δ VnFor present speed deviation, ∑ V is velocity deviation aggregate-value, and Δ Vn=Vn-Vn0；∑ V=Δ V0+Δ
V1+……+ΔVn；Kp2For speed proportional gain, Ki2For rate integrating gain.
Further, according to current of electric IpnCalculate output electric current InCalculation formula are as follows:
In=Kp3*ΔIpn+Ki3*∑I；
Wherein Δ InFor current flow deviation, ∑ I is current deviation aggregate-value, and Δ Ipn=Ipn-In0, ∑ I=Δ I0+Δ
I1+……+ΔIn, Kp3For current ratio gain, Ki2For current integration gain.
Further, the method also includes adjusting threshold values E according to control precision setmaxThe step of；It can according to need
To adjustment threshold value EmaxIt is set.Specifically, user, which can use external upper computing device, passes through data communication module to control
Unit processed sends new adjustment threshold value.
Further, as the motor speed given value VnGreater than motor maximum speed VmaxWhen, V can be takenn=Vmax。
Further, as the current of electric given value IpnGreater than the maximum current I of motormaxWhen, I can be takenpn=
Imax.Motor maximum speed VmaxIt can be set according to motor characteristic, motor maximum current ImaxIt can also be set according to motor characteristic
It is fixed.
The present invention controls the electric current of voice coil motor using analog circuit control mode, changes pulse mode and interferes big
Disadvantage greatly improves the control precision of whole system, and the plans such as valve control, control range restriction are increased on traditional algorithm
Slightly, enable whole system fast convergence.
Any process described otherwise above or method description are construed as in flow chart or herein, and expression includes
It is one or more for realizing specific logical function or process the step of executable instruction code module, segment or portion
Point, and the range of the preferred embodiment of the present invention includes other realization, wherein can not press shown or discussed suitable
Sequence, including according to related function by it is basic simultaneously in the way of or in the opposite order, Lai Zhihang function, this should be of the invention
Embodiment person of ordinary skill in the field understood.
It should be appreciated that each section of embodiments of the present invention can be with hardware, software, firmware or their combination come real
It is existing.In the above-described embodiment, multiple steps or method can be with storages in memory and by suitable instruction execution system
The software or firmware of execution is realized.For example, if realized with hardware, in another embodiment, ability can be used
Any one of following technology or their combination well known to domain is realized: being had for realizing logic function to data-signal
The discrete logic of logic gates, the specific integrated circuit with suitable combinational logic gate circuit, programmable gate array
(PGA), field programmable gate array (FPGA) etc..Those skilled in the art are understood that realize above-described embodiment
The all or part of the steps that method carries is that relevant hardware can be instructed to complete by program, and the program can store
In a kind of computer readable storage medium, which when being executed, includes the steps that one or a combination set of embodiment of the method.
Any process described otherwise above or method description are construed as in flow chart or herein, and expression includes
It is one or more for realizing specific logical function or process the step of executable instruction code module, segment or portion
Point, and the range of the preferred embodiment of the present invention includes other realization, wherein can not press shown or discussed suitable
Sequence, including according to related function by it is basic simultaneously in the way of or in the opposite order, Lai Zhihang function, this should be of the invention
Embodiment person of ordinary skill in the field understood.
Although an embodiment of the present invention has been shown and described, it will be understood by those skilled in the art that: not
A variety of change, modification, replacement and modification can be carried out to these embodiments in the case where being detached from the principle of the present invention and objective, this
The range of invention is defined by the claims and their equivalents.
Claims (6)
1. a kind of voice coil motor position motion control device characterized by comprising
Station acquisition module, the motor position information E that the position for detecting voice coil motor obtains initial time to current time00
~En0, wherein En0For current motor positions；
Speed acquisition module, the motor speed information V that the speed for detecting voice coil motor obtains initial time to current time00
~Vn0, wherein Vn0For current motor speed；
Current acquisition module, the current of electric information I that the electric current for detecting voice coil motor obtains initial time to current time00
~In0, wherein In0For current motor electric current；
D/A converter module, for the control parameter of voice coil motor to be converted into analog voltage control signal；
Constant-current driven module controls the driving current that signal generates driving voice coil motor according to analog voltage；
Control unit is configured to execute following steps:
According to positional information calculation current of electric direction DrWith motor speed given value Vn；
According to motor speed given value VnCalculate current of electric given value Ipn；
According to current of electric given value IpnCalculate output electric current In；
According to current of electric direction DrWith output electric current InDrive voice coil motor；
According to current of electric direction DrWith output electric current InIt generates the control parameter of voice coil motor and is transferred to analog-to-digital conversion module,
According to positional information calculation motor speed given value VnWith current of electric direction DrFormula are as follows:
Vn=Kp1*ΔEn+Ki1*∑E；
Wherein Δ En=En-En0；∑ E=Δ E0+ΔE1+……+ΔEn；Kp1For speed proportional gain, Ki1For rate integrating increasing
Benefit, EnFor the motor position of previous moment, En0For current motor positions；
Also, according to location error Δ EnCalculate current of electric direction DrFormula are as follows:
Above-mentioned calculating current of electric direction DrFormula in 1 and 0 be indicate current direction forward and reverse two logical values,
The current of electric given value IpnCalculation formula are as follows:
Ipn=Kp2*ΔVn+Ki2*∑V；
Wherein Δ VnFor present speed deviation, ∑ V is velocity deviation aggregate-value, and Δ Vn=Vn-Vn0；∑ V=Δ V0+ΔV1
+……+ΔVn；Kp2For speed proportional gain, Ki2For rate integrating gain, according to current of electric given value IpnCalculate output electricity
Flow InCalculation formula are as follows:
In=Kp3*ΔIpn+Ki3*∑I；
Wherein Δ InFor current flow deviation, ∑ I is current deviation aggregate-value, and Δ Ipn=Ipn-In0, ∑ I=Δ I0+ΔI1
+……+ΔIn, Kp3For current ratio gain, Ki2For current integration gain.
2. voice coil motor position as described in claim 1 motion control device, which is characterized in that the station acquisition module packet
Include grating scale or one-dimensional position sensor.
3. voice coil motor position as described in claim 1 motion control device, which is characterized in that the D/A converter module
Second switching device of the first switching device for generating the first driving voltage including one and second driving voltage of generation.
4. voice coil motor position as described in claim 1 motion control device, which is characterized in that the constant-current driven module packet
One first is included with phase operational amplification circuit and one second with phase operational amplification circuit, the voice coil motor is connected to described
Together between phase operational amplification circuit and the described second output end with phase operational amplification circuit.
5. voice coil motor position as described in claim 1 motion control device, which is characterized in that the current acquisition module
Including sampling resistor or Hall sensor.
6. voice coil motor position as described in claim 1 motion control device, which is characterized in that described device further includes data
Communication module, for receiving the target position parameter of voice coil motor.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710250592.6A CN106887990B (en) | 2017-04-17 | 2017-04-17 | A kind of voice coil motor position motion control device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710250592.6A CN106887990B (en) | 2017-04-17 | 2017-04-17 | A kind of voice coil motor position motion control device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN106887990A CN106887990A (en) | 2017-06-23 |
| CN106887990B true CN106887990B (en) | 2019-04-23 |
Family
ID=59183393
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201710250592.6A Active CN106887990B (en) | 2017-04-17 | 2017-04-17 | A kind of voice coil motor position motion control device |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN106887990B (en) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111083347B (en) * | 2018-10-22 | 2021-04-20 | 杭州海康威视数字技术股份有限公司 | Lens drive control device, lens drive device and camera |
| CN112468024A (en) * | 2020-10-28 | 2021-03-09 | 深圳市兆威机电股份有限公司 | Motor jitter control method, control device, terminal equipment and storage medium |
Family Cites Families (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP2216898B1 (en) * | 2009-02-09 | 2020-04-01 | Analog Devices, Inc. | Control techniques for motor driven systems |
| CN105305912B (en) * | 2015-09-29 | 2018-01-09 | 芯荣半导体有限公司 | Input signal shaping methods, drive circuit and its driving method of voice coil motor |
| CN105958898B (en) * | 2016-06-01 | 2018-09-11 | 深圳德康威尔科技有限公司 | Voice coil motor driver and its control method |
| CN106533318A (en) * | 2016-10-31 | 2017-03-22 | 深圳市太赫兹系统设备有限公司 | Voice coil motor control method and system and controller |
-
2017
- 2017-04-17 CN CN201710250592.6A patent/CN106887990B/en active Active
Also Published As
| Publication number | Publication date |
|---|---|
| CN106887990A (en) | 2017-06-23 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN106953579B (en) | A kind of voice coil motor position motion control method | |
| CN101960714B (en) | Self-calibration algorithms in a small motor driver IC with an integrated position sensor | |
| US9612600B2 (en) | Controller of linear motion device and control method of the same | |
| CN106887990B (en) | A kind of voice coil motor position motion control device | |
| CN106949822B (en) | Real-time displacement feedback system and feedback method of micro device | |
| CN104423009A (en) | Optical instrument, and control method for optical instrument | |
| CN104516086A (en) | Control system and method of fast-steering mirror | |
| US20140183346A1 (en) | Position detection apparatus, drive control apparatus, and lens apparatus | |
| CN110519687B (en) | Accurate positioning method and system suitable for robot and robot | |
| CN100388620C (en) | Method for improving permanent-magnetic linear motor motion precision | |
| US10364103B2 (en) | Conveyor systems and methods of controlling moving stage | |
| CN100549627C (en) | The initial point signal generating method and the device of scrambler | |
| CN115800840A (en) | Dynamic control method and device of stepping motor and position following system | |
| CN1225638C (en) | Sensor system and drive adjusting device set therewith, and internal communication networking method | |
| KR20200057503A (en) | Robot calibration system and calibration method thereof | |
| CN109478066A (en) | Mobile robot and control method | |
| CN104539245A (en) | Self-zeroing circuit of operational amplifier | |
| US9923573B2 (en) | Method and device for reading a serial data stream | |
| CN109842350A (en) | A kind of mechanical positioning methods based on analysis current changing rate | |
| CN109240216B (en) | Dynamic process control method of parallel servo system and information data processing terminal | |
| EP1798849A2 (en) | A system and method for drift compensation when using pulse count controlled motors | |
| JP5679575B2 (en) | Position detection device | |
| CN113648064B (en) | Position control system and method for surgical robot motor | |
| WO2014136230A1 (en) | Distributed control device and control method | |
| CN116300623B (en) | Fly-swatting control method, device, system and storage medium |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |