CN102332859B - Closed-loop control method and system for stepping motor - Google Patents

Closed-loop control method and system for stepping motor Download PDF

Info

Publication number
CN102332859B
CN102332859B CN201110274592.2A CN201110274592A CN102332859B CN 102332859 B CN102332859 B CN 102332859B CN 201110274592 A CN201110274592 A CN 201110274592A CN 102332859 B CN102332859 B CN 102332859B
Authority
CN
China
Prior art keywords
motor
module
count value
stepping motor
loop control
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.)
Expired - Fee Related
Application number
CN201110274592.2A
Other languages
Chinese (zh)
Other versions
CN102332859A (en
Inventor
诸葛琳娜
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Tianjin Yaan Technology Co Ltd
Original Assignee
Tianjin Yaan Technology Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Tianjin Yaan Technology Co Ltd filed Critical Tianjin Yaan Technology Co Ltd
Priority to CN201110274592.2A priority Critical patent/CN102332859B/en
Publication of CN102332859A publication Critical patent/CN102332859A/en
Application granted granted Critical
Publication of CN102332859B publication Critical patent/CN102332859B/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Abstract

The invention belongs to the field of video monitoring, and provides a closed-loop control method and system for a stepping motor. In the method, several simple position detection elements are used to simulate the working mode of an encoder; a software and hardware filtering module enables the received information to be more correct; a separate control chip is especially used to receive position signal and correct the motor count value; and only useful information is transferred to a main control module, therefore the time the main control module takes for processing invalid information is saved and the execution of other necessary functions of the main control module can be ensured. In addition, through the method, the cost increase caused by the adoption of a professional encoder is greatly reduced; and as multiple single chips are used for data processing, the cost of single chips is remarkably reduced, and the structure and installation can be realized easily.

Description

A kind of closed loop control method for stepping motor and system
Technical field
The invention belongs to field of video monitoring, particularly relate to a kind of closed loop control method for stepping motor and system.
Background technology
At present, opened loop control application for stepping motor is very general, due to the improvement of motor manufacture craft, the optimization of type of drive, want to accomplish to make stepping motor not lose step still very easy, but the step angle due to stepping motor itself can not meet actual control precision requirement usually, this will increase a lot of drive disk assembly for motor, to realize the hardware subdivision controlled.Drive disk assembly limits by the manufacture craft of itself on the one hand, on the other hand along with the growth of service time, mechanical wear situation is also inevitable, this just makes motor and driving section branch inevitably occur gap, can not contact very closely, frame amount produces thus, and this can have influence on the control precision of system equally.In order to avoid frame amount has an impact to precision, closed-loop control is utilized to be taken seriously to the thought improving control precision.
More common close-loop control mode is: executive component adopts servomotor or stepping motor, feedback detecting element is encoder (photoelectric encoder, magnetic coder etc.), this control mode is very good beyond doubt in raising precision, but the mode of opened loop control stepping motor of comparing, cost often needs to increase several times, and can not determine the movement angle of motor, the control effects of realizing ideal if want due to other motor, control algolithm is often very complicated.
Summary of the invention
The invention provides a kind of closed loop control method for stepping motor, be intended to the mode that the common close-loop control mode of solution compares opened loop control stepping motor, cost often needs to increase several times, and can not determine the movement angle of motor due to other motor, the control effects of realizing ideal if want, control algolithm is the problem such as very complicated often.
The object of the present invention is to provide a kind of closed loop control method for stepping motor, the method comprises:
Position detecting element and the position signalling of trigger equipment to stepping motor is utilized to feed back;
Anti-tampering process filtering process is carried out to the positional information that each road collects;
The current count value of step motor position information and the count value of benchmark are compared, the error amount drawn and actual count value is carried out arithmetical operation, and revises actual count value.
Another object of the present invention is to provide a kind of closed-loop control system for stepping motor, this closed-loop control system comprises:
For carrying out the position detecting module of position feedback,
Export with described position detecting module and be connected, the positional information for collecting each road carries out the hardware filtering module of anti-tampering process;
Export with described hardware filtering module and be connected, for carrying out motor counting and correction, the algoritic module that count value can be returned when needing to preserve motor current state;
Export with described algoritic module and be connected, running synchronous pulse signal and the count signal of counting direction signal for providing for algoritic module with motor, carrying out motor counting to make algoritic module according to count signal; When motor status preserved by needs, the main control module of the information returned by algoritic module can be received.
The present invention realizes by analog encoder the method improving control precision, and one week of continuous rotation installs multiple position detecting device, and installation quantity is more, and counting error compensates will be more timely, and count value is more accurate, and control precision and positioning precision also can be higher; The seizure of position detection signal is adopted and carries out along detecting the mode of interrupting, ensure that the promptness of seizure, accuracy; By the filtering process of software, twice, hardware, make the signal that captures more accurate, avoid the signal caused due to voltage fluctuation, load variations etc. and gather by mistake; Utilize the count signal that main control module provides, independently carry out motor and run step number record, only when needs, count information is returned, share the task of main control module, more complicated functional module can be increased in main control module, or select the more cheap master controller that can meet the demands, reduce system power dissipation, extend working time.Because the current type of drive research to stepping motor is comparatively ripe, the control precision of itself can reach very high requirement, for the control precision compensated caused by structural factor or environmental factor declines, only need adopt method of the present invention, to compare the closed-loop control system of other encoders or servomotor, cost of the present invention is low, stability is high, service life of equipment is longer, system building is simple and convenient, without the need to complicated algorithm, operability is high, control is more simple and easy.
Accompanying drawing explanation
Fig. 1 is the flow chart of the closed loop control method for stepping motor provided by the invention;
Fig. 2 is the structured flowchart of the closed-loop control system for stepping motor provided by the invention;
Fig. 3 is the flow chart carrying out software filtering provided by the invention;
Fig. 4 is the flow chart that provided by the invention carrying out interrupts detecting.
Embodiment
In order to make object of the present invention, technical scheme and advantage clearly understand, below in conjunction with drawings and Examples, the present invention is further elaborated.Should be appreciated that specific embodiment described herein only in order to explain the present invention, and be not used in restriction invention.
Fig. 1 shows the realization flow of the closed loop control method for stepping motor that the embodiment of the present invention provides.
For a closed loop control method for stepping motor, the method comprises:
In step S101, position detecting element and the position signalling of trigger equipment to stepping motor is utilized to feed back;
In step s 102, the positional information collected each road carries out anti-tampering process filtering process;
In step s 103, the current count value of step motor position information and the count value of benchmark are compared, the error amount drawn and actual count value are carried out arithmetical operation, and revises actual count value.
In embodiments of the present invention, the implementation method utilizing position detecting element and the positional information of trigger equipment to stepping motor to feed back is:
By at least one independently position detecting element be installed on circumferentially fixing, stepping motor rotating shaft is installed a trigger equipment, make trigger equipment with rotating shaft continuous rotation, when trigger equipment arrival can cause detecting element to occur the position of state variation, utilize the detection port of single-chip microcomputer the position signalling of stepping motor can be detected.
In embodiments of the present invention, the computational methods of the count value residing for position detecting element are: choosing the position detecting element present position be installed on uniformly on circumference is counting original position C 1=n 0, utilize stepping motor step angle θ 1, reduction box speed reducing ratio η 1and drive system compares η 2, obtain stepping motor and often turn and move a step, the actual angle value θ turned over of load rotating shaft,
θ=θ 1/(η 1×η 2);
Count value C residing for other position detecting elements ncan determine,
C n=C n-1+(360/θ)/N。
In embodiments of the present invention, the implementation method that the positional information collected each road carries out anti-tampering process filtering process is:
Adopt C-R-C π type filter circuit, by the interference sections filtering in the position signalling of stepping motor.
In embodiments of the present invention, the current count value of step motor position information and the count value of benchmark is compared, the error amount drawn and actual count value are carried out arithmetical operation, and the implementation method revising actual count value is:
Take to interrupt detecting to the response of each road position signalling;
The each road position signalling interrupting detecting is carried out the anti-tampering process of secondary;
After utilizing process, the data of the active position information of feedback carry out the correction of motor counting error calculating.
In embodiments of the present invention, this closed loop control method also comprises further:
When receiving the instruction needing to preserve the current running status of motor, count value can be carried out output by communication and preserving.
Fig. 2 shows the structure of the closed-loop control system for stepping motor that the embodiment of the present invention provides.For convenience of explanation, illustrate only part related to the present invention.
For a closed-loop control system for stepping motor, this closed-loop control system comprises:
For carrying out the position detecting module 21 of position feedback,
Export with described position detecting module and be connected, the positional information for collecting each road carries out the hardware filtering module 22 of anti-tampering process;
Export with described hardware filtering module and be connected, for carrying out motor counting and correction, the algoritic module 23 that count value can be returned when needing to preserve motor current state;
Exporting with described algoritic module and be connected, running synchronous count signal for providing for algoritic module with motor, carry out motor counting to make algoritic module according to count signal; When motor status preserved by needs, the main control module 24 of the information returned by algoritic module can be received.
As a preferred version of the embodiment of the present invention, described algoritic module 23 also comprises:
Export with described hardware filtering module and be connected, for responding the interruption detection module 231 of each road position feed back signal;
Export with described interruption detection module and be connected, for the event of interrupting detecting being carried out the software filtering module 232 of the anti-tampering process of secondary;
Export with described software filtering module and be connected, for the data after software filtering resume module being carried out the correction module 233 of motor counting error calculating;
Exporting with described correction module and be connected, for carrying out motor counting according to the motor count signal received, and utilizing error amount correction motor count value; When the running status that system needs preservation motor current, count value can be carried out the counting module 234 returned by communication.
In embodiments of the present invention, the position detecting element 1...N used in position detecting module 21 adopts optocoupler and catch (or Hall element and magnet), to ensure during installation catch can accessible vertically through each optocoupler part, if the standard meter numerical value of detecting element present position, each position is C 1.。。C nif the installation of position detecting element can be very accurate, be then installed on uniformly on circumference by element as far as possible, such system only need define a position detecting element present position for counting original position C 1=n 0(generally for and prevent counting from overflowing, counting initial value n 0usually be set to slightly larger than circumference counting total value 1/2 nonzero integer), utilize motor step elongation θ 1, reduction box speed reducing ratio η 1and drive system compares η 2, obtain motor and often turn and move a step, the actual angle value θ turned over of load rotating shaft,
θ=θ 1/(η 1×η 2);
Count value C so residing for other position detecting elements ncan determine,
C n=C n-1+(360/θ)/N;
Just the count value after each position corrects can be set like this without the need to carrying out the self-inspection of motor counting.
If the installation accuracy of element can not ensure, then system needs circumferentially circle after powering on certainly, using the count value at each position detecting element gained as the count value after correction.
Hardware filtering module 22 adopts C-R-C π type filter circuit, by the interference sections filtering in signal, ensures that interruptive port detects the accuracy along signal, and the interference edge of reducing due to misoperation or fluctuation generation is gathered by mistake, has influence on control precision.
The realization flow that interruption detection module 231 carries out interrupting detecting is: be set to along detecting, and the level after edge produces keeps producing interrupt response afterwards sometime, utilizes the resource of single-chip microcomputer to improve along accuracy of detection.Interrupt when a certain position detecting element produces, after then entering interruption subroutine, arrange filtering inspection and start, filtering check mark checkstart carries out state change in position, the reference count value of motor count value count initialization position detecting element position for this reason, namely
count=C n
And current base count value and current count value are asked for difference, be stored in error variance error.
Fig. 3 shows and carries out the realization flow that software filtering module 232 carries out software filtering, if detect that in primitive recursive function a certain position detecting element creates filtering check mark position checkstart state and changes, whether the level that then circulation T time detects interruptive port continues to keep the level value along after generation, judges that whether the interruption produced is effective with this.After each filtering is verified, to be all filtering test ending by filtering check mark position change state.
Fig. 4 shows the realization flow that correction module 233 carries out correcting: if along the level value retention time long enough after producing, then assert that current is correct along gathering, then motor count value keeps current value; If the level value retention time after producing is very short, then it is wrong for assert that current edge gathers, then motor count value will deduct error numerical value, comes, guarantee the accuracy counted by correcting corrigendum by mistake.
In counting module 234, often receive the counting direction from main control module 24 and counting pulse signal, just carry out the amendment of count value count, after receiving the count value read requests from main control module 24, current count value count is returned to main control module 24 by communication port, carries out other function application.
In main control module 24, after motor receives action command, rotate according to a certain frequency, often turn and move a step, namely a level skip signal is sent to the counting module 234 in algoritic module 23, the triggering signal counted is carried out as counting module 234, simultaneously using the level of some IO ports as counting direction signal, when needs store motor current location information time, pass through communication port, send request signal to counting module 234, and received the count information returned by counting module 234 by communication port, carry out other function application.
The beneficial effect of the embodiment of the present invention is:
1, adopt, in stroke, multiple position detecting element is installed, compensate in time, revise counting error, improve control precision;
2, adopt the seizure carrying out position signalling along the interrupt mode detected, through twice filtering process of hardware, software, make the triggering of capture events more timely, accurate, avoid and signal during misoperation is gathered;
3, adopt independently single-chip microcomputer to carry out motor and run the record of step number, by the share tasks of main control module, slot milling and time carry out the process of other functions, improve chip utilization ratio, reduce system power dissipation, extend the service time of chip;
4, to compare the closed-loop control system of other encoders or servomotor, cost of the present invention is low, stability is high, service life of equipment is longer, system building is simple and convenient, without the need to complicated algorithm, operability is high, it is more simple and easy to control.
The foregoing is only preferred embodiment of the present invention, not in order to limit the present invention, all any amendments done within the spirit and principles in the present invention, equivalent replacement and improvement etc., all should be included within protection scope of the present invention.

Claims (5)

1. for a closed loop control method for stepping motor, it is characterized in that, the method comprises:
Position detecting element and the position signalling of trigger equipment to stepping motor is utilized to feed back;
Anti-tampering process filtering process is carried out to the positional information that each road collects;
The current count value of step motor position information and the count value of benchmark are compared, the error amount drawn and actual count value is carried out arithmetical operation, and revises actual count value;
The computational methods of the count value residing for described position detecting element are: choosing the position detecting element present position be installed on uniformly on circumference is counting original position C1=n0, utilize stepping motor step angle θ 1, reduction box speed reducing ratio η 1 and drive system than η 2, obtain stepping motor often to turn and move a step, the actual angle value θ turned over of load rotating shaft
θ=θ1/(η1×η2);
Count value Cn defining method residing for other position detecting elements is as follows:
Cn=Cn-1+(360/θ)/N;
N is position detecting element number;
The implementation method that the described positional information collected each road carries out anti-tampering process filtering process is:
Adopt C-R-C π type filter circuit, by the interference sections filtering in the position signalling of stepping motor.
2. closed loop control method as claimed in claim 1, it is characterized in that, the described implementation method utilizing position detecting element and the positional information of trigger equipment to stepping motor to feed back is:
By at least one independently position detecting element be installed on circumferentially fixing, stepping motor rotating shaft is installed a trigger equipment, make trigger equipment with rotating shaft continuous rotation, when trigger equipment arrival causes detecting element to occur the position of state variation, utilize the detection port of single-chip microcomputer the positional information of stepping motor can be detected.
3. closed loop control method as claimed in claim 1, it is characterized in that, described the current count value of step motor position information and the count value of benchmark to be compared, the error amount drawn and actual count value are carried out arithmetical operation, and the implementation method revising actual count value are:
Take to interrupt detecting to the response of each road position signalling;
The position signalling interrupting detecting is carried out the anti-tampering process of secondary;
After utilizing process, the data of the active position information of feedback carry out the correction of motor counting error calculating.
4. closed loop control method as claimed in claim 1, it is characterized in that, described closed loop control method also comprises further:
When receiving the instruction needing to preserve the current running status of motor, count value being carried out output by communication and preserves.
5. for a closed-loop control system for stepping motor, it is characterized in that, this closed-loop control system comprises:
For carrying out the position detecting module of position feedback, exporting be connected with described position detecting module, the positional information for collecting each road carries out the hardware filtering module of anti-tampering process;
Export with described hardware filtering module and be connected, for carrying out motor counting and correction, when receiving the information needing to preserve motor current state, by the algoritic module that count value returns;
Export with described algoritic module and be connected, running synchronous counting pulse signal and the count signal of counting direction for providing for algoritic module with motor, carrying out motor counting to make algoritic module according to count signal; When motor status preserved by needs, the main control module of the information returned by algoritic module can be received;
The algoritic module of described closed-loop control system also comprises:
Export with described hardware filtering module and be connected, for responding the interruption detection module of each road position feed back signal;
Export with described interruption detection module and be connected, for the event of interrupting detecting being carried out the software filtering module of the anti-tampering process of secondary;
Export with described software filtering module and be connected, for the data after software filtering resume module being carried out the correction module of motor counting error calculating;
Exporting with described correction module and be connected, for carrying out motor counting according to the motor in synchrony count signal received, and utilizing error amount correction motor count value;
When the system of receiving needs the information of preserving the current running status of motor, count value can be carried out the counting module returned by communication.
CN201110274592.2A 2011-09-16 2011-09-16 Closed-loop control method and system for stepping motor Expired - Fee Related CN102332859B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201110274592.2A CN102332859B (en) 2011-09-16 2011-09-16 Closed-loop control method and system for stepping motor

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201110274592.2A CN102332859B (en) 2011-09-16 2011-09-16 Closed-loop control method and system for stepping motor

Publications (2)

Publication Number Publication Date
CN102332859A CN102332859A (en) 2012-01-25
CN102332859B true CN102332859B (en) 2015-06-03

Family

ID=45484503

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201110274592.2A Expired - Fee Related CN102332859B (en) 2011-09-16 2011-09-16 Closed-loop control method and system for stepping motor

Country Status (1)

Country Link
CN (1) CN102332859B (en)

Families Citing this family (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6019397B2 (en) * 2012-09-07 2016-11-02 パナソニックIpマネジメント株式会社 Motor control device
CN104007685B (en) * 2014-03-21 2017-02-15 宁波巨匠自动化装备有限公司 High-speed precise-positioning acquisition trigger card circuit and acquisition method
CN104199466A (en) * 2014-06-26 2014-12-10 拓卡奔马机电科技有限公司 Control method and system for closed-loop stepping motor of sewing machine
CN104267742B (en) * 2014-09-24 2017-08-15 浙江宇视科技有限公司 A kind of vertical origin calibrating method of ball machine and device
JP6504081B2 (en) * 2016-02-26 2019-04-24 オムロン株式会社 Control device, control program and recording medium
CN110286378B (en) * 2019-06-19 2021-09-03 青海大学 Pulse trigger control method and device for meteorological radar three-dimensional scanning
CN111258339B (en) * 2019-11-25 2022-12-09 天津津航技术物理研究所 Follow-up control device based on stepping motor and photoelectric switch
CN110759004B (en) * 2019-12-25 2020-03-31 常州磐宇仪器有限公司 Motor boundary determination method and self-adaptive positioning application thereof on sampling needle push rod
CN111342715B (en) * 2020-03-16 2022-02-01 浙江众邦机电科技有限公司 Sewing machine and electric angle correction method and system of open-loop stepping motor of sewing machine
CN114246738A (en) * 2021-12-20 2022-03-29 上海大学 Conveying mechanism for tumor targeted therapy device and control method

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1334642A (en) * 2000-07-19 2002-02-06 精工爱普生株式会社 Device for driving electric machine without sensor
CN1377130A (en) * 2001-03-26 2002-10-30 精工爱普生株式会社 Driving device of electric machine without sensor

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006326109A (en) * 2005-05-27 2006-12-07 Aruze Corp Game machine
JP5646846B2 (en) * 2009-01-28 2014-12-24 セミコンダクター・コンポーネンツ・インダストリーズ・リミテッド・ライアビリティ・カンパニー Driver circuit

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1334642A (en) * 2000-07-19 2002-02-06 精工爱普生株式会社 Device for driving electric machine without sensor
CN1377130A (en) * 2001-03-26 2002-10-30 精工爱普生株式会社 Driving device of electric machine without sensor

Also Published As

Publication number Publication date
CN102332859A (en) 2012-01-25

Similar Documents

Publication Publication Date Title
CN102332859B (en) Closed-loop control method and system for stepping motor
WO2021196521A1 (en) Remote operation and maintenance management system and method
US11005730B2 (en) System, method, and apparatus for high throughput ingestion for streaming telemetry data for network performance management
CN104753425B (en) It is a kind of to realize that permagnetic synchronous motor mechanical zero looks for the method with compensation online
CN100351738C (en) Automatic power down rebooting device
CN103414408B (en) A kind of switched reluctance machines position signalling on-line fault diagnosis and fault tolerant control method
CN103401704A (en) Implementation scheme of distributed log collecting server
CN101976217A (en) Anomaly detection method and system for network processing unit
CN110360145B (en) Bearing control method and device, storage medium and processor
CN107748524A (en) Bi-motor high speed and super precision servo-control system and its method based on SCM&FPGA
CN104218865A (en) Permanent magnet motor rotor position calculation method
CN109983309A (en) Detect the defects of motor position decoder system
CN112230603B (en) Multi-sensor data acquisition method and system based on numerical control machine tool
CN103869094A (en) Main pump rotation speed measurement signal processing method
CN103605374A (en) Method and device for increasing positioning accuracy of holder
CN102969970A (en) Motor efficiency tracking driving system and driving method
CN202168029U (en) Subdivided driving device for stepping motor
CN204836005U (en) Brushless DC motor does not have position sensor driver chip and system
CN104216812A (en) Method and device for carrying out multi-event statistics on performance monitoring unit
CN209707960U (en) A kind of programmable controller and engineering machinery vehicle
Lu et al. Iaso: an autonomous fault-tolerant management system for supercomputers
CN110912488B (en) Motor control method and system
CN205453452U (en) System for eliminate step motor accumulated error
CN103240743B (en) System and method for improving performance of incremental code disc
CN103516288A (en) Self-adaptive encoder speed measuring device and method

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
C56 Change in the name or address of the patentee
CP03 Change of name, title or address

Address after: 300384 in Tianjin Binhai Huayuan Industrial Zone (outer ring) eight Haitai Huake Road No. 6

Patentee after: TIANJIN YAAN TECHNOLOGY Co.,Ltd.

Address before: Zi Yuan Road 300384 Tianjin city Nankai District Huayuan Industrial Park No. 8

Patentee before: TIANJIN YAAN TECHNOLOGY Co.,Ltd.

PP01 Preservation of patent right
PP01 Preservation of patent right

Effective date of registration: 20200120

Granted publication date: 20150603

PD01 Discharge of preservation of patent
PD01 Discharge of preservation of patent

Date of cancellation: 20230120

Granted publication date: 20150603

CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20150603