- 在线时间
- 120 小时
- 最后登录
- 2012-9-21
- 注册时间
- 2009-12-31
- 听众数
- 3
- 收听数
- 0
- 能力
- 0 分
- 体力
- 6950 点
- 威望
- 0 点
- 阅读权限
- 200
- 积分
- 2433
- 相册
- 0
- 日志
- 0
- 记录
- 0
- 帖子
- 687
- 主题
- 23
- 精华
- 0
- 分享
- 0
- 好友
- 3

智慧的蓝色小毛驴
TA的每日心情 | 开心 2011-12-5 23:03 |
|---|
签到天数: 106 天 [LV.6]常住居民II
- 自我介绍
- 200 字节以内
不支持自定义 Discuz! 代码
 |
给予组合趋近律的变结构控制,程序如下:( J; e- V" a8 h! z
clear all;2 k W m7 |% P4 `+ J9 t
close all;' |) f4 q% g9 y
a=25;b=133;
' G& `/ _7 a$ z9 ]& {' E, T. Hts=0.001;0 @8 x8 W6 b( O. p
A1=[0,1;0,-a];
+ \% N8 j! S/ I2 X. l( Y$ S/ cB1=[0;b];7 q e% y4 ^0 u, Z# f' r9 S
C1=[1,0];
0 k4 |4 D8 m6 |D1=0;& p3 [8 D2 F! ?- o* K: P/ G( n
[A,B,C,D]=c2dm(A1,B1,C1,D1,ts,'z');
# T+ p3 n) N7 }8 k9 C5 t. U zx=[-0.8;-0.5];
% b7 T/ n6 Y# Nr_1=0;r_2=0;
2 B6 {% g3 Z! h% I/ }c=20;4 `" K j' E! u0 L' Y
eq=5;) V2 W! c* x w; e/ k9 t$ b
q=30;
, V2 O' s" z8 `. q# ~Ce=[c,1];
9 V, L' ^# J$ G" S* Z+ ~, yfor k=1:1:20000 B) j9 {2 ^4 a3 {3 Q6 B; C
time(k)=k*ts;, o/ I! ^( @6 _+ h# F( y0 Q
r(k)=1.0;3 M/ F/ \/ g$ g' q/ T
5 I" g1 X( I1 y' s5 i7 s3 ?- W# m. ?
%Using Waitui method - m: l! [" ~# `) i2 D2 d0 h
dr(k)=(r(k)-r_1)/ts;9 j& ^; e5 I: e$ U
dr_1=(r_1-r_2)/ts;# I: a1 G5 o) Q' p+ R
r1(k)=2*r(k)-r_1;
; L8 I0 k1 { z, Z* v dr1(k)=2*dr(k)-dr_1;/ {/ T) S$ K- b6 A5 x, z; H U# m1 M( r. r
6 f) ^/ n( z8 [1 t' r( P. T/ ] \
R=[r(k);dr(k)];
$ e% E1 _4 `/ a4 a- }+ c/ c0 h W1 u R1=[r1(k);dr1(k)]; x$ Y9 m6 W% i/ b
! P2 Q6 H3 u8 T5 d1 J6 e% o5 c) q1 Y
E=R-x;
p8 D7 s: H9 G+ m k; u3 d e(k)=E(1);
: x! L2 q X" [6 |/ S+ j de(k)=E(2);, S0 T" _% d0 r- a( G1 [
" v+ A7 R( Z, }" [- L) k& b s(k)=Ce*E;! @9 F2 a+ a8 E3 \$ u4 u
) Z# w0 {! \$ J- w3 K$ v6 C
X1=abs(e(k))+abs(de(k));
7 b2 t$ D0 `5 F+ B ( E3 X$ h6 Q. m9 c
M=2;
( @% @- d+ ]+ {if M==1 %EXP reaching law
8 A4 [& `' p5 [" a% x* J2 A7 e- _' _ ds(k)=-eq*ts*sign(s(k))-q*ts*s(k);
|* l [1 D( U2 c" \ u(k)=inv(Ce*B)*(Ce*R1-Ce*A*x-s(k)-ds(k));4 H, c& O% C0 G# U: p
elseif M==2 %Variable rate reachine law
: ~9 n4 N4 e1 k4 n8 Q ds(k)=-eq*ts*X1*sign(s(k));
* P1 L2 l2 b+ q( u u(k)=inv(Ce*B)*(Ce*R1-Ce*A*x-s(k)-ds(k));) M8 [6 J, H2 |8 r" b; v
elseif M==3 %Coposite reaching law8 p9 c; _) I* l7 }" l4 y b
k0=0.60;
5 ^4 @: d, E% F) V+ c! B- q if X1>k0 %EXP reachine law; z/ f9 I5 Y# m* x; F4 q7 U k
ds(k)=-eq*ts*sign(s(k))-q*ts*s(k);
8 Q: ?; {2 ]6 t$ s u(k)=inv(Ce*B)*(Ce*R1-Ce*A*x-s(k)-ds(k));2 w- A) E) T' }1 I: P
elseif X1<=k0 %Variable rate reachine law
- H% f% P" o. U+ h" u7 @- A" W2 n7 I ds(k)=-eq*ts*X1*sign(s(k));3 o7 e+ W6 V8 U& M4 a
u(k)=inv(Ce*B)*(Ce*R1-Ce*A*x-s(k)-ds(k));
! z7 V' f4 k$ J8 @% x1 H+ _: ~ end. C w* a/ R7 A3 y! y: W
end
# h9 z* T% R9 Y0 K, P P. lif u(k)>=10
0 s; Z" p9 @! A L u(k)=10;
. e, ~- v7 p% J, d/ s! @end
/ B# }6 j8 R5 z! @1 yif u(k)<=-10
6 @# |/ w+ y+ u9 {( `/ a u(k)=-10;: R1 f' m& c8 e! o
end! [9 L" h& w, u
x=A*x+B*u(k);
" X) u5 | u8 `- \% Z4 Oy(k)=x(1);
5 z. v. s* ], B4 o# x8 V+ s! U; c; h%Update Parameters
/ T6 N9 ?" Z, V7 a* F2 H5 Nr_2=r_1;
2 B8 l# o. n! Xr_1=r(k);8 P6 I" c) @, @# C( C4 z1 j
end
5 x3 o. {& h0 ?figure(1)2 ?9 O7 I# [2 R+ A0 ~: @1 |$ V
plot(time,r,'r',time,y,'b');6 u% t- L9 t1 Y- I
xlabel('Time(second)');ylabel('Position tracking');
, ~* l$ t7 g* _4 ?figure(2)
) ~: n$ Y3 j; w" H% W7 ?8 dplot(time,s,'r');( ~5 I# q! A1 q: G* Z
xlabel('Time(second)');ylabel('Switch function s');4 r( G2 w9 b) ]1 Y9 C; B6 q: }( \7 O" J
figure(3)& E' O! \2 \ p
plot(e,de,'r',e,-c*e,'b');
+ j; K; \! w$ X7 K! ?2 Nxlabel('e');ylabel('de');
1 N; p) |+ N5 M e+ X7 }figure(4)
8 L/ o+ o) V: |0 L$ c" m \/ nplot(time,u,'r');
2 {+ i1 B4 W7 l9 N q! h5 V# W9 [$ M; @xlabel('Time(second)');ylabel('u');0 R. t, x7 y5 q- d
! U4 O' r4 D0 U4 k& ^5 U
请问最后的4个图分别是什么意识,本人新手,谢谢大家了! |
zan
|