Professional Documents
Culture Documents
Bao Cao Xe Do Line Nhom Qua Mon
Bao Cao Xe Do Line Nhom Qua Mon
Bao Cao Xe Do Line Nhom Qua Mon
Nhập môn cntt (Trường Đại học Sư phạm Kỹ Thuật Thành phố Hồ Chí Minh)
BÁO CÁO DỰ ÁN
ĐỀ TÀI: DỰ ÁN CUỐI KÌ MÔN HỌC NHẬP
MÔN NGÀNH (ROBOT DÒ LINE)
Giảng viên hướng dẫn: Ths. Bùi Thị Tuyết
Đan Sinh viên thực hiện: Lê Hoài Lâm
Nguyễn Chí Phúc
Nguyễn Ngọc Nguyên Bình
Trần Đức Huy
Lê Sỹ Đan
Nguyễn Lê Phú Cường
1
Downloaded by haha haha (capdatmaan2310@gmail.com)
CỘNG HÒA XÃ HỘI CHỦ NGHĨA VIỆT
NAM
Độc lập – Tự do – Hạnh phúc
−−−−−−−−−−−−−−−−
TỔNG QUAN DỰ ÁN
Sinh viên thực hiện :
Họ tên SV: Lê Hoài Lâm MSSV: 20161220
Họ tên SV: Lê Sỹ Đan MSSV: 20161175
Họ tên SV: Trần Đức Huy MSSV: 20131043
Họ tên SV: Nguyễn Lê Phú Cường MSSV:
20161168 Họ tên SV: Nguyễn Ngọc Nguyên Bình MSSV:
20161165 Họ tên SV: Nguyễn Chí Phúc MSSV:
20161244 Người hướng dẫn : Trần Thiện An
Mô tả kĩ thuật :
* Thiết kế Robot xe dò line thỏa mãn các yêu cầu sau:
- Đảm bảo dò đúng đường.
- Xe chạy đảm bảo tốc độ ổn định.
- Có đèn LED hiển thị đúng trạng thái hiện tại của xe trên đường.
- Xe có khả năng đảo chiều quay động cơ, hãm ngược.
- Thiết kế phần mềm dễ nhìn, dễ kiểm tra, sửa chữa đảm bảo thực hiện
đúng yêu cầu đề bài.
✓ Phần điều khiển chuyển động chọn 2 mạch cầu H được tích hợp sẵn trong
L298.
✓ Phần dò đường dùng 3 cặp cảm biến (1 led phát hồng ngoại và 1 quang
trở.)
PHẦN 3 : THIẾT KẾ DỰ ÁN
I. Xây dựng dự án
• Khối nguồn: cung cấp điện áp 12V cho động cơ và 5V cho khối vi điều
khiển.
Dùng nguồn 12V để cấp điện áp vào, sau đó thông qua khối lọc, hạ áp dùng
7805 ta lấy ra điện áp 5V ổn định để cung cấp cho các khối còn lại.
Ngoài ra còn có một số biện pháp bảo vệ như dùng cầu chi 2A, dùng diode
chống ngược nguồn.
10
11
12
13
3. Đường line
14
KHỞI TẠO
GIỚI THIỆU
DÒ ĐƯỜNG
NO YES
LỆCH
15
NO
int L1 =
A0; int L2
= A1; int
L3 = A2;
int L4 =
A3; int L5
= A4;
void setup()
{
pinMode(enA, OUTPUT);
pinMode(A_1, OUTPUT);
pinMode(A_2, OUTPUT);
pinMode(enB, OUTPUT);
pinMode(B_1, OUTPUT);
16
Downloaded by haha haha (capdatmaan2310@gmail.com)
pinMode(B_2, OUTPUT);
pinMode(L1, INPUT);
pinMode(L2, INPUT);
pinMode(L3, INPUT);
pinMode(L4, INPUT);
pinMode(L5, INPUT);
analogWrite(enA, 65);
analogWrite(enB, 65);
delay(200);
}
void loop()
{
if ((digitalRead(L1) == 0)&&(digitalRead(L2) == 0)&&(digitalRead(L3) ==
1)&& (digitalRead(L4) == 0)&&(digitalRead(L5) == 0)){dithang();}
if ((digitalRead(L1) == 0)&&(digitalRead(L2) == 1)&&(digitalRead(L3) ==
1)&& (digitalRead(L4) == 1)&&(digitalRead(L5) == 0)){dithang();}
17
void dithang()
{ digitalWrite(A_1, LOW);
digitalWrite(A_2, HIGH);
digitalWrite(B_1, HIGH);
digitalWrite(B_2, LOW);
}
void dilui(){
digitalWrite(A_1, HIGH);
digitalWrite(A_2, LOW);
digitalWrite(B_1, LOW);
digitalWrite(B_2, HIGH);
}
void trai()
{ digitalWrite(A_1, LOW);
digitalWrite(A_2, LOW);
digitalWrite(B_1, HIGH);
digitalWrite(B_2, LOW);
}
void phai()
{ digitalWrite(A_1, LOW);
digitalWrite(A_2, HIGH);
digitalWrite(B_1, LOW);
digitalWrite(B_2, LOW);
}
void dung(){
digitalWrite(A_1, LOW);
18
19
20