CN102347720B - Method for automatically zeroing analog quantity speed instructions of servo controller - Google Patents
Method for automatically zeroing analog quantity speed instructions of servo controller Download PDFInfo
- Publication number
- CN102347720B CN102347720B CN2010102468963A CN201010246896A CN102347720B CN 102347720 B CN102347720 B CN 102347720B CN 2010102468963 A CN2010102468963 A CN 2010102468963A CN 201010246896 A CN201010246896 A CN 201010246896A CN 102347720 B CN102347720 B CN 102347720B
- Authority
- CN
- China
- Prior art keywords
- speed command
- servo controller
- digital
- zero
- signal processor
- 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
Links
Images
Landscapes
- Feedback Control In General (AREA)
Abstract
The invention discloses a method for automatically zeroing analog quantity speed instructions of a servo controller. The servo controller is provided with a zeroing starting signal end and monitors speed instructions; the speed instructions are the analog quantity speed instructions which are sampled by using a zero-time sampling module, converted into digital quantity speed instructions and input into a digital signal processor; the digital signal processor accumulates the digital quantity speed instructions, performs mean algorithm filtering, stores the digital quantity speed instructions which are sampled at the first four times, performs differential operation on the digital quantity speed instructions which are sampled at any two times and filters results which exceed an even filtering threshold value; the digital signal processor performs third-order Kalman filtering on the results of even filtering and differential operation to obtain a zero-point voltage correction value; the zero-point voltage correction value and the sampled digital quantity speed instructions are subjected to superposition operation to obtain a current speed instruction; and during the operation of a numerical control system, the digital signal processor drives a motor to operate according to the zeroed speed instructions. The method has the advantages that: the speed instructions of the numerical control system can be automatically zeroed without manual operation; zeroing accuracy and zeroing efficiency are improved; and the servo driving control of the motor is facilitated.
Description
Technical field
The present invention relates to the method for a kind of servo controller analog quantity speed command automatic zero set.
Background technology
Servo controller is used for AC permanent magnet synchronous motor is implemented to drive control in digital control system, digital control system drives AC permanent magnet synchronous motor work at servo controller signal input part input analog amount speed command, and by photoelectric encoder the position signalling of AC permanent magnet synchronous motor is fed back to digital control system, digital control system is carried out position proportional according to the alliance deviation and is regulated, output analog quantity speed command is to servo controller, again by the speed command operation of servo controller control motor according to appointment.
As shown in Figure 1, in the closed-loop digital control system of position, position ring is based upon on the digital control system 1, and speed ring is based upon on the servo controller 2, and position feedback and speed feedback provide by position transducer 3 and velocity transducer 4; Namely carry out position proportional by digital control system 1 according to the alliance deviation and regulate, and output analog quantity speed command is to servo controller 2, again by the speed command operation of servo controller 2 control servomotors 5 according to appointment.
The output area of the analog quantity speed command of general digital control system output is between-10 volts to+10 volts, namely-the minimum speed instruction of 10V correspondence system, the maximal rate instruction of+10V correspondence system, the dead-center position of the corresponding analog quantity speed command of 0V, namely motor per minute zero turns.Because the minimum and maximum speed command of each position closed-loop digital control system is different, this just need to have a speed command gain parameter to come corresponding how many speed commands of setting unit analog quantity voltage in digital control system and servo controller.
For example: in the position closed-loop digital control system that a positive and negative per minute 2000 turns, the speed command gain parameter is 2000/10;
The analog quantity speed command is owing to be subject to the impact of the many factors such as environment, temperature, humidity, electromagnetic field space, its dead-center position can be offset, be the analog quantity voltage value speed command that turns of the per minute zero of corresponding motor not of 0V, so just the control precision of whole position digital control system caused larger impact.This just need to carry out to the analog quantity speed command correction of dead-center position skew, and analog quantity speed command dead-center position offset correction principle is:
Zero point speed command=analog quantity zero-point voltage command value-analog quantity zero-point voltage corrected value=0
In original position closed-loop digital control system, analog quantity speed command dead-center position offset correction is detected to add to adjust manually by digital control system and realizes.Its set-up procedure is as follows:
1) instruction of digital control system output 0V analog quantity voltage is to servo-driver;
2) digital control system is carried out differential calculation to the positional information of position sensor feedback, obtains the system running speed value;
3) the system running speed value is presented on the display screen of digital control system;
4) operating personnel arrange analog quantity zero-point voltage correction parameter according to the system running speed value that shows;
Above-mentioned method of adjustment is owing to the participation that needs artificial adjustment, and operating personnel's visual correction itself also just decreases the precision of system's offset correction at zero point with regard to the larger measure error of existence; And the interference of analog quantity zero-point voltage is at random, manually adjusts significant adverse in the real-time adjustment of analog quantity speed command, and the zero error of system can be increased greatly; And the artificial efficient of adjusting also is lower, and the operating efficiency of whole system also can be descended greatly.
Summary of the invention
Technical problem to be solved by this invention provides the method for a kind of servo controller analog quantity speed command automatic zero set, this method need not the automatic zero set that manual operation realizes the digital control system speed command, improve accuracy, reliability, rapidity and the stability of the zeroing of digital control system speed command, made things convenient for the servo drive control of motor.
For solving the problems of the technologies described above, the method for servo controller analog quantity speed command of the present invention automatic zero set comprises the steps:
After step 2, servo controller were accepted the automatic zero set enabling signal, the analog quantity speed command of servo controller multichannel modulus high-speed sampling modular converter sampling input also became input servo controller digital signal processor behind the digital quantity speed command as analog-to-digital conversion;
After step 6, servo controller digital signal processor were carried out superposition with the digital quantity speed command of zero-point voltage corrected value and sampling, drawing the present speed instruction, to make motor speed be zero;
When step 7, digital control system operation, the servo controller digital signal processor provides the speed command of motor by following formula:
Speed command=(the digital quantity speed value of sampling-zero-point voltage corrected value) * speed command gain
Wherein: the speed command gain is the gain amplifier of servo controller speed feedback amplifier.
Because the method for servo controller analog quantity speed command of the present invention automatic zero set has adopted technique scheme, namely at the servo controller input interface automatic zero set enabling signal end and monitoring velocity instruction are set, when speed command was zero, servo controller is opened and exported to the enabling signal end; After servo controller is accepted start signal, the analog quantity speed command of its multichannel modulus high-speed sampling modular converter sampling input and convert the digital quantity speed command to after the supplied with digital signal processor; Processor is to the operation that adds up of digital quantity speed command, the average algorithm filtering of taking the mean again; Processor stores the digital quantity speed command of front four samplings and any twice digital quantity speed command is carried out derivation operation, the derivation operation result is surpassed the filtering of carrying out of average algorithm filtering threshold values; Processor carries out three rank Kalman filterings with the result of average algorithm filtering and derivation operation, draws the zero-point voltage corrected value; The digital quantity speed command of zero-point voltage corrected value and sampling carries out superposition and draws the present speed instruction to make motor speed be zero; During the digital control system operation, processor provides the speed command of motor by speed command=(the digital quantity speed value of sampling-zero-point voltage corrected value) * speed command gain: this method need not the automatic zero set that manual operation realizes the digital control system speed command, improve accuracy, reliability, rapidity and the stability of the zeroing of digital control system speed command, made things convenient for the servo drive control of motor.
Description of drawings
The present invention is described in further detail below in conjunction with drawings and embodiments:
Fig. 1 is position closed-loop digital control system control block diagram,
Fig. 2 is the FB(flow block) of servo controller analog quantity speed command automatic zero-setting method of the present invention,
Fig. 3 is that the hardware of this method is realized block diagram.
Embodiment
As shown in Figure 2, the method for servo controller analog quantity speed command of the present invention automatic zero set comprises the steps:
After step 2, servo controller were accepted the automatic zero set enabling signal, the analog quantity speed command of servo controller multichannel modulus high-speed sampling modular converter sampling input also became input servo controller digital signal processor behind the digital quantity speed command as analog-to-digital conversion;
After step 6, servo controller digital signal processor were carried out superposition with the digital quantity speed command of zero-point voltage corrected value and sampling, drawing the present speed instruction, to make motor speed be zero;
When step 7, digital control system operation, the servo controller digital signal processor provides the speed command of motor by following formula:
Speed command=(the digital quantity speed value of sampling-zero-point voltage corrected value) * speed command gain
Wherein: the speed command gain is the gain amplifier of servo controller speed feedback amplifier.
This method is on the basis of servo controller internal control software, utilize the original modulus high-speed sampling of servo controller modular converter, add the software algorithm of analog quantity speed command dead-center position skew automatic calibration, realize position closed-loop digital control system analog quantity speed command automatic zero set.
As shown in Figure 3, this method increases the enabling signal of an automatic zero set in the input interface 21 of servo controller 2, when digital control system 1 output analog quantity speed command is zero, servo controller 2 is opened and exported to this enabling signal, this moment, servo controller 2 matched with software algorithm with regard to inner integrated sample conversion module 22 and the digital signal processor 23 of application, realized the automatic zero set of analog quantity speed command.The multichannel modulus high-speed sampling modular converter of servo controller has 16 16 analog-to-digital conversion passages in this method, the analog-to-digital conversion rate can reach 2MHZ simultaneously, analog-to-digital error only is 60,000/, so just provide good hardware foundation for the automatic zero set of analog quantity speed command; The software algorithm of digital signal processor by using inside is processed the software that the transformation result of analog quantity speed command averages algorithm filtering, repeated sampling filtering and three rank Kalman Algorithm filtering, and the result that software is processed is directly as the corrected value of analog quantity zero-point voltage.
This method has improved the control precision of digital control system, has improved the operating efficiency of whole digital control system, has made things convenient for the operation of digital control system, has improved the reliability of digital control system.
Claims (1)
1. the method for servo controller analog quantity speed command automatic zero set is characterized in that this method comprises the steps:
Step 1, at the servo controller input interface automatic zero set enabling signal end is set, described enabling signal end monitoring numerical-control system speed command, when speed command was zero, the enabling signal end was opened and is also exported servo controller to;
After step 2, servo controller were accepted the automatic zero set enabling signal, the analog quantity speed command of servo controller multichannel modulus high-speed sampling modular converter sampling input also became input servo controller digital signal processor behind the digital quantity speed command as analog-to-digital conversion;
Step 3, servo controller digital signal processor are to the operation that adds up of the digital quantity speed command of multi-channel sampling, and the average algorithm filtering of taking the mean again will connect the interference signal filtering that produces owing to the physical channel;
Step 4, servo controller digital signal processor store the digital quantity speed command of front four samplings and any twice digital quantity speed command are carried out derivation operation, with the carry out filtering of derivation operation result above average algorithm filtering threshold values, with the external interference signals filtering that the analog quantity speed command is suffered;
Step 5, servo controller digital signal processor carry out three rank Kalman filterings with the result of average algorithm filtering and derivation operation, and three rank Kalman filtering algorithm results are the zero-point voltage corrected value of analog quantity speed command;
After step 6, servo controller digital signal processor were carried out superposition with the digital quantity speed command of zero-point voltage corrected value and sampling, drawing the present speed instruction, to make motor speed be zero;
When step 7, digital control system operation, the servo controller digital signal processor provides the speed command of motor by following formula:
Speed command=(the digital quantity speed value of sampling-zero-point voltage corrected value) * speed command gain
Wherein: the speed command gain is the gain amplifier of servo controller speed feedback amplifier.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN2010102468963A CN102347720B (en) | 2010-08-06 | 2010-08-06 | Method for automatically zeroing analog quantity speed instructions of servo controller |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN2010102468963A CN102347720B (en) | 2010-08-06 | 2010-08-06 | Method for automatically zeroing analog quantity speed instructions of servo controller |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN102347720A CN102347720A (en) | 2012-02-08 |
| CN102347720B true CN102347720B (en) | 2013-04-24 |
Family
ID=45546056
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN2010102468963A Expired - Fee Related CN102347720B (en) | 2010-08-06 | 2010-08-06 | Method for automatically zeroing analog quantity speed instructions of servo controller |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN102347720B (en) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103207570B (en) * | 2013-03-05 | 2015-07-08 | 中国核电工程有限公司 | Rotary transformer signal simulation system and method applied to loader-unloader analog machine |
| CN104423320A (en) * | 2013-09-10 | 2015-03-18 | 重庆长安工业(集团)有限责任公司 | Automatic zero setting method of servo control system |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN1945467A (en) * | 2006-10-24 | 2007-04-11 | 北京航空航天大学 | Servo control system for quick response magnetic suspension control torque gyroscope frame |
| CN101349910A (en) * | 2008-08-29 | 2009-01-21 | 华中科技大学 | Numerical control machine tool double-shaft synchronization controller |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101743479B (en) * | 2007-09-03 | 2012-02-29 | 三菱电机株式会社 | Sensor output compensator |
-
2010
- 2010-08-06 CN CN2010102468963A patent/CN102347720B/en not_active Expired - Fee Related
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN1945467A (en) * | 2006-10-24 | 2007-04-11 | 北京航空航天大学 | Servo control system for quick response magnetic suspension control torque gyroscope frame |
| CN101349910A (en) * | 2008-08-29 | 2009-01-21 | 华中科技大学 | Numerical control machine tool double-shaft synchronization controller |
Non-Patent Citations (2)
| Title |
|---|
| 智能型通用位置闭环伺服控制系统;陈宝萍等;《机械与电子》;19970228(第2期);8-10 * |
| 陈宝萍等.智能型通用位置闭环伺服控制系统.《机械与电子》.1997,(第2期),8-10. |
Also Published As
| Publication number | Publication date |
|---|---|
| CN102347720A (en) | 2012-02-08 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN102142800B (en) | Stage synchronous lift control system and method | |
| CN103213666B (en) | A kind of electric steering gear device of position-based ring commutation and control method | |
| CN103303454B (en) | A kind of electric steering gear device based on speed ring commutation and control method thereof | |
| CN103490678B (en) | Slave synchronisation control means and system | |
| CN104516086B (en) | Control system and method of fast-steering mirror | |
| CN1869846A (en) | Integral high precision control moment gyro gimbal servo digital controller | |
| CN103281020B (en) | A kind of four-quadrant control device for electric steering engine and method thereof | |
| CN103269187A (en) | Dual-motor synchronous control system and control method thereof | |
| CN102347720B (en) | Method for automatically zeroing analog quantity speed instructions of servo controller | |
| CN105680734B (en) | A kind of bi-motor synchronization driving method | |
| CN106953579A (en) | A kind of voice coil motor position motion control method | |
| CN108037776A (en) | A kind of electric elevatable table synchronous lifting control system | |
| CN104451884A (en) | Lifting controlsystem and lifting control method for crucible of silicon carbide crystal furnace | |
| CN101840064B (en) | Control method of direct current motor type force actuator | |
| CN105262405A (en) | Closed loop disturbance observation compensation method for electric current loop of servo motor | |
| CN104458126B (en) | The control method and device of magnetic suspension bearing | |
| CN203275613U (en) | Data acquisition port for DC power hardware | |
| CN103066909A (en) | Control method and yarn constant tension control system of proportional-integral-derivative (PID) controller with dead zone | |
| CN219980676U (en) | Intelligent rotating speed controller | |
| CN217769928U (en) | Pan-tilt motor control system | |
| CN204928974U (en) | Automatic clamp video processing hybrid integrated circuit of multichannel | |
| CN109782662A (en) | A kind of digital laser control power supply | |
| CN104716960B (en) | A kind of digitlization LLC circuit collection control methods based on DSP | |
| CN115824352B (en) | Self-adaptive digital radio frequency admittance level meter | |
| CN102385154A (en) | Electrical control device for DC motor type force actuator |
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 | ||
| 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: 20130424 Termination date: 20190806 |