Documenti di Didattica
Documenti di Professioni
Documenti di Cultura
ThC1.1
I. INTRODUCTION
Ib
& & + mg sin = 0
x mx& 2 my
) &&
r2
I
& & + mg sin = 0
( m + b2 ) &&
y my & 2 mx
r
(m +
978-89-956056-9-1/09/2009 ACA
(1)
(2)
(3)
(4)
471
ThC1.1
&x& = f ( x, x& , w x (t ), t ) + k
&y& = f ( y, y& , w y (t ), t ) + k
2
mg /(m + I b / r ) = k
= k ( f ( x , x& , w x (t ), t ))
= 1 ( f ( y , y& , w (t ), t ))
1
y
k
(6)
[mg /( m + I b / r 2 )]
y = x
is
magnification
&x& =
&y& =
factor, y is
(10)
v1
e1
v2
e2
z1
z2
u0
z3
(7)
(9)
(5)
[mg /(m + I b / r 2 )]
&y& = m(&&x + & 2 y ) /(m + I b / r 2 )
(8)
output
1) TD
v1 (k + 1) = v1 (k ) + hv 2 (k )
v 2 (k + 1) = v 2 (k ) + hfhan(v1 (k )
v(k ), v 2 (k ), r0 , h)
(11)
472
ThC1.1
d = rh 2 , a 0 = hv 2 ( k )
y = v1 ( k ) + a 0
a1 = d ( d + 8 y )
a 2 = a 0 + sign ( y )( a 1 d ) / 2
s y = ( sign ( y + d ) sign ( y d )) / 2
a = (a 0 + y a 2 )s y + a 2
s a = ( sign ( a + d ) sign ( a d )) / 2
fhan = r ( a / d sign ( a )) s rsign ( a )
a
adjust are
simply.
IV.
(12)
(13)
e sign ( e ), e >
fal ( e, , ) =
1
e
e / ,
Where the function sign() is the symbolic function. And the
meanings of the other parameters can be found in [ 9, 10].
3) NLSEF
The new NLSEF using function fhan()
Synthesis of Control Value
e1 (k + 1) = v1 (k + 1) z1 (k + 1)
e (k + 1) = v (k + 1) z (k + 1)
2
2
2
u
(
k
1
)
fhan
(
e
(
k
1), ce2 (k + 1), r , h1 )
+
=
+
0
1
u (k + 1) z 3 (k + 1)
u (k + 1) = 0
b0
SIMULATIONS
2) ESO
(k ) = z1 (k ) y (k )
z (k + 1) = z (k ) + h( z (k ) (k ))
1
2
01
1
z 2 (k + 1) = z 2 (k ) + h( z 3 (k )
fal ( (k ),1 / 2, h) + b u (k ))
0
02
z 3 (k + 1) = z 3 (k ) h 03 fal ( (k ),1 / 4, h)
(14)
473
ThC1.1
Fig.10. Trajectory Tracking for x,y axis when add controller output
disturbance
474
ThC1.1
Fig.12. Trajectory tracking for x,y axis when add controller output
disturbances and measurement noise
fuzzy controller
475
ThC1.1
J.H. Su, Study on Path Planning and High Precision Track Control for
Unconstrained Mobile,changchun:Jilin university,2006
X. Fan, N. Zhang, S.Teng, Trajectory planning and tracking of ball and
plate system using hierarchical fuzzy control scheme, Fuzzy Sets and
Systems, Vol. 14, No. 2, pp: 297-312, February 2003
M. Bai, H Lu, J. Su, et al, Motion control of ball and plate system using
supervisory fuzzy controller, Proceedings of the 6th IEEE World
Congress on Intelligent Control and Automation, pp: 8127-8131, 2006.
A.Rad, P. Chan, W. Lo, An online learning fuzzy controller, IEEE Trans.
Industrial Electronics, Vol.50, No.5, pp: 1016-1021,May 2003.
S. Awtar, C. Bernard, N. Boklund, et al, Mechatronic design of a
ball-on-plate balancing system, Mechatronics, Vol. 12, No. 2, pp:
217-228, February 2002.
J. Park, Y. Lee, Robust visual servoing for motion control of the ball on a
plate, Mechatronics, Vol. 13, No. 7,pp: 723-738,July 2003.
C. Ker, Ch. L, R. Wang, Tracking and balance control of ball and plate
system, Journal of the Chinese institute of engineers, Vol. 30, No. 3, pp:
459-470, March 2007.
J.H. Han, From PID technique to active disturbance rejection control
technique[J]. Control Engineering of China, Vol. 9, No. 3,pp: 13-18,
March 2002 (In Chinese).
J.Q. Han, Nonlinear state error feedback control law [J]. Control and
Decision, Vol. 10, No. 3,pp: 221-225,231, March 1995. (In Chinese).
J.Q. Han, From PID Technique to Active Disturbances Rejection
Control Technique. Control Engineering of China, Vol. 9, No. 3, pp:
13-18, March 2002. (In Chinese)
J.Q. Han, Auto disturbances rejection control technique[J]. Frontier
Science, No. 1, 24-31, 2007. (In Chinese).
X.N.Yu,L.L.Zhu,Dynamic parameter setting and application of active
disturbance rejection controller. Journal of North China Electric Power
University, Vol. 32, No.6, pp: 9-13,June 2005. (In Chinese)
Zh.Zh.Chen, Q.Zheng, Zh.Q.Gao, Active disturbance rejection control of
chemical processes, Control applications, 2007. CCA 2007. IEEE
international conference.pp:855-861, October 2007.
476