Đề Tài 1:Điều Khiển Chuyển Động Của Robot pot






 ! "#$%#&'($%)
*+,*-.&-/.&0&%1'2$3$!)


Giáo viên hướng dẫn:
Giáo viên hướng dẫn:
Sinh viên thực hiện :
Sinh viên thực hiện :
Nguyn Văn Thng.
Nguyn Văn Thng.
1. Nguyn Vit Việt.
1. Nguyn Vit Việt.
2. B"i Thanh Th$y.
2. B"i Thanh Th$y.
3.Tr'n Qu)c Đ+t.
3.Tr'n Qu)c Đ+t.
4. Nguyn Th- H/ng Vân.
4. Nguyn Th- H/ng Vân.
5. Phan Th- Hoa.
5. Phan Th- Hoa.
6. Ngô Quang Huân.
6. Ngô Quang Huân.
7. Giáp Huy Việt.
7. Giáp Huy Việt.
Thái Nguyên,tháng 11 năm 2010.
4#4#

1
V i nh ng m ch i n không òi h i n nh c a i n áp quá cao, s d ng IC ớ ữ ạ đệ đ ỏ độổ đị ủ đệ ử ụ
n áp th ng c ng i thi t k s d ng vì m ch i n khá n gi n. Các lo i ổ ườ đượ ườ ế ế ử ụ ạ đệ đơ ả ạ
n áp th ng c s d ng l IC 78xx, v i xx l i n áp c n n áp. Ví d 7805 ổ ườ đượ ử ụ à ớ àđệ ầ ổ ụ
n áp 5V, 7812 n áp 12V. Vi c dùng các lo i IC n áp 78xx t ng t nhau, ổ ổ ệ ạ ổ ươ ự
d i ây l minh h a cho IC n áp 7805.ướ đ à ọ ổ 7
%56'(-7&8&9:&;<=>?9@&AB!C&%-D&#-&%#EB!'/
98)) -&%-D&9@&#FGH#I90!&%0!9@&AB!J&%#'$K"#9@&
LM&$"!90&%8&9:&&N#FOPQ<LM&%R9ST#9@&AB;&%5
6'<=U7&%98)))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))O
NK;9V-

 !"
