Thiết kế bộ điều khiển bám cho AGV dùng kỹ thuật tuyến tính hồi tiếp.DOC

7/25/2019 Thit k b iu khin bm cho AGV dng k thut tuyn tnh hi tip.DOC

1/36

0B GIO DC V O TO

TRNG I HC K THUT CNG NGH TP. HCM

---------------------------

V TH GM

THIT K B IU KHIN BM CH!

"GV #$NG K THUT TU%N T&NHH'I TIP

(UN V)N THC *+Chuyn ngnh :K thut in

! "# ngnh: $% &' %' %'

T,M T-T (UN V)N THC *+

T() *+ C*, I*. th/ng 0' n12 '%0'


2/36

1

CHNG / GI0I THIU/./. T123 4562

Thut ng3 456 7#t8 9ut ;h/t t< ti=ng >?@ AC?@h 457tE8 @F

nghE H @6ng i@ tJ; L@h tMng N L@h 5""u2P" Qni?M"EH 57t"@RE KEM?H CE;?. n12 0S'0) CF H F H 2Ut gi W 7En Xu @h@/@ nh "/ng @h= thut Y nh3ng @Z @u. 2/y 2F@ 7[t @h\]@ @/@hJt Ung @Z 7[; @RE @n ng\^i)

V h_ng n12 0S`S. @/@ 2/y @6ng @a iYu hibn "# ME ^i.nhc2 /; dng yu @Xu giE @6ng @/@ @hi ti=t tMng ngnh @h= tJ 2/y

7Ey) 56 7#t H "e tf h; h_ n1ng hJt Ung Hinh hJt @RE @/@ @Z @u

iYu hibn t< 9E ]i 2d@ U 4tMi thd@8 ngy @ng ;hng ;h @RE hth#ng iYu hibn th? @h\Zng tMnh "# @ng nh\ thut @h= tJ @/@

7U @_2 7i=n. @6ng ngh H; tMnh @/@ ;h/t tMibn @RE tMj tu nhkntJ)Ut i "# Hiu Y "# H\ng M6 7#t \@ "_n 9ut N 2Ut i n\]@@6ng nghi; ;h/t tMibn nh\ 7_ng)

Bng 1.1. S lng r bt sn xut mt s nccng nghip pht trin

\]@ >l 12 0SS% 12 0SS` 12 0SSm

ht $%)00m 'S)&$ $)%%%

`)o' )$o` 00)0%%

d@ &)m`& &)0'& m)$%%

p ')&%% ')`%m `)%%%

(h/; 0)`mm 0)0S ')%%%

qnh &0% 0)%m$ 0)&%%

AT>) (hJ2 1ng ;h\]@. n12 '%%. 4 Gi/ tMnh M7t8. h 9ut7_n Ji *r@ sng

gy nEy. i@ ;h/t tMibn ti=n t]i te Ung hFE tMng @/@ ngnhEng tMN thnh n Y uEn tMrng @RE nhiYu u#@ giE. in @_nh tM\]@2[t H @/@ thi=t 7L in tv te Ung hFE \@ dng ang ngy @ng MUng

M!i 2Eng HJi nhiYu hiu u_ @E tMng hXu h=t @/@ Hnh e@ inh t=.


3/36

2

thut @ng nh\ tMng î "#ng 9! hUi hcng ngy) Gi_i ;h/; @hn Y ny H 9ky eng @/@ 26 hnh M6 7#t te Ung hFE i @huybn

7cng 7/nh nhc2 /; dng nhu @Xu the@ t= @RE @/@ ky @huyYn "_n

9ut H h=t "d@ @Xn thi=t)56 7#t \@ "v ang b thEy th= @n ng\î tMng nh3ng @6ng i@nh\:

- C/@ @6ng i@ Hw; i Hw; HJi. nh2 @h/n. nwng nhr@: n @huybnnguyn t Hiu. H[; M/;. gi; t1ng n1ng "ut ti=t i2 "d@ HEUng @RE @n ng\î)

- TMng 26i tM\^ng h[@ nghit hw@ nguy hib2: ngi h_ngh6ng tMa. tMn @hi=n tM\^ng. \]i n\]@ "ku. tMng Hxng t. nZi @F

;hFng 9J. nhit U @E.)))

- h3ng i@ xi hi U @hjnh 9/@ @E: H[; M/; @/@ @u tv tMng@/@ i 2J@h.)))

*in nEy. @/@ thi=t 7L in tv te Ung hFE nh\ @/@ 9? te hnhAEutn2u" gui? ?hi@H? z qGV hEy M6 7#t i Ung 7cng 7/nh

