BÀI tập lớn XE dò ĐƯỜNG

ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG NHẬN XÉT CỦA GIẢNG VIÊN HƯỚNG DẪN ……………………………………………………………………………… …… …………………………………………………………………… ……………… ………………………………………………………… ………………………… ……………………………………………… …………………………………… …………………………………… ……………………………………………… ………………………… ………………………………………………………… ……………… …………………………………………………………………… …… ……………………………………………………………………………… ………………………………………………………………………… ………… ……………………………………………………………… …………………… …………………………………………………… ……………………………… ………………………………………… ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG LỜI NÓI ĐẦU Trong sống hàng ngày bắt gặp hệ thống tự động hóa khắp nơi nói đóng vai trò ngày quan trọng sống nay.Điều khiển tự động có nhiều ứng dụng thiết yếu chi phối sống Một ứng dụng quan trọng robot Robot ngày đóng vai trò quan trọng nhà máy công nghiệp sống, robot thay người làm công việc khác nhau, đặc biệt công việc nguy hiểm Robot tổng hợp tất kiến thức khí, mạch điện, điều khiển… Lĩnh vực robot di động ngày dành quan tâm người Đặc biệt robot dò đường vấn đề quan trọng robot di động Cũng mục đích mà nhóm sinh viên chúng em thực tập lớn tìm hiều robot dò đường Đây bước khởi đầu việc chế tạo lập trình robot Trong trình tìm hiểu thiết kế chúng em rút nhiều kinh nghiệm quý báu để phục vụ trình học tập tiếp tục tìm hiều vấn đề phúc tạp Mặc dù có cố gắng việc hoàn thành tập lớn không tránh khỏi thiếu sót Nhóm sinh viên thực chúng em mong nhận ý kiến đóng góp từ thầy cô bạn bè Hà Nội, 11-2015 Giáo viên hướng dẫn Sinh viên thực Nguyễn Thế Ngọc Lưu Văn Nam ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG MỤC LỤC LỜI NÓI ĐẦU………………………………………………………… PHẦN 1: NHIỆM VỤ BÀI TẬP LỚN …………………………… I Thông tin sinh viên………………………………………………… II Thông tin đề tài…………………………………………………… PHẦN : TỔNG QUAN VỀ ROBOT………………………………… I Lịch sử phát triển………………………………………………… II Ứng dụng robot……………………………………………… PHẦN : ROBOT DÒ ĐƯỜNG……………………………………… I Giới thiệu robot dò đường……………………………………… II Mục đích yêu cầu…………………………………………… III Nguyên tắc hoạt đông….……………………………………… IV Ứng dụng xe dò đường…………………………………… V Thiết kế khí…….…………………………………………… VI Thiết kế mạch điều khiển…………………………………… 12 VII Xây dựng chương trình lập trình……………………………… 36 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG PHẦN 1: NHIỆM VỤ BÀI TẬP LỚN I THÔNG TIN SINH VIÊN Sinh viên thực hiện: NGUYỄN THẾ NGỌC LƯU VĂN NAM Lớp : Đ7 - CƠ ĐIỆN TỬ II THÔNG TIN ĐỀ TÀI Tên đề tài: TÌM HIỂU VÀ THIẾT KẾ ROBOT DÒ ĐƯỜNG PHẦN TỔNG QUAN VỀ ROBOT I LỊCH SỬ PHÁT TRIỂN Từ thời cổ xưa người mong muốn tạo vật giống để bắt chúng phục vụ phải thoả mãn ba nguyên tắc sau: - Robot không xúc phạm người không gây tổn hại cho người - Hoạt động robot phải tuân theo quy tắc người đặt ra, quy tắc không vi phạm nguyên tắc thứ - Một robot phải bảo vệ sống không vi phạm hai nguyên tắc Các nguyên tắc trở thành tảng cho việc thiết kế robot, robot giống máy đặc biệt để thay người công việc lặp lặp lại, nhàm chán, nặng nhọc, vận chuyển, lắp ráp, môi trường khắc nghiệt không gian vũ trụ, lòng đất, lò phản ứng hạt nhân… Thuật ngữ ‘Robot’ bắt đầu xuất từ năm 1921 kịch Đầu thập kỉ 60 công ty Mỹ AMF quảng cáo lạo máy tự động vạn gọi ‘Người máy công nghiệp’ ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG Tiếp theo mọt loạt nước bắt đầu sản xuất robot Anh1967, Thụy Điển Nhật Bản-1968, Đức-1971, Pháp-1973… Năm 1974 công ty Cincinnati đưa loại robot điều khiển máy tính gọi robot T3 Trong năm gần lĩnh vực chế tạo robot ngày phát triển, robot ngày tích hợp nhiều chức để nhận biết nhiều việc Vì mà robot không đóng vai trò quan trọng sản xuất mà cón đóng vai trò quan trọng sống hàng ngày II ỨNG DỤNG CỦA ROBOT Từ đời robot áp dụng nhiều lĩnh vực nhằm thay sức lao động người Trong nghành khí robot sử dụng nhiều dây chuyền đúc, hàn, cắt kim loại, sơn phun phủ… Robot có khả làm việc điều kiện vượt khả người Robot xuất hầu hết dây chuyền sản xuất công nghiệp, ứng dụng nhiều lĩnh vực y học, khai thác nguyên nhiên liệu, quốc phòng, công nghiệp nguyên tử, lĩnh vực xã hội sống hàng ngày… PHẦN ROBOT DÒ ĐƯỜNG I GIỚI THIỆU ROBOT DÒ ĐƯỜNG Robot tự hành (Mobile Robot) thành phần có vai trò quan trọng ngành Robot học Một vấn đề quan tâm nghiên cứu robot tự hành làm để robot di chuyển tới vị trí xác định mà tự động tránh chướng ngại vật đường ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG Robot tự hành định nghĩa loại xe robot có khả tự dịch chuyển, tự vận động (có thể lập trình lại được) điền khiển tự động để thực thành công công việc giao Môi trường hoạt động robot tự hành đất, nước, không khí, không gian vũ trụ hay tổ hợp chúng Địa hình bề mặt mà robot di chuyển phẳng hay thay đổi, lồi lõm Tiềm ứng dụng robot tự hành rộng lớn Có thể kể đến robot vận chuyển vật liệu, hàng hóa tòa nhà, nhà máy, cửa hàng, sân bay thư viện, robot phục vụ quét dọn đường phố, khoang chân không, robot kiểm tra môi trường nguy hiểm, robot canh gác, thám, robot khám phá không gian, di chuyển hành tinh, robot hàn, sơn nhà máy, robot xe lăn phục vụ người khuyết tật, robot phục vụ sinh hoạt gia đình v.v II MỤC ĐÍCH VÀ YÊU CẦU Tìm hiểu thiết kế robot dò đường theo đường đen kẻ sẵn III NGUYÊN TẮC HOẠT ĐỘNG Xe dò đường chuyển động theo quỹ đạo định trước nhờ vạch dẫn, hệ thống bánh xe phía sau dẫn động động chiều thông qua mạch điều khiển, bánh xe phía trước có nhiệm vụ dẫn hướng chuyển hướng thông qua mạch điều khiển Đường xe dò đường thường có màu sắc khác so với màu quỹ đạo chuyển động xe Bộ phận chịu trách nhiệm nhận biết đường cho xe phận cảm biến, phận cảm biến nhận biết đường đưa tín hiệu mạch điều khiển Mạch điều khiển có nhiệm vụ tiếp nhận phân tích tín hiệu để từ ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG điều khiển tốc độ chiều quay động bánh sau cho xe theo đường có vạch sẵn IV ỨNG DỤNG CỦA XE DÒ ĐƯỜNG Xe dò đường ứng dụng nhiều vận chuyển hàng hóa, việc dò đường khu vực nguy hiểm hay khu vực mà người khó tiếp cận lòng đất, đại dương, không gian(trên hành tinh) … V THIẾT KẾ CƠ KHÍ Cấu tạo Các thành phần xe + B1: Bánh xe + DC1: Động + B2: Bánh xe + DC2: Động + B3: Bánh xe + DC3: Động ĐẠI HỌC ĐIỆN LỰC + B4: Bánh xe XE DÒ ĐƯỜNG + DC4: Động + MDK: Khối mạch điều khiển + CB: Khối cảm biến Cấu trúc robot dò đường gồm: Tên Hình ảnh Khung xe Động có hộp giảm tốc Bánh xe để gắn với trục động ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG Nguồn(pin) Đế pin Mạch điều khiển Mạch cảm biến ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG Mạch điều khiển động Mạch nguồn Các loại đai ốc bu lông Mô hình thực tế 10 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG break; case 3: robotMover( inR1, inR2, inL1, inL2, 5);// quay trái break; } } void robotMover (byte inR1, byte inR2, byte inL1, byte inL2, byte action) { inR1 inR2 chân tín hiệu động bên phải inL1 inL2 chân tín hiệu động bên trái action= đứng yên action =1 thẳng action =2 lùi lại action =3 quay trái action =4 quay phải action =5 rẽ trái action =6 rẽ phải switch (action) { case 0:// không di chuyển motorControlNoSpeed(inR1, inR2, 0); motorControlNoSpeed(inL1, inL2, 0); break; case 1://đi thẳng motorControlNoSpeed(inR1, inR2, 1); 44 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG motorControlNoSpeed(inL1, inL2, 1); break; case 2:// lùi lại motorControlNoSpeed(inR1, inR2, 2); motorControlNoSpeed(inL1, inL2, 2); break; case 3:// quay trái motorControlNoSpeed(inR1, inR2, 2); motorControlNoSpeed(inL1, inL2, 1); break; case 4:// quay phải motorControlNoSpeed(inR1, inR2, 1); motorControlNoSpeed(inL1, inL2, 2); break; case 5:// rẽ trái motorControlNoSpeed(inR1, inR2, 1); motorControlNoSpeed(inL1, inL2, 0); break; case 6:// rẽ phải motorControlNoSpeed(inR1, inR2, 0); motorControlNoSpeed(inL1, inL2, 1); break; default: action = 0; } } void motorControlNoSpeed (byte in1, byte in2, byte direct) { 45 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG // in1 and in2 are signal pins to control the motor // en is the enable pin // the defauspeed is the highest // direct includes: // 0:Stop // 1:Move on direct // 2:Move on another direct switch (direct) { case 0:// Dừng không quay digitalWrite(in1, LOW); digitalWrite(in2, LOW); break; case 1:// Quay chiều thứ digitalWrite(in1, HIGH); digitalWrite(in2, LOW); break; case 2:// Quay chiều thứ digitalWrite(in1, LOW); digitalWrite(in2, HIGH); break; //default: } } boolean IFSensor (byte PinNumb) { //0 sáng 46 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG //1 tối return(digitalRead (PinNumb)); } int deviationDarkLine4Sensor (int PinNumb1, int PinNumb2, int PinNumb3, int PinNumb4) { int left = 0; //biến kiểm tra lệch trái int right = 0; // biến kiểm tra lệch phải left = IFSensor (PinNumb1)+IFSensor (PinNumb2); //kiểm tra cảm biến trái màu đen right= IFSensor (PinNumb3)+IFSensor (PinNumb4); //kiểm tra cảm biến phải màu đen Serial.print("left="); Serial.println(left); Serial.print("right="); Serial.println(right); if ((left!=0) || (right!=0))return left - right; else return 3; // Kết trả là không lệch Âm lệch trái, Dương lệch phải } Để hiểu cod sễ cod chi tiết : a Cod cho phận di chuyển : #define inA1 //Định nghĩa chân in1 động A #define inA2 //Định nghĩa chân in2 động A 47 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG #define inB1 //Định nghĩa chân in1 động B #define inB2 //Định nghĩa chân in2 động B void setup() { pinMode(inA1, OUTPUT);//Set chân in1 dc A output pinMode(inA2, OUTPUT);//Set chân in2 dc A output pinMode(inB1, OUTPUT);//Set chân in1 dc B output pinMode(inB2, OUTPUT);//Set chân in2 dc B output } void loop() { robotMover (inA1, inA2, inB1, inB2,1); delay (1000); robotMover (inA1, inA2, inB1, inB2,0); delay (1000); robotMover (inA1, inA2, inB1, inB2,2); delay (1000); robotMover (inA1, inA2, inB1, inB2,0); delay (1000); robotMover (inA1, inA2, inB1, inB2,3); delay (1000); robotMover (inA1, inA2, inB1, inB2,0); delay (1000); robotMover (inA1, inA2, inB1, inB2,4); delay (1000); robotMover (inA1, inA2, inB1, inB2,0); 48 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG delay (1000); robotMover (inA1, inA2, inB1, inB2,5); delay (1000); robotMover (inA1, inA2, inB1, inB2,0); delay (1000); robotMover (inA1, inA2, inB1, inB2,6); delay (1000); robotMover (inA1, inA2, inB1, inB2,0); delay (1000); robotMover (inA1, inA2, inB1, inB2,7); delay (1000); robotMover (inA1, inA2, inB1, inB2,0); delay (1000); robotMover (inA1, inA2, inB1, inB2,8); delay (1000); robotMover (inA1, inA2, inB1, inB2,0); delay (1000); } void robotMover (byte inR1, byte inR2, byte inL1, byte inL2, byte action) { inR1 inR2 chân tín hiệu động bên phải inL1 inL2 chân tín hiệu động bên trái action= đứng yên action =1 thẳng action =2 lùi lại action =3 quay trái 49 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG action =4 quay phải action =5 rẽ trái action =6 rẽ phải action =7 rẽ lùi trái action =8 rẽ lùi phải switch (action) { case 0:// không di chuyển motorControlNoSpeed(inR1, inR2, 0); motorControlNoSpeed(inL1, inL2, 0); break; case 1://đi thẳng motorControlNoSpeed(inR1, inR2, 1); motorControlNoSpeed(inL1, inL2, 1); break; case 2:// lùi lại motorControlNoSpeed(inR1, inR2, 2); motorControlNoSpeed(inL1, inL2, 2); break; case 3:// quay trái motorControlNoSpeed(inR1, inR2, 1); motorControlNoSpeed(inL1, inL2, 2); break; case 4:// quay phải motorControlNoSpeed(inR1, inR2, 2); motorControlNoSpeed(inL1, inL2, 1); 50 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG break; case 5:// rẽ trái motorControlNoSpeed(inR1, inR2, 1); motorControlNoSpeed(inL1, inL2, 0); break; case 6:// rẽ phải motorControlNoSpeed(inR1, inR2, 0); motorControlNoSpeed(inL1, inL2, 1); break; case 7:// rẽ lùi trái motorControlNoSpeed(inR1, inR2, 2); motorControlNoSpeed(inL1, inL2, 0); break; case 8:// rẽ lùi phải motorControlNoSpeed(inR1, inR2, 0); motorControlNoSpeed(inL1, inL2, 2); break; default: action = 0; } } void motorControlNoSpeed (byte in1,byte in2, byte direct) { // in1 and in2 are signal pins to control the motor // en is the enable pin // the defauspeed is the highest 51 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG // direct includes: // 0:Stop // 1:Move on direct // 2:Move on another direct switch (direct) { case 0:// Dừng không quay digitalWrite(in1,LOW); digitalWrite(in2,LOW); break; case 1:// Quay chiều thứ digitalWrite(in1,HIGH); digitalWrite(in2,LOW); break; case 2:// Quay chiều thứ digitalWrite(in1,LOW); digitalWrite(in2,HIGH); b reak; //default: } } b Hàm xác định độ lệch line robot: #define sensor1 10 #define sensor2 11 #define sensor3 12 52 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG #define sensor4 13 void setup() { Serial.begin(9600);// thiet lap su dung serial gui tin hieu ve may tinh pinMode (sensor1, INPUT); pinMode (sensor2, INPUT); pinMode (sensor3, INPUT); pinMode (sensor4, INPUT); } void loop() { Serial.print(IRSensor(sensor1)); Serial.print(' '); Serial.print(IRSensor(sensor2)); Serial.print(' '); Serial.print(IRSensor(sensor3)); Serial.print(' '); Serial.println(IRSensor(sensor4)); Serial.println (deviationDarkLine4Sensor (sensor1, sensor2, sensor3, sensor4)); delay (1000); } boolean IRSensor (byte PinNumb) { //0 sáng //1 tối 53 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG return(digitalRead (PinNumb)); } int deviationDarkLine4Sensor (int PinNumb1, int PinNumb2, int PinNumb3, int PinNumb4) { int left = 0; //biến kiểm tra lệch trái int right = 0; // biến kiểm tra lệch phải left = IRSensor (PinNumb1)+IRSensor (PinNumb2); //kiểm tra cảm biến trái màu đen right= IRSensor (PinNumb3)+IRSensor (PinNumb4); //kiểm tra cảm biến phải màu đen Serial.print("left="); Serial.println(left); Serial.print("right="); Serial.println(right); if ((left!=0) || (right!=0))return left - right; else return 3; //Kết trả là không lệch Âm lệch trái(-1;-2) Dương lệch phải(1,2) robot không lệch robot vạch } c Cod cho cảm biến hồng ngoại dò đường : #define sensor1 13 #define sensor2 12 #define sensor3 11 #define sensor4 10 void setup() { 54 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG Serial.begin(9600); // thiet lap su dung serial gui tin hieu ve may tinh pinMode (sensor1, INPUT); pinMode (sensor2, INPUT); pinMode (sensor3, INPUT); pinMode (sensor4, INPUT); } void loop() { if (digitalRead (sensor1) == 0)Serial.print("Sensor1 = white "); else Serial.print("Sensor1 = black "); if (digitalRead (sensor2) == 0)Serial.print("Sensor2 = white "); else Serial.print("Sensor2 = black "); if (digitalRead (sensor3) == 0)Serial.print("Sensor3 = white "); else Serial.print("Sensor3 = black "); if (digitalRead (sensor4) == 0)Serial.println("Sensor4 = white "); else Serial.println("Sensor4 = black "); delay(1000); } d Cod cho điều khiển động dc : #define inA1 13 //Định nghĩa chân in1 động A #define inA2 12 //Định nghĩa chân in2 động A void setup() { pinMode(inA1, OUTPUT);//Set chân in1 dc A output pinMode(inA2, OUTPUT);//Set chân in1 dc A output 55 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG } void loop() { motorControlNoSpeed (inA1,inA2,1);// Cho quay giay delay (5000); motorControlNoSpeed (inA1,inA2,2); // Quay ngược lại giay delay (5000); } void motorControlNoSpeed (int in1,int in2, byte direct) { // in1 and in2 are signal pins to control the motor // en is the enable pin // the defauspeed is the highest // direct includes: // 0:Stop // 1:Move on direct // 2:Move on another direct switch (direct) { case 0:// Dừng không quay digitalWrite(in1,LOW); digitalWrite(in2,LOW); break; case 1:// Quay chiều thứ digitalWrite(in1,HIGH); digitalWrite(in2,LOW); break; case 2:// Quay chiều thứ 56 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG digitalWrite(in1,LOW); digitalWrite(in2,HIGH); break; default; } } 57 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG TÀI LIỆU THAM KHẢO Phần mềm thiết kế mạch điện tử: Altiun disigner, Proteus Phần mềm lập trình C Nguồn internet 58 [...]...ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG 11 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG VI THIẾT KẾ CÁC MẠCH ĐIỀU KHIỂN 1 Sơ đồ khối chức năng 12 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG a Khối nguồn Khối nguồn có nhiệm vụ cấp nguồn cho mạch điện trên xe cũng như 4 động cơ Trong đề tài xe dò đường ta dùng nguồn 12V để cung cấp nguồn cho động cơ hoạt động Tuy nhiên đối với... (Backlight Anode (+) và Backlight Cathode (-)): Tắt bật đèn màn hình LCD 1 2 3 4 5 6 19 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG c Khối mạch cảm biến Khối cảm biến(khối dò đường) là bộ phận không thể thiếu của xe dò đường Khối này có chức năng nhận biết đâu là đường cân bám theo Để phân biệt màu sắc khác nhau giữa đường đi và môi trường xung quang ta dùng các led phat hồng ngoại và các quang trở Nguyên lý làm việc:... ánh vị trí lệch của xe so với vạch đen, từ đó giúp debug chương trình thuận tiện hơn rất nhiều + Màn hình LCD: Dùng để hiển thị thông tin hoạt động của xe như tốc độ xe, hướng quay của xe Tuy nhiên việc sử dụng LCD cần chú ý vì màn hình LCD tiêu thụ dòng khá lớn đặc biệt là khi bật đèn nền, nên chỉ nên sử dụng màn hình hiển thị ở những trường hợp cân thiết 18 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG Sơ đồ chân LCD... gồm một đường nguồn Vs (thật ra là đường chung cho hai mạch cầu), một chân current sensing (cảm biến dòng ở cuối mạch cầu H), chân này không được nối đất mà để người dùng nối một điện trở nhỏ gọi là sensingresistor Bằng cách đo điện áp rơi trên 29 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG điện trở này ta có thể tính được dòng chạy qua điện trở, cũng là dòng qua động cơ, mục đích của việc này là xác định dòng quá... sẽ gây hỏng mạch nên cần chú ý 24 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG Động cơ dùng cho xe dò đường này là động cơ một chiều có hộp giảm tốc Động cơ một chiều Ưu điểm của việc dùng động một chiều có hộp giảm tốc + Quang trở có phản ứng chậm, nếu dùng động cơ tốc độ quay cao robot sẽ không phản ứng kịp để điều chỉnh hướng đi +Dòng cấp bởi transistor không lớn, nếu động cơ không có hộp giảm tốc có thể không... như động cơ DC loại vừa và nhỏ… 27 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG Sơ đồ chân IC L298 Chân 1;15 Tên Sense A 2;3;13;14 Sense B OUT1 OUT2 OUT3 OUT4 4 VS Chức năng Nối chân này qua điện trở cảm ứng dòng xuống GND để điều khiển dòng tải Out1 và Out2 là ngõ ra của cầu A Dòng của tải mắ giữa 2 chân này được quy định bởi chân 1 Out3 và Out4 là ngõ ra của cầu B Dòng của tải mắ giữa 2 chân này được quy định bởi... thuộc số photon được hấp thụ Một số cách bố trí cảm biến 1 Bố trí 2 led 22 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG 2 Bố trí 4 led 3 Bố trí 5 led 23 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG 4 Bố trí 6 led 5 Bố trí 8 led d.Khối điều khiển động cơ Khối điều khiển động cơ hay còn gọi là khối mạch công suất, mạch cầu H có nhiệm vụ khuếch đại dòng và điện áp đưa vào động cơ và ổn định công suất Do mạch được nối trực tiếp với nguồn... thụ động trong mạch điện 30 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG Cấu tạo đơn giản của điện trở Kí hiệu điện trở Trong các mạch điều khiển trong bài ta sử dụng loại điện trở thường có các đặc điểm: + Công suất hoạt động (tỏa nhiệt) thấp: 0.125W đến 0.5W + Độ chính xác không cao: sai số thường dao động khoảng +/- 5% trở lên + Giá thành rẻ 31 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG + Dễ mua được ở bất kì đâu Điện trở là... ĐIỆN LỰC XE DÒ ĐƯỜNG Mạch nguồn ta dùng IC LM7805 để hạ áp và ổn định điện áp ở giới hạn 5V Cấu tạo chân IC 7805 IC 7805 có các thông số - Đầu vào: AC7.0-35V - Đầu ra: DC5V 1A - Sử dụng IC LM7805CV TO220 - Dải nhiệt độ hoạt động là từ 00C đến 1250C - Dòng cực đại có thể duy trì 1A Dòng đỉnh 2.2A - Công suất tiêu tán cực đại nếu không dùng tản nhiệt: 2W - Công suất tiêu tán nếu dùng tản nhiệt đủ lớn: 15W... một mạch điện giúp đảo chiều dòng điện qua một đối tượng Đối với đối tượng là động cơ DC thì mục đích điều khiển là cho phép dòng điện qua động cơ chạy từ A đến B và từ B đến A từ đó có thể 26 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG giúp đảo chiều quay động cơ a b Nguyên lý hoạt động của mạch cầu H Theo hình a thì 2 khóa L1 và R2 được “đóng lại” (L2 và R1 vẫn mở), ta thấy có một dòng điện chạy từ V qua khóa L1 ... HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG điều khiển tốc độ chiều quay động bánh sau cho xe theo đường có vạch sẵn IV ỨNG DỤNG CỦA XE DÒ ĐƯỜNG Xe dò đường ứng dụng nhiều vận chuyển hàng hóa, việc dò đường khu vực... robot dò đường gồm: Tên Hình ảnh Khung xe Động có hộp giảm tốc Bánh xe để gắn với trục động ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG Nguồn(pin) Đế pin Mạch điều khiển Mạch cảm biến ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG... LỰC XE DÒ ĐƯỜNG 11 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG VI THIẾT KẾ CÁC MẠCH ĐIỀU KHIỂN Sơ đồ khối chức 12 ĐẠI HỌC ĐIỆN LỰC XE DÒ ĐƯỜNG a Khối nguồn Khối nguồn có nhiệm vụ cấp nguồn cho mạch điện xe động