Control Course Work swinging pendulum

8/3/2019 Control Course Work swinging pendulum

1/16

' ' ' ' ' ' '

''' ' ''

!"#$%"&'!"(%)*+"%,'!"#$%&'%&($#)*+,$-)(%

!"#$%&'(&)#*&+,%-#*$%-,%.&$#/+#+/%-%01+,)122&)%,"-,%$,-3#2#$&$%-%$4#+/#+/%(&+.525*%#+%,"&%5(4-).%

-+.%.14+4-).%(1$#,#1+6%7&%.&)#8&%-%$,-,&%$(-0&%)&()&$&+,-,#1+%19%,"&%$:$,&*;%2#+&-)#$&%#,%-)15+.%

#,$%&


2/16

P1*3#+#+/%,"&%,41%-+.%.#99&)&+,#-,#+/%4#,"%)&$(&0,%,1% !," %/#8&$%

Lq =

!

!!

!

!"

"

#

$$$

$

%

&

'''

'

T(V( ) = 0

mp sin !( )cos !( ) !!2lp2 (mp sin "( ) !! !!rlp (mp sin "( )glp

"

#

$$

%

&

''

%

Q#99&)&+,#-,#+/%46)6,% !!, !" %

L!q =

!

! !!

!

! !!

"

#

$$$$

%

&

''''

T(V( ) = Jarm

!!+mp sin2"( ) !!lp

2+mp

!!r2+mp cos "( ) !!rlp

Jp !! +mp !!lp2+mp cos !( ) !!rlp

"

#

$$

%

&

''%

%

R+.%.#99&)&+,#-,#+/% L!q %4#,"%)&$(&0,%,1%,#*&%/#8&$H%

d

dtL

!q =

2mp cos !( ) !!lp2 !!sin "( )!mp sin !( ) !!

2lpr + mpr

2+mplp

2 !mplp2cos

2!( )+ Jarm( ) !!!+mp cos "( ) !!!lpr

Jp +mplp2( ) !!! !mp sin !( ) !! !!lpr +mp cos "( ) !!!lpr

"

#

$$$

%

&

'''

%

P1*3#+#+/%-22%&


3/16

-0/'1*+%2$2#3'$4*')5)$*6'7*%28*7'2#'-./'2#'$4*'69$%2:';"%6''

'

!"&%*-,)#'%91)*%/#8&+%#+%BSDH%

D q(t)( ) !!q(t)+C q(t), !q(t)( ) !q(t)+ g q(t)( ) = !

% % % %

0-+%3&%4)#,,&+%-$%

D!!!

!!"

!

"#

$

%&+C

!!

!"

!

"#

$

%&+ g = # %%

D11

D12

D21 D22

!

"

#$

%

&!!!

!!!

!

"

#$

%

&+C

11C

12

C21 C22

!

"

#$

%

&!!

!!

!

"

#$

%

&+g1

g2

!

"

#$

%

&="m' B

arm!!

'Bp!!

!

"

#

#

$

%

&

&

%

7"&)&%P%#$%+1,%5+#


4/16

Q14+4-).$%(1$#,#1+;%&


5/16

@1)%,"&%.14+4-).%(1$#,#1+H%%

D!1=

1

D11D

22! D

12D

21

D22

!D12

!D21

D11

"

#$

%

&'%-+.%!! g =

!m ! Barm !!

!Bp !! !mpglp!

"

#

$$

%

&

''%

!!q =1

mpr2Jp + JarmJp + Jarmmplp

2

Jp + mplp2 !mplpr

!mplpr mpr2+ Jarm

"

#$$

%

&''

!m! B

arm

!!

!Bp!! !mpglp!

"

#$$

%

&''%

%

V&+0&% !!! =1

mpr2Jp + JarmJp + Jarmmplp

2Jp +mplp

2( ) "m ! Barm !!( )+ !mplpr( ) !Bp !#!mpglp#( )"# $% %

G&,%M = mpr2Jp + JarmJp + Jarmmplp

