A kind of mechanical arm servo-drive system neural network full-order sliding mode control method with dead area compensation
Technical field
The present invention relates to a kind of mechanical arm servo-drive system neural network full-order sliding mode control method with dead area compensation, particularly with the mechanical arm servo system control method of the input of unknown dead band and the unknown dynamic parameter of system.
Background technology
Mechanical arm servo-drive system, as the increasingly automated equipment of one, is widely used in robot, the contour performance system of aviation aircraft, and the accurate fast control how realizing mechanical arm servo-drive system has become a hot issue.But the input of unknown dead band is extensively present in mechanical arm servo-drive system, the efficiency of control system is often caused to reduce or even lost efficacy.For the control problem of mechanical arm servo-drive system, there is a lot of control method, such as PID controls, adaptive control, sliding formwork control etc.
Sliding formwork controls to be considered to an effective robust control method in and external disturbance uncertain at resolution system.The advantages such as sliding-mode control has that algorithm is simple, fast response time, to external world noise and Parameter Perturbation strong robustness.Therefore, sliding-mode control is widely used in every field.Contrast conventional linear sliding formwork controls, and the superiority of TSM control is that his finite time is received.But TSM control discontinuous switching characteristic in itself will cause the buffeting of system, becomes the obstacle that TSM control is applied in systems in practice.In order to address this problem, the method for many improvement is suggested in succession, such as high_order sliding mode control method, observer control method.In these methods, choosing of sliding-mode surface all obtains according to idealized system parameter depression of order.Recently, a kind of full-order sliding mode control method is suggested, and this method well avoids buffeting problem and makes system input signal more level and smooth in the response of system.
But in the method for above-mentioned proposition, the dynamic model parameters of mechanical system all must be known in advance.Therefore, the uncertain factor of system and the input of unknown dead band can affect the direct application of mechanical arm servo-drive system.As everyone knows, because neural network approaches the ability of any smooth function in an arbitrary accuracy compacted, therefore it has been widely used in the non-intellectual of disposal system and nonlinear problem.For these reasons, many adaptive neural network control methods are used to control nonlinearity and the mechanical arm system containing the input of unknown dead band.
Summary of the invention
Dead band cannot be avoided to input systematic influence and there is the deficiency that sliding formwork controls buffeting problem to overcome existing mechanical arm servo-drive system, the invention provides a kind of mechanical arm servo-drive system neural network full-order sliding mode control method with dead area compensation, achieve the effective compensation to unknown dead band, improve buffeting problem and the singular problem of system, ensure the convergence of system fast and stable.
In order to the technical scheme solving the problems of the technologies described above proposition is as follows:
With a mechanical arm servo-drive system neural network full-order sliding mode control method for dead area compensation, comprise the following steps:
Step 1, sets up the dynamic model of mechanical arm servo-drive system, initialization system state, sampling time and controling parameters, and process is as follows:
The dynamic model expression formula of 1.1 mechanical arm servo-drive systems is:
Wherein, q,
with
be respectively the position of joint of mechanical arm, speed and acceleration; M
h, C
hand D
hrepresent the symmetric positive definite inertial matrix in each joint respectively, the diagonal angle positive definite matrix of centrifugal Coriolis matrix and damping friction coefficient; G
hrepresent gravity item; τ is control signal; T (τ) is dead band, is expressed as:
Wherein, g
rand g
lrepresent the left slope in dead band and right slope respectively; b
rand b
lrepresent the unknown width parameter in dead band, meet g
r> 0, g
l> 0, b
r> 0, b
l< 0;
Formula (2) is expressed as by 1.2:
T(τ)=g(t)τ+b(t)(3)
Wherein,
And
1.3 through types (2) and (3), definition:
B(t)=(g(t)-g
l(t))τ+b(t)(4)
Then formula (3) is represented as:
T(τ)=g
l(t)τ+B(t)(5)
Therefore, relational expression is obtained || B (t) ||≤B
m=max ((2*g
l+ g
r) b
r, (2*g
l+ g
r) b
l);
1.4 owing to existing measurement noises, the impact of load variations and external interference, and the systematic parameter in formula (1) can not obtain accurately, therefore the systematic parameter of reality is rewritten as:
Wherein, estimated value
and
represent known portions; Δ M
h(q),
Δ D
hand Δ G
h(q) representative system unknown term;
Step 2, based on the mechanical arm servo-drive system containing the input of unknown dead band and unknown parameter, the neural network of design, process is as follows:
Definition θ
*for ideal weight matrix of coefficients, then nonlinear uncertain function f approached for:
F=θ
* Tφ (x)+ε (7) wherein,
represent input vector; φ (x)=[φ
1(x), φ
2(x) ... φ
m(x)]
tit is the basis function of neural network; ε represents the approximate error of neural network and meets || ε || and≤ε
n, ε
nit is then a positive constant; φ
ix () is taken as following Gaussian function:
Wherein, c
irepresent the nuclear parameter of Gaussian function; σ
ithen illustrate the width of Gaussian function;
Step 3, computing system tracking error, design full-order sliding mode face, process is as follows:
3.1 define system tracking errors are
e=q
d-q(9)
Wherein, q
dfor second order can lead desired trajectory; So the first differential of formula (9) and second-order differential are represented as:
3.2 therefore, and in order to avoid singular problem, full-order sliding mode face will be defined as:
Wherein, c
1and c
2be a positive constant, its selection ensures polynomial expression p
2+ c
2whole characteristic roots of p+c in the left-half of complex plane to ensure the stability of system; α
1and α
2choose, be by following polynomial expression:
Wherein, α
n+1=1, α
n=α, α ∈ (1-ε, 1) and ε ∈ (0,1);
Step 4, based on the mechanical arm system containing the input of unknown dead band, according to full-order sliding mode and neural network theory, design neural network full-order sliding mode controller, process is as follows:
4.1 consider formula (1), and neural network full-order sliding mode controller is designed to:
v=-(k
d+k
T+η)sgn(s)(17)
Wherein, c
iand α
iconstant, i=1,2, be defined in formula (12); k
d, k
tbe all constant with η, and will be described afterwards;
The Rule adjusting of 4.2 design neural network weight coefficient matrix:
Wherein, Γ is the diagonal matrix of a positive definite;
Formula (14) to be brought in (1) and is obtained following equation by 4.3:
Wherein,
represent the weight evaluated error of neural network;
representative system disturbance term, and be bounded, so suppose d (q, t)≤l
dand
wherein l
dit is the constant of a bounded; K
tto choose be meet k when K > 0
t>=Tl
d;
Through type (1), formula (12), formula (14)-Shi (17) and formula (19), full-order sliding mode face is expressed as following equation:
s=d(q,t)+u
n(20)
Formula (17) is brought in formula (16) and obtains:
At u
n(0), when=0, following equation is obtained:
k
T≥Tl
d≥T|u
n(t)|
max≥T|u
n(t)|(22)
4.4 design Liapunov functions:
Carry out differentiate to formula (12) to obtain:
Formula (16) is brought in formula (24) and obtains:
Carry out differential to formula (23) to obtain:
Formula (22) is brought in formula (26), if
then decision-making system is stable.
The present invention is based on the input of unknown dead band and unknown nonlinear factor, full-order sliding mode and neural network, design the mechanical arm servo-drive system neural network full-order sliding mode control method with dead area compensation, realizes system stability and control, improve the buffeting that sliding formwork controls, ensure the convergence of system fast and stable.
Technical conceive of the present invention is: for containing Dynamic Execution mechanism, and with the mechanical arm servo-drive system that unknown dead band inputs, utilize full-order sliding mode control method, then in conjunction with neural network, design a kind of mechanical arm servo-drive system neural network full-order sliding mode control method with dead area compensation.Dead band is converted into a linear time varying system, then approaches unknown function by neural network, compensate for traditional added influence in unknown dead band and the unknown parameter of system.In addition, the design in full-order sliding mode face is the fast and stable convergence in order to ensure system, and by avoiding occurring differential term to improve buffeting and singular problem in the control system of reality.The invention provides a kind of buffeting problem and the solution singular problem that can improve sliding-mode surface, and the control method of the unknown dynamic parameter of energy effective compensation system and the input of unknown dead band, the fast and stable realizing system controls.
Advantage of the present invention is: the non-dynamic parameter of bucking-out system and the input of unknown dead band, improves buffeting problem, realizes fast and stable convergence.
Accompanying drawing explanation
The position tracking effect schematic diagram that Fig. 1 (a) is joint one of the present invention.
The position tracking error schematic diagram that Fig. 1 (b) is joint one of the present invention.
The position tracking effect schematic diagram that Fig. 2 (a) is joint two of the present invention.
The position tracking error schematic diagram that Fig. 2 (b) is joint two of the present invention.
The controller input schematic diagram that Fig. 3 (a) is joint one of the present invention.
The controller input schematic diagram that Fig. 3 (b) is joint two of the present invention.
Fig. 4 is control flow schematic diagram of the present invention.
Embodiment
Below in conjunction with accompanying drawing, the present invention will be further described.
With reference to Fig. 1-Fig. 4, a kind of mechanical arm servo-drive system neural network full-order sliding mode control method with dead area compensation, comprises the following steps:
Step 1, sets up the dynamic model of mechanical arm servo-drive system, initialization system state, sampling time and controling parameters, and process is as follows:
The dynamic model expression formula of 1.1 mechanical arm servo-drive systems is:
Wherein, q,
with
be respectively the position of joint of mechanical arm, speed and acceleration; M
h, C
hand D
hrepresent the symmetric positive definite inertial matrix in each joint respectively, the diagonal angle positive definite matrix of centrifugal Coriolis matrix and damping friction coefficient; G
hrepresent gravity item; τ is control signal; T (τ) is dead band, is expressed as:
Wherein, g
rand g
lrepresent the left slope in dead band and right slope respectively; b
rand b
lrepresent the unknown width parameter in dead band, meet g
r> 0, g
l> 0, b
r> 0, b
l< 0;
Formula (2) is expressed as by 1.2:
T(τ)=g(t)τ+b(t)(3)
Wherein,
And
1.3 through types (2) and (3), definition:
B(t)=(g(t)-g
l(t))τ+b(t)(4)
Then formula (3) is represented as:
T(τ)=g
l(t)τ+B(t)(5)
Therefore, relational expression is obtained || B (t) ||≤B
m=max ((2*g
l+ g
r) b
r, (2*g
l+ g
r) b
l);
1.4 owing to existing measurement noises, the impact of load variations and external interference, and the systematic parameter in formula (1) can not obtain accurately, therefore the systematic parameter of reality is rewritten as:
Wherein, estimated value
and
represent known portions; Δ M
h(q),
Δ D
hand Δ G
h(q) representative system unknown term;
Step 2, based on the mechanical arm servo-drive system containing the input of unknown dead band and unknown parameter, the neural network of design, process is as follows:
Definition θ
*for ideal weight matrix of coefficients, then nonlinear uncertain function f approached for:
f=θ
*Tφ(x)+ε(7)
Wherein,
represent input vector; φ (x)=[φ
1(x), φ
2(x) ... φ
m(x)]
tit is the basis function of neural network; ε represents the approximate error of neural network and meets || ε || and≤ε
n, ε
nit is then a positive constant; φ
ix () is taken as following Gaussian function:
Wherein, c
irepresent the nuclear parameter of Gaussian function; σ
ithen illustrate the width of Gaussian function;
Step 3, computing system tracking error, design full-order sliding mode face, process is as follows:
3.1 define system tracking errors are
e=q
d-q(9)
Wherein, q
dfor second order can lead desired trajectory; So the first differential of formula (9) and second-order differential are represented as:
3.2 therefore, and in order to avoid singular problem, full-order sliding mode face will be defined as:
Wherein, c
1and c
2be a positive constant, its selection ensures polynomial expression p
2+ c
2whole characteristic roots of p+c in the left-half of complex plane to ensure the stability of system; α
1and α
2choose, be by following polynomial expression:
Wherein, α
n+1=1, α
n=α, α ∈ (1-ε, 1) and ε ∈ (0,1);
Step 4, based on the mechanical arm system containing the input of unknown dead band, according to full-order sliding mode and neural network theory, design neural network full-order sliding mode controller, process is as follows:
4.1 consider formula (1), and neural network full-order sliding mode controller is designed to:
v=-(k
d+k
T+η)sgn(s)(17)
Wherein, c
iand α
iconstant, i=1,2, be defined in formula (12); k
d, k
tbe all constant with η, and will be described afterwards;
The Rule adjusting of 4.2 design neural network weight coefficient matrix:
Wherein, Γ is the diagonal matrix of a positive definite;
Formula (14) to be brought in (1) and is obtained following equation by 4.3:
Wherein,
represent the weight evaluated error of neural network;
representative system disturbance term, and be bounded, so suppose d (q, t)≤l
dand
wherein l
dit is the constant of a bounded; K
tto choose be meet k when K > 0
t>=Tl
d;
Through type (1), formula (12), formula (14)-Shi (17) and formula (19), full-order sliding mode face is expressed as following equation:
s=d(q,t)+u
n(20)
Formula (17) is brought in formula (16) and obtains:
At u
n(0), when=0, following equation is obtained:
k
T≥Tl
d≥T|u
n(t)|
max≥T|u
n(t)|(22)
4.4 design Liapunov functions:
Carry out differentiate to formula (12) to obtain:
Formula (16) is brought in formula (24) and obtains:
Carry out differential to formula (23) to obtain:
Formula (22) is brought in formula (26), if
then decision-making system is stable.
In order to obtain the corresponding system parameter value in formula (2), we provide the mechanical arm servo-drive system expression formula in following two joints:
Wherein, a
11=(m
1+ m
2) r
1 2+ m
2r
2 2+ 2m
2r
1r
2cos (q
2)+J, a
12=m
2r
2+ m
2r
1r
2cos (q
2), a
22=m
2r
2 2+ J
2, b
12=m
2r
1r
2sin (q
2), c
1=(m
1+ m
2) r
1cos (q
2)+m
2r
2cos (q
1+ q
2), c
2=m
2r
2cos (q
1+ q
2),
The validity of extracting method in order to verify, The present invention gives following three kinds of methods and contrasts:
S1: the neural network full-order sliding mode control method not with dead area compensation;
S2: the neural network full-order sliding mode control method of band dead area compensation;
S3: the neural network finite-time control with dead area compensation: method is carried out.
Contrast in order to more effective, all parameter of system is all consistent, that is: q
1(0)=0.5, q
2(0)=0.5, J
m=diag (0.67 × 10
-4, 0.42 × 10
-4), D
m=diag (0.21,0.15), N=diag (9,1), and given system disturbance is:
system control signal parameter is: K
τ=diag (19/40,19/80), Γ=diag (50,50), α
1=13/27, α
2=13/27, c
1=100, c
2=40, T=1; Mechanical arm actual parameter is: r
1=0.2, r
2=0.18, m
1=2.3, m
2=0.6, J
1=0.02, J
2=0.003, g=9.8, makes k=k
d+ k
t+ η=10; Neural network comprises 15 nodes, i.e. n=15; Neural network width is: σ
i=4, i=1,2 ..., 15; Deadzone parameter is: b
r=0.8, b
l=-0.5, g
r=1.2, g
l=0.5; And tracking signal is: y
d1=y
d2=0.5 (sin (2 π t)+cos (π t)).
From Fig. 1, we find out, owing to there is the impact of dead band input, S1 method is the poorest on the tracking effect in joint one, also there is maximum tracking error, and S3 method has better tracking effect than S1 method, and S2 method has best tracking effect.For joint 2, the existence due to dead band causes M in formula (1)
hthere is unusual appearance, therefore make S1 method lose efficacy; From Fig. 2, we obtain, and same S2 method has better tracking effect and less tracking error than S3 method.As can be seen from Figure 3, S3 method has obvious chattering phenomenon, but S2 method then effectively improves this chattering phenomenon.
What more than set forth is the excellent effect of optimization that an embodiment that the present invention provides shows, obvious the present invention is not just limited to above-described embodiment, do not depart from essence spirit of the present invention and do not exceed scope involved by flesh and blood of the present invention prerequisite under can do all distortion to it and implemented.