Lec2 FeedbackControl Arduino-complete

download Lec2 FeedbackControl Arduino-complete

of 79

  • date post

    13-Apr-2018
  • Category

    Documents

  • view

    227
  • download

    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$