CN106154838A - The residual oscillation suppressing method of a kind of positioner and system - Google Patents
The residual oscillation suppressing method of a kind of positioner and system Download PDFInfo
- Publication number
- CN106154838A CN106154838A CN201610801531.XA CN201610801531A CN106154838A CN 106154838 A CN106154838 A CN 106154838A CN 201610801531 A CN201610801531 A CN 201610801531A CN 106154838 A CN106154838 A CN 106154838A
- Authority
- CN
- China
- Prior art keywords
- zero
- motor
- oscillation
- transfer function
- shaper
- 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.)
- Pending
Links
- 230000010355 oscillation Effects 0.000 title claims abstract description 64
- 238000000034 method Methods 0.000 title claims abstract description 27
- 238000012546 transfer Methods 0.000 claims abstract description 46
- 238000007493 shaping process Methods 0.000 claims abstract description 14
- 230000009471 action Effects 0.000 claims description 38
- 238000013016 damping Methods 0.000 claims description 21
- 230000001629 suppression Effects 0.000 claims description 7
- 238000010998 test method Methods 0.000 claims description 7
- 238000004458 analytical method Methods 0.000 claims description 3
- 238000010183 spectrum analysis Methods 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 2
- 230000000694 effects Effects 0.000 abstract description 2
- 230000005540 biological transmission Effects 0.000 abstract 1
- 230000002401 inhibitory effect Effects 0.000 description 3
- 238000011161 development Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 230000000452 restraining effect Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 1
- 238000012938 design process Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000000670 limiting effect Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000004806 packaging method and process Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
- 230000002035 prolonged effect Effects 0.000 description 1
- 230000002829 reductive effect Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 239000004753 textile Substances 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position Or Direction (AREA)
Abstract
The invention discloses residual oscillation suppressing method and the system of a kind of positioner.Particular for the position control device of servo driver drives low rigid mechanical equipment, the method is implemented to perform by servo-driver.Specifically include: obtain home position instruction;Obtain amplitude and the time lag of continuous print n effect pulse;Obtain servo position and control the cycle;Calculate the transmission function that zero vibration zero derivative reshaper is discrete;Utilize zero vibration zero derivative reshaper discrete transfer function that home position is instructed shaping, obtain the discretization position command through shaping;Electric machine rotation is driven, the residual oscillation of the mechanical load end that motor shaft connects at the end of suppressing positioner location according to shaped discretization position command.The driver that the present invention provides has the function that home position instruction carries out shaping, makes positioner both can position in the range of the position error of license, can reduce positioning time again, improve the work efficiency of equipment.
Description
Technical Field
The invention relates to the field of servo control, in particular to a method and a system for restraining residual oscillation of a positioning device.
Background
Currently, the ac servo system is increasingly widely applied in the field of modern automation, such as in positioning control devices for textile, packaging, assembly, laser processing, etc. Particularly for low rigidity equipment such as an industrial robot, after rapid positioning, residual oscillation of a load end (such as a mechanical arm end) is easy to occur. The residual vibration easily causes the problems of prolonged system positioning time, increased positioning error and the like. In order to enable a positioning control device to perform positioning within an allowable positioning error range and to shorten positioning time, a pulse input shaping technique is generally adopted in the prior art. The pulse input shaping mainly comprises a zero shaper, a zero oscillation zero derivative shaper, an extremely insensitive shaper and an optimal input shaper.
Based on the comprehensive consideration of robustness of the input shapers to the natural oscillation frequency change of the system, computational complexity and real-time performance, a zero oscillation zero derivative (ZVD) shaper is a better choice when selecting the shaper form.
However, when designing the ZVD shaper, first, system parameters need to be determined: the damped oscillation frequency and damping coefficient of the oscillating system, and then the amplitude and time lag of the action pulse are calculated. However, the damping coefficient in the actual system is very small, which is inconvenient for measurement and brings inconvenience for the use of the ZVD.
In addition, the current pulse shaper is implemented in the position planning stage of the superordinate controller (such as a motion control card, a motion controller, a PLC, etc.), and is not integrated inside the servo driver.
Disclosure of Invention
The invention aims to provide a method and a system for restraining residual oscillation of a positioning device, which are used for realizing the following steps: (1) the positioning device can perform positioning within the allowable positioning error range, reduce the positioning time and improve the working efficiency of equipment; (2) the residual vibration suppression function of the mechanical load tail end is integrated in the driver, so that a user does not need to develop or purchase other components with the residual vibration suppression function when developing a positioning system, and development time and cost are saved for the user; (3) the method provided by the invention does not need to measure the damping coefficient of the positioning device system, reduces the difficulty of determining the system parameters and brings convenience to the use of users.
In order to achieve the purpose, the invention provides the following scheme:
a method of suppressing residual oscillation, comprising:
acquiring an original position instruction, wherein the position instruction is an instruction for position control sent by an upper controller;
acquiring the amplitude and time lag of n continuous action pulses, wherein n is 3;
acquiring a servo position control period;
calculating a discrete transfer function of a zero oscillation zero derivative shaper;
discrete transfer function using zero oscillation zero derivative shaperShaping and discretizing the position instruction to obtain a shaped discrete position instruction, wherein AiIs the amplitude of the i-th action pulse, Ni=Round(Ti/Tc) Round () is Ti/TcRounding off the one digit of the decimal point of the calculated value to obtain a function of the integer, TiTime lag of the ith action pulse, TcA servo position control period;
and controlling the motor to rotate according to the shaped discrete position command so as to inhibit residual oscillation of the tail end of the mechanical load connected with the motor shaft at the end of positioning by the positioning device.
Optionally, the acquiring amplitudes and time lags of the n consecutive action pulses specifically includes:
obtaining the vibration frequency of the tail end of the mechanical load, wherein the vibration frequency of the tail end of the mechanical load is measured by an off-line experimental test method;
setting the system damping ζ to 0;
calculating to obtain the amplitude A of the action pulse of the zero oscillation zero derivative shaper according to the vibration frequency and the system dampingiAnd a time lag Ti;
Optionally, the determination by the off-line experimental test method specifically comprises:
directly obtaining a vibration waveform of a mechanical load tail end through a laser interferometer, and measuring vibration frequency according to the vibration waveform;
or observing a position deviation curve or an actual position curve of the motor shaft when the system is positioned by a drawing function observation system of upper monitoring software of the servo system, and measuring the vibration frequency of the motor shaft to replace the vibration frequency of the tail end of the load;
or carrying out frequency spectrum analysis on the position or speed data of the motor shaft when the system is positioned by a fast Fourier analysis method to obtain the vibration frequency of the motor shaft to replace the vibration frequency of the tail end of the load.
Optionally, the calculating a discrete transfer function of the zero oscillation zero derivative shaper specifically includes:
obtaining a continuous transfer function of a zero-oscillation zero-derivative shaper in an s-domain, wherein the transfer function of the zero-oscillation zero-derivative shaper is as follows:
wherein A isiIs the amplitude of the i-th action pulse, TiThe time lag for the ith action pulse;
converting the continuous transfer function of the zero-oscillation zero-derivative shaper into a discrete transfer function in the z-domain:
wherein N isi=Round(Ti/Tc) Round () is Ti/TcRounding off the one digit of the decimal point of the calculated value to obtain a function of the integer, TcIs a servo position control period.
Optionally, the controlling the motor to rotate according to the shaped discrete position command specifically includes: and performing closed-loop feedback control on the position of the motor, performing closed-loop feedback control on the speed of the motor and performing closed-loop feedback control on the torque of the motor according to the shaped discrete position instruction.
The present invention also provides a system for suppressing residual oscillation, comprising:
the system comprises a position instruction acquisition unit, a position control unit and a position control unit, wherein the position instruction acquisition unit is used for acquiring an original position instruction which is an instruction sent by an upper controller and used for position control;
the amplitude time lag acquisition unit is used for acquiring the amplitudes and time lags of n continuous action pulses, wherein n is 3;
a control period acquisition unit for acquiring a servo position control period Tc;
The discrete function calculating unit is used for calculating a discrete transfer function of the zero oscillation zero derivative shaper;
a position command shaping discretization unit for discretizing a transfer function with a zero-oscillation zero-derivative shaperShaping and discretizing the position instruction to obtain a shaped and discretized position instruction, wherein AiIs the amplitude of the i-th action pulse, Ni=Round(Ti/Tc) Round () is Ti/TcRounding off the one digit of the decimal point of the calculated value to obtain a function of the integer, TiTime lag of the ith action pulse, TcA servo position control period;
and the motor control unit is used for controlling the motor to rotate according to the shaped discrete position command so as to inhibit residual oscillation of the tail end of the mechanical load connected with the motor shaft when the positioning of the positioning device is finished.
Optionally, the amplitude time lag obtaining unit specifically includes:
the vibration frequency acquisition subunit is used for acquiring the vibration frequency of the tail end of the mechanical load, and the vibration frequency of the tail end of the mechanical load is measured by an off-line experimental test method;
a system damping ratio setting subunit for setting the system damping to 0;
an amplitude time-lag calculating subunit, which calculates the amplitude A of the continuous 3 action pulses according to the vibration frequency and the system dampingiAnd a time lag Ti,i=1,2,3。
Optionally, the discrete transfer function calculating unit specifically includes:
a continuous transfer function obtaining subunit, configured to obtain a continuous transfer function of a zero oscillation zero derivative shaper, where a transfer function of the zero oscillation zero derivative shaper is:
wherein A isiIs the amplitude of the i-th action pulse, TiThe time lag for the ith action pulse;
in the formula e is a natural constant; omegan,ωdζ is the natural frequency, damped oscillation frequency and damping coefficient of the positioner system, respectively, and f is the frequency of vibration at the end of the mechanical load.
A transfer function discretization subunit, configured to convert the continuous transfer function of the zero oscillation zero derivative shaper into a discrete transfer function:
wherein N isi=Round(Ti/Tc) Round () is Ti/TcRounding off the one digit of the decimal point of the calculated value to obtain a function of the integer, TcIs a servo position control period.
Optionally, the motor control unit specifically includes:
the motor position control subunit is used for carrying out closed-loop feedback control on the position of the motor according to the shaped discrete position instruction;
the motor speed control subunit is used for carrying out closed-loop feedback control on the motor speed according to the feedback speed of the motor shaft code;
and the motor torque control subunit is used for carrying out closed-loop feedback control on the motor torque according to the feedback torque of the motor.
The invention also provides a servo driver for suppressing residual oscillations, said driver comprising a system according to any of claims 6-9.
The invention provides a residual oscillation suppression method and a residual oscillation suppression system of a positioning device, and particularly relates to a positioning control device for a servo driver to drive low-rigidity mechanical equipment. The invention can make the positioning device not only position within the allowable positioning error range, but also shorten the positioning time to improve the working efficiency of the equipment; secondly, as the residual vibration suppression function of the mechanical load tail end is integrated in the driver, a user does not need to develop or purchase other components with the function when developing a positioning system, so that the development time and cost are saved for the user; in addition, the method provided by the invention does not need to measure the damping coefficient of the positioning device system, thereby reducing the use difficulty of users.
Drawings
In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings needed to be used in the embodiments will be briefly described below, and it is obvious that the drawings in the following description are only some embodiments of the present invention, and it is obvious for those skilled in the art to obtain other drawings without inventive exercise.
FIG. 1 is a flow chart of a method of suppressing residual oscillation according to an embodiment of the present invention;
FIG. 2 is a schematic diagram of a system for suppressing residual oscillation according to an embodiment of the present invention;
FIG. 3 is a graph of position response without the addition of a ZVD shaper;
FIG. 4 is a graph of the position response when a ZVD shaper is added.
Detailed Description
The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
The invention aims to provide a method and a system for inhibiting residual oscillation, which can effectively inhibit the residual oscillation at the tail end of a mechanical load in a positioning device and can overcome the technical problems of large computation amount, low real-time property and difficulty in measuring and determining the damping coefficient of the system in the design process of a shaper in the prior art.
In order to make the aforementioned objects, features and advantages of the present invention comprehensible, embodiments accompanied with figures are described in further detail below.
Fig. 1 is a flowchart of a method for suppressing residual oscillation according to an embodiment of the present invention, and as shown in fig. 1, the method for suppressing residual oscillation is applied to a servo driver, that is, the following steps are performed by the driver, and the specific steps are:
step 101: acquiring an original position instruction, wherein the position instruction is an instruction for position control sent by an upper controller;
step 102: acquiring the amplitude and time lag of n continuous action pulses, wherein n is 3;
step 103: obtaining a servo position control period Tc;
Step 104: calculating a discrete transfer function of a zero oscillation zero derivative shaper;
step 105: transfer function discretization with zero oscillation zero derivative shaperShaping the position instruction to obtain a shaped discrete position instruction, wherein AiIs the amplitude of the i-th action pulse, Ni=Round(Ti/Tc) Round () is Ti/TcRounding off the one digit of the decimal point of the calculated value to obtain a function of the integer, TiTime lag of the ith action pulse, TcA servo position control period;
step 106: controlling the motor to rotate according to the shaped discrete position command to dampen residual oscillations at the end of the mechanical load coupled to the motor shaft.
In step 102, the obtaining of the pulse amplitude and the time lag specifically includes: the vibration frequency f of the mechanical load end is obtained and the damping coefficient ζ of the mechanical load end is set to 0, sinceWherein, thus, K can be calculated from the natural constants e and ζ, and T can be calculated from the damped vibration frequency ωdNatural frequency omeganThe damping coefficient zeta or the vibration frequency f at the tail end of the mechanical load is calculated, and the amplitude A of the action pulse is further calculatedi. To obtain A1=0.25、A2=0.5、A30.25, the continuous transfer function of the zero oscillation zero derivative shaper is:
the mechanical load end vibration frequency f can be obtained by the following methods: firstly, directly obtaining the vibration waveform of the tail end of the mechanical load through equipment (such as a laser interferometer), and directly measuring the vibration frequency. And secondly, observing a position deviation curve (or an actual position curve) through a drawing function of an upper computer of the servo system and measuring the vibration frequency of the motor shaft to approximately replace the vibration frequency of the load. This is because the residual vibration at the end of the mechanical load during positioning also drives the motor to vibrate, and it can be considered that the vibration frequency of the motor shaft is close to the vibration frequency of the load. And thirdly, performing frequency spectrum analysis on the position or speed data when the system is positioned by a Fast Fourier Transform (FFT) analysis method to obtain the vibration frequency of the motor shaft to approximately replace the load vibration frequency.
The step 104 of calculating the discrete transfer function of the zero oscillation zero derivative shaper specifically includes: discretizing a continuous transfer function into
Wherein the discrete domainsCorresponding to a continuous domainNi=Round(Ti/Tc) Round () is Ti/TcRounding off the one digit of the decimal point of the calculated value to obtain a function of the integer, TcIs a servo position control period.
In the embodiment, the vibration frequency of the actual position curve of the system motor measured by the method ② is 15.6Hz, and the time lag T of the action pulse can be calculatedi. The ZVD shaper transfer function can be obtained by the formula:
position control period T of actual systemcAnd (4) obtaining a ZVD shaper discretization model according to the formula as 0.0002 s:
after the driver receives the position instruction, the position instruction is shaped and discretized by using a ZVD shaper discretization model to obtain a shaped discrete position instruction thetanFinally according to said shaped discrete position instruction thetanThe method comprises the steps of carrying out closed-loop feedback control on the position of a motor, carrying out closed-loop feedback control on the speed of the motor and carrying out closed-loop feedback control on the torque of the motor.
The driver can directly drive thetanThe position ring command can be input through an electronic gear frequency division and multiplication link and a smooth filtering link and then is given as the position ring command. The position controller is typically in the form of a proportional controller, the motor shaft being rotated through an angle thetamFed back to the position controller by the encoder, the position controller will be fed with thetanAnd thetamThe difference is multiplied by the coefficient of the proportional controller (i.e. the position loop gain) to obtain the command of the speed loop. The speed and current control unit can be realized by common closed-loop control, and outputs three-phase current to drive the motor to rotate.
The scheme provided by the invention is adopted for simulation verification, and comparing the effect graphs in fig. 3 and fig. 4, the low-frequency oscillation of the mechanical load tail end of the positioning control device can be effectively inhibited, so that the positioning error can be reduced and the positioning time can be shortened when the positioning control device is positioned.
Fig. 2 is a schematic structural diagram of a system for suppressing residual oscillation according to an embodiment of the present invention, as shown in fig. 2, the system is located in a driver, and specifically includes a position instruction obtaining unit 201, configured to obtain an original position instruction, where the position instruction is an instruction sent by an upper controller for position control; an amplitude-time lag acquisition unit 202 for acquiring the amplitudes and time lags of n successive action pulses, where n is 3; control period acquisitionA fetch unit 203 for obtaining a servo position control period Tc(ii) a A discrete function calculation unit 204 for calculating a discrete transfer function of the zero-oscillation zero-derivative shaperWherein A isiIs the amplitude of the i-th action pulse, Ni=Round(Ti/Tc) Round () is Ti/TcRounding off the one digit of the decimal point of the calculated value to obtain a function of the integer, TiTime lag of the ith action pulse, TcA servo position control period; the position instruction shaping discretization unit 205 is used for shaping and discretizing the position instruction by using a discrete transfer function of the zero oscillation zero derivative shaper to obtain a shaped and discrete position instruction; and the motor control unit 206 is used for controlling the motor to rotate according to the discrete position command and inhibiting residual oscillation at the tail end of the mechanical load connected with the motor.
The amplitude time lag obtaining unit 202 specifically includes a vibration frequency obtaining subunit, configured to obtain a vibration frequency of the tail end of the mechanical load, where the vibration frequency of the tail end of the mechanical load is determined by using an offline experimental test method; and the system damping setting subunit is used for setting the system damping zeta to 0. An amplitude time-lag calculating subunit, which calculates the amplitude A of the n continuous action pulses according to the vibration frequency and the system dampingiAnd a time lag Ti,i=1,2,3。
The discrete function calculating unit 204 specifically includes a continuous transfer function obtaining subunit, configured to obtain a continuous transfer function of the zero oscillation zero derivative shaper, where the transfer function of the zero oscillation zero derivative shaper is:wherein A isiIs the amplitude of the i-th action pulse, TiThe time lag for the ith action pulse; a transfer function discretization subunit, configured to convert the continuous transfer function of the zero oscillation zero derivative shaper into a discrete transfer function:wherein N isi=Round(Ti/Tc) Round () is Ti/TcRounding off the one digit of the decimal point of the calculated value to obtain a function of the integer, TcIs a servo position control period.
The motor control unit 206 specifically includes a motor position control subunit, and is configured to shape the discretization unit 205 according to the position instruction to obtain a shaped discrete position instruction, and perform closed-loop feedback control on the motor position; the speed and torque control subunit can be realized by common closed-loop control, and outputs three-phase current to drive the motor to rotate.
The driver provided by the invention enables a user to develop a positioning system without developing or purchasing other components with the function of inhibiting the residual vibration at the tail end of the mechanical load, thereby bringing convenience to the user.
The embodiments in the present description are described in a progressive manner, each embodiment focuses on differences from other embodiments, and the same and similar parts among the embodiments are referred to each other. For the system disclosed by the embodiment, the description is relatively simple because the system corresponds to the method disclosed by the embodiment, and the relevant points can be referred to the method part for description.
The principles and embodiments of the present invention have been described herein using specific examples, which are provided only to help understand the method and the core concept of the present invention; meanwhile, for a person skilled in the art, according to the idea of the present invention, the specific embodiments and the application range may be changed. In view of the above, the present disclosure should not be construed as limiting the invention.
Claims (10)
1. A method of suppressing residual oscillation of a positioning device, comprising:
acquiring an original position instruction, wherein the position instruction is an instruction for position control sent by an upper controller;
acquiring the amplitude and time lag of n continuous action pulses, wherein n is 3;
acquiring a servo position control period;
calculating a discrete transfer function of a zero oscillation zero derivative shaper;
discrete type using zero oscillation zero derivative shaperTransfer functionAnd performing shaping discretization on the position instruction to obtain a shaped discretized position instruction, wherein AiIs the amplitude of the i-th action pulse, Ni=Round(Ti/Tc) Round () is Ti/TcRounding off the one digit of the decimal point of the calculated value to obtain a function of the integer, TiTime lag of the ith action pulse, TcFor the servo position control period, n is 3;
and driving the motor to rotate according to the shaped and discretized position command so as to inhibit residual oscillation of the tail end of the mechanical load connected with the motor shaft when the positioning of the positioning device is finished.
2. The method of suppressing residual oscillations according to claim 1, characterized in that said acquisition of the amplitude and the time lag of successive n action pulses specifically comprises:
obtaining the vibration frequency of the mechanical load tail end at the end of positioning, wherein the vibration frequency of the mechanical load tail end is measured by an off-line experimental test method;
setting a system damping coefficient zeta to 0;
according to the vibration frequency and the system damping, the amplitude A of continuous n action pulses of the zero oscillation zero derivative shaper is calculatediAnd a time lag Ti,i=1,2,3。
3. The method for suppressing residual oscillation according to claim 2, wherein the off-line experimental test method is used for determining that:
directly obtaining a vibration waveform of a mechanical load tail end through a laser interferometer, and measuring vibration frequency according to the vibration waveform;
or observing a position deviation curve or an actual position curve of the motor shaft when the system is positioned by a drawing function observation system of upper monitoring software on the servo system, and measuring the vibration frequency of the motor shaft to replace the vibration frequency of the tail end of the load;
or carrying out frequency spectrum analysis on the position or speed data of the motor shaft when the system is positioned by a fast Fourier analysis method to obtain the vibration frequency of the motor shaft to replace the vibration frequency of the tail end of the load.
4. The method of suppressing residual oscillations according to claim 1, characterized in that, said calculating a zero oscillation zero derivative shaper discrete transfer function specifically comprises:
obtaining a continuous transfer function of a zero-oscillation zero-derivative shaper in an s-domain, wherein the transfer function of the zero-oscillation zero-derivative shaper is as follows:
wherein A isiIs the amplitude of the i-th action pulse, TiThe time lag for the ith action pulse;
converting the zero oscillation zero derivative shaper continuous transfer function into a discrete transfer function in the z-domain:
wherein N isi=Round(Ti/Tc) Round () is Ti/TcRounding off the one digit of the decimal point of the calculated value to obtain a function of the integer, TcIs the servo drive position control period.
5. The method of suppressing residual oscillations according to claim 1, characterized in that, said controlling motor rotation according to said shaped discrete position command. The method specifically comprises the following steps: and performing closed-loop feedback control on the position of the motor, the speed of the motor and the torque of the motor according to the shaped discrete position command.
6. A residual oscillation suppression system for a positioning device, comprising:
the system comprises a position instruction acquisition unit, a position control unit and a position control unit, wherein the position instruction acquisition unit is used for acquiring an original position instruction which is an instruction sent by an upper controller and used for position control;
the amplitude time lag acquisition unit is used for acquiring the amplitudes and time lags of n continuous action pulses, wherein n is 3;
a control period acquisition unit for acquiring a servo position control period Tc;
The discrete function calculating unit is used for calculating a discrete transfer function of the zero oscillation zero derivative shaper;
a position command shaping discretization unit for discretizing a transfer function with a zero-oscillation zero-derivative shaperShaping and discretizing the position instruction to obtain a shaped discrete position instruction, wherein AiIs the amplitude of the i-th action pulse, Ni=Round(Ti/Tc) Round () is Ti/TcRounding off the one digit of the decimal point of the calculated value to obtain a function of the integer, TiTime lag of the ith action pulse, TcA servo position control period;
and the motor control unit is used for controlling the motor to rotate according to the shaped discrete position command so as to inhibit residual oscillation of the tail end of the mechanical load connected with the motor shaft when the positioning of the positioning device is finished.
7. The system according to claim 6, wherein the magnitude skew obtaining unit specifically includes:
the vibration frequency acquisition subunit is used for acquiring the vibration frequency of the tail end of the mechanical load, and the vibration frequency of the tail end of the mechanical load is measured by an off-line experimental test method;
a system damping ratio setting subunit configured to set a system damping ζ to 0;
an amplitude time-lag calculating subunit for calculating the amplitude time-lag according to the vibration frequency and the systemDamping, calculating to obtain the amplitude A of continuous 3 action pulsesiAnd a time lag Ti,i=1,2,3。
8. The system according to claim 6, wherein the discrete transfer function calculation unit specifically comprises:
a continuous transfer function obtaining subunit, configured to obtain a continuous transfer function of a zero oscillation zero derivative shaper, where the transfer function of the zero oscillation zero derivative shaper is:
wherein A isiIs the amplitude of the i-th action pulse, TiThe time lag for the ith action pulse;
in the formula e is a natural constant; omegan,ωdζ is the natural frequency, damped oscillation frequency and damping coefficient of the positioner system, respectively, and f is the frequency of vibration at the end of the mechanical load.
A transfer function discretization subunit, configured to convert the continuous transfer function of the zero oscillation zero derivative shaper into a discrete transfer function:
wherein N isi=Round(Ti/Tc) Round () is Ti/TcRounding off the one digit of the decimal point of the calculated value to obtain a function of the integer, TcIs a servo position control period.
9. The system according to claim 6, characterized in that the motor control unit comprises in particular:
the motor position control subunit is used for carrying out closed-loop feedback control on the position of the motor according to the shaped discrete position instruction;
the motor speed control subunit is used for carrying out closed-loop feedback control on the motor speed according to the feedback speed of the motor shaft code;
and the motor torque control subunit is used for carrying out closed-loop feedback control on the motor torque according to the feedback torque of the motor.
10. A servo driver for suppressing residual oscillations, characterized in that said driver comprises a system according to any of claims 6-9.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610801531.XA CN106154838A (en) | 2016-09-05 | 2016-09-05 | The residual oscillation suppressing method of a kind of positioner and system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610801531.XA CN106154838A (en) | 2016-09-05 | 2016-09-05 | The residual oscillation suppressing method of a kind of positioner and system |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106154838A true CN106154838A (en) | 2016-11-23 |
Family
ID=57344543
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610801531.XA Pending CN106154838A (en) | 2016-09-05 | 2016-09-05 | The residual oscillation suppressing method of a kind of positioner and system |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106154838A (en) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107272409A (en) * | 2017-07-04 | 2017-10-20 | 浙江理工大学 | A kind of linear servo system vibration suppressing method based on iterative learning |
CN107544247A (en) * | 2017-09-11 | 2018-01-05 | 北京航空航天大学 | A kind of method and system for suppressing mechanical moving structure vibration |
CN110239140A (en) * | 2019-06-13 | 2019-09-17 | 博众精工科技股份有限公司 | A kind of servo press equipment compress control method based on input shaper |
CN111367170A (en) * | 2020-02-11 | 2020-07-03 | 固高科技(深圳)有限公司 | Input shaper design method |
CN113848700A (en) * | 2020-06-28 | 2021-12-28 | 北京配天技术有限公司 | Robot jitter suppression method, device, equipment and readable storage medium |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4517500A (en) * | 1983-11-16 | 1985-05-14 | Fmc Corporation | Controller for electromagnetic exciter using power line subharmonic |
CN101156117A (en) * | 2005-04-07 | 2008-04-02 | 贝利莫控股公司 | Suppression of vibrations |
CN101584111A (en) * | 2007-01-17 | 2009-11-18 | 松下电器产业株式会社 | Servo motor control device and control method |
-
2016
- 2016-09-05 CN CN201610801531.XA patent/CN106154838A/en active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4517500A (en) * | 1983-11-16 | 1985-05-14 | Fmc Corporation | Controller for electromagnetic exciter using power line subharmonic |
CN101156117A (en) * | 2005-04-07 | 2008-04-02 | 贝利莫控股公司 | Suppression of vibrations |
CN101584111A (en) * | 2007-01-17 | 2009-11-18 | 松下电器产业株式会社 | Servo motor control device and control method |
Non-Patent Citations (2)
Title |
---|
经迎龙: "闭环输入整形器控制策略研究", 《中国优秀硕士学位论文全文数据库(电子期刊) 工程科技II辑》 * |
陈俊恒: "输入整形减振算法的研究与实现", 《中国优秀硕士学位论文全文数据库(电子期刊) 信息科技辑》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107272409A (en) * | 2017-07-04 | 2017-10-20 | 浙江理工大学 | A kind of linear servo system vibration suppressing method based on iterative learning |
CN107272409B (en) * | 2017-07-04 | 2020-07-14 | 浙江理工大学 | Linear servo system vibration suppression method based on iterative learning |
CN107544247A (en) * | 2017-09-11 | 2018-01-05 | 北京航空航天大学 | A kind of method and system for suppressing mechanical moving structure vibration |
CN110239140A (en) * | 2019-06-13 | 2019-09-17 | 博众精工科技股份有限公司 | A kind of servo press equipment compress control method based on input shaper |
CN110239140B (en) * | 2019-06-13 | 2021-06-15 | 博众精工科技股份有限公司 | Servo laminating equipment pressure control method based on input shaping |
CN111367170A (en) * | 2020-02-11 | 2020-07-03 | 固高科技(深圳)有限公司 | Input shaper design method |
CN111367170B (en) * | 2020-02-11 | 2023-08-08 | 固高科技股份有限公司 | Input shaper design method |
CN113848700A (en) * | 2020-06-28 | 2021-12-28 | 北京配天技术有限公司 | Robot jitter suppression method, device, equipment and readable storage medium |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106154838A (en) | The residual oscillation suppressing method of a kind of positioner and system | |
CN100538563C (en) | Control device | |
JP4283214B2 (en) | Machine tip control device | |
Vukosavic et al. | Suppression of torsional oscillations in a high-performance speed servo drive | |
CN104238361B (en) | Adaptive robust position control method and system for motor servo system | |
KR101522511B1 (en) | Control method and control device | |
WO2011067976A1 (en) | Control device for power device | |
CN105247432B (en) | Frequency response determines device | |
CN102904521A (en) | Electric motor controller comprising function for simultaneously estimating inertia, friction, and spring | |
CN100441374C (en) | Position control device and position control method for machine tools | |
JP2014136260A (en) | Control device | |
CN104993766A (en) | Two-mass system resonance suppression method | |
CN102820844A (en) | Vibration suppression method for flexible manipulators | |
JP5762166B2 (en) | Vibration suppression method | |
JP2004005469A (en) | Control method and control device for electric motor | |
JP6789459B1 (en) | Motor inductance measuring device, motor drive system, and motor inductance measuring method | |
JP5283804B1 (en) | Servo control device | |
CN111015661B (en) | Active vibration control method and system for flexible load of robot | |
CN103034253B (en) | Inhibition method of vibration in dynamic physical process and inhibition system of vibration in dynamic physical process | |
JP5407435B2 (en) | Motor control device | |
JP6661676B2 (en) | Robot controller | |
JP2010130854A (en) | Thrust ripple compensating arrangement of linear motor and compensating method thereof | |
JP4660947B2 (en) | Electric power steering device | |
JP5278333B2 (en) | Motor control device | |
Ivoilov et al. | The power consumption decreasing of the two-wheeled balancing robot |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20161123 |