#$##%&'()*+#",-.+/012
'(!3%
45"#6"'7)8#8"#9:!0;<
=!62>0::?@:$AA,-#
B;BB#6,#<%
C#66,DE":E,F,:")*+01'(
G:(D"%&2'()*+HI=,!#@01'(
":EHI0JBIK2'(%
4#GK:=9;#E01G,
012'(##L:KK<,;I:!DI<%&'='=
# 0.#<I"%MN01'(#"
!N;!>#(;E9O4=:I0P#
,#<Q#%
C#62'(E##6B:R8:/#@:
9#Q"#@#%MB,A$$#HI%&+
2?E6#""B:8: #"S"B
$:#Q"#@:@%

T<:="E/UB!V$A01H%
2
Em xin chân thành cảm
ơn !

WXYZZ
,[S\&%A&! !U 
Thực hiện đề tài: ” Thiết kế mạch điều khiển rôbốt ”.
4A62":;6,V,::A$$
#%
M$::EA$#;P9R8:'(":H$A$
#,WH%
MA$$;,;Q#";Q!I<"X!%
Y:.62AA'#66,D:E=Z$IA
HC*[
\E=Z,01,:E=Z@B01<EP]##,^8%M
:E=Z>01<EP_##^8%4"'(##^8,"
B:P'J'?5W/+I<,%4DA$",
DS`"!'?a'J'?"!,$<!I%
3
\E=ZB$IA'?QI6B01'#":E
A$HC*":EK:"!%M+:EA$H@:E=Z
B$IAH,HI%*b=:PB"RA::@:+%
][A#(&U@&G^>4&%!6$&%K"#

MA:EA$$#W:",[
c )*d_ef%
c \H[_:H%
c )*gfhi%
c M=%

c *XA$[]X%
c M#P%
c d8'%
c C%
c je&%
c kWH%

_[`\(ST#L*(&U@&G^>4&%
c M"!<!,6]l&%
c 43'?C*m,6]n)
c M"!?%
c *2KIQ"%
c M"!,ohp5q%i&#P/+`,A:77,a%
4
*d_ef,:ED1!H!B$S<qi9jr8#Ys_h`,
'"<a%d)*:E=BIKEP;'?%B
010HDt44d,"II:"0#8,;,8';HC*
H0%BB_98,8`!U!a$!U!u!U!)*E;
,!"9D%*!"`8:8#a##'0:v:E=01
++#9$+#PI:2'?=%
BB6::9<!WR!:E,B$EP<!H%

\H:#,:mE#$;0:H;B0.'
$b:HN:H+#%

5
4+[
c M0.D[_]%]::%
c 4+[_fhh?u!R%
c C?+[h%qgn`_qeh?u!Ra%

6
c *<[h%gwx%
c M"!t[_%i&%

)*B"'(3mW#:EB#P"%
*"+HI)*gfhi[
c C?2EB$'#@,qn%
c C?b,_%_n%
c *<6"E'I,_r%
c *<6"'I,,[qir%
&G:E?S3m"!Q";'()*3"!
0.010.'(@:E"HI%*",E3"!0.01
'(,)*gf//;//,"!=3"!%&D'(gfhi3"!i&;gfq_3"!q_&%&'
",E)*3"!gf//0H;'09,:)*3"!gfhi%
y#sz4,3mPi&'"!5W<!3%%W
B+["!K:EJE3m.B)*gfhiJG
01"!Py#sz4i&3%
7
4#:Eb,0''8B$01D1!''8=%
C'8=B"'(b,0'?;L:01DC*%

4#:E'(]X'A$$A$;X[E;,;Q
#";Q!I:#%
8
d,(;B"'(E'?%
M#P01,:51!<:,E8{,!#:",
#PB#m+"%|"#m#P01$#6"E:%

d8'B-,''8!"Q;,"''8BIK!"#""W
E;Em

d8'0.B!9H''80.;#I5q;icw&%
d8'01'$,:!$m#"m;;}QI";}
%
~D[

9
~D=+D''8;0B:>6P!D#6%
d8'B@'E0"@P!D#6,,8'H%
4#:E'(q,8'"W$B'?:EE%

4'(q'$+'?01;I:I:E<!'?
01A%
*<!WqA:EA$E%`Y'(!e&a%

10
dI!t::##:E%*":#01X_"
$A$$%
11
WZZ
,[`\9DUI
YHW#6,HW+:6I:EA$#%
][a#&J&%#1'!C&%UI
a) Khối điều khiển môtơ: (Modul DK L298).

4#:EA$#;$A$:H'()*d_ef%
)*d_ef,)*:E=;BHW+d_ef0[
12
W

MA$

\',
C~
d_ef
\
#q
\
#_
YHW9[
13
*($"90[
c&[W,];icg&;:2t,i&%
c&[W<!HP=#;B"#m_;ic]l&,EH%4#:E
'i&;@bA$HS%
c*B]=q;_;w;]•9,"=_:E=Z`=n=€a
L:E'?%M$!U!:E=EB"9D•n
•€%•nMA$:E=2_=q_`=na%•€A$:E
=2w]`=€a%
c*"9Y88n;Y88€[01+<Qq#P%|"#m#P A
$:2'?EQH%
c*B]=#q;_;w;]0H2"=%C?P"=#
q_01A$P#P+Y88n;?'?P=#w]
01A$P#P+Y88€%
\E!U!A$H8IAm[
c ~*P:2;CP:2<![HQ8A
c ~CP:2;*P:2<![HQ88A01%
b~=*CP:2N:2<!;"!G_=H
Lh6H'5,EB%
Chú ý:
Khi thit k c'n có một tụ điện không cảm kháng 100nF ở cả hai chân Vs và Vss tới
GND. Gn tụ điện thật g'n với chân GND c$a IC. Khi tụ điện c$a m+ch ngu/n quá xa IC, hãy

them một tụ nhỏ g'n IC.
14
Về điện trở cảm ứng động, không được d"ng lo+i điện trở dây quấn và phải được n)i đát
sao cho càng g'n chân GND càng t)t.
Mỗi chân điều khiển ngõ vào phải được kt n)i với m+ch điều khiển sao cho đường dây
n)i thật ngn.

b) Môtơ:
dH:A;'$3"DA$'0'E"/
#.#E!"$BQN"$#BI
K+m#"m#D=%
*":HQ8506BD/"A:NA$%0
P!=#6;":H01X"/8WH$A
$$%Y'()*d_ef$A$AQ;,:#%
'(H0;+H0H+S;:N""
H0"%‚$:H0,BIK:;H '5,E
XW%46P9'(H:AT^wqh4;B"#ƒ;
„601'(!3#",EWH%`CH0H+6B$
6:+"#K$:#QS8Ha%
c) Nguồn:
~+HI0…Q#;$3m"!#6W
'()*d\gfhi%
W'(P9,!w;<!WqA:E%
d) Khối điều khiển:
15
~+A$,X<'$$$+01"#6# $
A$01'7'%
_[%-/c&(d
'["##V-
0P!==;:E=ZB:(Q##'J'?5

W/+I;L:IAH8V:+%
)A#>"&%#E-!"$#1'K"##V-
\E=Z01<EP_'ED[
+) Dạng 1:
M01<EP]##`^8a*6%YHW6,V:E01<E0
`*b :E'##$:@a
16
M+'E@01<EP"##6%b=_DA$
D:P"##%
+) Dạng 2:
M01<EP_N!##j;^•4`4Z01a%YHW6,V<
EB01<E0[`4>'##:@%
M+QI,<",3m+"!=SI_]&%
M+:E<,@"^•4<,0.B6j6'01
8":!I'8"q%
. Nguyên tắc hoạt động của mạch cầu H.
*b/U6,VEE0:E=Z€†401
$D'(?^8@B=0H0H%
4!9D:'E:E=Z0#6%Z'EB6,VE
+b",,<E,6=Z0B:P"##
^80‡M+'Eq'^86@!I':E,"+<
,"!,%*?'E_'<S"!=S%
17
4!9D6,VE:E'_0[
\E=Z01A$P]DB:P"B,"Dq
D_`0#6@_aA$01_A`*B-,IA'?a%ˆU
5m%
0RA$B:P6"##,[
cM+6$:P@z8‰h:P##L'?%
cM##6j$:P@z8Š‹h%40.@Lh,B :P%

*Điều khiển > chế độ thu?n:
Œ<!]DAA$]4##A$B
'?EQI#q.$:,[
•4Dq‹h`42,:P##Žqa%
•4D_‹h`42,B##Ž_a%
•4Dw‹q`42,B##Žwa%
•4D]‹q`42,:P##Ž]a%
&'E0.01:I0@ [
M<,'EA[C?5WQŽqBQIQŽ_/+
|C%
18
*Điều Khiển > chế độ ng@ch:
Œ><!]DA$]##%&]DA
$!IS:A$[
•4Dq‹q`42,B##Žqa%
•4D_‹q`42,:P##Ž_a%
•4Dw‹h`42,:P##Žwa%
•4D]‹h`42,B##Ž]a%
&'E0.R01$0@ [
) Ưu nhược điểm của cầu H.
a‚$:[Y'(=Z,::E#P6HIH!:!D%
a01$:[0:EA$@_XPq=@
 :E,RmX:EW%01/I##q.
X`Ž"aY /<'?#'JQ<,:K<6"#6
%.#'J';'?#'J ,,:"<%42,:E
BI'?"!
19
) Chú ý.
M+:E#@!I;D"'?Q=Z;
"!D&•:E=Z=RVG$:[4DA$

;'?Q=Z;I;'?01'II:E#,:!"!
"!%%%%%
+) Đối với mạch công suất nhỏ:
M+IB<S[4=+BX=+A$S0A$
HSII:B<S%4@:E=Z0.01L€†4%
R=RV'?01A$H;DA$$€†4:P
"+",6QB0'?;"!%
`\E:I01 a
+) Đối với mạch công suất lớn[
M+Im==+BX,`‰_h~•a0.0.'€†4
@01$:#6:0.'",<0\‘8)|€4%%%&"
0.'$A$HC*,"K:"!B<,%*"R
=R[4DA$BX;I"A$;'?015BI
K!"!"!
4#Bq,E)*"'J01D1!,I=Z#Bb=<!
/A$;BI'?[
•d_ef%
•d_ew%
C#6HPBR8:'()*d_ef$A$AQ;,;#";
!I:H%
Y'(_:HX_"$A$$%
’'(!=:A:s#*nCv#1:E%
20
@9,A0H+HI;b:D<:.
'(")*:H$E#$HI0Q#";!I;;,%
3[`\9D&%-/c&(d
Nguyên lI hoạt động:
€="9d_efP:2h;~<XA$@92
XB018,6q,:d_ef%C?6Q)*d_ef#90H
20'?:#,::#Q8A'?%C=B"'(b

,0'?%*":#Q#A$"/8%€"/801"Q
A:#t$8AQ:#%
21
ZEHQm$[
*$ d8‘:# T:#
4 4 4
d 01 01
T !I 4 ~Q
T #" ~Q 4
d!I 01 ~Q
d#" ~Q 01
\E#6'(X!$A$%
#[`\9DK"#&
e[`f&BgK!-9ST#
22
Y:.626,VE:EA$#;
@:$A",='#:E;B:I!t::E
A$$WH;01:P@I'09%

V&;60&%

23
M+&)“4n\;#E=.…!B;EB<
0;I/<;E#,,-0H+::ƒ%
TL:E#B#Q"#@I/<I:2,L
90.,%
YI!t:,I!t:HI#EA$$#%
45I!t:;B$:P##"I!t:"L:2
'(7#+%
MAA$$#,:2'(:!"

#$:E: ;'E;B012'(A#":"I/<L:
I:2,0.W.>9+,01>0<
,01I!t:;6B!1!A2'(;O
4Q:EA$$##6;B$:P#E":E
A$$#!2!H;/HB$E:EA$5/
$#%
V&=Z
24
 MA[” THIẾT KẾ MẠCH ĐIỀU KHIỂN CHUYỂN ĐỘNG CỦA ROBOT”,
MAR!R$6:A:o4:E,,o%
4QA;R$'('(",>0"2
/9';+#D::E%
\A$$#HI"'<:0:#
26;L:0=E,;D,?:6"E;$R
XEG:EA$#!2E!HL:R'(#
7:GE#0T;•#8O%
MAB:0$#"SGB;:
"=""EB!V;/9'$AH%
Chúng em xin chân thành cảm ơn!
+(@-!'KUf$
c |"#@:E,,[|z”•4Z–”&—%
c ![uurrr%#'%:u'uqllffhflucc'c
c  ![uu'%8u'8/%!!‡!‹:˜8F8r‹#,8F'‹qfhw[c
#F'‹]_[8,8#c8,8#F)8:'‹_ig
c |,8%:%

hU &9A&%A#1'%A$Lc&V&#$9.K
iiiiiiiiiiiiiiiiiiiiiiiiiii
iiiiiiiiiiiiiiiiiiiiiiiiiii
25