Control Course Work swinging pendulum
Transcript of 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+.%
#,$%&
-
8/3/2019 Control Course Work swinging pendulum
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%&
-
8/3/2019 Control Course Work swinging pendulum
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+#
-
8/3/2019 Control Course Work swinging pendulum
4/16
Q14+4-).$%(1$#,#1+;%&
-
8/3/2019 Control Course Work swinging pendulum
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%&
-
8/3/2019 Control Course Work swinging pendulum
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&%%
-
8/3/2019 Control Course Work swinging pendulum
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/3/2019 Control Course Work swinging pendulum
8/16
!"#$%&:;%
-
8/3/2019 Control Course Work swinging pendulum
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%%
%
%
%%
% %
%
%
%
%
-
8/3/2019 Control Course Work swinging pendulum
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&$%-$%
-
8/3/2019 Control Course Work swinging pendulum
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+$%#$%
-
8/3/2019 Control Course Work swinging pendulum
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$#+/%-%$
-
8/3/2019 Control Course Work swinging pendulum
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%!"&%$
-
8/3/2019 Control Course Work swinging pendulum
14/16
-K/'-L/'MD+9%7'D")2$2"#'+2$4')2#()"279&'%*;*%*#E*')23#9&'
!"&%)&9&)&+0&%$#/+-2%/-#+%#$%#+0)&-$&.%,1%LX%.&/)&&$%-+.%,"&%9)&
-
8/3/2019 Control Course Work swinging pendulum
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)&
-
8/3/2019 Control Course Work swinging pendulum
16/16
R$%9)&