Chap 13 Examples
Chap 13 Examples
-1
-1
-1
-2
-1
-1
-1
-1
-3]
B=
1
1
-1
1]
W=
[
-5
-4
-4
-1
-2
-1
ans =3
2]
>> rank(W(:,1:2))
ans = 2
>> rank(W(:,1:3))
ans =3
>> rank(W(:,1:4))
ans = 3
>> p4 = [0;0;0;1]
p4 =
[
0
0
0
1]
-5
-4
-1
-1
1]
ans =
>> PI = inv(P)
PI =
[ 2.0000 1.5000 2.5000
1.0000 1.0000 ]
A_hat =
Controb Part
-0.0000
-1.0000 1.5000
B_hat =
1
0
0
0
Uncontrob
Part
-1.0000
2
1
0
-2
3
0
0
1
4
3
2
-1
B=
1
-1
2
-2
>> W = ctrb(A,B), rank (W)
W=
1 -3 2 67
-1 -7 14 17
2 -3 11 4
-2 7 1 -16
ans = 4
>> M = inv(W)
M=
0.0174
0.0423
0.0024
0.0165
-0.2226
-0.0676
0.0222
-0.0004
0.2885
0.0672
0.0579
-0.0030
-0.0915
0.1222
0.0480
0.0054
-0.0004
0.0218
-0.0473
-0.1874
-0.0030
0.0549
0.1100
0.5787
0.0054
0.0534
0.1972
0.3896
-4.0000
-6.0000
-5.0000
9.0000
1.0000
-1.0000
2.0000
-2.0000
>> P = inv(PI)
P=
64.0000
44.0000
-21.0000
-19.0000
1.0000
25.0000
6.0000
2.0000
>> AH = PI*A*P
AH =
0
-0.0000
0.0000
13.0000
1.0000
-0.0000
0.0000
13.0000
-0.0000
1.0000
-0.0000
4.0000
0.0000
0.0000
1.0000
1.0000
>> BH = PI*B
BH =
0.0000
-0.0000
0.0000
1.0000
CH = [1 0 0 0], D =0;
>> [b,a]=ss2tf(AH,BH,CH,D)
b=
0
1.0000
a=
1.0000 -1.0000 -4.0000 -13.0000 -13.0000
H(s) =
1
S^4-S^3-4s^2-13s-13
13
-1
1
-1
-10
1
-7
6
3
-3
5
-3
-7
4
2
-2
5
-2
-15
0
-4
8
11
0
21
-1
2
-2
-16
1
>> B = [3 8 -1; 0 0 0; 1 -1 0; -1 1 0; -2 -6 1; 0 0 0]
B=
3 8 -1
0 0 0
1 -1 0
-1 1 0
-2 -6 1
0 0 0
>> % Is (A,B) Controllable?? Is B full rank???
>> W = ctrb(A,B), rank (W), rank(B)
W=
3
0
8 -1 -3 2 -4
0 0 2 -2 0
1 -1
0 -1 -1
-1
-2 -6
2 -2
0 -1
1 3 -8 29 -2
3 -1 2 0 -5
3 39 -38 10 56 -70 16
1 1 -3
1 3 -1 5
2 -4 -3 -1 -4
3 -1 -2
0 -1
-5
6 -1 -5
6 -22
0 -1
4 -6
8
1 10 -7
0 -17
-1 -1 -2
4
ans =
5
ans =
5
>> % roh_3 = 1, AB3
>> rank(W(:,1:7)) = 6
>> rank(W(:,1:8)) =6
>> % roh_2 = 2, A^2B2
9 -8
ans =
ans =
-3
2
0
1
2
-1
1 8 2 -1
3 0 -2 0
3 -1 -1 0
-4 1 1 0
-1 -6 -2 1
-1 0 1 0
-0.3333
1.0000
1.0000
0.6667
2.0000
6.3333
1.6667
1.0000
0
-0.3333
1.0000
1.3333
1.0000
1.0000
0
0.0000
1.0000
2.0000
0.3333
0
0
0.3333
-0.0000
3.6667
0.0000
2.0000
2.0000
1.0000
5.0000
14.0000
1.0000
1.0000
0
2.0000
3.0000
6.3333
0
0
3.0000
1.0000
-3.0000
1.3333
0
0
2.0000
0
0
1.0000
2.0000
0
0
1.0000 -0.0000 5.0000
-2.0000 4.0000 3.0000
2.0000 3.6667 14.0000
>> P = inv(PI)
P=
-28.0000
-1.0000
6.0000
-9.0000
21.0000
1.0000
-9.0000
2.0000
-2.0000
3.0000
6.0000
-1.0000
3.0000
0
1.0000
-1.0000
-2.0000
0
>> AH = PI*A*P
AH =
0
-0.0000
1.0000
0
9.0000
6.6667
1.0000
0
-3.0000
0.0000
4.0000
0.0000
0
1.0000
2.0000
0.0000
-0.0000
0.0000
>> BH = PI*B
BH =
0
0
1.0000
0
0
-0.0000
0
0
0
0
-1.0000
0
0.0000 -0.0000
1.0000 1.0000
0.0000 1.0000
0
0
0
0.0000
0
0
0.0000
1.0000 0.0000
0.0000
1.0000
0
-11.0000 -4.0000 3.0000
-10.3333
0
3.0000
2
1
0
-2
3
0
0
1
4
3
2
-1
>> C = [1 -1 2 -2]
C=
1
-1
-2
>> O = obsv(A,C)
O=
1 -1 2 -2
1 5 1 7
9 -7 10 14
33 -17 41 21
>> J = inv(O)
J=
-2.7632
-0.1842
2.0263
0.2368
-0.4211
0.1053
0.3421
0.0789
-0.6336
-0.1397
0.3826
0.1356
0.2996
0.0405
-0.1761
-0.0466
>> Jn = J(:,4)
Jn =
0.2996
0.0405
-0.1761
-0.0466
>> PI= [Jn A*Jn A*A*Jn A*A*A*Jn]
PI =
0.2996
0.0405
-0.1761
-0.0466
-0.3340
-0.0992
0.2065
0.0891
0.4433
0.1680
-0.1559
-0.0182
0.2389
0.1134
0.4069
-0.0304
1.0000
1.0000
-1.0000
2.0000
5.0000
15.0000
9.0000
-2.0000
>> P = inv(PI)
P=
7.0000
4.0000
0.0000
1.0000
-17.0000
-8.0000
6.0000
-1.0000
>> AH = P * A * PI
AH =
0.0000
1.0000
-0.0000
0.0000
-0.0000
-0.0000
1.0000
-0.0000
0.0000
0.0000
0.0000
1.0000
13.0000
13.0000
4.0000
1.0000
>> CH = C*PI
CH =
-0.0000 -0.0000 0.0000 1.0000