A{h??H? 27iH? 57t z |5 ngy @ng \@ "e uEn tk2 H]n@RE nhiYu ng\î tMng nh3ng n12 gXn ky. @hng \@ dng angMUng M!i tMng @/@ ngnh h/@ nhEu nh\ @6ng nghi;. n6ng Hk2nghi;. y t=. L@h a)

b h[@ ;ha@ nh3ng t}n tJi. /; dng nh3ng th/@h thd@ 2]i wt MEtMng 9u h\]ng tn @Xu hFE. the@ hin th[ng Hi @6ng @uU@ @6ngnghi; hFE. hin Ji hFE t n\]@) Th? uEn ib2 @RE t6i th @Xn

;h_i @F 2Ut t\ uy thEy fi uEn ib2 b 2N MUng dng ang @hd@n1ng te Ung hFE tMng @/@ ngnh @6ng nghi; L@h a @REn\]@ tE)

/.7. T89 :;: 9 ?@23 :A2 23DE2 ?F5

1. Structur!l "r#p$rti$s !n% &l!ssi'ic!ti#n #' (in$m!tic!n%)*n!mic +#%$ls #' ,h$$l$% +#bil$ -#b#ts/ 0u* &!mpi#n/0$#rg$s B!stin/!n% Brigitt$ )2n%r&!34#5$6 i777 tr!ns!cti#ns

#n -#b#tics !n% !ut#m!ti#n/ 5#l. 18/ n#. 1/ '$bru!r* 199:.;1


4/36

3

2. ,+- c#ntr#l 5i! %*n!mic '$$%b!c= lin$!ri>!ti#n? +.@$n%itt$lli/ )$sign/ impl$m$nt!ti#n !n% $xp$rim$nt!l 5!li%!ti#n60ius$pp$ Ari#l#/ +$mb$r/ 777/ 2l$ss!n%r# )$ Cuc!/ +$mb$r6

777/ !n% +!ril$n! @$n%itt$lli/ 777 Dr!ns.ntr#l. S*st. D$chn#l./@#l. 1E/ 4#. :/ pp. FGHIFH8/ 4#5. 8EE8.;J

nhn thy

T TA> q %=t< ;t Ao)'

T> D IT n m U T n m U =. @F thb \@ i=t HJi

nh\ "Eu:

D DS +S> S T +S &S U> + + =&&

Ao)0

(h\Zng tMnh Ung He@ hr@ the@ "e @RE qGV ]i @/@ nhiu 7n ngi

@F thb \@ 7[t ;h/t tMibn t< ;h\Zng tMnh Ao)0D D %S +S> S T +S &S U> + + + =&&

%+> &> +&Ao)0m

V]i :D T n m U T n m U+ S +S =

D T n m U T n m U& S T +SZ&S U = &

0 T n m U% %+

0 T n m U%

Ao)0S

0 ' D

% % %; ' '


20/36

19

TMng F:0

m%'

'm%'

H @n tMn @RE @/@ nhiu)V@ tZ 7i=n tMJng th/i \@ Lnh nghE H:

[ ]T ' 09 t B T n m U =

Ao)'0D

p p rM lM rM lMx *[ [ =

DeE tMn @/@ 7ibu thd@ Ao)00. Ao)0m. Ao)0S Ao)'0. h th#ng Ung

He@ hr@ @RE qGV \@ thb hin tMng @/@ hnh thd@ 26 hnh h6nggiEn tMJng th/i nh\ "Eu:

0

-0'

% %>B9

B

n T n m U n

%

= +

&&

&

Ao)''

Gi_ "v Mcng "# H\ng @/@ y=u t# Xu @RE h th#ng

r T n m U

-0

! \@ 9=; hJngT n m U

. @ tZ Xu @F thb thu \@:

[ ]' u % +Ao)'o

V]i:

0u B T n m U &H 2Ut @ tZ iYu hibn Xu )

T< 7ibu thd@ Ao)'o.7ibu thd@ Ao)'' \@ i=t HJi:

0

%>AB9 u A9 gA9u

% I

n T n m U

T n m U T n m U T n m U

&

Ao)'`

V]i :


21/36

20

' 0

0

>ABA9

%T n m U

T n m U

'%

gA9 I

n T n m U T n m U T n m U

T n m U T n m U

CHNG QTHIT K B IU KHINTU%N T&NHH'I TIP