2%-+.%)&-))-+/#+/%#+%,&)*$%19%!,", !!, !!,"

m/#8&$%

!!! =1

M0!+ mp

2lp

2gr( )"+ !JpBarm !mplp2Barm( ) !!+ mplprBp( ) !"+ mplp2 + Jp( )#m"# $% %

!!! =1

M0"+ !mp

2r2glp ! Jarmmpglp( )!+ Barmmplpr( ) !"+ !mpr2Bp ! JarmBp( ) !!! mplpr( )#m"# $% %

%

Z#*#2-)2:%91)%,"&%5(4-).%(1$#,#1+%4#,"% x2=! !" %/#8&$%

!!! =1

M0!+ mp

2lp2gr( ) "!#( )+ !JpBarm !mplp2Barm( ) !!! mplprBp( ) !"+ mplp2 + Jp( )$m"# $% %

!!! =1

M0"+ mp

2r2glp + Jarmmpglp( ) !!#( )! Barmmplpr( ) !"+ !mpr2Bp ! JarmBp( ) !!+ mplpr( )$m"# $% %

%

[)#+/#+/%-22%&


6/16

-+.%91)%5(4-).%(1$#,#1+H%

A =1

M

0 0 M 0

0 0 0 M

0 mp2

lp2

gr !Barm Jp +mplp( )2

!mplprBp

0 mpglp mpr2 ! J

arm( ) !Barmmplpr !Bp mpr2 + Jarm( )

"

#

$$

$$$

%

&

''

'''

B =1

M

0

0

mplp2+

Jpmplpr

!

"

##

###

$

%

&&

&&&

%

%

%

!"#$%&&&%5%678$/3%9("478-8%

-./'F89&(9$*'*:D%*))2"#';"%'G'H'I''

Z53$,#,5,#+/%8-25&$%/#8&+%#+%,-32&%K%#+,1%,"&%*-,)#0&$%R%-+.%[%/#8&$%,"&%912214#+/%&'()&$$#1+H%

Q14+4-).%(1$#,#1+H%

A =

0 0 1 0

0 0 0 1

0 52.8369 !0.6554 0.65410 !98.0815 0.6541 !1.2143

"

#

$$$$

%

&

''''

% B =

0

0

273.0922

!272.5556

"

#

$$$$

%

&

''''

%

%

U(4-).%(1$#,#1+H%

A =

0 0 1 0

0 0 0 1

0 52.8369 !0.6554 !0.65410 98.0815 !0.6541 !1.2143

"

#

$$$$

%

&

''''

B =

0

0

273.0922

272.5556

!

"

####

$

%

&&&&

%

%

G))*))2#3'$4*')$9J2&2$5'";'$4*')5)$*6'

!"#$%#$%.1+&%5$#+/%,"&%>-,2-3%!"#%95+0,#1+;%4"#0"%0-2052-,&$%,"&%/&+8-25&$%19%,"&%*-,)#'%R6%!"&%

$:$,&*%#$%$,-32&%#9%-22%/&+8-25&$%19%R%-)&%01+,-#+&.%#+%,"&%G&9,%V-+.%\2-+&%BGV\D%19%,"&%01*(2&'%

(2-+&6%

Q14+4-).%(1$#,#1+%/&+8-25&$H%

!AD=

0

-0.7832 + 9.8672i

-0.7832 - 9.8672i

-0.3034

!

"

##

##

$

%

&&

&&

%"&+0&%$,-32&%%


7/16

U(4-).%(1$#,#1+%

!AD=

0

-10.7234

9.1564

-0.3027

!

"

##

##

$

%

&&

&&

%"&+0&%5+$,-32&%

%

P1+$#.&)#+/%,"&%/&+8-25&$%19%,"&%*-,)#'%R%-)15+.%31,"%&


8/16

!"#$%&:;%


9/16

!"#$%:%?"$4"@%"(*%6-3+4-(A%

-./'!"6D9%2#3'"D*#'9#7'E&")*7'&""D'%*)D"#)*'";'$4*')5)$*6'2#'$4*'7"+#+9%7'D")2$2"#'

