Professional Documents
Culture Documents
Thiết Kế, Chế Tạo Thiết Bị Đo Mô Men Xoắn Trên Trục Quay
Thiết Kế, Chế Tạo Thiết Bị Đo Mô Men Xoắn Trên Trục Quay
http://www.lrc-tnu.edu.vn/
--------------------000-------------------
PGS.TS Ng Nh Khoa
http://www.lrc-tnu.edu.vn/
LI CAM OAN
Tn ti l
Hc vin lp cao hc kha K14-chuyn ngnh: Cng ngh ch to myTrng i hc k thut cng nghip Thi Nguyn
Hin ang cng tc ti S Cng Thng Thi Nguyn.
Ti xin cam oan nhng kt qu c c trong lun vn l do bn thn
ti thc hin di s hng dn ca thy gio PGS.TS Ng Nh Khoa. Ngoi
phn ti liu tham kho c lit k, cc kt qu v s liu thc nghim l
do ti thc hin v cha c cng b trong bt c cng trnh no khc.
Ti xin cam oan rng mi thng tin tr dn trong lun vn u ch r
ngun gc.
Thi Nguyn, thng 12 nm 2014
Ngi thc hin
http://www.lrc-tnu.edu.vn/
MC LC
BNG DANH MC CC HNH V.................................................................................. 5
PHN M U .................................................................................................................. 7
1. Tnh cp thit ca ti.................................................................................................... 7
2. Mc ch nghin cu ti .............................................................................................. 7
3. i tng nghin cu ca ti....................................................................................... 7
4. ngha khoa hc ca ti ............................................................................................. 7
5. Phng php nghin cu .................................................................................................. 8
CHNG I. TNG QUAN V THIT B O M MEN XON .................................... 9
TRN TRC QUAY ........................................................................................................... 9
1. Gii thiu v thit b o m men xon trn trc quay ...................................................... 9
2. Nguyn l c bn o m men xon trn trc quay......................................................... 12
3. La chn phng n thit k .......................................................................................... 14
CHNG 2. C S TNH TON THIT K TRC QUAY ........................................ 17
I. Phn tch yu cu bi ton:.............................................................................................. 17
1. Mc ch ca ti ......................................................................................................... 17
2 La chn kiu trc quay ................................................................................................. 17
3. Phn tch bi ton ........................................................................................................... 18
II. CM BIN BIN DNG (STRAIN GAUGE) ............................................................... 19
1. Cu to strain gauge ....................................................................................................... 19
2) Phn loi strain gauge .................................................................................................... 20
3) Thng s c bn v cc c trng ca strain gauge ....................................................... 21
CHNG 3. THIT K, CH TO THIT B O M MEN XON ......................... 23
I. Thit k trc chu xon (trc quay) ................................................................................. 23
1. Chc nng: ...................................................................................................................... 23
2. Tnh ton thit k trc..................................................................................................... 23
3) Bn v thit k trc quay ................................................................................................ 26
II. Nghin cu la chn strain gauge ................................................................................. 26
III. ng dng mch cu Wheatstone trong vic bin i R ca strain gauge thnh
in p................................................................................................................................. 28
IV. La chn b khuych i, b x l, ngun v mn hnh hin th ................................ 33
1. La chn b khuych i................................................................................................ 33
2. La chn h thng x l d liu ..................................................................................... 35
3. Mn hnh hin th ............................................................................................................ 36
4. Ngun cp in p .......................................................................................................... 38
S ha bi Trung tm Hc liu - HTN
http://www.lrc-tnu.edu.vn/
http://www.lrc-tnu.edu.vn/
http://www.lrc-tnu.edu.vn/
PHN M U
1. Tnh cp thit ca ti
Ngy nay vi s pht trin ca khoa hc, cng ngh. Dng c o lng
c nhng bc tin ln v cht lng, kt cu v s thun tin khi s dng. C
th nh v chnh xc php o, phng php o, c ch hin th kt qu o,
kh nng tch hp vi my in, my vi tnh, kh nng thu pht khng dy.
Thit b o lng thng c phn thnh cc nhm nh: o lng nhit,
o lng p sut, o lng lc v m men, o lng cng, o lng di,
o lng cc ch tiu ha l, o dung tch, o khi lng, o bc x ht nhn
Thit b o m men xon trn trc quay da trn nguyn l mch cu
wheatston, tn hiu u ra t cc cm bin bin dng c kt ni vi b
khuych i 3B18 ca hng Analog divices, vi x l Ardunio gim ng k
cng vic tnh ton thit k c kh, tng chnh xc ca thit b.
Kt qu ca ti s l c s thit k ch to cc thit b o m men
xon, ng dng cc strain gauge vo cng tc o bin dng trn trc quay, la
chn b khuych i v x l tn hiu o cho mch cu hai tay v mch cu 4
tay (Half- Bridge v full-Bridge).
2. Mc ch nghin cu ti
Thit k ch to thit b o m men xon trn trc quay di o 0 Nm500Nm.
3. i tng nghin cu ca ti
* i tng nghin cu:
- Cc loi strain gauge.
-Thit k trc chu xon thun ty
- Nguyn l mch cu wheatston.
- K thut gn strain gauge trn trc quay, kt ni ng ra ca strain
gauge vi b khuych i v b vi x l;
4. ngha khoa hc ca ti
* ngha khoa hc ca ti:
-Xy dng v th nghim c cng ngh dn strain gauge trn b mt
trc chu xon bng nhm. La chn v th nghim thnh cng s dng strain
gauge vi b khuych i v b vi x l;
S ha bi Trung tm Hc liu - HTN
http://www.lrc-tnu.edu.vn/
http://www.lrc-tnu.edu.vn/
http://www.lrc-tnu.edu.vn/
Hnh 1.4.
http://www.lrc-tnu.edu.vn/
http://www.lrc-tnu.edu.vn/
http://www.lrc-tnu.edu.vn/
Hnh 1.8: Hnh nh tho ri cm bin m men xon dng vnh gp slip ring
b) Dng strain gauge tch hp vi bin p quay:
Phng php ny hot ng theo nguyn tc cm ng truyn tn hiu
in. Thit b s dng 2 my bin p. Mt my bin p dng truyn dng
in xoay chiu (AC) kch thch cho mch cu. My bin p cn li truyn tn
hiu u ra ca mch cu. Khi c in p kch thch cho cun dy s cp th t
trng bin thin to ra trong mch in th cp 1 hiu in th th cp. y
hai my bin p thay th cho 4 vng trt v chi than, trong qu trnh hot
ng cng khng c s tip xc trc tip. Tn hiu c truyn qua khong cch
khng kh gia cun dy s cp v cun th cp nh hnh v.
u im: Tn hiu n nh, cho chnh xc cao, bo tr t hn so vi
phng php vnh gp (slip rings). Nhc im: chnh xc ca thit b ph
thuc vo khong cch ca 2 cun dy trong bin p. Kh ch to, gi thnh
thit b cao.
ng dng: Thng c s dng cho cc c cu quay vi tc cao, cc
c cu o cn chnh xc cao.
S ha bi Trung tm Hc liu - HTN
http://www.lrc-tnu.edu.vn/
http://www.lrc-tnu.edu.vn/
STRAIN GAUGE
BRIDGE
B KHUYCH
I
B X L
LU TR D LIU
Hnh 1.12: S khi h thng o m men xon dng dng strain gauge tch
hp vi h thng chuyn i b lu tr d liu v hin th gn trn trc quay
http://www.lrc-tnu.edu.vn/
b) Cu to thit b
Hnh 1.13. Hnh v cu to thit b o m men xon dng strain gauge tch hp vi h thng
chuyn i , b lu tr d liu v hin th gn trn trc quay.
Ch gii:
1: Trc chu xon gn lin mt bch;
2: B chuyn i v lu tr d liu;
3: Strain gauge bridge;
4: Ngun v b x l ARDUINO.
c) Phng n lp t o m men xon
o m men xon th trc s c ni vi vi c cu truyn m men
xon v c cu hm nh mt bch 2 u. Di tc dng ca mmen xon
truyn t trc ng c n hp gim tc qua trc xon v n c cu hm lm
trc o bin dng. S bin dng ny t l vi m men. Nh vy vic xc nh
c bin dng ca trc o cng chnh l xc nh mmen ca c cu.
http://www.lrc-tnu.edu.vn/
a. Tr trn c
b. Tr trn rng
http://www.lrc-tnu.edu.vn/
1=- 3=
u=
1
E
2G
1
(
E
. )
y ta c G=
E
2(1
)
(1)
http://www.lrc-tnu.edu.vn/
u=
L
L
(2)
Cn bng 1 v 2, thay =
G=
2. L
8L. M
L D 3 (1
M
16 M
=
ta c
wp
D 3 (1 4 )
D 3
M
D3
[ ]; vi Wp=
(1wp
16
);
16 M
D3 1
[ ] vy
[ ]=
3
L
L
gi l bin dng.
0,1
=0,001=1000.10-6
100
http://www.lrc-tnu.edu.vn/
http://www.lrc-tnu.edu.vn/
l
S
L
L
S
S
b
b
S
S
L
d2
; Tit din ngang ca dy S=a.b hoc S=
ta c
L
4
d
d
L
mt khc, i vi u o kim loi:
L
V
;
V
(1 2 )
L
R
Vy ta c:
L
R
1 2
C (1 2 )
L
L
K.
L
L
0,3 ; C 3 th K
Ta c Mi lin h gia R v :
R
R. GF
L
L
* Cc c trng ch yu
- in tr sut: in tr ca vt liu lm dy phi ln dy khng
qu di lm tng kch thc cm bin v tit din dy khng qu b lm gim
dng o dn n lm gim nhy.
S ha bi Trung tm Hc liu - HTN
http://www.lrc-tnu.edu.vn/
Thng thng
vonfram GF=4.1
- nh hng ca lc n tuyn tnh: Trong gii hn n hi, h s u
o khng i do quan h tuyn tnh gia in tr v bin dng. Ngoi gii
hn n hi, khi l/l>0.5%-20% ty theo vt liu, h s u o GF =2.
- nh hng ca nhit : Ni chung GF t chu nh hng ca nhit
, ngoi tr isoelastic. Trong khong nhit t -100oC 300oC s thay i
ca h s u o GF theo nhit c th biu th qua biu thc:
GF (T)= GF [1+
K(T- o)]
=-0.04%/ oC,
http://www.lrc-tnu.edu.vn/
Hnh 3.1: Bn v hnh dng v cc k hiu kch thc trn trc quay
- Tnh ng knh trc D0 v d1.
+ ng sut tip ti thanh trn.
Max [ ] hay
D0 3
16M
1
M
D
[ ]; vi Wp= 0 (1wp
16
);
16M
3
D0 1
[ ] vy
, vy [ ] = 4.500N/cm2.
http://www.lrc-tnu.edu.vn/
16 50.000
=4,07cm; chn D0=4,32cm, d1=2,4cm; Tnh c
9000 3,14159 1 0,5554
d
=0,555
D
D0
(116
)= 9000
3,14159 4,323
(116
)= 644,49 Nm
D2
2
Fmax
4 ; Vy Fmax=
2 M max 2 644,52
=
=2.865,39 N
D2 4
0,12 4
d1
4
[ ]; vi [ ]=4500 N/cm2.
http://www.lrc-tnu.edu.vn/
d1
4 Fmax
4500* 3,14159
4 2865,39
=0,435cm;
4500* 3,14159
Thng s
TT
d
=0,555
D
K
hiu
n
v
Gi tr
[ ]
N/cm2
Nm
500
Mmax Nm
644,49
iu kin bn ca trc
D0
mm
40,7
D0
mm
43,2
mm
24
Chiu di ln nht
L2
mm
206
ng knh mt bch
D3
mm
173
10
D2
mm
120
11
d1
mm
0,435
12
d1
mm
10
13
S l bu lng
4500
http://www.lrc-tnu.edu.vn/
10
Si
Fe
2014
0,5-0,9 0,5
Cu
Mn
Mg
Cr
3,9-5
Zn
Ti
0,25
0,15
http://www.lrc-tnu.edu.vn/
Hnh 3.5: Bng thng s v hnh dng strain gauge kiu Z23-FA-2-350-11
- Kiu: Z23-FA-2-350-11
- Chiu di cng: 2mm;
- Mc thay i in tr: 350 0,3%;
- Gauge factor: 2,060,2%;
- Thermal output: 0,2
http://www.lrc-tnu.edu.vn/
R3
R2
R4
R3
R1
R4
).Ve
http://www.lrc-tnu.edu.vn/
a) Quarter-Bridge
dng mch cu ny, ch c mt strain gauge c s dng, s
nguyn l nh Hnh 3.7. Do R1= R3 = R4 = RG = R, vi RG l in tr ca
strain gauge khi cha b bin dng. Khi c tc ng vo vt, in tr ca strain
gauge s thay i mt lng R. Khi , VO c tnh:
V0=(
R
2R
1
).Ve
2
nh hng ca nhit
Thc t, yu t nhit bn ngoi nh hng trc tip ln in tr ca
strain gauge lm gim chnh xc ca kt qu o. Trong trng hp ny
hn ch nh hng ca nhit ngi ta s dng thm mt dummy gauge
dn vo vt chng nhng trng thi khng hot ng.
Hnh 3.8 : S
dng
dummy
gauge trnh
nh hng ca
nhit
http://www.lrc-tnu.edu.vn/
nh hng ca in tr dy dn
Hnh
3.9:
nh hng
ca in tr
dy dn
mch
o
dng
QuarterBrige
http://www.lrc-tnu.edu.vn/
b) Half-Bridge
R
2R
1
).VEX
2
c. Full-Bridge
Mch Full-Bridge s dng 4 strain gauge, trong c 2 strain gauge chu
nn v 2 strain gauge chu ko. S mch Full-Bridge nh Hnh 3.11.
R4
R1
i4
i1
Ve
VE
V0
i2
i3
R2
R3
R
R
2R
R
2R
).VEX
http://www.lrc-tnu.edu.vn/
http://www.lrc-tnu.edu.vn/
n 1K .
http://www.lrc-tnu.edu.vn/
200K
G
; vi R3A=500
vy G=
200
=400
0,5
http://www.lrc-tnu.edu.vn/
http://www.lrc-tnu.edu.vn/
http://www.lrc-tnu.edu.vn/
http://www.lrc-tnu.edu.vn/
nui b x l.
http://www.lrc-tnu.edu.vn/
b) S mch ngun:
http://www.lrc-tnu.edu.vn/
Type
Z23-MA-2-350-11
Nominal
Resistance
350
Apporox
Gage
Fator
2.0
Dimensionmm
Grid
Remarks
Base
2.0
---
13.0
Uniaxial
45,for
7.0
shearing
strain
http://www.lrc-tnu.edu.vn/
- Giy rp mn: 02 t
- Dung mi lm sch chuyn dng, cn 700
- Dy dn tn hiu chng nhiu: s lng 50cm.
- Cu dn in 4 chn: S lng 01 cu.
- B khuych i 3B18, b x l ardunio, ngun cp in, mn hnh hin th.
- B hin th: loi Daytronic 3570,
b) Thit b phc v th nghim:
- My cng c gm: My tin, my mi, my khoan, my phay.
- Cc dng c cm tay: My mi, my ct, my nh bng.
- M hn, dy hn, ng h o Amprobe AM-570.
2. Cc bc tin hnh dn strain gauge
- Bc 1: Lm sch b mt trc quay bng giy rp v dung mi.
- Bc 2: Ly du v tr dn trn trc quay v dn Strain gauge ln trc
quay theo du vch sn: Qu trnh ly du c thc hin trn my tin
m bo chnh xc. Sau lm sch b mt thn trc v cc strain gauge ln
2. Sau khi c lm sch b mt thn trc v cc strain gauge c ph bng
mt lp keo dnh. Cc strain gauge ny sau c dn ln thn trc
- Bc 3: Hn ni to mch cu: Sau khi keo kh, bc lp bng dnh bn
ngoi, dng dung mi nh nhang ty ra b mt ca strain gauge. Dng m hn
v dy dn hn ni to dy cp ngun vo v dy nhn tn hiu u ra cho mch
cu theo s nguyn l 6 dy.
- Bc 4: Kt ni u dy tn hiu v in p kch thch ca mch cu vi
mch khuych i 3B18 v b x l, ngun nui v mn hnh hin th.
- Bc 5. G t cc thit b in t ln trc quay
- Bc 6: Ph slicon A900 nn b mt th b in t: B mt dn cc
strain gauge v mch in tr ca thit b s c ph mt lp silicon A 900 bo
http://www.lrc-tnu.edu.vn/
http://www.lrc-tnu.edu.vn/
Hnh 3.24. Hnh nh kim tra nhy xon ca thit b sau khi dn strain gauge
bng mn hnh hin tr Daytronic 3570.
http://www.lrc-tnu.edu.vn/
http://www.lrc-tnu.edu.vn/
http://www.lrc-tnu.edu.vn/
o in p u ra
Quan h gia m
men xon v in
p
3. Thit b th nghim
Thc hin ti Trung tm sng to sn phm, trng i hc KT cng nghip
- Thit b to m men xon v c cu hm;
- B hin th daytronic 3570
Hnh 4.1. Hnh nh lp t thit b o m men xon trn truc quay ln b truyn
ng to m men xon
S ha bi Trung tm Hc liu - HTN
http://www.lrc-tnu.edu.vn/
II. Kt qu th nghim
1. Th nghim kho st gi tr in p hin th khi t ti trng bit.
Ln lt p ti mmen xon t 0Nm n 500Nm ta c bng gi tr sau:
Bng 3 gi tr in p hin th (in p sau khuych i) trn mn hnh (Vo)
Th t
Gi tr m
men xon M
(Nm)
in p sau
khuych i - gi
tr hin th (Vo)
(V)
0
10
20
30
40
50
60
70
80
90
100
110
120
130
140
150
160
170
180
190
200
210
220
230
240
0
0,0278
0,0519
0,0742
0,1016
0,1270
0,1524
0,1778
0,2032
0,2286
0,2541
0,2795
0,2975
0,3222
0,3469
0,3715
0,4065
0,4319
0,4573
0,4702
0,4949
0,5196
0,5442
0,5843
0,6097
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
Th
t
Gi tr m
men xon M
(Nm)
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
250
260
270
280
290
300
310
320
330
340
350
360
370
380
390
400
410
420
430
440
450
460
470
480
490
500
in p sau khuych
i - gi tr hin th
(Vo) (V)
0,6352
0,6606
0,6859
0,7114
0,7368
0,7622
0,7663
0,7909
0,8156
0,8638
0,8892
0,9146
0,9400
0,9654
0,9636
0,9883
1,0417
1,0671
1,0925
1,1179
1,1433
1,1687
1,1941
1,2195
1,2103
1,2350
Gi tr in p (V)
0,6
0,4
0,2
0
0
100
200
300
400
500
600
Gi tr M men (Nm)
http://www.lrc-tnu.edu.vn/
Vo
(Nm)
0,00254
in p
Gi tr m
Ln hin th V0 men (Nm)
o
Ln th nghim 1
0
1
2
3
4
5
6
7
8
9
10
11
0
0,0029
0,0879
0,1759
0,2791
0,4110
0,4750
0,5819
0,6800
0,7781
0,8762
0,9743
0
1,1410
34,697
69,230
109,85
161,77
186,96
229,04
267,65
306,25
345,86
385,47
0
0,0175
0,0879
0,1730
0,2521
0,3140
0,4017
0,4755
0,5521
0,6286
0,7051
0,7816
in p
Gi tr m
hin th V0 men (Nm)
Ln th nghim 3
0
7,8878
34,397
68,090
99,220
123,59
158,11
187,17
217,29
247,41
276,53
305,65
0
0,0850
0,2199
0,3277
0,4245
0,5170
0,5880
0,7107
0,8107
0,9108
1,0109
1,1110
0
31,455
86,550
128,98
167,08
203,49
231,43
279,71
319,10
358,50
398,89
433,28
Gi tr m men (Nm)
450
400
350
300
th nghim ln 1
250
th nghim ln 2
200
th nghim ln 3
150
100
50
0
0
0,2
0,4
0,6
0,8
1,2
in p Vo (V)
http://www.lrc-tnu.edu.vn/
3. nh gi kt qu v nhn xt
xc nh c gi tr in p u ra khi c m men xon tc dng. Xy
dng c phng trnh ch ra mi quan h gia in p v m men
- Nghin cu la chn b khuych i 3B18, b x l Ardunio gim bt
s phc tp trong tnh ton v thit k phn cng. Kt qu th nghim cho thy
thit b sau khi ch to p ng c yu cu t ra cho bi ton x l tn hiu
strain gauge ng dng trong vic o m men xon.
4. Kt lun v hng nghin cu tip theo
- Kt lun:
+ Tc gi bc u nghin cu, ch to thnh cng thit b o m
men xon trn trc quay. Tuy nhin do iu kin nghin cu ch to trong
nc nh l ti liu, h thng phng th nghim v c nhng vn v ti
chnh cn kh khn thiu thn nn chnh xc, tin cy ca tn hiu ca
thit b vn cha cao.
+ Thit k, ch to mch o lng strain gauge, b ngun, b khuych
i, b x l v kt ni thnh cng mn hnh hin th.
- Hng nghin cu tip theo:
+ Hon thin h thng o m men xon trn trc quay vi s phi hp
ca cc chuyn gia v in t nng cao chnh xc ca thit b.
+ Nghin cu v vn ng sut mi ca cm bin, tnh n nh
ca h thng, nh hng ca nhit n chnh xc ca thit b
http://www.lrc-tnu.edu.vn/
5. Mt s hnh nh ca thit b
Hnh 4.3. Hnh nh kim tra nhy xon ca thit b sau khi dn strain gauge
bng mn hnh hin tr Daytronic 3570.
http://www.lrc-tnu.edu.vn/
http://www.lrc-tnu.edu.vn/
http://www.lrc-tnu.edu.vn/
http://www.lrc-tnu.edu.vn/
// return;
}
tmp=readad();
//tmp=0;
}
void loop()
{
out=readad()-tmp;
toBCD(out);
state=digitalRead(sw);
//if (sw==HIGH) toBCD(out); else toBCD(out/400);
for (int i=4; i >= 0; i--){
writeled(i,dataout[i]);
delay(2);
}
}
float momen(float input){
return (input-hs2)/hs1;
}
//
float mapad(float x, float in_min, float in_max, float out_min, float out_max)
{
return (x - in_min) * (out_max - out_min) / (in_max - in_min) + out_min;
}
///
float readad(){
Value = analogRead(sensor);
if (abs(Value-oldvalue)>0){
old=mapad(Value,0,1023,0,maxin);
oldvalue=Value;
return old;
} else return old;
}
void writesd(int value){
myFile = SD.open("example.txt", FILE_WRITE);
myFile.println(value);
myFile.close();
}
void writeled(int pos, int num)
{
// turn off all of leds
digitalWrite(led_A,HIGH);
digitalWrite(led_B,HIGH);
digitalWrite(led_C,HIGH);
// OUT NUMBER FOR PRINTING
S ha bi Trung tm Hc liu - HTN
http://www.lrc-tnu.edu.vn/
switch (num) {
case 0:
digitalWrite(data_D,LOW);
digitalWrite(data_C,LOW);
digitalWrite(data_B,LOW);
digitalWrite(data_A,LOW);
break;
case 1:
digitalWrite(data_D,LOW);
digitalWrite(data_C,LOW);
digitalWrite(data_B,LOW);
digitalWrite(data_A,HIGH);
break;
case 2:
digitalWrite(data_D,LOW);
digitalWrite(data_C,LOW);
digitalWrite(data_B,HIGH);
digitalWrite(data_A,LOW);
break;
case 3:
digitalWrite(data_D,LOW);
digitalWrite(data_C,LOW);
digitalWrite(data_B,HIGH);
digitalWrite(data_A,HIGH);
break;
case 4:
digitalWrite(data_D,LOW);
digitalWrite(data_C,HIGH);
digitalWrite(data_B,LOW);
digitalWrite(data_A,LOW);
break;
case 5:
digitalWrite(data_D,LOW);
digitalWrite(data_C,HIGH);
digitalWrite(data_B,LOW);
digitalWrite(data_A,HIGH);
break;
case 7:
digitalWrite(data_D,LOW);
digitalWrite(data_C,HIGH);
digitalWrite(data_B,HIGH);
digitalWrite(data_A,HIGH);
break;
case 8:
digitalWrite(data_D,HIGH);
digitalWrite(data_C,LOW);
digitalWrite(data_B,LOW);
digitalWrite(data_A,LOW);
S ha bi Trung tm Hc liu - HTN
http://www.lrc-tnu.edu.vn/
break;
case 9:
digitalWrite(data_D,HIGH);
digitalWrite(data_C,LOW);
digitalWrite(data_B,LOW);
digitalWrite(data_A,HIGH);
}
/// TURN ON LED
switch (pos) {
case 0:
digitalWrite(led_A,LOW);
digitalWrite(led_B,LOW);
digitalWrite(led_C,LOW);
digitalWrite(Point,HIGH);
break;
case 1:
digitalWrite(led_A,HIGH);
digitalWrite(led_B,LOW);
digitalWrite(led_C,LOW);
digitalWrite(Point,HIGH);
break;
case 2:
digitalWrite(led_A,LOW);
digitalWrite(led_B,HIGH);
digitalWrite(led_C,LOW);
digitalWrite(Point,LOW);
break;
case 3:
digitalWrite(led_A,HIGH);
digitalWrite(led_B,HIGH);
digitalWrite(led_C,LOW);
digitalWrite(Point,LOW);
break;
case 4:
digitalWrite(led_A,LOW);
digitalWrite(led_B,LOW);
digitalWrite(led_C,HIGH);
digitalWrite(Point,LOW);
}
}
void toBCD(float num){
long newnum=(long)(num*pow(10,4));
for (int i=4;i>=0;i--){
dataout[i]=newnum%10;
newnum=newnum/10;
}
S ha bi Trung tm Hc liu - HTN
http://www.lrc-tnu.edu.vn/
http://www.lrc-tnu.edu.vn/