Lec2 FeedbackControl Arduino-complete
date post
13-Apr-2018Category
Documents
view
227download
0
Embed Size (px)
Transcript of Lec2 FeedbackControl Arduino-complete
7/26/2019 Lec2 FeedbackControl Arduino-complete
1/79
!"#$%&" () *+,$"- ./$"0&1$23/
45""671#8 93/$&3:;
[email protected]>> ??(
7/26/2019 Lec2 FeedbackControl Arduino-complete
2/79
H3I2#,
5""671#8 #3/$&3:
JI"/ K,L #:3,"6M:33I
*$172:2$+ 1/6 I"&N3&-1/#" ,I"#2N2#1$23/,
*+,$"- &",I3/,"O.E #3/$&3::"&
7/26/2019 Lec2 FeedbackControl Arduino-complete
3/79
JI"/ 1/6 #:3,"6 :33I #3/$&3:
G1,2# I&37:"-)
7/26/2019 Lec2 FeedbackControl Arduino-complete
4/79
JI"/ !33I *+,$"-
93-I%$"& ,"/6, 1 #3--1/6 71,"6 3/ !T 1/6 +3%
D3I" $D" &20D$ $D2/0" #3-", 3%$
53& -3,$ 1II:2#1$23/,T $D2, &":2", 3/ 1 0336 -36":
3N $D" I:1/$
7/26/2019 Lec2 FeedbackControl Arduino-complete
5/79
JI"/ !33I *+,$"-
O&3#"6%&" N3& N3"M#3/$&3: ,+,$"-)93-I%$"& #1:#%:1$", 1 N3"T 5T $3 62,I:1+ 1$ $D"
"/6 "NN"#$3&
93-I%$"& #3/$&3::"& 6"$"&-2/", $D" #3&&"#$
K3:$10" $3 ,"/6 $3 $D" 1#$%1$3& 1$ $D" U32/$
E+/1-2#, 3N $D" 6"K2#" Q2:: &",%:$ 2/ 1 #D1/0" 2/
I3,2$23/
T
Ki
1 !"! iKv A
bm results in
,fwd. kin.
xx ,
7/26/2019 Lec2 FeedbackControl Arduino-complete
6/79
9:3,"6 !33I *+,$"-
HD" #3--1/6 2, -362N2"6 71,"6 3/ "&&3&7"$Q""/ $D" 3%$I%$ 1/6 $D" &"N"&"/#" 4N""671#8#3/$&3:;
=6K1/$10", 3N N""671#8 #3/$&3:*$172:2V1$23/
E2,$%&71/#" &"U"#$23/
W"N"&"/#" $&1#82/0
7/26/2019 Lec2 FeedbackControl Arduino-complete
7/79
9:3,"6M:33I H&1/,N"& 5%/#$23/
=,,%-" /"0:2027:" /32," 1/6 62,$%&71/#"T 1N""671#8 #3/$&3: ,+,$"- #1/ 7" &"I&","/$"6 1,
>4,; R W4,;X4,;Y4,;L Z3$" $D1$ Q2$D 1/ 26"1:,"/,3&T X4,; R [L HD" 0"/"&1: $&1/,N"& N%/#$23/ 2,
HD" &"N"&"/#" ,20/1: #1/ K1&+ Q2$D $2-" 4$&1#82/0;
3& #3/,$1/$ 4&"0%:1$3&;L
)()()(1
)()(
)(
)(
sHsGsC
sGsC
sR
sY
7/26/2019 Lec2 FeedbackControl Arduino-complete
8/79
HD" 0"/"&1: $&1/,N"& N%/#$23/ 2,
Note that the denominator of both TFs are the
,1-" R\ ,1-" I3:", R\ 1II:+ $D" ,1-" ,$172:2$+
#3/,26"&1$23/
P2$D E2,$%&71/#"
H(S)
C(S)
)()()(1
)(
)(
)(
sHsGsC
sG
sD
sY
7/26/2019 Lec2 FeedbackControl Arduino-complete
9/79
!H. *+,$"-,
!H. R !2/"1& $2-"M2/K1&21/$ ,+,$"-L 53& +4$; R *]^4$;_T
!2/"1&2$+) 53& 1/+ $Q3 2/I%$ ,20/1:, ^[4$; 1/6 ^(4$;1/6 1 &"1: #3/,$1/$ 1T
*]^[4$;`^(4$;_ R *]^[4$;_ ` *]^(4$;_ 1/6
*]1^[4$;_ R 1*]^[4$;_
H2-" 2/K1&21/#") 53& 1/+ &"1: #3/,$1/$ HT +4$MH; R*4^4$MH;;L HD2, 2/#:%6", #3/,$1/$M012/ ,+,$"- 1/6:2/"1& #3-72/1$23/, 3N $2-"M,D2N$, 3N $D" 2/I%$,20/1:T 2L"L +4$; R ^4$;(^4$Ma;L
7/26/2019 Lec2 FeedbackControl Arduino-complete
10/79
*$172:2$+ 3N !H. ,+,$"-,
B2K"/ 1 $&1/,N"& N%/#$23/ 3N 1 !H. ,+,$"- 2/ $D" N3&-T
HD" &33$ 3N $D" #D1&1#$"&2,$2# "S%1$23/T #1::"6 $D"$%&'(T #1/
7" N3%/6 N&3- ,"$$2/0
QD2#D #1/ 7" Q&2$$"/ 1, 1 #3-I:"^ /%-7"&) I R ` U
HD" ,+,$"- 2, ()*+&'2N 1:: $D" I3:", 3N 2$, $&1/,N"& N%/#$23/
D1K" /"01$2K" &"1: I1&$, 4b AT 3/ :"N$MD1:N I:1/"; 1/6
%/,$17:" 3$D"&Q2,"L
PD"/ R AT $D" ,+,$"- 2, ,*-./0*&&1 ()*+&'2N $D" #3-I:"^
&33$, 1&" /3/M&"I"1$"6 1/6 %/,$17:" 3$D"&Q2,"L
HD" &33$, 3N $D" /%-"&1$3& 2, #1::"6 2'-%(T QD2#D 1&" /3$
&":1$"6 $3 $D" ,$172:2$+T $D3%0D 2$ Q2:: 1NN"#$ $D" &",I3/," 3N
$D" ,+,$"-L
7/26/2019 Lec2 FeedbackControl Arduino-complete
11/79
*$172:2$+ 9&2$"&23/
Rouths
7/26/2019 Lec2 FeedbackControl Arduino-complete
12/79
O"&N3&-1/#" *I"#2N2#1$23/, 4H2-" 63-12/;
HD" I"&N3&-1/#" &"S%2&"-"/$, 1&" %,%1::+ 02K"/ N3&
$D" ,$"I &",I3/,"L
W2," $2-"T $&
JK"&,D33$T
7/26/2019 Lec2 FeedbackControl Arduino-complete
13/79
O"&N3&-1/#" ,I"#2N2#1$23/, W2," $2-" 4$&;) HD" $2-" N3& 3%$I%$ $3 &2," N&3- A 43&
[Ad; $3 @Ad 3N $D" N2/1: K1:%"
JK"&,D33$ 4
7/26/2019 Lec2 FeedbackControl Arduino-complete
14/79
W",I3/," 3N [,$ J&6"& *+,$"-
= , > 0
!1I:1#" $&1/,N3&-) =
=
+
+ ()
*3:K" !M[T =
+()
P2$D ,$"I 2/I%$ 454,; R =C,;;T =
[1
]
7/26/2019 Lec2 FeedbackControl Arduino-complete
15/79
93/,26"& 1 W! #2%2$)
= , 0 = 0
W"Q&2$"T
=
H2-" #3/,$1/$ =
53& %/2$ ,$"I 2/I%$T =
(1
)
Whats the steady state response?PD1$ D1II"/ 1$ 4g
7/26/2019 Lec2 FeedbackControl Arduino-complete
16/79
93/,26"& (/6 3&6"& -M7M8 ,+,$"-
PD1$ D1II"/ $3 $D" &",I3/,"T ^4$;T 3N $D"
,+,$"- QD"/ Q" 16U%,$ 8 1/6 7g
fkxxbxm
xbkxfxm
fffxmF bk
5 includes all forces
applied to the system
7/26/2019 Lec2 FeedbackControl Arduino-complete
17/79
!"#$%"& (%)*$)+,- . /"012+3 4"#25
[h
W"Q&2$2/0 $D" (/6
M3&6"& "S%1$23/ 2/ 1/3$D"& N3&-
E2K26"6 7+ [C-)
Z1$%&1: N&"S%"/#+)
E1-I2/0 &1$23)
Z3$" $D1$ A
fm
xm
kx
m
bx
1
mk
b
m
b
n 22
sradm
kn /
7/26/2019 Lec2 FeedbackControl Arduino-complete
18/79
65#"& 4)715+7)
[i
!1I:1#" $&1/,N3&-)
*3:K" N3& e4,;)
./K"&," !1I:1#" $&1/,N3&-)
W",I3/," $3
./2$21: #3/62$23/,
W",I3/," $3
./I%$
7/26/2019 Lec2 FeedbackControl Arduino-complete
19/79
8#)1 4)715+7)
[@
=,,%-" $D" N3/0 N%/#$23/T ,$"I 2/I%$
0 1 2 3 4 5 6 7 8 9 10
-0.1
0
0.1
0.2
0.3
0.4
0.5
Step Response
Time (sec)
A
mplitude
= 0.1
= 0.4= 1.0
= 2.0
= 0
4)715+7)7 95% :299)%)+# :"012+3
%"#25
; < =>+:"01):?
1$%) 57,2&&"#25+
< @ @ A =>+:)%:"01):?:),"-2+3 57,2&&"#25+
; A =B%2#2,"&&- :"01):?
C A =DE)%:"01):?
+5 57,2&&"#25+
7/26/2019 Lec2 FeedbackControl Arduino-complete
20/79
*$"I &",I3/," ,I"#2N2#1$23/, 3N %/6"&61-I"6
,+,$"- Q2$D /3 /%-"&1$3& 6+/1-2#,
PL O1:-T *+,$"- E+/1-2#,T c&6 >6L
F+ ,5+#%5& :)723+G 5+) 5% 05%) 59 #H)7) %)*$2%)0)+#7 I2&& J) 32E)+ #5 :)#)%02+)
#H) "&&5I"J&) %)325+ 59 #H) 15&)7 2+ #H) 7K1&"+)L
7/26/2019 Lec2 FeedbackControl Arduino-complete
21/79
H3I2#,
5""671#8 #3/$&3:JI"/ K,L #:3,"6M:33I
*$172:2$+ 1/6 I"&N3&-1/#" ,I"#2N2#1$23/,
*+,$"- &",I3/,"
O.E #3/$&3::"&
7/26/2019 Lec2 FeedbackControl Arduino-complete
22/79
O.E 93/$&3::"&
O&3I3&$23/1:M2/$"0&1:M6"&2K1$2K" #3/$&3: I&3K26",1 Q26":+M%,"6 0"/"&2# N""671#8 #3/$&3::"&
HD" #3/$&3: ,20/1: 2, 0"/"&1$"6 71,"6 3/ $D""&&3&T "4$;T 7"$Q""/ $D" #%&&"/$ ,+,$"- ,$1$"
1/6 $D" &"N"&"/#" 1/6 2/K3:K", c 012/,) 8IR I&3I3&$23/1: 012/ 41II:+ $3 $D" "&&3&;
8ER 6"&2K1$2K" 012/ 41II:+ $3 $D" 6"&2K1$2K" 3N
$D" "&&3&; 8.R 2/$"0&1: 012/ 41II:+ $3 $D" 2/$"0&1: 3N $D"
"&&3&;
7/26/2019 Lec2 FeedbackControl Arduino-complete
23/79
M&5,N :2"3%"0 59 OF/ ,5+#%5&&)%
HD" "^I&",,23/ 3N $D" #3/$&3::"& 2, 02K"/ 7+
H2-" 63-12/)
H&1/,N"& N/)sk
s
kk
sE
sUD
Ip
)(
)(
t
DIp dt
tdekdektektu
0
)()()()(
7/26/2019 Lec2 FeedbackControl Arduino-complete
24/79
OE 93/$&3::"& >^1-I:"
93/,26"& (/6M3&6"& I:1/$)
OE #3/$&3::"&)
JK"&1:: H5)
./#&"1,2/0 8I2/#&"1,", /1$%&1: N&"S%"/#+
2/#&"1,", 1/6 6"#&"1,", 61-I2/0 &1$23L
./#&"1,2/0 8E2/#&"1,", 61-I2/0L
21
2)( asasbsG
skksC Dp )(
pD
pD
bkasbkas
kskb
sR
sY
21
2)(
)(
)(
)(
7/26/2019 Lec2 FeedbackControl Arduino-complete
25/79
O&3I3&$23/1:
93/$&3: ,20/1: R 8I4&"NM+; R 8I" >NN"#$) 720 ,20/1: N3& :1&0" "&&3&T ,-1:: ,20/1:
N3& ,-1:: "&&3&
W",%:$, 2/ ,$"16+M,$1$" "&&3&Z""6, 1 /3/V"&3 "&&3& $3 0"/"&1$" 1 #3/$&3:1#$23/
>,,"/$21::+ 1 ,I&2/01$ $D" 6",2&"6 I3,2$23/45R8^;
X20D 012/ -18", 1 ,$2NN"& ,I&2/0 1/62/#&"1,", $"/6"/#+ $3 3,#2::1$"
7/26/2019 Lec2 FeedbackControl Arduino-complete
26/79
>NN"#$ 3N 8I
7/26/2019 Lec2 FeedbackControl Arduino-complete
27/79
E"&2K1$2K"
93/$&3: ,20/1: R 8E64";C6$