Q./ Vs2 ct ?h2 3DaD 45eO:Q.7 Pu2 :f? L c6 A6 3DaD rQ. TDO: qO `< cDt5 qDZ2 :5eO2 :f2 ]D :DOGi_ "v h!y 9?2 9t ;hi tuy=n h th#ng IO "Eu ky:

9 A9 gA9u&

A`)0

y hA9A`)'

TMng F:

-

' 09 T n m U H @ tZ tMJng th/i)

-

0u T n m U H @ tZ iYu hibn Xu )

-0y T n m U

H @ tZ Xu ME)

-

' 0A9 T n m U

'gA9 T n m U T n m U

0hA9C T n m U

H @/@@ tZ h6ng giEn tMJng th/i)

a@ tiu @RE @h\Zng ny H b thi=t = 2Ut 7U iYu hibn n \^ng@h ;h; qGV th? 2Ut @n \^ng 2ng 2u#n) V]i ;h\Zng tMnh

Xu ME \@ thb hin 7Ni 2Ut @ tZ y nh\ "Eu:


22/36

21

[ ] [ ]0 ' 0 'y BD D

* * h T U h T U= =A`)o

TMng F:

-0 h T U

H h_ng @/@h ng[n nht t< ib2!"

tMn qGV =n \^ng n2ng 2u#n)

-' Bh T U

H n t#@ tuy=n tjnhp5

@RE ib2 ( @RE qGV r@ th? tMa@ l%)TMng tM\^ng h; 2Ut \^ng thng \@ 26 t_ 7Ni 7ibu thd@:

%2x B* &+ + =

0 0' '

! !! !2x B* &

* T U h T x / * / U2 B

+ +

= =+

A`)`

V' ' B p p* h T U x c#s * sin = = +& &

' rM lM p

rT U 5 = + =

A`)&TMng F:

-! !T x / * U

H trE U @RE ib2!"

)

-p p

T x / * / U

H Hin uEn =n @/@ 7i=n iYu hibn 7cng @/@;h\Zng tMnh "Eu ky)

! p !

! p !

x x C c#s

* * C sin

= +

= +

A`)$C/@ iYu in Xu 9ut hin tMng @/@ ;h\Zng tMnh Xu ME h/@

7it nh\ "Eu:


23/36

22

00 h0

h00 h0

t At>AtBt

>tB At>AtB

t

h*

T U*

=

=

&&

&&&

A`)

h00 h0

>tB At>Atu

t

T U*

=

&&&

A`)m

' h' h' ABB ABu* = =& &

A`)SV]i :

00h0 At

t

nh =

0'h' AB

B

T n m Uh =

H 2E tMn E@7iEn)

E tMn

t/@h Ming :

K0 h0 'K

K' h'

At At>At AB AB

T n m U

A`)0%C/@ 2E tMn E@7iEn tMng 7ibu thd@ A`)0% @h @/@ \^ng thng\@ "uy ME t< 7ibu thd@ A`)& A`)$ nh\ "Eu:

0h0 A

h=

' '

0

%

%

D

! !

2

B

BC c#s 2C sin2 B

= +

A`)00


24/36

23

V

'h' AB

B ' '

h r r = = A`)0'

T< 7ibu thd@ A`)m - A`)0%. 2E tMn t/@h Ming \@ "v ang b thi=tH; @/@ ;h_n h}i th6ng tin tuy=n tjnh Xu -Xu ME nh\ "Eu:

0K K

'

y B u*

*

= =

&&&&&

&

A`)0oV@ tZ Xu iYu hibn b Jt \@ Xu -Xu ME tuy=n tjnh\@ @hrn:

-0KK

u - B &

A`)0`

TMng F:

- H @ tZ n t#@ @RE 7/nh 9?)

-

' 0

\@ Lnh nghE nh\ H @ tZ Xu iYu hibn 2]i@F Jng:

00

''

" p ) p %

@ 5 %

= $ = $ r

= $ r

+ + = = +

& &&

&

A`)0&

V" ) @= / = / =

H h "# \@ HeE @hrn b _2 7_ "e hUi ta th? h22 @RE @/@ Hi iYu hibn Y h6ng)V]i @ tZ"Ei "# L tMj n t#@ tuy=n tjnh \@ Lnh nghE nh\ "Eu:

00

''

? p %

5 %

$ r *

$ r *

= =

A`)0$


25/36

24

T< 7ibu thd@ A`)0& - A`)0. @/@ "Ei "# L tMj n t#@ @RE @/@ hth#ng xng h; jn \@ \E ME 7Ni:

