•
CAO HOÀI PHƯƠNG
•
TRẦN NHƠN
•
TRƯƠNG VĂN CẢNH
•
LÊ VIỆT VŨ
•
NGUYỄN THANH THIỆN
•
BÙI VĂN MINH
ĐIỀU KHIỂN VẬN TỐC ĐỘNG CƠ DC BẰNG THUẬT
TOÁN PID
I. GIỚI THIỆU
II. Incremental Optical Encoder
III. Chip driver L298D: DUAL FULL-BRIDGE DRIVER
IV.Mạch logic cho L298D.
V. Giải thuật điều khiển PIC.
VI.Điều khiển DC Motor bằng PIC.
VII.Mạch logic cho L298D.
•
!"#$%&%'()*+,
-./!"**0",, 12%3
*45-
•
67.#!"8(9:;0
•
8<01040!"=
>?,!=6@6&4#'1-
>,!=A'8,B4
•
B4C(D.6@%&.,##7!E0FF
•
4$%&=B%G!H1A%3E#EI7%7E
JE))BC."#'K6*
•
L@%&C4%MNOPQRRENQPRR
•
8<'!1S!".JS65.MT,U ."
.B5
•
C04CVW.B5=()XY#!"(D4
,UZ+,RCV[\,U%Z40]!^E_,6`,U
Z12.B5F
•
aCVK-:;0!"#T,U#"KT,##'K6*
I!"%.7
•
bW.B5KT,7U0,(FcB5##5.".B5
-+,12J^7RF
CONTROL:C.B")BC
.".B0ER*
LOGIC:-.(;Z4d
',4d03200%.7
POWER: 0%.7<eQ."
II. Incremental Opcal Encoder:
•
65.MT,U,U.B5/_,*;0)I
128T,U+,#
•
a4J8T,U+,#(,9#,#77B,,#77.B
5T,U E%3(;fR,UE]%37%7
•
C1040,,!."%30:,,!7%77%7T, 8#
01040%,!
•
b50:,!7%7(,9##904T,1A!"9'
gP,7% E#)#(;T,."#h,8,i
•
j%71A8k^kl, (,9#^?E^m."^%7R
•
n^+,7%7!"#!op(^0S,+,h,T,U."#]00,q
%"^!op"UF
•
n^?+,7%7!"(^"h,T,U12,"4ip."#
]0q044%"4i"UF
•
n^m+,7%747%7M8#]004412]^
31AM.^?1!#_!>rEsi
•
)040I7%7(DC
>Dùng input capture
+Dùng chức năng counter
+ Sử dụng ngắt ngoài
III. Chip driver L298D: DUAL FULL-BRIDGE DRIVER
•
<eQ!"#0d20<#'Xb8Nst
•
<eQ840%,h,,!*src ."%M%,h,!
<?^*S2044$%&K6*p14
!'p.".H,
K/B+,0."*_(^0F
*_(^0
•
8<#'Xb^#o0<eQ^8<512W.N
0"U
•
o#'X(,9#N1A9c6E#1A7676E0X
5+,#'XbK125.#"(p51A%35
#fpI!"676766
•
6`125.<1AuNEu<]ukEuv;%3
#'X(^0)
•
L`8<1AS#oXbI!"N."<]kEv
•
<eQKW12%3)#"M.B5
(DCV
•
^0<eQM841Ac66*0400X!sc ."
)!."#F
IV. Mạch logic cho L298D
•
;;##'%.7#1A,1A%"k1A
8!"CV%3.B5Ew1."j0x0
#''
•
0<eQi86y1Aj1<1AN."<K
B6-$z1_,##5
•
_,6`;;##'!0&.<l."!"CV."w<
l,!"<1AN."<
m)NF()tJ+,#'!%.7<eQF
c;"#(!<lN."<=N[CVFuw
<[CVFw
V. Giải thuật điều khiển PID
C!"4.;Y+,4HC0:,!W! E7,!d0t ."
7.,:.7'"# FUR**!t1;,UC.{!")
B12%3*4$%&-
•
#A,E(C12#K)(D#K/.",=
•
87 !"dl."E !"dl,+,(F
•
U^E5.c8E.d44"0XCEEq
844!"d4d0t,U'"#K$^!"K
-12F|%=CKS4SR4#$}[rEh,
!"K!^&F
•
8E,W8S4X_(D4,}[~*p1
!rF$CA'=
•
"0Xd0t=
•
"0X.0t=
VI. Điều khiển DC Motor bằng PIC
•
CX"U_,6`.B%&*)0X!|U;f^.;
1/CNO•QQ€F&S!".B5+,(D
)BCF'#K0p12/("U/NF
•
K/%3.S%&!"!'N<c8.B5K)5,!"
Nrrr0#7.!707#7 F
•
j%7%3#12I80t)krr0!67•.MF
•
n^?+,7%7125.t7#7NNn;#REF
•
n7U0,(125.Cuw?"].B5##5XF
•
7R125.Cuw.;U%G!vm%3J
.B5-+,#IHj%7?,!6077% .".B5"]767%
6077% F
•
)BC6512.B"(fCA,!*U#{!"Nr#6F#7r
12%3')A,Nr#6F#7NNO( !"(;#75
.7%7F#7<Q( !"('CV.B5