Hình 2.17: Puli trượt ................................................................................................. 29
2.3.5. Thiết kế tay xúc quà. ....................................................................................... 29
Hình 1.18: Kích thước tay xúc quà ......................................................................... 30
Hình 2.19:kích thước cánh tay ................................................................................ 30
PHẦN 3: THIẾT KẾ MẠCH ĐIỆN ........................................................................... 36
Hình 3.1: Sơ đồ khối mạch điều khiển. ................................................................... 36
Hình 3.6. Khi thay đổi duty cycle, ta sẽ có điện áp trung bình thay đổi .................. 41
Hình 3.7. minh họa giải thuật phương pháp điều biến độ rộng xung ...................... 42
3.1.5.2.Van bán dẫn IRF 540N...........................................................................46
3.1.5.4.Opto PC817...........................................................................................48
3.2.3 Sơ đồ chân và chức năng các chân P89V51RD2 ............................................ 50
3.2.3.1. Sơ đồ chân P89V51RD2 ............................................................................. 50
Hình 3.13. Sơ đồ chân IC P89V51RD2 ................................................................... 50
3.4. PHƯƠNG PHÁP ĐIỀU CHẾ ĐỘ RỘNG XUNG .............................................. 52
Hình 3.18 Sơ đồ mạch vi điều khiển ........................................................................ 57
3.6. KHỐI PHÍM BẤM ............................................................................................... 59
Hình 3.19. Gampad ................................................................................................. 59
3.7.1.1. IC LM7805.........................................................................................60
3.7.1.2. B688. .......................................................................................................... 61
Hình 3.21. Sơ đồ chân của TIP B688. ..................................................................... 61
Bảng 3.8: Bảng thông số của B688 .............................................................................. 61
-Nguồn động lực...................................................................................................63
3.8: SƠ ĐỒ NGUYÊN LÝ CỦA MẠCH ROBOT. ................................................... 64
Hình 3.24: Mạch sơ đồ nguyên lý ........................................................................... 65
Hình 4.1. Lưu đồ giải thuật đi thẳng ....................................................................... 66
Hình 4.2. Lưu đồ giải thuật đi lùi ............................................................................ 66
Hình 4.3. Lưu đồ giải thuật rẽ phải ......................................................................... 67
Hình 4.4 Lưu đồ giải thuật rẽ trái ........................................................................... 67
Hình 4.5. Lưu đồ giải thuật nâng ............................................................................ 68
Hình 4.6. Lưu đồ giải thuật hạ ................................................................................ 68
4.2.CHƯƠNG TRÌNH ĐIỀU KHIỂN. ....................................................................... 69
4.3. PHƯƠNG ÁN XỬ LÝ NHIỄU ............................................................................ 79
4.3.1. Các nguyên nhân cơ bản gây ra nhiễu ........................................................... 79
4.3.1.1. Nguyên nhân cơ khí:.................................................................................79
4.3.1.2. Nguyên nhân do điện: ................................................................................ 79
4.3.2. Các phương án xử lý nhiễu. ............................................................................ 81
4.3.2.1. Xử lý cơ khí: ...................................................................................................... 81