%p ) p " p$ = $ = $+ + =&& &

A`)0m

%5 @ 5$ = $+ =&A`)0S

fn Lnh th? h2 2)

Q.Q (5 c] 3DaD :5: cDt5 qDZ2 :5eO2 :f2 ]D :DO

*nh `)0 \u } gi_i thut iYu hibn tuy=n tjnh h}i ti=;

CHNG v KT wUx M PHyNGv./ w5z cXg 9g23 95>2 ?g "GV ={ |23 9@ }23

*nh &)0 7ibu in u J 2ng 2u#n @h qGV @F Jng \^ngthng ]i @hiYu i H '.m'A2 @F Jng y 9) V]i @/@ y=u t#

rd+-

e( 4.15) ( 4.14)

( 3.23)u ( 3.22)

W

( 4.1)x y

I ~ I 3I5

%


26/36

25

0 0 %2 / B / & .= = = Vn t#@ tuy=n tjnh 2ng 2u#n @RE qGV H

' % %&%

r . ; m R s ={ |23 ?g `< cDt5 qDZ2 :5eO2 :f2 ]D :DO

C/@ h "# @RE @ tZ ib2"/t Xu 2]i H:

'o $"= . ; s


27/36

26

C/@ gi/ tML thE2 "# 7cng "# @/@ gi/ tML 7En Xu @h 26 ;hng

thj nghi2 \@ \E ME tMng B_ng &)0 B_ng &)')

B_ng &)0 C/@ gi/ tML th6ng "# @RE qGV

KW hiu Gi/ tML \]n 5^ KW hiu Gi/ tML \]n 5^

b % oS. ; m < Mm ' n&. ; = g Int?MnEtinEH Cn?M?n@? n Int?HHig?nt 57t" En>y"t?2" >En Di?g. 4Kin?2Eti@ En DynE2i@ CntMH E |h??H?

7iH? 57t8.&2/ OS2/ Act 89 3 4#5 8/ 8EEN.0%) Mu Eng. Dng7ing Gu . T"ut2u itE . En *u"h?ng *u.4nHin?EM TME@ing CntMH O q CEM-i?27iH? 57t ViEDynE2i@ ??7E@ in?EMiEtin8.ntr#l 8EEJ/ Oni5$rsit* #' B!th/O(/ S$p 8EEJ. 00)5) i?MM En ) ) ?{i". ?HH{. I ntr#l #' !

4#nh#l#n#mic +#bil$ -#b#t Osing 4$ur!l 4$tM#r=s/ 777

tr!ns!cti#ns #n n$ur!l n$tM#r=s/ 5#l. 9/ n#. J/ Pul* 199F.

0') ) *ung. TuEn) D) V. E?) >) I. *) K) Ki2 En >) B) Ki2.4tin CntMH O2niiM?@tinEH 7iH? (HEtM2 M TME?@tMyTME@ing Q"ing Int?gMEH >Hiing ? CntMHH?M8. nt$rn!ti#n!l

#urn!l #' ntr#l/ 2ut#m!ti#n !n% S*st$ms T&2SU. VH) m. ) $.D?@?27?M '%00)0o) ?En-E@u?" ) >Htin? En |?i;ing i. 2ppli$% 4#nlin$!r

ntr#l. (M?nti@?-*EHH Int?MnEtinEH. In@). 0SS0)0`) C z {EM" En >)V)";uMg?n. >Hiing 2? @ntMH:8 Th?MyEn q;;Hi@Etin. (M?nti@? z *EHH int?MnEtinEH. In@. 0SS0)

0&) hn DyH?. BMu@? MEn@i". qHH?n TEnn?n7Eu2 A0SS%/ BE"i@Cn@?;t". hn DyH?. BMu@? MEn@i". qHH?n TEnn?n7Eu2.K$$%b!c=ntr#l Dh$#r*. E@2iHHEn (u7Hi"hing C). ;Eg? Ao0- `%)

0$) ) K) *?Mi@ En q) GiMEM A8EEHU/ ??7E@ in?EMiEtin. )K) *?Mi@ En q) GiMEM . ntr#l #' 4#nlin$!r )*n!mic S*st$ms?Dh$#r* !n% 2pplic!ti#ns/;Eg? A0oo z 0$%)

Thiết kế bộ điều khiển bám cho AGV dùng kỹ thuật tuyến tính hồi tiếp.DOC

Documents

Transcript of Thiết kế bộ điều khiển bám cho AGV dùng kỹ thuật tuyến tính hồi tiếp.DOC