CN106066602A - The implementation method of motor servo system positioner based on expansion error symbol integration robust - Google Patents

The implementation method of motor servo system positioner based on expansion error symbol integration robust Download PDF

Info

Publication number
CN106066602A
CN106066602A CN201510645323.0A CN201510645323A CN106066602A CN 106066602 A CN106066602 A CN 106066602A CN 201510645323 A CN201510645323 A CN 201510645323A CN 106066602 A CN106066602 A CN 106066602A
Authority
CN
China
Prior art keywords
theta
centerdot
formula
robust
error
Prior art date
Application number
CN201510645323.0A
Other languages
Chinese (zh)
Other versions
CN106066602B (en
Inventor
马大为
杨贵超
乐贵高
Original Assignee
南京理工大学
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Priority to CN201510190968X priority Critical
Priority to CN201510190968 priority
Application filed by 南京理工大学 filed Critical 南京理工大学
Publication of CN106066602A publication Critical patent/CN106066602A/en
Application granted granted Critical
Publication of CN106066602B publication Critical patent/CN106066602B/en

Links

Abstract

The present invention relates to electromechanical servo control field, disclose a kind of motor servo system positioner (RISEE) based on expansion error symbol integration robust, belong to electromechanical servo control field.The present invention chooses dc rotating machine positional servosystem as object of study, establishes the nonlinear model of total disturbance of consideration system;By introducing, the external disturbance existed for system based on the robust item expanding error signal integration and Unmarried pregnancy etc. are uncertain has good robustness to designed controller;Motor servo system robust position controller based on expansion error symbol integration designed by the present invention is full-state feedback device, and the position output of motor servo system can be made to have asymptotic tracking performance, and i.e. when the time tends to infinite, tracking error is zero;Controller parameter designed by the present invention is easily dimmable and controls input voltage continuously, is more conducive to apply in engineering reality.

Description

The implementation method of motor servo system positioner based on expansion error symbol integration robust

Technical field

The present invention relates to electromechanical servo control field, watch in particular to a kind of motor based on expansion error symbol integration robust The implementation method of dress system positioner.

Background technology

Response is fast, transmission efficiency is high, easy to maintenance and the energy obtains the outstanding advantages such as convenient owing to having for motor servo system, It is widely used in the key areas such as industry and national defence, such as machine tool feed, rocket gun servo system, robot etc..Along with these are led The development in territory and the continuous progress of technical merit, in the urgent need to high performance motor servo system as support, tradition is based on linearly The control performance that change method obtains gradually can not meet system requirements.There is many model uncertainties in motor servo system, including Parameter uncertainty (such as change, the viscosity friction coefficient etc. that changes with temperature and abrasion of load quality) and uncertain Non-linear (such as outer interference etc.), these probabilistic existence may the desired control performance of severe exacerbation, even make based on being System controller designed by nominal plant model is unstable, therefore becomes the major obstacle of development Dynamic matrix control device.

Usually, Self Adaptive Control can effectively be estimated unknown constant parameter and can improve its tracking accuracy, but when system suffers Big may be unstable when not modeling disturbance.Tradition robust controller, such as sliding mode controller, can be effectively improved whole closed loop System is to not modeling the robustness of disturbance, but controller input can produce jitter phenomenon, is unfavorable in engineering reality application; As automatic disturbance rejection controller (ADRC) can effectively carry out feedforward compensation to big disturbance present in system, but the ADRC proposed Method can only guarantee the tracking error bounded of system.As a whole, Self Adaptive Control and robust control have the excellent of each of which Shortcoming.The Bin Yao of Purdue Univ-West Lafayette USA teaches the team's all uncertainties for nonlinear system, it is proposed that a kind of mathematics Prove strict nonlinear adaptive robust control (ARC) theoretical frame.Its team is based primarily upon mission nonlinear mathematical model and sets Meter gamma controller, for parameter uncertainty, the on-line parameter being designed correctly estimates strategy, to improve the tracing property of system Energy;Uncertain non-linear to contingent outer interference etc., suppressed by strong nonlinear gain feedback control.Due to by force Nonlinear gain feedback control often leads to stronger conservative (i.e. High Gain Feedback), has certain difficulty in engineering uses, and And potential in system big do not model disturbance the tracking performance of system may be made to be deteriorated.In order to compensate disturbing when ARC designs Dynamic, there is scholar to devise ARC method for designing based on extended state observer, and demonstrate from theoretical and experimental results and carried The controller gone out can make system have good tracking performance.But, Nonlinear Design method set forth above can only be true The tracking error bounded of insurance system, such performance may be difficult to meet requirement in the occasion of actual requirements for high precision.This is had Scholar propose robust control based on error symbol integration (RISE) method the system that there is matching disturbance be can ensure that its with Track error goes to zero when stable state, but this controller design method is relative complex and can only ensure whole system half overall situation gradually Near stable.The most appropriate designing can guarantee that whole system asymptotically stable in the large and simple controller are still research at present Focus.

In summary, the weak point of the control strategy of existing motor servo system mainly have following some:

1. tradition sliding mode controller acts on system and can make control input generation jitter phenomenon;

2. automatic disturbance rejection controller (ADRC) can only guarantee the tracking error bounded of system;

There is High Gain Feedback phenomenon in the most traditional adaptive robust control (ARC).There is high-gain in tradition adaptive robust control The problem of feedback, namely reduces tracking error by increase feedback oscillator.But High Gain Feedback is easily by measuring influence of noise And the high frequency of activating system dynamically and then the tracking performance of system may be reduced, even result in system unstable;

The most traditional adaptive robust control (ARC) is to there is parameter uncertainty and the nonlinear system of uncertainty can only simultaneously Ensure tracking error bounded (i.e. ensureing that tracking error, in the range of a bounded, does not ensures that tracking error goes to zero).Pass The adaptive robust control of system is to there is parameter uncertainty and the nonlinear system of uncertainty can only guarantee the tracking of system simultaneously Error bounded, such performance may be difficult to meet requirement in the occasion of actual requirements for high precision.

5. the design of robust control based on error symbol integration (RISE) device is relative complex and can only ensure whole system half overall situation Asymptotic Stability.

Summary of the invention

The present invention solves that tradition sliding mode controller acts on system and control input can be made to produce jitter phenomenon, automatic disturbance rejection controller (ADRC) can only guarantee that the tracking error bounded of system, traditional adaptive robust control (ARC) exist High Gain Feedback phenomenon And to there is parameter uncertainty and the nonlinear system of uncertainty can only ensure that tracking error bounded (i.e. ensures to follow the tracks of simultaneously Error, in the range of a bounded, does not ensures that tracking error goes to zero), it is simultaneously based on the robust control of error symbol integration (RISE) device design is relative complex and can only ensure the globally asymptotically stable problem of whole system half, proposes a kind of based on expansion The motor servo system robust position controller of error symbol integration.

The present invention solves that the technical scheme that the problems referred to above are taked is as follows:

The implementation method of motor servo system positioner based on expansion error symbol integration robust, comprises the following steps:

2, the implementation method of motor servo system positioner based on expansion error symbol integration robust, it is characterised in that bag Include following steps:

Step one, set up the mathematical model of electric machine position servo system:

In formula (1), J is the rotary inertia of load;Y is the angular displacement of load;KfFor torque error constant;U is defeated for controlling Enter voltage;For the non-linear friction model that can model, whereinRepresent different friction level,Represent different Shape function vector is used for describing the impact of various non-linear friction,Wherein B is viscosity friction coefficient;It is to include outer interference and do not model the uncertain item of friction;

For dc rotating machine servosystem, defined parameters collection θ=[θ12]T, wherein θ1=J/Kf, θ2=B/KfRepresent The known nominal value of systematic parameter;Definition system state variables is

The nonlinear model characterized by formula (1), then the state space form of mission nonlinear model can be expressed as:

x · 1 = x 2 (2)

θ 1 x · 2 = u - θ 2 x 2 + f ( x , t )

F (x, t)=d (x, t)/K in formula (2)fThe modeling indeterminate in real system and parameter error shadow is included for total disturbance Ring;

Assume 1: system mode x1、x2Can survey;

Assume 2: total disturbance f (x, t) smooth enough andWherein δ is known constant;

Step 2, for the state equation in formula (2), design motor servo system robust based on expansion error symbol integration Positioner, it specifically comprises the following steps that

Step 2 (one), define one group of variable being similar to switch function and be:

z 2 = z · 1 + k 1 z 1 , r = z · 2 + k 2 z 2 - - - ( 3 )

Z in formula (3)1=x1-x1dFor the tracking error of system, k1、k2For positive feedback oscillator.Formula (3) draws Enter error signal r of an expansion to obtain extra design freely;

Step 2 (two), design Nonlinear Robust Controller input u so that motor servo system has asymptotic tracking performance

According to formula (3), expansion error signal r can arrange and be:

r = x · 2 - x ·· 1 d + ( k 1 + k 2 ) z 2 - k 1 2 z 1 - - - ( 4 )

Based on system state equation (2), can obtain:

θ 1 r = u - θ 1 x ·· 1 d - θ 2 x · 1 d + f ( x , t ) + ( θ 1 k 1 + θ 1 k 2 - θ 2 ) z 2 - θ 1 k 1 2 z 1 + θ 2 k 1 z 1 - - - ( 5 )

According to the structure of formula (5), the Nonlinear Robust Controller Design of motor servo system is:

U=ua+us+un,uaTYd,

u s = - μ , μ = k r z 2 + ∫ 0 t k r k 2 z 2 d v , - - - ( 6 )

Y d = [ x ·· 1 d , x · 1 d ] T

krFor positive feedback gain;uaFor Feed forward Compensating Control Law based on model;usIt is used for ensureing name for nonlinear robust control rule The stability of justice system;unFor Robust Control Law based on expansion error symbol r integration, its disturbance being used for processing time-varying, un's Value will be given in below step;

Control law in (6) is brought in (5), can obtain:

θ 1 r = - k r z 2 - ∫ 0 t k r k 3 z 2 d v + u n + f ( x , t ) + ( θ 1 k 1 + θ 1 k 2 - θ 2 ) z 2 - ( θ 1 k 1 2 - θ 2 k 1 ) z 1 - - - ( 7 )

Formula (7) is carried out differential can obtain:

θ 1 r · = - k r r + u · n + f · ( x , t ) - [ k 2 ( θ 1 k 1 + θ 1 k 2 - θ 2 ) + ( θ 1 k 1 2 - θ 2 k 1 ) ] z 2 + k 1 ( θ 1 k 1 2 - θ 2 k 1 ) z 1 + ( θ 1 k 1 + θ 1 k 2 - θ 2 ) r - - - ( 8 )

Can design Robust Control Law un according to formula (8) is:

u · n = - δ sgn ( r ) - - - ( 9 )

Wherein sign (r) is defined as:

Owing to signal r is unknown, for the sgn (r) in computing formula (9), defined function g (t) is:

g ( t ) = ∫ 0 t r ( v ) d v = z 2 ( t ) - z 2 ( 0 ) + k 2 ∫ 0 t z 2 ( v ) d v - - - ( 11 )

Due to r (t)=limτ→0(g (t)-g (t-τ))/τ, τ can be chosen for the sampling time, and can be seen that according to (11) only needs It is to be understood that symbol sgn (r) of r, therefore have only to know that g (t) increases or reduces and be obtained with sgn (r), wherein Sgn (r)=sgn (g (t)-g (t-τ));

Step 3, regulation parameter τ (τ > 0), k1(k1> 0), k2(k2> 0) and kr(kr> 0), thus guarantee Whole system is stable, and makes position output y (t) of electro-hydraulic position servo system follow the tracks of desired position command yd

The invention has the beneficial effects as follows: the present invention chooses dc rotating machine positional servosystem as object of study, establishes and examines The nonlinear model of total disturbance of worry system;Designed controller is by introducing robust item pin based on expansion error signal integration The external disturbance that there is system and Unmarried pregnancy etc. are uncertain has good robustness;Designed by the present invention based on The motor servo system robust position controller of expansion error symbol integration is full-state feedback device, and can make motor servo system The position output of system has asymptotic tracking performance, and i.e. when the time tends to infinite, tracking error is zero;Control designed by the present invention Device parameter is easily dimmable and controls input voltage continuously, is more conducive to apply in engineering reality.

As long as should be appreciated that all combinations of aforementioned concepts and the extra design described in greater detail below are at such structure Think the most conflicting in the case of can be viewed as the part of subject matter of the disclosure.It addition, theme required for protection All combinations be considered as the part of subject matter of the disclosure.

The foregoing and other aspect that can be more fully appreciated with from the following description in conjunction with accompanying drawing present invention teach that, embodiment and Feature.Feature and/or the beneficial effect of other additional aspect such as illustrative embodiments of the present invention will show in the following description See, or by the practice according to the detailed description of the invention that present invention teach that is learnt.

Accompanying drawing explanation

Accompanying drawing is not intended to drawn to scale.In the accompanying drawings, each identical or approximately uniform ingredient illustrated in each figure Can be indicated by the same numeral.For clarity, in each figure, the most each ingredient is the most labeled.Now, By by example embodiment that various aspects of the invention are described in reference to the drawings, wherein:

Fig. 1 is the dc rotating machine positional servosystem schematic diagram that the present invention is considered.

Fig. 2 is motor servo system robust position controller principle signal based on expansion error symbol integration and flow chart;

Fig. 3 is that controller designed by the present invention (identifying with RISEE in figure) and conventional PID controllers are (with PID mark in figure Know) the time dependent curve synoptic diagram of tracking error of the lower system of effect respectively.

Fig. 4 is the actual control input time dependent curve synoptic diagram of u of electric machine position servo system.

Detailed description of the invention

In order to know more about the technology contents of the present invention, especially exemplified by specific embodiment and coordinate institute's accompanying drawings to be described as follows.

Each side the most with reference to the accompanying drawings to describe the present invention, the embodiment illustrated shown in the drawings of many.The disclosure Embodiment must not be intended to include all aspects of the invention.Should be appreciated that multiple design presented hereinbefore and embodiment, with And describe in more detail below those design and embodiment can in many ways in any one is implemented, this is because Design disclosed in this invention and embodiment are not limited to any embodiment.It addition, aspects more disclosed by the invention can be single Solely use, or otherwise any appropriately combined use with disclosed by the invention.

In conjunction with Fig. 1 to Fig. 2, present embodiment is described, the motor servo based on expansion error symbol integration robust of present embodiment The implementation method of system position controller specifically comprises the following steps that

Step one, setting up the mathematical model of electric machine position servo system, the present invention with dc rotating machine (as shown in Figure 1) is Example, the kinematical equation that can obtain system according to Newton's second law is:

In formula (1), J is the rotary inertia of load;Y is the angular displacement of load;KfFor torque error constant;U is defeated for controlling Enter voltage;For the non-linear friction model that can model, whereinRepresent different friction level,Represent different Shape function vector is used for describing the impact of various non-linear friction, and the present invention, in order to improve the intelligibility of controller design, The re-examination card controller robustness to Unmarried pregnancy, thus simplify the compensation part of controller, thus use linear friction model, I.e.Wherein B is viscosity friction coefficient;For the uncertain item such as outer interference and the friction that do not models.

Design for making controller is more extensive, for dc rotating machine servosystem, defined parameters collection θ=[θ12]T, Wherein θ1=J/Kf, θ2=B/KfRepresent the known nominal value of systematic parameter;Definition system state variables isThe nonlinear model characterized by formula (1), then the state space form of mission nonlinear model is permissible It is expressed as:

x · 1 = x 2 (2)

θ 1 x · 2 = u - θ 2 x 2 + f ( x , t )

F (x, t)=d (x, t)/K in formula (2)fThe modeling indeterminate in real system and parameter error shadow is included for total disturbance Ring.

Assume 1: system mode x1、x2Can survey;

Assume 2: total disturbance f (x, t) smooth enough andWherein δ is known constant.

In following controller design, it is assumed that 2 are applied with some constraints to not modeling disturbance.Although friction is typically modeled as Discontinuous function can cause assuming that 2 is somewhat conservative, but do not have which executor can produce discontinuous power and compensate discontinuously The impact of frictional force, therefore still uses some continuous print friction models, it is assumed that 2 meet when System design based on model device designs Practical situation.The design object of controller is to make position export x1Follow the tracks of ideal trajectory x that expectation is followed the tracks of as much as possible1d=yd(t)。

Step 2, for the state equation in formula (2), design motor servo system robust based on expansion error symbol integration Positioner, it specifically comprises the following steps that

Step 2 (one), define one group of variable being similar to switch function and be:

z 2 = z · 1 + k 1 z 1 , r = z · 2 + k 2 z 2 - - - ( 3 )

Z in formula (3)1=x1-x1dFor the tracking error of system, k1、k2For positive feedback oscillator.We are in formula (3) In introduce error signal r of an expansion to obtain extra design freely.Significantly, since the error letter of expansion Number r depends on accelerationInformation so that it can not be surveyed, be used merely to here assist following controller to design.

Step 2 (two), design Nonlinear Robust Controller input u so that motor servo system has asymptotic tracking performance.

According to formula (3), expansion error signal r can arrange and be:

r = x · 2 - x ·· 1 d + ( k 1 + k 2 ) z 2 - k 1 2 z 1 - - - ( 4 )

Based on system state equation (2), we can obtain:

θ 1 r = u - θ 1 x ·· 1 d - θ 2 x · 1 d + f ( x , t ) + ( θ 1 k 1 + θ 1 k 2 - θ 2 ) z 2 - θ 1 k 1 2 z 1 + θ 2 k 1 z 1 - - - ( 5 )

According to the structure of formula (5), the Nonlinear Robust Controller of motor servo system can be designed as:

U=ua+us+un,uaTYd,

u s = - μ , μ = k r z 2 + ∫ 0 t k r k 2 z 2 d v , - - - ( 6 )

Y d = [ x ·· 1 d , x · 1 d ] T

krFor positive feedback gain;uaFor Feed forward Compensating Control Law based on model;usIt is used for ensureing name for nonlinear robust control rule The stability of justice system;unFor Robust Control Law based on expansion error symbol r integration, its disturbance being used for processing time-varying, un's Value will be given in following design procedure.

Control law in (6) is brought in (5), and we can obtain:

θ 1 r = - k r z 2 - ∫ 0 t k r k 3 z 2 d v + u n + f ( x , t ) + ( θ 1 k 1 + θ 1 k 2 - θ 2 ) z 2 - ( θ 1 k 1 2 - θ 2 k 1 ) z 1 - - - ( 7 )

Formula (7) is carried out differential can obtain:

θ 1 r · = - k r r + u · n + f · ( x , t ) - [ k 2 ( θ 1 k 1 + θ 1 k 2 - θ 2 ) + ( θ 1 k 1 2 - θ 2 k 1 ) ] z 2 + k 1 ( θ 1 k 1 2 - θ 2 k 1 ) z 1 + ( θ 1 k 1 + θ 1 k 2 - θ 2 ) r - - - ( 8 )

Robust Control Law u can be designed according to formula (8)nFor:

u · n = - δ sgn ( r ) - - - ( 9 )

Wherein sign (r) is defined as:

Owing to signal r is unknown, for the sgn (r) in computing formula (9), defined function g (t) is:

g ( t ) = ∫ 0 t r ( v ) d v = z 2 ( t ) - z 2 ( 0 ) + k 2 ∫ 0 t z 2 ( v ) d v - - - ( 11 )

Due to r (t)=limτ→0(g (t)-g (t-τ))/τ, τ can be chosen for the sampling time, can be seen that us according to (11) Having only to know symbol sgn (r) of r, therefore we have only to know that g (t) increases or reduces and are obtained with sgn (r), Wherein sgn (r)=sgn (g (t)-g (t-τ)), so, it is thus achieved that sgn (r) is not required to accelerationInformation, thus compare Obtain r easier.

Step 3, regulation parameter τ (τ > 0), k1(k1> 0), k2(k2> 0) and kr(kr> 0), thus guarantee Whole system is stable, and makes position output y (t) of electro-hydraulic position servo system be accurately tracked by desired position command yd

In the disclosure, Lyapunov equation is selected to analyze based on the electric machine position servo system under controller (6) effect steady Qualitative:

Theoretical 1: choose sufficiently large feedback oscillator k1、k2、krSo that matrix Λ positive definite defined below, then proposition Control law (6) is able to ensure that all signal boundeds of whole closed loop motor servo, and can obtain Global Asymptotic tracking performance, i.e. when Z during t → ∞1→0.Λ is defined as:

Λ = k 1 - 1 2 - 1 2 a 2 - 1 2 k 2 - 1 - a 1 2 - 1 2 a 2 - 1 - a 1 2 k 3 - - - ( 12 )

Wherein:

a 1 = k 2 ( θ 1 k 1 + θ 1 k 2 - θ 2 ) + ( θ 1 k 1 2 - θ 2 k 1 ) - - - ( 13 )

a 2 = k 1 ( θ 1 k 1 2 - θ 2 k 1 ) - - - ( 14 )

k3=kr-(θ1k11k22) (15)

Choosing Lyapunov equation is:

V = 1 2 z 1 2 + 1 2 z 2 2 + 1 2 θ 1 r 2 - - - ( 16 )

About the time, formula (16) is carried out derivation can obtain:

V · = z 1 z · 1 + z 2 z · 2 + θ 1 r r · - - - ( 17 )

Formula (3) and (8) are substituted into formula (17), can obtain:

V · = z 1 ( z 2 - k 1 z 1 ) + z 2 ( r - k 2 z 2 ) + r { - k r r + u · n + f · ( x , t ) + ( θ 1 k 1 + θ 1 k 2 - θ 2 ) r - [ k 2 ( θ 1 k 1 + θ 1 k 2 - θ 2 ) + ( θ 1 k 1 2 - θ 2 k 1 ) ] z 2 + k 1 ( θ 1 k 1 2 - θ 2 k 1 ) z 1 } - - - ( 18 )

(18) conversion further can be obtained:

V · ≤ - k 1 z 1 2 - k 1 z 2 2 + z 1 z 2 + z 2 r - k r r 2 + r u · n + r f · ( x , t ) + ( θ 1 k 1 + θ 1 k 2 - θ 2 ) r 2 - [ k 2 ( θ 1 k 1 + θ 1 k 2 - θ 2 ) + ( θ 1 k 1 2 - θ 2 k 1 ) ] z 2 r + k 1 ( θ 1 k 1 2 - θ 2 k 1 ) z 1 r - - - ( 19 )

By(19) can be arranged further obtain:

V · ≤ [ k r - ( θ 1 k 1 + θ 1 k 2 - θ 2 ) ] r 2 - k 1 z 1 2 - k 2 z 2 2 - + z 1 z 2 + z 2 r - a 1 z 2 r + a 2 z 1 r - - - ( 20 )

It is positive definite matrix according to the Λ defined in formula (12), formula (20) conversion further can be obtained:

V · ≤ - z T Λ z ≤ - λ m i n ( Λ ) ( z 1 2 + z 2 2 + r 2 ) = Δ - W - - - ( 21 )

In formula (21), z is defined as z=[z1,z2,r]T;λmin(Λ) it is the minimal eigenvalue of matrix Λ.

V ∈ L can be obtained according to formula (21)And W ∈ L2, synchronous signal z bounded.Therefore, it can draw x and control System input u bounded.Based on z1、z2And the dynamical equation of r, the time-derivative bounded of W can be obtained, therefore W unanimously connects Continuous.Thus, W → 0 as t → ∞ can be obtained according to Barbalat lemma, theoretical 1 is i.e. proven.

Effect below in conjunction with an instantiation aforementioned embodiments of this disclosure illustrates.

Motor servo system parameter is: inertia load parameter J=0.5kg m2;Torque error constant Kf=4N m/V;Viscosity Coefficient of friction B=1.6N m s/rad;Disturb d (t)=sin (t) N m outside time-varying, choose δ=1;The position that system expectation is followed the tracks of Instruction is curve x1d(t)=sin (π t) [1-exp (-t3)]rad。

The parameter of the controller designed by the present invention is chosen for: τ=0.2ms, k1=300, k2=60 and kr=20;PID is controlled Device parameter processed is chosen for: P gain kP=1000, I gain kI=600, D gain kD=2.

Controller action effect: Fig. 3 is the controller (identifying with RISEE in figure) designed by the present invention and traditional PID control The time dependent curve synoptic diagram of tracking error of the lower system of device (identifying with PID in figure) effect respectively, can from figure Going out, under under the controller action designed by the present invention, the tracking error of system is significantly less than PID controller effect, the tracking of system is by mistake Difference and steady track error level off to 0, so that its tracking performance obtains the biggest raising.

Fig. 4 is the control input time dependent curve synoptic diagram of u of electric machine position servo system, it can be seen that this Control input signal obtained by invention is continuous and regular, is conducive to applying in engineering reality

Although the present invention is disclosed above with preferred embodiment, so it is not limited to the present invention.The technical field of the invention Middle tool usually intellectual, without departing from the spirit and scope of the present invention, when being used for a variety of modifications and variations.Therefore, originally The protection domain of invention is when being as the criterion depending on those as defined in claim.

Claims (1)

1. an implementation method for motor servo system positioner based on expansion error symbol integration robust, its feature exists In, comprise the following steps:
Step one, set up the mathematical model of electric machine position servo system:
In formula (1), J is the rotary inertia of load;Y is the angular displacement of load;KfFor torque error constant;U is defeated for controlling Enter voltage;For the non-linear friction model that can model, whereinRepresent different friction level,Represent different Shape function vector is used for describing the impact of various non-linear friction,Wherein B is viscosity friction coefficient;It is to include outer interference and do not model the uncertain item of friction;
For dc rotating machine servosystem, defined parameters collection θ=[θ12]T, wherein θ1=J/Kf, θ2=B/KfRepresent The known nominal value of systematic parameter;Definition system state variables is
The nonlinear model characterized by formula (1), then the state space form of mission nonlinear model can be expressed as:
x · 1 = x 2
(2)
θ 1 x · 2 = u - θ 2 x 2 + f ( x , t )
F (x, t)=d (x, t)/K in formula (2)fThe modeling indeterminate in real system and parameter error shadow is included for total disturbance Ring;
Assume 1: system mode x1、x2Can survey;
Assume 2: total disturbance f (x, t) smooth enough andWherein δ is known constant;
Step 2, for the state equation in formula (2), design motor servo system robust based on expansion error symbol integration Positioner, it specifically comprises the following steps that
Step 2 (one), define one group of variable being similar to switch function and be:
z 2 = z · 1 + k 1 z 1 , r = z · 2 + k 2 z 2 - - - ( 3 )
Z in formula (3)1=x1-x1dFor the tracking error of system, k1、k2For positive feedback oscillator.Formula (3) draws Enter error signal r of an expansion to obtain extra design freely;
Step 2 (two), design Nonlinear Robust Controller input u so that motor servo system has asymptotic tracking performance
According to formula (3), expansion error signal r can arrange and be:
r = x · 2 - x ·· 1 d + ( k 1 + k 2 ) z 2 - k 1 2 z 1 - - - ( 4 )
Based on system state equation (2), can obtain:
θ 1 r = u - θ 1 x ·· 1 d - θ 2 x ·· 1 d + f ( x , t ) + ( θ 1 k 1 + θ 1 k 2 - θ 2 ) z 2 - θ 1 k 1 2 z 1 + θ 2 k 1 z 1 - - - ( 5 )
According to the structure of formula (5), the Nonlinear Robust Controller Design of motor servo system is:
U=ua+us+un,uaTYd,
u s = - μ , μ = k r z 2 + ∫ 0 t k r k 2 z 2 d v , - - - ( 6 )
Y d = [ x ·· 1 d , x · 1 d ] T
krFor positive feedback gain;uaFor Feed forward Compensating Control Law based on model;usIt is used for ensureing name for nonlinear robust control rule The stability of justice system;unFor Robust Control Law based on expansion error symbol r integration, its disturbance being used for processing time-varying, un's Value will be given in below step;
Control law in (6) is brought in (5), can obtain:
θ 1 r = - k r z 2 - ∫ 0 t k r k 3 z 2 d v + u n + f ( x , t ) + ( θ 1 k 1 + θ 1 k 2 - θ 2 ) z 2 - ( θ 1 k 1 2 + θ 2 k 1 ) z 1 - - - ( 7 )
Formula (7) is carried out differential can obtain:
θ 1 r · = - k r r + u · n + f · ( x , t ) - [ k 2 ( θ 1 k 1 + θ 1 k 2 - θ 2 ) + ( θ 1 k 1 2 - θ 1 k 2 ) ] z 2 + k 1 ( θ 1 k 1 2 - θ 2 k 1 ) z 1 + ( θ 1 k 1 + θ 1 k 2 - θ 2 ) r - - - ( 8 )
Robust Control Law u can be designed according to formula (8)nFor:
u · n = - δ sgn ( r ) - - - ( 9 )
Wherein sign (r) is defined as:
Owing to signal r is unknown, for the sgn (r) in computing formula (9), defined function g (t) is:
g ( t ) = ∫ 0 t r ( v ) d v = z 2 ( t ) - z 2 ( 0 ) + k 2 ∫ 0 t z 2 ( v ) d v - - - ( 11 )
Due to r (t)=limτ→0(g (t)-g (t-τ))/τ, τ can be chosen for the sampling time, and can be seen that according to (11) only needs It is to be understood that symbol sgn (r) of r, therefore have only to know that g (t) increases or reduces and be obtained with sgn (r), wherein Sgn (r)=sgn (g (t)-g (t-τ));
Step 3, regulation parameter τ, τ > 0, k1、k1> 0;k2、k2> 0 and kr、kr> 0, thus guarantee whole System stability, and make position output y (t) of electro-hydraulic position servo system follow the tracks of desired position command yd
CN201510645323.0A 2015-04-21 2015-10-08 The implementation method of motor servo system positioner based on expansion error symbol integral robust CN106066602B (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201510190968X 2015-04-21
CN201510190968 2015-04-21

Publications (2)

Publication Number Publication Date
CN106066602A true CN106066602A (en) 2016-11-02
CN106066602B CN106066602B (en) 2019-02-22

Family

ID=57419529

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510645323.0A CN106066602B (en) 2015-04-21 2015-10-08 The implementation method of motor servo system positioner based on expansion error symbol integral robust

Country Status (1)

Country Link
CN (1) CN106066602B (en)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104111607A (en) * 2014-06-13 2014-10-22 南京理工大学 Motor position servo system control method taking input time lag into consideration
CN104252134A (en) * 2014-09-17 2014-12-31 南京理工大学 Method for controlling position of self-adaptive robust of motor servo system based on extended state observer
CN104317198A (en) * 2014-10-21 2015-01-28 南京理工大学 Method for controlling nonlinear robust position of electro-hydraulic servo system with time-varying output constraints

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104111607A (en) * 2014-06-13 2014-10-22 南京理工大学 Motor position servo system control method taking input time lag into consideration
CN104252134A (en) * 2014-09-17 2014-12-31 南京理工大学 Method for controlling position of self-adaptive robust of motor servo system based on extended state observer
CN104317198A (en) * 2014-10-21 2015-01-28 南京理工大学 Method for controlling nonlinear robust position of electro-hydraulic servo system with time-varying output constraints

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
JIANYONG YAO ET.AL: "Adaptive Robust Control of DC Motors With Extended State Observer", 《IEEE TRANSACTIONS ON INDUSTRIAL ELECTRONICS》 *
JIANYONG YAO ET.AL: "Adaptive Robust Motion Control of Direct-Drive DC Motors with Continuous Friction Compensation", 《ABSTRACT AND APPLIED ANALYSIS》 *
吴跃飞等: "具有状态约束的机电伺服系统自适应鲁棒控制", 《上海交通大学学报》 *
张磊等: "伺服系统的反馈控制设计研究综述", 《控制理论与应用》 *

Also Published As

Publication number Publication date
CN106066602B (en) 2019-02-22

Similar Documents

Publication Publication Date Title
He et al. Vibration control of a flexible robotic manipulator in the presence of input deadzone
Chen et al. Adaptive neural output feedback control of uncertain nonlinear systems with unknown hysteresis using disturbance observer
Huang et al. Active disturbance rejection control: methodology and theoretical analysis
Li et al. Continuous-time model predictive control of under-actuated spacecraft with bounded control torques
Li et al. Adaptive RBFNNs/integral sliding mode control for a quadrotor aircraft
Wang et al. Practical tracking control of robot manipulators with continuous fractional-order nonsingular terminal sliding mode
Zhu et al. Attitude stabilization of rigid spacecraft with finite‐time convergence
Yao et al. Adaptive robust control of DC motors with extended state observer
Yao et al. RISE-based precision motion control of DC motors with continuous friction compensation
Parra-Vega et al. Dynamic sliding PID control for tracking of robot manipulators: Theory and experiments
Oh et al. Path following of underactuated marine surface vessels using line-of-sight based model predictive control
Nodland et al. Neural network-based optimal adaptive output feedback control of a helicopter UAV
Sun Synchronization and control of multiagent systems
Abidi et al. Sliding-mode control for high-precision motion of a piezostage
Guo et al. Effective chaotic orbit tracker: a prediction-based digital redesign approach
Defoort et al. A third-order sliding-mode controller for a stepper motor
Guo et al. Anti-disturbance control theory for systems with multiple disturbances: A survey
Lu et al. Adaptive robust control of linear motors with dynamic friction compensation using modified LuGre model
Chen et al. Adaptive neural control of uncertain MIMO nonlinear systems with state and input constraints
Gao et al. Neural network control of a two-link flexible robotic manipulator using assumed mode method
CN104252134B (en) Method for controlling position of self-adaptive robust of motor servo system based on extended state observer
Yu et al. Continuous finite-time control for robotic manipulators with terminal sliding mode
Wang et al. Fast and accurate trajectory tracking control of an autonomous surface vehicle with unmodeled dynamics and disturbances
Zhang et al. Composite guidance laws based on sliding mode control with impact angle constraint and autopilot lag
Siradjuddin et al. Image-based visual servoing of a 7-DOF robot manipulator using an adaptive distributed fuzzy PD controller

Legal Events

Date Code Title Description
PB01 Publication
C06 Publication
SE01 Entry into force of request for substantive examination
C10 Entry into substantive examination
GR01 Patent grant
GR01 Patent grant