R2("-%-+/2&%B.&/)&&$D%8$%!#*&%B$&01+.$D%

%

%

%

%

%

%

%

U+.-*(&.%1$0#22-,#1+$H%?WX% %P21$&.%211(;%.-*(&.%)&(1+$&H%

k= 0.0316 !1.6352 0.3178 ! 0.1359[ ]%

!"&%5+.-*(&.%1$0#22-,#1+$%.&0-:%-,%-%$214%)-,&;%-$%,"&)&%#$%1+2:%9)#0,#1+%,1%$214%,"&%(&+.525*%

.14+6%!"&%021$&.%211(%01+,)12%$:$,&*%$#/+#9#0-+,2:%#*()18&$%,"&%.&0-:%,#*&%3:%-(()1'#*-,&2:%-%

9-0,1)%19%IX6%\":$#0-22:;%,"&%01+,)122&)%01*(&+$-,&$%,"&%(&+.525*%*18&*&+,%3:%*18#+/%#+%,"&%

1,"&)%.#)&0,#1+6%%%

%

-0/'!49#32#3'$4*'392#'";'%*;*%*#E*')23#9&'

_&&(#+/%,"&%$-*&%?%8-25&$H% k= 0.0316 !1.6352 0.3178 ! 0.1359[ ] %-+.%#+0)&-$#+/%,"&%/-#+%

19%,"&%$#+5$1#.-2%)&9&)&+0&%$#/+-2%,1%NX%.&/)&&$6%%

%

%

%%

% %

%

%

%

%


10/16

\21,%$"14#+/%,"&,-%-+/2&%B325&D%-+.%)&9&)&+0&%$#/+-2%

B:&2214D%4#,"%+1%(&),5)3-,#1+%

\21,%$"14#+/%,"&,-%-+/2&%4#,"%,41%(&),5)3-,#1+$%%

!"&%+&4%)&9&)&+0&%$#/+-2%.1&$%+1,%-99&0,%,"&%.-*(&.%)&$(1+$&%19% ! t( ) -$%,"&%(&+.525*%

$&,,2&$%-$%


11/16

=*#>(&(?'%*)@"#)*'$"'@*%$(%A0$2"#)'k= [1,!1.36,0.28,0.17] '

B"$0%C'0%?'D$E*$0F'#"'@*%$(%A0$2"#)' B"$0%C'0%?'D$E*$0F'$"'$+"'@*%$(%A0$2"#)'

3D%U$#+/% k= [0.6,!1.36, 0.28,0.17]%

%

%

%

%

%

%

%

%

%

!"&%/)-("%$"14#+/%,"&%(&+.525*%-)*%)&$(1+$&%4-$%1*#,,&.;%-$%,"&)&%4&)&%+1%$#/+#9#0-+,%

0"-+/&$%9)1*%()&8#15$2:6%V14&8&);%,"&%)1,-):%-)*%+14%912214$%,"&%)&9&)&+0&%$#/+-2%*50"%

3&,,&);%31,"%#+%,#*&%-+.%-*(2#,5.&6%!"&%.&2-:%3&,4&&+%,"&%$#/+-2%-+.%,"&%*18&*&+,%19%,"&%

-)*%#$%.&0)&-$&.%,1%-(()1'#*-,&2:%I%$&01+.;%-+.%,"&%)&$(1+$&%,1%(&),5)3-,#1+$%#$%


12/16

R/-#+;%,"&%+&4%?%8-25&$%"-8&%$#/+#9#0-+,2:%#*()18&.%,"&%,)-0?#+/%(&)91)*-+0&%19%,"&%)1,-):%

-)*%-$%#,%912214$%,"&%)&9&)&+0&%$#/+-2%021$&2:%-+.%-005)-,&2:6%\&),5)3-,#1+$%"-8&%-%+&/2#/#32&%

