CN110032073B - 1/2 power attraction repetitive control method with equivalent disturbance compensation - Google Patents
1/2 power attraction repetitive control method with equivalent disturbance compensation Download PDFInfo
- Publication number
- CN110032073B CN110032073B CN201910386927.6A CN201910386927A CN110032073B CN 110032073 B CN110032073 B CN 110032073B CN 201910386927 A CN201910386927 A CN 201910386927A CN 110032073 B CN110032073 B CN 110032073B
- Authority
- CN
- China
- Prior art keywords
- error
- attraction
- equivalent disturbance
- controller
- disturbance
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
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)
- Feedback Control In General (AREA)
Abstract
A1/2 power attraction repetitive control method with equivalent disturbance compensation is disclosed, wherein a given module generates periodic reference signals, a periodic feedforward link is constructed, equivalent disturbance compensation is introduced into the 1/2 power attraction law, and a disturbance observer is used for estimating equivalent disturbance; constructing an ideal error dynamic state based on the power attraction law, designing a controller according to the ideal error dynamic state, and taking a signal obtained by calculation as the control input of a servo system; the specific controller parameter setting can be carried out according to the convergence performance index of the representation system, and a calculation formula for representing a monotone decreasing area, an absolute attraction layer, a steady-state error band boundary and the maximum step number of the tracking error entering the steady-state error band for the first time in the tracking error convergence process is provided. The 1/2 power attraction repetitive control method with equivalent disturbance compensation provided by the invention can improve the tracking precision of the system and completely inhibit periodic disturbance by estimating the equivalent disturbance.
Description
Technical Field
The invention designs a 1/2 power attraction repetitive control method with equivalent disturbance compensation, which is used for a periodic position servo system and is also suitable for other industrial occasions containing periodic operation processes.
Background
The essence of the internal model principle is that a dynamic model of external signals of the system (namely, the internal model) is implanted into the control system, so that a high-precision feedback control system is formed, and the system can track input signals without errors. Repetitive control is a typical application of the principle of the internal model, and regardless of the specific form of the input signal, as long as the initial segment signal is given, the internal model accumulates the input signal cycle by cycle, and repeatedly outputs the same signal as the previous cycle. The repetitive controller designed according to the internal model principle has the characteristics of memory and learning, and realizes the track tracking of periodic reference signals and the complete suppression of periodic disturbance. At present, the repetitive control technology has been successfully applied to the precise control of servo motors, the power electronic control technology, the power quality control and the like.
Different from a method of designing dynamics based on a sliding mode function by an approach law, the approach law is a method of designing dynamics based on errors directly, and the approach law method can enable the errors to be converged in a limited time. The attraction law method directly utilizes the tracking error signal, and the controller design is more direct and concise. The attraction law can reflect the expected dynamic characteristics of the system error when the disturbance condition is not considered; under the condition of interference, the controller cannot be directly designed according to the attraction law, so that interference suppression measures are 'embedded' into the attraction law, an ideal error dynamic state with a disturbance suppression effect is constructed, and the digital controller is designed according to the constructed ideal error dynamic equation. The closed loop system dynamics is determined by the ideal error dynamics and has a desired tracking performance characterized by the ideal error dynamics. In the attraction law method, the performance of the system is characterized by a monotone decreasing area, an absolute attraction layer, a steady-state error band and the maximum number of steps required for the tracking error to enter the steady-state error band for the first time. Once an ideal error dynamic form is given, specific expressions of various indexes are given in advance and used for guiding the parameter setting of the controller.
The extended state observer is a core unit for active disturbance rejection control, and the basic method is to define the total disturbance (including internal disturbance and external disturbance) as a new state, construct a disturbance observer of an extended variable (including total disturbance action) by using a method designed by the extended state observer. The method can estimate system variables, and can also estimate the real-time action quantity of overall disturbance in a system model, so as to compensate the influence of disturbance signals. Since the overall disturbance encompasses uncertainties in the system model, the system model is greatly simplified, and the control gain is considered known, facilitating controller design.
Disclosure of Invention
In order to solve the problem that the existing power attraction repetitive controller can not realize high-precision tracking of a servo system and can not completely inhibit periodic disturbance, the invention provides a 1/2 power attraction repetitive control method with equivalent disturbance compensation, in order to enable a closed-loop system to have preset expected error tracking performance, a motor servo repetitive controller is designed according to an ideal error dynamic equation of a power attraction structure, non-periodic components exist in disturbance while the periodic disturbance components are completely inhibited, a disturbance observer is introduced into the closed-loop system to compensate non-periodic disturbance, the control performance is further improved, and the motor servo system can realize high-speed and high-precision tracking; the invention expands the disturbance effect influencing the system output into a new variable to construct a disturbance observer, the disturbance observer does not need to directly measure a disturbance signal and know a specific model of the disturbance signal, and the invention specifically provides a specific expression of at most four indexes, namely a steady state error band, an absolute attraction layer, a monotone subtraction area and a step number required for a tracking error to enter the steady state error band for the first time, and the specific expression is used for guiding the parameter setting of the controller.
The technical scheme adopted by the invention for solving the technical problems is as follows:
a1/2 power attraction repetitive control method with equivalent disturbance compensation comprises the following steps:
rk=rk-N (1)
Where N is the period of the reference signal, rkAnd rk-NReference signals respectively representing time k and time k-N;
In the formula
Satisfy the requirement of
Wherein e isk+1Represents the tracking error at time k +1, rk+1Reference signal, y, representing the time instant k +1k+1、yk、 yk+1-NAnd yk-NRepresenting the output signals at times k +1, k +1-N and k-N, respectively, ukAnd uk-NRepresenting the input signal at times k and k-N, wk+1And wk+1-NRespectively representing the interfering signals at times k +1 and k +1-N, d represents the delay, A (q)-1) And B (q)-1) Is q-1Polynomial of (a), q-1Representing a one-step delay operator, naRepresents A (q)-1) Order of (1), nbRepresents B (q)-1) The order of (a) is selected,is a system parameter and b0≠0, na≥nbD is an integer, and d is not less than 1;
dk=wk-wk-N (4)
Where N is the period of the reference signal, dkRepresenting the equivalent disturbance signal at time k, wkAnd wk-NRespectively representing interference signals at the k moment and the k-N moment;
expressing the tracking error as
ek+1=rk+1-yk+1-N+A1(q-1)(yk-yk-N)-q-d+1B(q-1)(uk-uk-N)-dk+1 (5)
Wherein d isk+1Representing the equivalent disturbance at the moment k + 1;
design observer equivalent disturbance dk+1Observing, and compensating equivalent disturbance by the observed value, wherein two observed variables of the observer areAndestimate e separatelykAnd dkBased on the error dynamics (equation (5)), an observer of the following form is designed
Wherein the content of the first and second substances,represents the error ek+1Is estimated by the estimation of (a) a,represents the error ekIs estimated by the estimation of (a) a,representing equivalent perturbation, beta1Representing the observer gain coefficient, beta, with respect to the error2Representing the observer gain coefficient with respect to the equivalent disturbance,an estimation error representing a tracking error;
Estimation error of tracking error is
The expressions (7) and (8) are written as follows
|λI-B|=0 (10)
Namely, it is
λ2+(β1-β2-1)λ-β1=0 (11)
For parameter beta1And beta2Configured so that all feature roots are within the unit circle, matrix B is a Schur stable matrix, and the estimation error converges asymptotically, i.e.
Wherein rho and epsilon are both adjustable parameters, rho is more than 0 and less than 1, and epsilon is more than 0;
and 6, constructing a repetitive controller with equivalent disturbance compensation, wherein the process is as follows:
combining equation (5) and equation (12), design a repetitive controller with equivalent disturbance compensation
Note the book
Expressing a repetitive controller as
uk=uk-N+vk (14)
Will ukAs input signal of controller of servo object, measuring to obtain output signal y of servo systemkFollows the reference signal rkAnd (4) changing.
Further, an expression of four indexes, such as a steady state error band, an absolute attraction layer, a monotone decreasing area, the maximum number of steps required for the tracking error to enter the steady state error band for the first time and the like is given, and the expression is used for describing the tracking performance of the system and guiding the parameter setting of the controller, wherein the steady state error band, the absolute attraction layer, the monotone decreasing area and the maximum convergence number are defined as follows:
1) monotonous decreasing region deltaMDR: when e iskGreater than this boundary, ekThe same number is decreased, namely the following conditions are met:
2) absolute attraction layer ΔAAL: absolute value of system tracking errorkIf | is greater than this boundary, its | ekI, monotonically decreases, i.e. the condition is satisfied:
3) steady state error band ΔSSE: when the system error once converges into the boundary, the error is stabilized in the region, that is, the following condition is satisfied:
4) maximum number of convergence stepsThe tracking error passes through at mostEntering a steady state error band;
equivalent disturbance compensation error satisfactionSpecific expressions of the respective indices are as follows
1) Monotonous decreasing region deltaMDR
2) Absolute attraction layer ΔAAL
3) Steady state error band ΔSSE
Wherein e is0In order to be the initial value of the tracking error,represents the smallest integer no less than.
The technical conception of the invention is as follows: a power-of-1/2 attraction repetitive controller with equivalent disturbance compensation is provided. According to a given reference signal and the constructed equivalent disturbance, an observer is introduced to estimate the equivalent disturbance, and interference suppression measures are embedded into a power law of attraction to form ideal error dynamics with interference suppression effect, so that a repetitive controller with equivalent disturbance compensation is designed, and rapid and high-precision tracking of the given reference signal is realized.
The invention has the following beneficial effects: the method has equivalent disturbance compensation, complete suppression of periodic disturbance, fast convergence performance and high tracking precision.
Drawings
Fig. 1 is a block diagram of a motor apparatus.
FIG. 2 is a block diagram of an equivalent disturbance observer.
Fig. 3 is a block diagram of a power-suction repetition controller.
FIG. 4 is a graph of the time when a disturbance w occursk=5sin(2πfkTs) +0.15sgn (sin (2k pi/150)), the simulation results for the controller parameters with ∈ 0.1, ρ 0.3, and Δ 0.3, where Δ is plottedMDR,ΔAALAnd deltaSSE。
FIG. 5 is a graph of the time when a disturbance w occursk=-10sin(2πfkTs) +0.15sgn (sin (2k pi/150)), the simulation results for the controller parameters with ∈ 0.1, ρ 0.3, and Δ 0.3, where Δ is plottedMDR,ΔAALAnd deltaSSE。
FIG. 6 is a graph of the time when a disturbance w occursk=5sin(2πfkTs) +0.15sgn (sin (2k pi/150)), the simulation results for the controller parameters with ∈ 0.2, ρ 0.3, and Δ 0.3, where Δ is plottedMDR,ΔAALAnd deltaSSE。
FIG. 7 is a graph of the time when a disturbance w occursk=-10sin(2πfkTs) +0.15sgn (sin (2k pi/150)), where the controller parameter is 0.2, 0.3, and 0.3In the figure,. DELTA.MDR,ΔAALAnd deltaSSE。
FIG. 8 is a graph of the time when a disturbance w occursk=5sin(2πfkTs) The simulation results for the case of +0.15sgn (sin (2k pi/150)), where the controller parameter ∈ is 0.5, ρ is 0.3, and Δ is 0.5 are shown in the figure, where Δ is indicatedMDR,ΔAALAnd deltaSSE。
FIG. 9 is a graph of the time when a disturbance w occursk=-10sin(2πfkTs) The simulation results for the case of +0.15sgn (sin (2k pi/150)), where the controller parameter ∈ is 0.5, ρ is 0.3, and Δ is 0.5 are shown in the figure, where Δ is indicatedMDR,ΔAALAnd deltaSSE。
Fig. 10 to 13 show experimental results of the permanent magnet synchronous motor control device when the repetitive controller parameter is ρ 0.7 and ∈ 0.3, where,
FIG. 10 is a reference position signal and an actual position signal under the influence of a repetitive controller based on the power law of attraction;
FIG. 11 is a controller voltage signal under the influence of a repetitive controller based on the power law of attraction;
FIG. 12 is a graph of position error under the influence of a repetitive controller based on the power law of attraction;
fig. 13 is a histogram of the distribution of position errors under the action of a repetitive controller based on the power law of attraction.
Fig. 14-17 show that the repetitive controller parameter is ρ 0.7, and ∈ 0.3, and the disturbance observer parameter is β1=0.2,β20.5, the experimental results of the permanent magnet synchronous motor control device, wherein,
FIG. 14 is a reference position signal and an actual position signal under the influence of a repetitive controller based on the power law of attraction and equivalent disturbance compensation;
FIG. 15 is a controller voltage signal under the influence of a repetitive controller based on the power law of attraction and equivalent disturbance compensation;
FIG. 16 is a position error under repetitive controller action based on the power law of attraction and equivalent disturbance compensation;
fig. 17 is a histogram of the position error distribution under the influence of a repetitive controller based on the power law of attraction and equivalent disturbance compensation.
Fig. 18 to 21 show experimental results of the permanent magnet synchronous motor control device when the repetitive controller parameter is ρ 0.5 and ∈ 0.15, where,
FIG. 18 is a graph of a reference position signal and an actual position signal under the influence of a repetitive controller based on the power law of attraction;
FIG. 19 is a controller voltage signal under the influence of a repetitive controller based on the power law of attraction;
FIG. 20 is a graph of position error under the influence of a repetitive controller based on the power law of attraction;
fig. 21 is a histogram of a position error distribution under the action of a repetitive controller based on the power law of attraction.
Fig. 22-25 show that the repetitive controller parameter is ρ 0.5, and ∈ 0.15, and the disturbance observer parameter is β1=0.2,β20.5, the experimental results of the permanent magnet synchronous motor control device, wherein,
FIG. 22 is a graph of the reference position signal and the actual position signal under the influence of a repetitive controller based on the power law of attraction and equivalent disturbance compensation;
FIG. 23 is a controller voltage signal under the influence of a repetitive controller based on the power law of attraction and equivalent disturbance compensation;
FIG. 24 is a graph of position error under repetitive controller action based on the power law of attraction and equivalent disturbance compensation;
fig. 25 is a histogram of the position error distribution under the influence of a repetitive controller based on the power law of attraction and equivalent disturbance compensation.
Fig. 26 to 29 are experimental results of the permanent magnet synchronous motor control device in which p is 0.3 and e is 0.1, respectively, in the repetitive controller parameters,
FIG. 26 is a graph of a reference position signal and an actual position signal under the influence of a repetitive controller based on the power law of attraction;
FIG. 27 is a controller voltage signal under the influence of a repetitive controller based on the power law of attraction;
FIG. 28 is a graph of position error under the influence of a repetitive controller based on the power law of attraction;
fig. 29 is a histogram of the distribution of position errors under the action of a repetitive controller based on the power law of attraction.
In fig. 30-33, the repetitive controller parameter is ρ 0.3, and ∈ 0.1, and the disturbance observer parameter is β1=0.2,β20.5, the experimental results of the permanent magnet synchronous motor control system, wherein,
FIG. 30 is a graph of a reference position signal and an actual position signal under the influence of a repetitive controller based on the power law of attraction and equivalent disturbance compensation;
FIG. 31 is a controller voltage signal under the influence of a repetitive controller based on the power law of attraction and equivalent disturbance compensation;
FIG. 32 is a graph of position error under repetitive controller action based on the power law of attraction and equivalent disturbance compensation;
fig. 33 is a histogram of the position error distribution under the influence of a repetitive controller based on the power law of attraction and equivalent disturbance compensation.
Fig. 34 to 37 are experimental results of the permanent magnet synchronous motor control device in which p is 0.7 and e is 0.3, where,
FIG. 34 is a graph of a reference position signal and an actual position signal under the action of a feedback controller based on the power law of attraction;
FIG. 35 is a controller voltage signal under the influence of a feedback controller based on the power law of attraction;
FIG. 36 is a graph showing a position error under the action of a feedback controller based on the power law of attraction;
fig. 37 is a histogram of the distribution of position errors under the action of a feedback controller based on the power law of attraction.
Fig. 38 to 41 show that the feedback controller parameter is ρ 0.7, and ∈ 0.3, and the disturbance observer parameter is β1=0.2,β20.5, the experimental results of the permanent magnet synchronous motor control device, wherein,
FIG. 38 is a reference position signal and an actual position signal under the influence of a feedback controller based on the power law of attraction and equivalent disturbance compensation;
FIG. 39 is a graph of the controller voltage signal under the influence of a feedback controller based on the power law of attraction and equivalent disturbance compensation;
FIG. 40 is a graph of position error under the influence of a feedback controller based on the power law of attraction and equivalent disturbance compensation;
fig. 41 is a position error distribution histogram under the action of a feedback controller based on the power law of attraction and equivalent disturbance compensation.
Fig. 42 to 45 are experimental results of the permanent magnet synchronous motor control device in which p is 0.5 and e is 0.15, where,
FIG. 42 is a graph of a reference position signal and an actual position signal under the action of a feedback controller based on the power law of attraction;
FIG. 43 is a controller voltage signal under the action of a feedback controller based on the power law of attraction;
FIG. 44 is a graph showing a position error under the action of a feedback controller based on the power law of attraction;
fig. 45 is a histogram of the distribution of position errors under the action of a feedback controller based on the power law of attraction.
Fig. 46 to 49 show that the feedback controller parameter is ρ ═ 0.5, and ∈ ═ 0.15, and the disturbance observer parameter is β1=0.2,β20.5, the experimental results of the permanent magnet synchronous motor control device, wherein,
FIG. 46 is a reference position signal and an actual position signal under the influence of a feedback controller based on the power law of attraction and equivalent disturbance compensation;
FIG. 47 is a controller voltage signal under the influence of a feedback controller based on the power law of attraction and equivalent disturbance compensation;
FIG. 48 is a graph of position error under the influence of a feedback controller based on the power law of attraction and equivalent disturbance compensation;
fig. 49 is a position error distribution histogram under the action of a feedback controller based on the power law of attraction and equivalent disturbance compensation.
Fig. 50 to 53 show experimental results of the permanent magnet synchronous motor control device when the feedback controller parameter is ρ 0.3 and ∈ 0.1, where,
FIG. 50 is a graph of a reference position signal and an actual position signal under the action of a feedback controller based on the power law of attraction;
FIG. 51 is a controller voltage signal under the influence of a feedback controller based on the power law of attraction;
FIG. 52 is a graph showing a position error under the action of a feedback controller based on the power law of attraction;
fig. 53 is a histogram of the distribution of position errors under the action of a feedback controller based on the power law of attraction.
Fig. 54 to 57 show that the feedback controller parameter is ρ ═ 0.3, and ∈ ═ 0.1, and the disturbance observer parameter is β1=0.2,β20.5, the experimental results of the permanent magnet synchronous motor control device, wherein,
FIG. 54 is a graph of the reference position signal and the actual position signal under the influence of a feedback controller based on the power law of attraction and equivalent disturbance compensation;
FIG. 55 is a graph of the controller voltage signal under the influence of a feedback controller based on the power law of attraction and equivalent disturbance compensation;
FIG. 56 is a graph of position error under the influence of a feedback controller based on the power law of attraction and equivalent disturbance compensation;
fig. 57 is a position error distribution histogram under the action of a feedback controller based on the power law of attraction and equivalent disturbance compensation.
Detailed Description
The following further describes embodiments of the present invention with reference to the accompanying drawings.
Referring to fig. 1-57, a power-of-1/2 attraction repetitive control method with equivalent disturbance compensation, wherein fig. 1 is a block diagram of a motor apparatus; FIG. 2 is a block diagram of an equivalent disturbance observer; fig. 3 is a block diagram of a power attraction repeat controller.
The power attraction repetitive servo control method based on equivalent disturbance compensation comprises the following steps:
and 6, constructing a repetitive controller with equivalent disturbance compensation, combining the formula (5) and the formula (12), designing a repetitive controller (13) with equivalent disturbance compensation, and expressing the repetitive controller as (14).
The above repetitive controller design is explained as follows:
1) introduction of d into power attraction lawk+1Reflecting suppression measures for disturbing signals of a given periodic pattern, introducedAn estimate of the equivalent disturbance is reflected, thereby providing equivalent disturbance compensation.
2) In the formula (13), ek、yk、yk-1、yk-1-NAre all obtained by measurement, uk-1、uk-1-NThe stored value for the control signal is read from memory.
3) When the reference signal satisfies rk=rk-1The discrete repetitive controller is also suitable for the constant value regulation problem, and the equivalent disturbance is dk=wk-wk-1(ii) a Wherein r isk-1Reference signal representing the time instant k-1, wk-1Representing the interference signal at time k-1; the feedback controller with equivalent disturbance compensation is
4) The discrete time controller is designed for a second-order system, and a design result of a high-order system can be given according to the same method.
Further, a specific expression of four indexes, namely a steady-state error band, an absolute attraction layer, a monotone decreasing area and the maximum step number required for the tracking error to enter the steady-state error band for the first time is given, and the specific expression is used for describing the tracking performance of the system and guiding the parameter setting of the controller.
In this embodiment, for example, the permanent magnet synchronous motor device executes a repetitive tracking task in a fixed interval, and the position reference signal has a periodic symmetry characteristic. TMS320F2812DSP is used as a controller, a Korean LS AC servo motor APM-SB01AGN is used as a control object, and a permanent magnet synchronous motor servo system is formed by the ELMO AC servo driver and an upper mechanism to control the position of the motor. The servo system adopts three-loop control, the current loop and speed loop controller ELMO driver provide, and the position loop is provided by DSP development board.
Obtaining a mathematical model of the servo object by parameter estimation
yk+1-1.8949yk+0.8949yk-1=1.7908uk-0.5704uk-1+wk+1 (22)
Wherein, yk,ukPosition output and control input, w, respectively, of the position servo systemkIs an interference signal.
The effectiveness of the repetitive controller given by the present invention will be illustrated in this example by numerical simulation and experimental results.
Numerical simulation: in the embodiment, a sinusoidal signal is used as a system reference signal, and the corresponding repetitive controller expression is
Given a position reference signal of rk=20(sin(2πfkTs-1/2 pi) +1) in degrees (deg), frequency f 1Hz, sampling period TsThe number of sampling points N is 1000, 0.005 s. Selecting proper disturbance amount w during simulationkIt consists of periodic disturbances and non-periodic random disturbances.
Under the action of a repetitive controller (23), different controller parameters rho and epsilon are selected, and three boundary layers of a servo system are different. For purposes of illustrating the invention patent with respect to the monotonically decreasing region ΔMDRAbsolute attraction layer DeltaAALAnd steady state error band ΔSSEThe theoretical correctness of (1).
1) When the controller parameter epsilon is 0.1, rho is 0.3, delta is 0.3,
ΔSSE=ΔAAL=ΔMDR=0.7176
2) when the controller parameter epsilon is 0.2, rho is 0.3, delta is 0.3,
ΔSSE=ΔAAL=0.5195,ΔMDR=0.6608
3) when the controller parameter epsilon is 0.5, rho is 0.3, delta is 0.5,
ΔSSE=0.5893,ΔAAL=0.5026,ΔMDR=1.6248
the simulation results are shown in FIGS. 4-9, where FIGS. 4, 6 and 8 are perturbation amounts wk=5sin(2πfkTs) The simulation result of +0.15sgn (2k pi/150), FIGS. 5, 7 and 9 are disturbance amounts wk=-10sin(2πfkTs) +0.15sgn (2k pi/150).
The numerical results verify the monotonous reduction area delta of the tracking error of the system under the action of the repetitive controller given by the patent under the condition of a given system model, a reference signal and an interference signalMDRAbsolute attraction layer DeltaAALAnd steady state error band ΔSSEThe accuracy of (2).
Experimental verification the block diagram of the motor apparatus used in the experiment is shown in figure 1. The tracking performance of the discrete controller based on the 1/2 power attraction law is verified by setting different controller parameters. Given position signal rkA (sin (2 pi × (k-200)/N) +1), where the amplitude a is 135deg, and the sampling period Ts2.5ms, k is the number of samples, and N is 800.
The adopted repetitive controller has the following form
The repetitive controller based on disturbance compensation is adopted and has the following form
The feedback controller adopted has the following form
The repetitive controller based on disturbance compensation is adopted and has the following form
1) The controller (24) is adopted, the controller parameters are rho is 0.7, epsilon is 0.3, and the experimental results are shown in figures 10-13, wherein delta is shown in the figuresSSE=0.1deg。
2) A controller (25) is adopted, wherein rho and epsilon are taken as parameters of the controller and 0.7 and 0.3 respectively, and beta is taken as a parameter of an equivalent disturbance observer1=0.2,β2The results are shown in FIGS. 14-17, where Δ is 0.5SSE=0.08deg。
3) The controller (24) is adopted, the controller parameters are rho is 0.5, epsilon is 0.15, and the experimental results are shown in figures 18-21, wherein delta is shown in the figuresSSE=0.14deg。
4) A controller (25) is adopted, wherein rho and epsilon are respectively taken as parameters of the controller and 0.5 and 0.15, and beta is taken as a parameter of an equivalent disturbance observer1=0.2,β2The results are shown in FIGS. 22-25, where Δ is 0.5SSE=0.11deg。
5) The controller (24) is adopted, the controller parameters are rho is 0.3, epsilon is 0.1, and the experimental results are shown in figures 26-29, wherein delta is shown in the figuresSSE=0.1deg。
6) A controller (25) is adopted, wherein rho and epsilon are respectively taken as parameters of the controller and 0.3 and 0.1, and beta is taken as a parameter of an equivalent disturbance observer1=0.2,β2The results are shown in FIGS. 30-33, where Δ is 0.5SSE=0.07deg。
7) The controller (26) is adopted, the controller parameters are rho is 0.7, epsilon is 0.3, and the experimental results are shown in FIGS. 34-37, wherein delta is shown in the figureSSE=0.13deg。
8) A controller (27) is adopted, wherein rho and epsilon are respectively taken as the parameters of the controller and 0.7 and 0.3, and beta is taken as the parameter of an equivalent disturbance observer1=0.2,β2The results are shown in FIGS. 38-41, where Δ is 0.5SSE=0.11deg。
9) The controller (26) is adopted, the controller parameters are rho is 0.5, epsilon is 0.15, and the experimental results are shown in figures 42-45, wherein delta is shown in the figuresSSE=0.16deg。
10) A controller (27) is adopted, wherein rho and epsilon are respectively taken as the parameters of the controller and 0.5 and 0.15, and beta is taken as the parameter of an equivalent disturbance observer1=0.2,β2The results are shown in FIGS. 46-49, where Δ is 0.5SSE=0.13deg。
11) The controller (26) is adopted, the controller parameters are rho is 0.3, epsilon is 0.1, and the experimental results are shown in figures 50-53, wherein delta is shown in the figuresSSE=0.13deg。
12) A controller (27) is adopted, wherein rho and epsilon are respectively taken as the parameters of the controller and 0.3 and 0.1, and beta is taken as the parameter of an equivalent disturbance observer1=0.2,β2The results are shown in FIGS. 54-57, where Δ is 0.5SSE=0.095deg。
The experiment result shows that the equivalent disturbance is introduced and is estimated by the equivalent disturbance observer, the compensation for the unmodeled characteristic and the external unknown disturbance of the system is provided, and the influence of the unknown disturbance on the tracking performance can be effectively inhibited; and the periodic disturbance is completely inhibited by adopting repeated control, so that the control performance of the system is further improved.
Claims (2)
1. A1/2 power attraction repetitive control method with equivalent disturbance compensation, wherein a controlled object is a periodic servo system, and the method is characterized by comprising the following steps:
step 1, giving periodic reference signals to satisfy
rk=rk-N (1)
Where N is the period of the reference signal, rkAnd rk-NReference signals respectively representing time k and time k-N;
step 2, defining tracking error
In the formula
Satisfy the requirement of
A(q-1)yk=q-dB(q-1)uk+wk (3)
Wherein e isk+1Represents the tracking error at time k +1, rk+1Reference signal, y, representing the time instant k +1k+1、yk、yk+1-NAnd yk-NRepresenting the output signals at times k +1, k +1-N and k-N, respectively, ukAnd uk-NRepresenting the input signal at times k and k-N, wk+1And wk+1-NRespectively representing the interfering signals at times k +1 and k +1-N, d represents the delay, A (q)-1) And B (q)-1) Is q-1Polynomial of (a), q-1Representing a one-step delay operator, naRepresents A (q)-1) Order of (1), nbRepresents B (q)-1) The order of (a) is selected,is a system parameter and b0≠0,na≥nbD is an integer, and d is not less than 1;
step 3. constructing equivalent disturbance
dk=wk-wk-N (4)
Where N is the period of the reference signal, dkRepresenting the equivalent disturbance signal at time k, wkAnd wk-NRespectively representing interference signals at the k moment and the k-N moment;
expressing the tracking error as
ek+1=rk+1-yk+1-N+A1(q-1)(yk-yk-N)-q-d+1B(q-1)(uk-uk-N)-dk+1 (5)
Wherein d isk+1Representing the equivalent disturbance at the moment k + 1;
step 4, designing an observer, estimating equivalent disturbance, and carrying out the following process:
design observer equivalent disturbance dk+1Observing and compensating equivalent disturbance by the observed value; two observed variables of the observer areAndare used to estimate e respectivelykAnd dk(ii) a From the error dynamics (equation (5)), an observer of the following form is designed
Wherein the content of the first and second substances,represents the error ek+1Is estimated by the estimation of (a) a,represents the error ekIs estimated by the estimation of (a) a,representing equivalent perturbation, β1Representing the observer gain coefficient, beta, with respect to the error2Representing observer gain coefficients with respect to equivalent disturbances;show the heelAn estimation error of the tracking error;
Estimation error of tracking error is
The expressions (7) and (8) are written as follows
|λI-B|=0 (10)
Namely, it is
λ2+(β1-β2-1)λ-β1=0 (11)
Thus, the characteristic root isFor beta is1And beta2Is configured such that all feature roots are within the unit circle;
step 5. construct the 1/2 power attraction law with disturbance suppression measures
Wherein rho and epsilon are both adjustable parameters, rho is more than 0 and less than 1, and epsilon is more than 0;
and 6, constructing a repetitive controller with equivalent disturbance compensation, wherein the process is as follows:
combining equation (5) and equation (12) to obtain a repetitive controller with equivalent disturbance compensation
Note the book
Expressing a repetitive controller as
uk=uk-N+vk (14)
Will ukAs input signal of controller of servo object, measuring to obtain output signal y of servo systemkFollows the reference signal rkAnd (4) changing.
2. The 1/2 power-of-attraction repetitive control method with equivalent disturbance compensation as claimed in claim 1, wherein expressions of four indexes, namely a steady-state error band, an absolute attraction layer, a monotone decreasing region and the maximum number of steps required for a tracking error to firstly enter the steady-state error band, are given for describing the tracking performance of the system and guiding the parameter setting of the controller, wherein the steady-state error band, the absolute attraction layer, the monotone decreasing region and the convergence steps are defined as follows:
1) monotonous decreasing region deltaMDR: when e iskGreater than this boundary, ekThe same number is decreased, namely the following conditions are met:
2) absolute attraction layer ΔAAL: absolute value of system tracking errorkIf | is greater than this boundary, its | ekI, monotonically decreases, i.e. the condition is satisfied:
3) steady state error band ΔSSE: when the system error once converges into the boundary, the error is stabilized in the region, that is, the following condition is satisfied:
4) maximum number of convergence stepsThe tracking error passes through at mostEntering a steady state error band; equivalent disturbance compensation error satisfactionSpecific expressions of the respective indices are as follows
1) Monotonous decreasing region deltaMDR
2) Absolute attraction layer ΔAAL
3) Steady state error band
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910386927.6A CN110032073B (en) | 2019-05-10 | 2019-05-10 | 1/2 power attraction repetitive control method with equivalent disturbance compensation |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910386927.6A CN110032073B (en) | 2019-05-10 | 2019-05-10 | 1/2 power attraction repetitive control method with equivalent disturbance compensation |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110032073A CN110032073A (en) | 2019-07-19 |
CN110032073B true CN110032073B (en) | 2022-05-03 |
Family
ID=67241736
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910386927.6A Active CN110032073B (en) | 2019-05-10 | 2019-05-10 | 1/2 power attraction repetitive control method with equivalent disturbance compensation |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110032073B (en) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110297427B (en) * | 2019-08-14 | 2022-03-08 | 台州学院 | Dual-mode structure half-cycle repetitive controller for inverter |
CN110297426B (en) * | 2019-08-14 | 2022-02-25 | 台州学院 | Parallel type half-cycle repetitive control method adopting periodic interference differential suppression strategy |
CN110376899B (en) * | 2019-08-14 | 2022-02-18 | 台州学院 | Dual-mode structure half-cycle repetitive controller adopting periodic interference differential compensation |
CN110716430B (en) * | 2019-09-27 | 2022-05-03 | 浙江工业大学 | Servo system rapid suction repetitive control method adopting equivalent disturbance compensation |
CN111835250B (en) * | 2020-06-05 | 2022-04-05 | 浙江工业大学 | 1/2 power finite value attraction repetitive control method for servo motor driving system |
CN112068423B (en) * | 2020-08-06 | 2024-06-18 | 浙江工业大学 | Design method of finite power attraction repetitive controller |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1992020019A1 (en) * | 1991-04-24 | 1992-11-12 | Fanuc Ltd | Method and apparatus for prediction repetition control of servo motor |
CN103048921A (en) * | 2012-11-12 | 2013-04-17 | 浙江工业大学 | Half-cycle repetitive controller for position servo system |
CN103197556A (en) * | 2013-03-21 | 2013-07-10 | 浙江工业大学 | Half period repetitive control method based on attractive rule |
CN107544245A (en) * | 2017-08-25 | 2018-01-05 | 浙江工业大学 | Attract the discrete repetitive control for motor servo system of rule using the one order inertia of disturbance expansion compensation |
CN107544244A (en) * | 2017-08-25 | 2018-01-05 | 浙江工业大学 | Based on the oval discrete repetitive control for motor servo system for attracting rule and the compensation of equivalent disturbance expansion state |
CN107797448A (en) * | 2017-08-25 | 2018-03-13 | 浙江工业大学 | Using the discrete repetitive control of motor position of disturbance expansion compensation |
CN108646574A (en) * | 2018-07-26 | 2018-10-12 | 台州学院 | A kind of discrete repetitive controller and its control method attracting rule based on power |
CN109240077A (en) * | 2018-10-09 | 2019-01-18 | 台州学院 | Discrete multicycle repetitive controller for period servo-system |
CN109450307A (en) * | 2018-10-10 | 2019-03-08 | 浙江工业大学 | Attract rule based on class normal distribution and using the discrete repetitive control for motor servo system of disturbance expansion state compensation |
-
2019
- 2019-05-10 CN CN201910386927.6A patent/CN110032073B/en active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1992020019A1 (en) * | 1991-04-24 | 1992-11-12 | Fanuc Ltd | Method and apparatus for prediction repetition control of servo motor |
CN103048921A (en) * | 2012-11-12 | 2013-04-17 | 浙江工业大学 | Half-cycle repetitive controller for position servo system |
CN103197556A (en) * | 2013-03-21 | 2013-07-10 | 浙江工业大学 | Half period repetitive control method based on attractive rule |
CN107544245A (en) * | 2017-08-25 | 2018-01-05 | 浙江工业大学 | Attract the discrete repetitive control for motor servo system of rule using the one order inertia of disturbance expansion compensation |
CN107544244A (en) * | 2017-08-25 | 2018-01-05 | 浙江工业大学 | Based on the oval discrete repetitive control for motor servo system for attracting rule and the compensation of equivalent disturbance expansion state |
CN107797448A (en) * | 2017-08-25 | 2018-03-13 | 浙江工业大学 | Using the discrete repetitive control of motor position of disturbance expansion compensation |
CN108646574A (en) * | 2018-07-26 | 2018-10-12 | 台州学院 | A kind of discrete repetitive controller and its control method attracting rule based on power |
CN109240077A (en) * | 2018-10-09 | 2019-01-18 | 台州学院 | Discrete multicycle repetitive controller for period servo-system |
CN109450307A (en) * | 2018-10-10 | 2019-03-08 | 浙江工业大学 | Attract rule based on class normal distribution and using the discrete repetitive control for motor servo system of disturbance expansion state compensation |
Non-Patent Citations (2)
Title |
---|
A unified design approach to repetitive learning control for systems subject to fractional uncertainties;Sun Mingxuan,et al.;《Journal of dynamic systems measurement and control-transactions of the asme》;20180630;第061003(1-11)页 * |
带扰动补偿的无抖振离散重复控制器设计;周文委 等;《控制与决策》;20170331;第32卷(第3期);第467-473页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110032073A (en) | 2019-07-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110032073B (en) | 1/2 power attraction repetitive control method with equivalent disturbance compensation | |
CN110134010B (en) | Power attraction repetitive control method adopting equivalent disturbance compensation servo system | |
CN110134014B (en) | Equivalent disturbance compensation method for periodic servo system power attraction repetitive control | |
CN107797448B (en) | Motor position discrete repetitive control method adopting disturbance expansion compensation | |
CN110658719A (en) | Servo system non-switching attraction repetitive control method adopting equivalent disturbance compensation | |
CN109450307B (en) | Discrete repetitive control method for motor servo system based on similar normal distribution attraction law and adopting disturbance expansion state compensation | |
CN107544245B (en) | Discrete repetitive control method for motor servo system adopting disturbance expansion compensation first-order inertia attraction law | |
CN107544244B (en) | Discrete repetitive control method for motor servo system based on elliptic attraction law and equivalent disturbance expansion state compensation | |
Liu et al. | Industrial process identification and control design: step-test and relay-experiment-based methods | |
CN110716430B (en) | Servo system rapid suction repetitive control method adopting equivalent disturbance compensation | |
CN106773694B (en) | Precision Piezoelectric location platform adaptively exports feedback inverse control method | |
CN108983615B (en) | Discrete double-period repetitive controller based on hyperbolic sine suction law | |
CN108958041B (en) | Discrete double-period repetitive control method based on hyperbolic secant attraction law | |
Chen et al. | Iterative learning of dynamic inverse filters for feedforward tracking control | |
Wang et al. | Command filtered finite-time control for nonlinear systems with state constraints and its application to TCP network | |
CN111835250B (en) | 1/2 power finite value attraction repetitive control method for servo motor driving system | |
CN112068423B (en) | Design method of finite power attraction repetitive controller | |
CN111752149B (en) | Design method of digital repetitive controller for designated time attraction of servo motor | |
Ahmadian et al. | A new approach to adaptive control of multi-input multi-output systems using multiple models | |
de la Parte et al. | Development of a GPC-based sliding mode controller | |
Wigren | Low-frequency limitations in saturated and delayed networked control | |
CN112068424B (en) | Discrete repeated control method of elliptic approach law adopting disturbance compensation | |
Kim et al. | A performance enhancement scheme for robust repetitive control system | |
CN112117945A (en) | Discrete repetitive control method of parabola approximation law adopting disturbance compensation | |
Zhou et al. | Preisach modeling of hysteresis and tracking control of a Thunder actuator system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |