Thiết kế, chế tạo thiết bị đo momen dạng cầm tay

i ĐẠI HỌC THÁI NGUYÊN TRƢỜNG ĐẠI HỌC KỸ THUẬT CÔNG NGHIỆP - NGUYỄN HỮU QUÂN THIẾT KẾ, CHẾ TẠO THIẾT BỊ ĐO MOMEN DẠNG CẦM TAY Chuyên ngành: Kỹ thuật khí Mã số : 60.52.01.03 LUẬN VĂN THẠC SĨ KỸ THUẬT NGƢỜI HƢỚNG DẪN KHOA HỌC PGS.TS NGÔ NHƢ KHOA THÁI NGUYÊN – NĂM 2015 Số hóa Trung tâm Học liệu Tai ngay!!! Ban co the xoa dong chu nay!!! http://www.lrc-tnu.edu.vn/ ii LỜI CAM ĐOAN Tôi là: Nguyễn Hữu Quân - Học viên cao học lớp K14 chuyên ngành Kỹ thuật Cơ khí, khóa 2011 - 2013 trƣờng Đại học Kỹ thuật Công nghiệp - Đại học Thái Nguyên Sau hai năm học tập, rèn luyện nghiên cứu trƣờng, lựa chọn thực đề tài tốt nghiệp “ Thiết kế, chế tạo thiết bị đo momen dạng cầm tay” Đƣợc giúp đỡ hƣớng dẫn tận tình Thầy giáo PGS.TS Ngơ Nhƣ Khoa nỗ lực thân, đề tài đƣợc hồn thành Tơi xin cam đoan số liệu kết nêu Luận văn trung thực chƣa đƣợc công bố cơng trình khác Thái Ngun, ngày 27 tháng 12 năm 2014 Học viên Nguyễn Hữu Quân Số hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/ iii LỜI CẢM ƠN Lời tơi xin bày tỏ lịng biết ơn chân thành tới PGS.TS Ngơ Nhƣ Khoa Thầy tận tình hƣớng dẫn tơi suốt q trình nghiên cứu hồn thành luận văn Tơi xin chân thành cảm ơn Ban giám hiệu trƣờng Đại học Kỹ thuật Công nghiệp, Phòng quản lý đào tạo sau đại học, Khoa Cơ khí mơn Chế tạo máy tạo điều kiện thuận lợi cho tơi q trình học tập, nghiên cứu thực luận văn Tôi xin gửi lời cảm ơn chân thành tới Chú Nguyễn Đức Dũng – Xƣởng khí Dũng Trình học viên Nguyễn Thu Hƣờng lớp cao học Khóa K15 giúp đỡ Tôi thời gian Tôi triển khai thực đê tài Cuối Tôi muốn bày tỏ lịng cảm ơn gia đình tơi, bạn bè ủng hộ động viên Tôi suốt trình làm luận văn Xin trân trọng cảm ơn! Tác giả Nguyễn Hữu Quân Số hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/ iv MỤC LỤC LỜI CAM ĐOAN i LỜI CẢM ƠN iii MỤC LỤC iv DANH MỤC CÁC KÝ HIỆU VÀ CHỮ VIẾT TẮT vi DANH MỤC CÁC HÌNH ẢNH viii DANH MỤC BẢNG BIỂU .x CHƢƠNG .1 TỔNG QUAN VỀ THIẾT BỊ ĐO MOMEN DẠNG DỤNG CỤ 1.1 Thiết bị đo momen xoắn dạng phản lực 1.2 Thiết bị đo momen xoắn dạng nối tiếp CHƢƠNG .5 CƠ SỞ TÍNH TỐN VÀ THIẾT KẾ .5 2.1 Thiết bị cảm biến strain gauge phƣơng pháp đo biến dạng 2.2 Mạch cầu đo biến dạng .10 Mạch cầu Wheatston’s Bridge .11 a Mạch cầu nhánh 13 b Mạch cầu hai nhánh 14 c Mạch cầu đầyđủ 16 CHƢƠNG 19 THIẾT KẾ VÀ CHẾ TẠO TRỤC ĐO 19 3.1 Hệ thức liên quan tới trục tròn rỗng chịu xoắn 19 Hình 3.1 Sự phân bố ứng suất mặt cắt ngang trục trịn chịu xoắn 19 3.2 Tính toán, thiết kế trục đo .20 3.2.1 Tính tốn kích thƣớc trục đo 20 3.2.2 Bản vẽ chế tạo trục mẫu 22 3.3 Chọn thiết bị cảm biến strain gauge 25 3.4 Chọn loại keo dán strain gauge 28 Số hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/ v 3.5 Thiết kế mạch hiển thị 31 NGHIÊN CỨU THỰC NGHIỆM ĐỂ XÁC ĐỊNH ĐẶC TÍNH CỦA TRỤC ĐO 34 4.1 Thí nghiệm 34 4.2 Kết thí nghiệm 36 TÀI LIỆU THAM KHẢO .43 PHỤ LỤC 44 Bảng kết đo giá trị điện áp momen giá trị điện áp biến dạng trục đo 44 Chƣơng trình chạy mạch hiển thị giá trị điện áp biến dạng 45 Số hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/ vi DANH MỤC CÁC KÝ HIỆU VÀ CHỮ VIẾT TẮT Kí hiệu STT Diễn giải nội dung đầy đủ R Điện trở ρ Điện trở suất L Chiều dài dây dẫn A Diện tích dây dẫn GF Hệ số cảm biến biến dạng υ hệ số poisson e, Vout Điện áp đầu Vin Điện áp đầu vào S Độ cảm biến 10  Biến dạng dài 11 T Biến dạng dài nhiệt 12  Ứng suất cắt 13  Ứng suất pháp 14 G Modun đàn hồi cắt 15 E Modun đàn hồi 16 r Bán kính trục chịu xoắn 17 d Đƣờng kính trục chịu xoắn 18 t Chiều dày trục rỗng Biến dạng cắt 19  20 Jp Momen quán tính 21 Wp Momen chống xoắn 22 MZ Momen xoắn 23 υ hệ số poisson 24  n Góc xoắn tỉ đối 25 hệ số an tồn Số hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/ vii 26 TT Biến dạng tính tốn 27 D Biến dạng đo 28 Vout QĐ Điện áp đầu quy đổi theo điện áp biến dạng trục đo 29 Vout Mz Điện áp momen Mz 30 KB Hệ số khuếch đại thiết bị 3B18 31 ∆% Sai số Số hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/ viii DANH MỤC CÁC HÌNH ẢNH Số hiệu Nội dung Trang Hình 1.1 Thiết bị đo momen dạng dụng cụ cầm tay Hình 1.2 Thiết bị đo momen dạng phản lực Hình 1.3 Cấu tạo dụng cụ đo momen dạng phản lực Hình 1.4 Thiết bị đo momen dạng phản lực Hình 1.5 Thiết bị đo momen dạng nối tiếp Hình1.6 Trục mẫu dán strain gauge Hình 2.1 Sơ đồ xác định momen xoắn – góc xoắn Hình 2.2 Biến dạng dài trục xoắn Hình 2.3 Cấu tạo cảm biến strain gauge Hình 2.4 Các dạng cảm biến strain gauge Hình 2.5 Biến dạng dây điện trở strain gauge Hình 2.6 Ngun lí ánh xạ dịng điện Hình 2.7 Mạch cầu Wheatston’s Bridge nhánh 11 Hình 2.8 Mạch cầu Wheatston’s Bridge nhánh 12 Hình 2.9 Mạch cầu Wheatston’s Bridge nhánh 13 Hình 2.10 Trục mẫu chịu xoắn dán strain gauge 14 Hình 2.11 Sơ đồ nguyên lí chế tạo trục đo momen xoắn 15 Hình 3.1 Sự phân bố ứng suất trục trịn chịu xoắn 16 Hình 3.2 Vịng trịn Morh ứng suất xoắn túy 16 Hình 3.3 Bản vẽ chế tạo trục đo 20 Hình 3.4 Strain gauge đo biến dạng dài thơng thƣờng 21 Hình 3.5 strain gauge đo biến dạng theo phƣơng vng góc 22 Hình 3.6 Strain gauge rosete hình chữ nhật 23 Hình 3.7 strain gauge đo biến dạng cắt 23 Hình 3.8 Keo dán extra 4000 25 Hình 3.9 Silicon chống nhiễu cho strain gauge 25 Số hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/ ix Hình 3.11 Trục đo dán strain gauge 27 Hình 3.12 Sơ đồ mạch khuếch đại thiết bị analog 3B18 28 Hình 3.13 Thiết bị analog 3B18 28 Hình 3.14 sơ đồ đấu nguồn cho khuếch đại 3B18 28 Hình 3.15 sơ đồ mạch hiển thị giá trị momen cho dụng cụ đo 29 Hình 4.1 Thí nghiệm xác định biến dạng trục đo 36 Hình 4.2 Đồ thị mối tƣơng quan momen – biến dạng 39 Bảng 4.2 Bảng tính tốn sai số kết đo 41 Số hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/ x DANH MỤC BẢNG BIỂU Số hiệu Nội dung Trang Bảng 3.1 Bảng thành phần hóa học thép 18Mn2Si 18 Bảng 3.2 Bảng tính thép 18Mn2Si 18 Bảng 3.3 Bảng ứng suất cắt cho phép 18 Bảng 3.4 Bảng đƣờng kính trục đo 18 Bảng 3.5 Bảng vật liệu chế tạo cảm biến strain gauge 21 Bảng 3.6 Bảng hệ số strain gauge 24 Bảng 3.7 Bảng loại keo dán strain gauge 24 Bảng 3.8 Bảng thơng số thiết bị analog 3B18 27 Bảng tính tốn giá trị momen – biến dạng – giá trị điện Bảng 4.1 áp 38 Bảng 4.2 Bảng tính tốn sai số kết đo 41 Bảng tính tốn giá trị momen – điệp áp đầu thiết Bảng 4.3 bị 3B18 43 Bảng Bảng giá trị điện áp momen giá trị điện áp biến dạng 48 Số hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/ 37 53,26 6,08495E-05 115,33 0,000134527 177,78 0,00019176 Bảng 4.1 Bảng tính tốn giá trị momen – biến dạng – giá trị điện áp Từ bảng 4.1 xây dựng phƣơng trình cho kết đo đƣợc xác định lại giá trị modun đàn hồi E cho vật liệu trục đo nhƣ sau: MZ(N.m) 200.00 MZ = 893919ε R² = 0,9954 180.00 160.00 140.00 120.00 100.00 80.00 60.00 40.00 20.00 ε 0.00 0.00005 0.0001 0.00015 0.0002 0.00025 Hình 4.3 Đồ thị mối tương quan momen – biến dạng Phƣơng trình Mz = 893919 ε (1) phƣơng trình đặc trƣng cho mối tƣơng quan momen – biến dạng vật liệu 18Mn2Si Do q trình tính tốn, thiết kế trục đo tác giả tra cứu lấy giá trị modun đàn hồi chung cho loại thép E = 200GPa Tuy nhiên, thực tế loại vật liệu có giá trị modun đàn hồi riêng Vì việc tiến hành thí nghiệm xây dựng phƣơng trình momen – biến dạng thép 18Mn2Si cho phép xác định lại giá trị modun đàn hồi thực tế thép 18Mn2Si Từ dạng phƣơng trình đƣờng thẳng bậc nhất: y = kx, với k hệ số góc đƣờng thẳng Theo (3.13), bảng 3.2, 3.4 phƣơng trình (1) rút đƣợc hệ thức: Số hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/ 38  E (1   ) MZ  MZ EWP 893919 893919(1   ) 893919(1  0,3)   210,65.109 ( N / m2 )  210,65(GPa) 9 WP 5516,76.10 Việc xác định lại giá trị modun E cho vật liệu 18Mn2Si dùng để xây dựng liệu để thiết kế mạch hiển thị giá trị momen cho trục đo nhƣ sau: Mz (N.m) 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 ε Vout(mV) 1,11866E-06 2,23732E-06 3,35598E-06 4,47464E-06 5,5933E-06 6,71195E-06 7,83061E-06 8,94927E-06 1,00679E-05 1,11866E-05 1,23053E-05 1,34239E-05 1,45426E-05 1,56612E-05 1,67799E-05 1,78985E-05 1,90172E-05 2,01359E-05 2,12545E-05 2,23732E-05 2,34918E-05 2,46105E-05 2,57292E-05 2,68478E-05 2,79665E-05 2,30444E-05 4,60888E-05 6,91331E-05 9,21775E-05 0,000115222 0,000138266 0,000161311 0,000184355 0,000207399 0,000230444 0,000253488 0,000276533 0,000299577 0,000322621 0,000345666 0,00036871 0,000391754 0,000414799 0,000437843 0,000460888 0,000483932 0,000506976 0,000530021 0,000553065 0,000576109 Số hóa Trung tâm Học liệu Mz (N.m) 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 ε Vout(mV) 3,46784E-05 3,57971E-05 3,69158E-05 3,80344E-05 3,91531E-05 4,02717E-05 4,13904E-05 4,2509E-05 4,36277E-05 4,47464E-05 4,5865E-05 4,69837E-05 4,81023E-05 4,9221E-05 5,03397E-05 5,14583E-05 5,2577E-05 5,36956E-05 5,48143E-05 5,5933E-05 5,70516E-05 5,81703E-05 5,92889E-05 6,04076E-05 6,15263E-05 0,000714376 0,00073742 0,000760464 0,000783509 0,000806553 0,000829598 0,000852642 0,000875686 0,000898731 0,000921775 0,00094482 0,000967864 0,000990908 0,001013953 0,001036997 0,001060041 0,001083086 0,00110613 0,001129175 0,001152219 0,001175263 0,001198308 0,001221352 0,001244396 0,001267441 http://www.lrc-tnu.edu.vn/ 39 26 27 28 29 30 2,90851E-05 3,02038E-05 3,13225E-05 3,24411E-05 3,35598E-05 0,000599154 0,000622198 0,000645243 0,000668287 0,000691331 56 57 58 59 60 6,26449E-05 6,37636E-05 6,48822E-05 6,60009E-05 6,71195E-05 0,001290485 0,00131353 0,001336574 0,001359618 0,001382663 Bảng 4.3 Bảng liệu xây dựng mạch khuếch điệp áp đầu thiết bị 3B18 Mz (N.m) 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 ε Vout(mV) 6,82382E-05 6,93569E-05 7,04755E-05 7,15942E-05 7,27128E-05 7,38315E-05 7,49502E-05 7,60688E-05 7,71875E-05 7,83061E-05 7,94248E-05 8,05435E-05 8,16621E-05 8,27808E-05 8,38994E-05 8,50181E-05 8,61368E-05 8,72554E-05 8,83741E-05 8,94927E-05 9,06114E-05 9,173E-05 9,28487E-05 9,39674E-05 9,5086E-05 0,00140571 0,00142875 0,0014518 0,00147484 0,00149788 0,00152093 0,00154397 0,00156702 0,00159006 0,00161311 0,00163615 0,0016592 0,00168224 0,00170528 0,00172833 0,00175137 0,00177442 0,00179746 0,00182051 0,00184355 0,00186659 0,00188964 0,00191268 0,00193573 0,00195877 Số hóa Trung tâm Học liệu Mz (N.m) 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 ε Vout(mV) 0,000101798 0,000102917 0,000104035 0,000105154 0,000106273 0,000107391 0,00010851 0,000109629 0,000110747 0,000111866 0,000112985 0,000114103 0,000115222 0,000116341 0,000117459 0,000118578 0,000119697 0,000120815 0,000121934 0,000123053 0,000124171 0,00012529 0,000126408 0,000127527 0,000128646 0,002097038 0,002120083 0,002143127 0,002166172 0,002189216 0,00221226 0,002235305 0,002258349 0,002281393 0,002304438 0,002327482 0,002350527 0,002373571 0,002396615 0,00241966 0,002442704 0,002465748 0,002488793 0,002511837 0,002534882 0,002557926 0,00258097 0,002604015 0,002627059 0,002650103 http://www.lrc-tnu.edu.vn/ 40 86 87 88 89 90 9,62047E-05 9,73233E-05 9,8442E-05 9,95607E-05 0,000100679 0,00198182 0,00200486 0,00202791 0,00205095 0,00207399 116 117 118 119 120 0,000129764 0,000130883 0,000132002 0,00013312 0,000134239 0,002673148 0,002696192 0,002719237 0,002742281 0,002765325 Bảng 4.3 Bảng liệu xây dựng mạch khuếch điệp áp đầu thiết bị 3B18 Mz (N.m) 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 ε Vout(mV) 0,000135358 0,000136476 0,000137595 0,000138714 0,000139832 0,000140951 0,00014207 0,000143188 0,000144307 0,000145426 0,000146544 0,000147663 0,000148782 0,0001499 0,000151019 0,000152138 0,000153256 0,000154375 0,000155494 0,000156612 0,000157731 0,00015885 0,000159968 0,000161087 0,00278837 0,002811414 0,002834459 0,002857503 0,002880547 0,002903592 0,002926636 0,00294968 0,002972725 0,002995769 0,003018814 0,003041858 0,003064902 0,003087947 0,003110991 0,003134035 0,00315708 0,003180124 0,003203169 0,003226213 0,003249257 0,003272302 0,003295346 0,00331839 Số hóa Trung tâm Học liệu Mz (N.m) 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 ε Vout(mV) 0,000191291 0,000192409 0,000193528 0,000194647 0,000195765 0,000196884 0,000198003 0,000199121 0,00020024 0,000201359 0,000202477 0,000203596 0,000204715 0,000205833 0,000206952 0,000208071 0,000209189 0,000210308 0,000211427 0,000212545 0,000213664 0,000214783 0,000215901 0,00021702 0,003940589 0,003963633 0,003986677 0,004009722 0,004032766 0,004055811 0,004078855 0,004101899 0,004124944 0,004147988 0,004171032 0,004194077 0,004217121 0,004240166 0,00426321 0,004286254 0,004309299 0,004332343 0,004355387 0,004378432 0,004401476 0,004424521 0,004447565 0,004470609 http://www.lrc-tnu.edu.vn/ 41 145 146 147 148 149 150 0,000162206 0,000163324 0,000164443 0,000165562 0,00016668 0,000167799 0,003341435 0,003364479 0,003387524 0,003410568 0,003433612 0,003456657 195 196 197 198 199 200 0,000218139 0,000219257 0,000220376 0,000221495 0,000222613 0,000223732 0,004493654 0,004516698 0,004539743 0,004562787 0,004585831 0,004608876 Bảng 4.3 Bảng liệu xây dựng mạch khuếch điệp áp đầu thiết bị 3B18 Kết tính tốn bảng 4.3 dùng để xây dựng phƣơng trình dùng để thiết kế mạch khuếch đại hiển thị giá trị momen cho trục đo tiến hành đo momen nhƣ sau: 0.005 Vout = 2E-05Mz R² = 0.0045 0.004 Vout (mV) 0.0035 0.003 0.0025 0.002 0.0015 0.001 0.0005 0 50 100 150 200 250 Mz (N.m) Hình 4.4 Đồ thị mối tương quan momen – biến dạng Phƣơng trình Vout = 2.10-5 Mz (mV) dùng đê thiết kế mạch khuếch đại hiển thị giá trị momen tƣơng ứng với đơn vị biến dạng trục đo Số hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/ 42 4.3 Kết luận 4.3.1 Những kết đạt đƣợc - Đã thiết kế chế tạo thành công thiết bị đo mô men xoắn cầm tay với khoảng đo từ ÷ 200 Nm Qua đó: + Làm chủ đƣợc cơng nghệ dán, sử dụng Strain gauge trục kim loại + Làm chủ đƣợc thiết kế kích thƣớc trục chịu xoắn giải đo momen xoắn khác + Thiết bị đo momen xoắn có độ xác cao thể đồ thị (hình 4.3) với sai số 1- R2= 0,0056 + Thiết bị sau chế tạo đƣợc kiểm nghiệm với thiết bị đo momen xoắn dạng phản lực (Wrench) có bán thị trƣờng nhận thấy chêch lệch giá trị momen hiển thị nhỏ khoảng 1,7% 4.3.3 Những điểm hạn chế hƣớng khắc phục - Kích thƣớc thiết bị chƣa thu gọn nhƣ thiết bị có bán thị trƣờng - Để tiến tới sản phẩm có tính thƣơng mại cần có điều kiện sau: + Đầu tƣ thiết bị thí nghiệm hiệu chỉnh có độ xác cao + Thiết kế, chế tạo khuếch đại hiển thị chuyên dùng + Có nhu cầu đặt hang thiết bị Số hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/ 43 TÀI LIỆU THAM KHẢO Trịnh Chất – Lê Văn Uyển, Tính tốn thiết kế hệ dẫn động khí tập 1, 2 PGS Hà Văn Vui, TS Nguyễn Chỉ Sáng, THs Phan Đăng Phong, Sổ tay thiết kế khí tập 1, 2, 3 Hồng Thắng Lợi, Bài giảng sức bền vật liệu Jame M Gere, Mechanics al of materials, sixth edition Practical strain gage measurement Website: www.omega.com/techref/pdf/StrainGage_Measurement.pdf Số hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/ 44 PHỤ LỤC Bảng kết đo giá trị điện áp momen giá trị điện áp biến dạng trục đo D (mV) Vout  (mV) Vout QĐ Vout (mV) 0,012 0,0499 0,014 0,041 0,036 0,12 0,05 0,1935 0,088 0,3343 0,089 0,3401 0,114 0,4193 0,139 0,5014 0,14 0,53 0,154 0,5982 0,212 0,7243 0,22 0,8475 0,223 0,8475 0,277 0,953 0,297 1,0117 0,301 1,1085 0,302 1,1173 0,348 1,2111 0,375 1,3372 0,394 1,39 0,41 1,4144 0,427 1,48888 0,442 1,5307 0,464 1,5801 0,00012475 0,0001025 0,0003 0,00048375 0,00083575 0,00085025 0,00104825 0,0012535 0,001325 0,0014955 0,00181075 0,00211875 0,00211875 0,0023825 0,00252925 0,00277125 0,00279325 0,00302775 0,003343 0,003475 0,003536 0,0037222 0,00382675 0,00395025 Bảng Bảng giá trị điện áp momen giá trị điện áp biến dạng Số hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/ 45 Chƣơng trình chạy mạch hiển thị giá trị điện áp biến dạng #include File myFile; /// int maxin=5; /// float hs1=0.01568; float hs2=0.0156; // const int data_A = 3; const int data_B = 4; const int data_C = 5; const int data_D = 6; //// const int led_A = 8; const int led_B = 9; const int led_C = 10; const int Point = 11; /// int sensor = A0; int Value = 0; float out =0; float old =0; float tmp; // int dataout[]={4,5,6,7,8}; int rest=5; //////////////// void setup() { Số hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/ 46 // set the digital pins as outputs: pinMode(data_A, OUTPUT); pinMode(data_B, OUTPUT); pinMode(data_C, OUTPUT); pinMode(data_D, OUTPUT); pinMode(led_A, OUTPUT); pinMode(led_B, OUTPUT); pinMode(led_C, OUTPUT); pinMode(Point, OUTPUT); /// if (!SD.begin(4)) { // digitalWrite(5,HIGH); // return; } } void loop() { tmp=readad(); out=momen(tmp); if (abs(out-old)>=0.0001){ toBCD(out); old=out; } for (int i=4; i >= 0; i ){ writeled(i,dataout[i]); delay(2); } } Số hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/ 47 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); return mapad(Value,0,1023,0,maxin); } 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 switch (num) { case 0: digitalWrite(data_D,LOW); digitalWrite(data_C,LOW); digitalWrite(data_B,LOW); Số hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/ 48 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); Số hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/ 49 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); 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: Số hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/ 50 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ố hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/ 51 } Số hóa Trung tâm Học liệu http://www.lrc-tnu.edu.vn/