#*(-0,%1+%,"&%,)-0?#+/%-$%,"&%-)*%)&,5)+$%,1%#,$%#.&-2%(1$#,#1+%4#,"#+%I%$&01+.6%%

a+%,"&%1,"&)%"-+.;%,"&%#*()18&*&+,%#+%,)-0?#+/%-((&-)$%,1%"-((&+%-,%,"&%01$,%19%,"&%

.-*(&+#+/%(&)91)*-+0&%19%,"&%(&+.525*;%-$%$"14+%#+%,"&%,1(%/)-("6%!"&%1$0#22-,#1+$%$,#22%

.&0-:%4#,"#+%IFK%$&01+.$%-$%()&8#15$2:%35,%.1%+1,%$&,,2&%.14+%1+0&%,"&:%"-8&%)&-0"&.%-%

$*-22%&+15/"%8-25&6%R$%-%)&$52,;%4&%0-+%$&&%1$0#22-,#1+$%4#,"#+%bO%.&/)&&$%)&*-#+#+/%-9,&)%

,"&%#+#,#-2%.-*(&+#+/%&99&0,%-+.%$1*&,#*&$%&8&+%#+0)&-$#+/%#+%-*(2#,5.&6%!"#$%#$%0-5$&.%3:%

,"&%*1)&%)-(#.%*18&*&+,$%19%,"&%)1,-):%-)*%,):#+/%,1%912214%,"&%,)-0?#+/%$#/+-2;%4"#0"%

#+,)1.50&$%$*-22%(&),5)3-,#1+$%#+%,"&%()10&$$6%

!1%95),"&)%,&$,%,"&%3&"-8#15)%-+.%)135$,+&$$%19%,"&%$:$,&*;%4&%)&(&-,%,"&%-318&%

&'(&)#*&+,%5$#+/%-%$


13/16

R$%3&91)&;%#+0)&-$#+/%,"&%9#)$,%8-25&%19%,"&%?%8&0,1)%01+$#.&)-32:%#*()18&$%,"&%,)-0?#+/%

(&)91)*-+0&%19%,"&%$:$,&*6%!"&%)&$(1+$&%,1%,"&%$5..&+%0"-+/&%19%,"&%)&9&)&+0&%$#/+-2%

3&"-8&$%$#*#2-)2:%,1%-%9#)$,%1).&)%,)-+$#&+,;%4#,"%-%$*-22%.&8#-,#1+%#+%,"&%*#..2&%4"#0"%#$%*1$,%

2#?&2:%0-5$&.%3:%,"&%.-*(&+#+/%*18&*&+,6%A+0)&-$#+/%,"&%?%8-25&%#*()18&$%,"&%,)-0?#+/%3:%

$"1),&+#+/%,"&%,)-+$#&+,6%%

>1)&18&);%4&%$&&%1+0&%-/-#+%,"-,%,"&)&%#$%-%01*()1*#$&%3&,4&&+%,)-0?#+/%-+.%.-*(&+#+/%

-005)-0:6%!"&%$


14/16

-K/'-L/'MD+9%7'D")2$2"#'+2$4')2#()"279&'%*;*%*#E*')23#9&'

!"&%)&9&)&+0&%$#/+-2%/-#+%#$%#+0)&-$&.%,1%LX%.&/)&&$%-+.%,"&%9)&


15/16

A,%#$%#+,&)&$,#+/%,1%+1,&%,"-,%,"&%(&+.525*%-0,$%-$%-%91)*%19%3-+.(-$$%9#2,&)%-$%,"&%.&8#-,#1+%

19%-+/2&%-2("-%-4-:%9)1*%T&)1%#$%"#/"&$,%-,%I6O"T%BW%KX%.&/)&&$%(&-?%,1%(&-?D%35,%.&0)&-$&$%

4"&+%*18#+/%-4-:%9)1*%,"-,%9)&


16/16

R$%9)&

Documents

Control Course Work swinging pendulum