1. Trang chủ
  2. » Luận Văn - Báo Cáo

ĐIỀU KHIỂN MOBILE ROBOT bám VẠCH

52 6 0

Đang tải... (xem toàn văn)

Tài liệu hạn chế xem trước, để xem đầy đủ mời bạn chọn Tải xuống

THÔNG TIN TÀI LIỆU

Thông tin cơ bản

Tiêu đề Điều Khiển Mobile Robot Bám Vạch
Định dạng
Số trang 52
Dung lượng 7,08 MB

Cấu trúc

  • CHƯƠNG 1: TỔNG QUAN VỀ ĐỀ TÀI

    • 1.1 Giới thiệu đề tài

    • 1.2 Mục đích nghiên cứu

    • 1.3 Đối tượng nghiên cứu

    • 1.4 Phạm vi nghiên cứu

    • 1.5 Dự kiến kết quả

  • CHƯƠNG 2: CƠ SỞ LÝ THUYẾT

    • 2.1. Giới thiệu về mobile robot dò line, bám vạch

    • 2.2 Các linh kiện để xây dựng một robot dò line

      • 2.2.1: Giới thiệu về PIC 16F877A

      • 2.2.2 Giới thiệu về cảm biến hồng ngoại: Cảm biến dò line đơn TCRT5000 - FC123

      • 2.2.3 Module điều khiển động cơ L298N

      • 2.2.4 Các linh kiện khác:

  • CHƯƠNG 3: THIẾT KẾ VÀ THI CÔNG

    • 3.1 Mạch nguyên lí Proteus

    • 3.2 Mạch PCB layout

    • 3.3 Kết quả mô phỏng

  • CHƯƠNG 4: GIẢI THUẬT VÀ ĐIỀU KHIỂN

    • 4.1. Sơ đồ khối

    • 4.2. Lưu đồ giải thuật

    • 4.3 Phần điều khiển:

  • CHƯƠNG 5: THỰC NGHIỆM

    • 5.1 Tiến hành thực nghiệm

  • CHƯƠNG 6: KẾT LUẬN

    • 6.1 Ưu điểm:

    • 6.2 Nhược điểm:

    • 6.3 Hướng phát triển thêm

  • Tài liệu tham khảo

  • Code lập trình

Nội dung

TỔNG QUAN VỀ ĐỀ TÀI

Giới thiệu đề tài

Ngành công nghiệp tự động hóa đang dần có vai trò quan trọng trong lĩnh vực kinh tế và đời sống trong thời đại 4.0 như hiện nay.

Với sự phát triển nhanh chóng của công nghệ điện tử và trí tuệ nhân tạo, robot ngày càng trở thành một phần quan trọng trong cuộc sống hiện đại Chúng không chỉ giúp giảm bớt sức lao động và thời gian làm việc, mà còn nâng cao năng suất và giảm thiểu rủi ro tai nạn lao động Robot tự động đáp ứng nhu cầu của con người và mở ra hướng nghiên cứu, phát triển mới trong lĩnh vực robotic.

Robot đóng vai trò quan trọng trong việc hỗ trợ con người thực hiện các nhiệm vụ trong những môi trường khắc nghiệt và nguy hiểm, nơi mà con người gặp khó khăn khi làm việc Chúng không chỉ giúp giám sát mà còn mang lại những kết quả chính xác, nâng cao hiệu quả công việc.

Lập trình thiết kế robot dò đường và bám vạch cho phép robot di chuyển theo quỹ đạo đã được xác định trước Loại robot này có ứng dụng thực tiễn trong việc vận chuyển hàng hóa và nhu yếu phẩm, giúp tiết kiệm nguồn nhân lực và chi phí vận chuyển một cách tối đa.

Mục đích nghiên cứu

Robot đang ngày càng phổ biến và thay thế con người trong các công việc nặng nhọc, tốn sức và nguy hiểm Trong kỷ nguyên kỹ thuật số hiện nay, robot tự động trở nên đa dạng, phức tạp và linh hoạt, có khả năng ứng dụng trong nhiều lĩnh vực khác nhau, đặc biệt là trong những nhiệm vụ nguy hiểm như thăm dò lòng đất, thăm dò đại dương, vận chuyển đường dài và tự hành trên không.

Robot dò đường bám vạch là một loại robot tự hành chuyên dùng để vận chuyển, thường được ứng dụng trong các cuộc thi khoa học kỹ thuật dành cho sinh viên tại nhiều trường đại học.

Để giúp mọi người hiểu rõ hơn về robot, đặc biệt là robot di động bám vạch, tôi đã chọn nghiên cứu đề tài này trong đồ án của mình.

Đối tượng nghiên cứu

- Mạch điều khiển động cơ

Phạm vi nghiên cứu

Nghiên cứu trong lĩnh vực học tập cho thấy việc sử dụng xe bám vạch theo đường đen trên địa hình bằng phẳng giúp duy trì liên tục mà không bị gián đoạn Điều này không chỉ phục vụ cho mục đích học tập và nghiên cứu phổ thông mà còn tạo nền tảng cho các ứng dụng thực tiễn trong lĩnh vực vận chuyển và giám sát đường dài theo quỹ đạo đã được xác định.

Dự kiến kết quả

- Hoàn thành thiết kế được mô hình mobile robot bám vạch bằng vi điều khiển PIC16F877A.

- Chạy thực nghiệm thành công.

CƠ SỞ LÝ THUYẾT

Giới thiệu về mobile robot dò line, bám vạch

Robot dò line được sử dụng rộng rãi trong công nghệ và trong đời sống hàng ngày, giúp nhận biết và di chuyển theo đường đi đã được xác định Mặc dù chỉ là một ứng dụng nhỏ, nhưng nó là nền tảng cho việc phát triển các dự án lớn hơn Các ứng dụng mở rộng của robot dò line bao gồm robot vận chuyển công nghiệp và robot tránh vật cản.

Các loại robot dò line thường gặp

+ Kết cấu xe: 2 bánh xe chủ động và 1 bánh xe đa hướng

+ Ưu điểm : Kết cấu đơn giản, đi qua các đoạn cua dễ dàng, các bánh xe đồng phẳng tiếp xúc với mặt đất, xe khó văng ra khỏi vạch

+ Nhược điểm: đối với loại xe bánh xe đa hướng phía trước tự lựa nên xe dễ bị văng ra khỏi đường vạch, không ổn định.

+ Kết cấu xe: 2 bánh xe chủ động và 2 bánh xe đa hướng

+ Ưu điểm: Kết cấu đơn giản, vững chắc vì có 4 bánh xe

+ Nhược điểm: khó đảm bảo 4 bánh hoạt động cân đối đồng phẳng, khi qua cua rất khó khăn do có đến 2 bánh xe đa hướng.

Trong đồ án lần này, em chọn Robot dò line 3 bánh có bánh xe đa hướng phía sau.

Các linh kiện để xây dựng một robot dò line

Sau khi nghiên cứu và tìm hiểu, em đã lựa chọn các thiết bị:

- Cảm biến dò line đơn TCRT5000 - Fc123 (3 chân)

- Mạch điều khiển động cơ L298

- Một công tắc bập bênh

- Điện trở và tụ gốm

PIC, viết tắt của Programmable Intelligent Computer, có nghĩa là "máy tính thông minh khả trình" Thuật ngữ này bắt nguồn từ vi điều khiển PIC đầu tiên, PIC1650, do hãng General Instrument phát triển Sau đó, hãng Microchip đã tiếp tục phát triển dòng vi điều khiển PIC, cho ra đời gần 100 loại khác nhau cho đến nay.

PIC 16F877A là một vi điều khiển 40 chân phổ biến trong các dự án nhúng, với năm cổng từ A đến E Nó bao gồm ba bộ định thời, trong đó có hai bộ định thời 8 bit và một bộ định thời 16 bit Vi điều khiển này hỗ trợ nhiều giao tiếp như giao thức nối tiếp, song song và I2C, đồng thời cung cấp khả năng xử lý ngắt chân phần cứng và ngắt bộ định thời.

Hình 2 2 Sơ đồ chân PIC16F877A Thông số kĩ thuật của PIC 16F877A

- Kích thước bộ nhớ: 14 Kbyte.

- Tốc độ CPU tối đa (MHZ) : 20

- Nhiệt độ hoạt động tối thiểu: -40oC.

- Nhiệt độ hoạt động tối đa: 125oC

- Điện áp hoạt động tối thiểu: 2V.

- Điện áp hoạt động tối đa: 5.5V.

Nạp chương trình cho PIC

Nạp trực tiếp sử dụng mạch nạp là phương pháp phổ biến, với hai thiết bị thường gặp là PICKIT và BURNE Mạch nạp PICKIT nổi bật với độ ổn định cao nhưng chỉ tương thích với các dòng vi điều khiển PIC và DSPIC Trong khi đó, mạch nạp BURNE có khả năng nạp cho nhiều loại vi điều khiển khác nhau, bao gồm cả PIC và AVR.

- Nạp qua Bootloader: có thể tải chương trình Bootloader và nạp cho PIC 1 lần, sau đó có thể nạp chương trình qua cổng UART tiện lợi.

PIC16F877a có tổng cộng 5 Cổng là:

Cổng A bao gồm 6 chân, bắt đầu từ chân số 2 đến chân số 7, được ký hiệu từ RA0 đến RA5 Trong đó, RA0 là ký hiệu cho chân đầu tiên của Cổng A.

Cổng B: có tổng cộng 8 chân bắt đầu từ chân số 33 đến chân số 40 Các chân cổng

B được ký hiệu từ RB0 đến RB7 trong đó RB0 là ký hiệu của chân đầu tiên của cổng B.

Cổng C có tổng cộng 8 chân, với bốn chân đầu tiên nằm từ chân số 15 đến chân số 18 và bốn chân cuối cùng từ chân số 23 đến chân số 26 Các chân của cổng C không được sắp xếp thẳng hàng với nhau.

Cổng D bao gồm 8 chân không thẳng hàng, với bốn chân đầu tiên nằm từ chân số 19 đến chân số 22 và bốn chân cuối cùng từ chân số 27 đến chân số 30.

Cổng E: có tổng cộng 3 chân bắt đầu từ chân số 8 đến chân số 10 Các chân cổng

E được ký hiệu từ RE0 đến RE2 trong đó RE0 là ký hiệu của chân đầu tiên của cổng E.

PIC16F877A sở hữu 8 nguồn ngắt, cho phép xử lý nhiều sự kiện khác nhau Các nguồn ngắt này có thể đến từ bộ đếm thời gian, như ngắt được tạo ra mỗi giây, hoặc từ sự kiện thay đổi trạng thái chân, nơi ngắt sẽ được kích hoạt khi có sự thay đổi trên chân.

Vì vậy, ngắt PIC16F877a có thể được tạo ra bằng 8 cách sau:

- Thay đổi trạng thái cổng B

- Cổng Slave Song song Đọc/Ghi

2.2.2 Giới thiệu về cảm biến hồng ngoại: Cảm biến dò line đơn TCRT5000 - FC123

Hình 2 3 Cảm biến hồng ngoại TCRT5000 - FC123 Nguyên lý hoạt động:

Khi cảm biến phát hiện chướng ngại vật trong khoảng cách 2 ~ 30cm với góc 35°, đèn LED màu xanh lá cây sẽ sáng và cổng ra sẽ phát tín hiệu thấp Khoảng cách phát hiện có thể được điều chỉnh thông qua Potentiometer; xoay theo chiều kim đồng hồ sẽ tăng độ nhạy và khoảng cách phát hiện, trong khi xoay ngược chiều kim đồng hồ sẽ giảm khoảng cách phát hiện.

- Cổng ra module cảm biến OUT có thể được kết nối trực tiếp với vi điều khiển

IO hoặc một module relay 5v; Kết nối: VCC-VCC; GND-GND; OUT-IO

- Bộ so sánh LM393, ổn định;

- Nguồn cấp 3-5V DC Khi bật nguồn, đèn báo nguồn màu đỏ sáng

- Được thiết kế lỗ vít 3mm để lắp đặt cố định dễ dàng

- Bảng mạch kích thước: 3.2CM * 1.4CM

- Chân kết nối: VCC/OUT/GND

- Ngõ ra của tín hiệu khi robot thấy vạch (tức màu trắng) thì ngõ ra sẽ ở trạng thái là mức logic 0 (LOW), ngược lại sẽ là mức cao.

Nguyên lí của dò line:

Khi bề mặt phản xạ ánh sáng, mắt sẽ thu nhận tín hiệu từ phản xạ đó Điều này giúp chúng ta xác định tín hiệu và tạo ra vùng sáng cụ thể Những bề mặt này gần như phản xạ hoàn toàn ánh sáng chiếu vào chúng.

Hình 2 4 Khi có tín hiệu phản xạ

Khi bề mặt không phản xạ ánh sáng, mắt không nhận được tín hiệu phản xạ, dẫn đến việc không thể xác định được vùng tối Những bề mặt này hấp thụ hầu hết ánh sáng đi qua, tạo ra một không gian tối hoàn toàn.

2.2.3 Module điều khiển động cơ L298N

Hình 2 6 Module điều khiển động cơ L298N

Module điều khiển động cơ L298N sử dụng chip cầu H, cho phép điều khiển tốc độ và chiều quay của động cơ DC một cách dễ dàng Ngoài ra, module này còn có khả năng điều khiển một động cơ bước lưỡng cực Mạch cầu H của IC L298N hoạt động hiệu quả trong dải điện áp từ 5V đến 35V.

Module L298N có tích hợp một IC nguồn 78M05 để tạo ra nguồn 5V để cung cấp cho các thiết bị khác.

Thông số kĩ thuật của Module điều khiển động cơ L298N

- Driver: L298N tích hợp hai mạch cầu H

- Dòng tối đa cho mỗi cầu H: 2A

- Điện áp tín hiệu điều khiển: +5 V ~ +7 V

- Dòng tín hiệu điều khiển: 0 ~ 36mA

- Công suất hao phí: 20W (khi nhiệt độ T = 75 )℃)

Hình 2 7 Sơ đồ chân của L298N

1 DC motor 1 “+” hoặc stepper motor A+.

2 DC motor 1 “-” hoặc stepper motor A-.

3.12V jumper – tháo jumper này nếu sử dụng nguồn trên 12V cấp vào chân 4 Jumper này dùng để cấp nguồn cho IC ổn áp tạo ra nguồn 5V nếu nguồn trên 12V sẽ làm cháy IC 78M05.

4 Cấp dương nguồn cho motor vào đây từ 6V đến 35V.

5 Cắm chân GND (đất, cực âm) của nguồn vào đây.

6 Nguồn ra 5V, nếu jumper (3) được cắm thì có nguồn ra 5V ở đây.

7 Chân Enable của Motor 1, chân này cũng dùng để cấp xung PWM cho motor Nếu điều khiển tốc độ thì rút jumper ra và cắm chân PWM của VĐK vào đây Giữ nguyên khi dùng với động cơ bước.

12 Chân Enable của Motor 2, chân này cũng dùng để cấp xung PWM cho motor Nếu điều khiển tốc độ thì rút jumper ra và cắm chân PWM của VĐK vào đây Giữ nguyên khi dùng với động cơ bước.

13 DC motor 2 “+” hoặc stepper motor B+.

14 DC motor 2 “-” hoặc stepper motor B-. Động cơ DC và bánh xe:

Động cơ DC hoạt động hiệu quả khi được cung cấp nguồn từ 3V đến 5V Khi nguồn điện được cấp ngược, động cơ sẽ quay theo chiều ngược lại, trong khi khi nguồn điện được cấp thuận, động cơ sẽ quay theo chiều thuận.

- Điện áp hoạt động : 39VDC

- Dòng điện tiêu thụ: 110-200mA

- Số vòng/1phút: 50 vòng/ 1 phút tại 3VDC 83 vòng/ 1 phút tại 5VDC.

THIẾT KẾ VÀ THI CÔNG

Mạch nguyên lí Proteus

Hình 3 1 Mạch nguyên lí của mobile robotThiết kế mạch gồm PIC16F877A, module điều khiển động cơ L298, cảm biến hồng ngoại, động cơ, xung, nguồn, …

Mạch PCB layout

Hình 3 2 Mạch PCB layout Xuất file:

Kết quả mô phỏng

Mạch mô phỏng quá trình dò line đơn giản dùng 5 cảm biến hồng ngoại:

Cảm biến hồng ngoại tích cực ở mức thấp (0), nên tìm thấy line thì tín hiệu Output sẽ ở mức low (0) , không có line thì tín hiệu Output mức high (1)

- Các trường hợp tìm thấy vạch line cơ bản:

Lúc này, 3 cảm biến hồng ngoại ở giữa tìm thấy đường vạch, 2 động cơ cùng lúc hoạt động hướng mobile robot đi thẳng và bám line

Hình 3 5 Vạch line chính giữa + Khi line bên trái: (00011)

Khi 3 cảm biến hồng ngoại bên trái nhận tín hiệu line, mobile robot sẽ được điều hướng để rẽ sang trái Lúc này, động cơ DC bên trái sẽ giảm tốc độ, trong khi động cơ DC bên phải quay để hỗ trợ xe rẽ sang bên trái.

Hình 3 6 Vạch line bên trái + Khi line nằm bên phải:

Khi ba cảm biến hồng ngoại bên phải phát hiện tín hiệu line, mobile robot sẽ được điều hướng để rẽ sang phải Lúc này, động cơ DC bên phải sẽ giảm tốc độ, trong khi động cơ DC bên trái sẽ quay để hỗ trợ xe rẽ sang bên phải.

Hình 3 7 Vạch line bên phải + Khi không dò thấy line

Lúc này cả 5 cảm biến không tìm thấy line, 2 động cơ DC quay nghịch làm cho mobile robot di chuyển lùi về phía sau.

Hình 3 8 Không thấy vạch line Ngoài 3 trường hợp dò line trên thì có những trường hợp cũng tương tự, không quá khác biệt:

Các trường hợp này sẽ nói rõ hơn trong Code lập trình.

GIẢI THUẬT VÀ ĐIỀU KHIỂN

Sơ đồ khối

Hình 4 1 Sơ đồ khối của hệ thống

Lưu đồ giải thuật

Hình 4 2 Lưu đồ giải thuật

Phần điều khiển

Hình 4 3 Khai báo các biến và khởi tạo các hàm điều khiển động cơ bằng PWM

Hình 4 4 Khởi tạo động cơ thuận – nghịch

Hình 4 5 Khởi tạo tốc độ động cơCác trường hợp tìm thấy line:

Hình 4 6 Các trường hợp thấy line

Hình 4 7 Khởi tạo các port

THỰC NGHIỆM

Tiến hành thực nghiệm

- Lắp các linh kiện đã chuẩn bị theo sơ đồ mạch Hoàn thành mô hình hoàn chỉnh.

- Vẽ line trên mặt phẳng và tiến hành để mobile robot hoạt động thực nghiệm.

Hình 5 2 Mô hình mobile robot hoàn chỉnh Kết quả thực nghiệm:

- Mobile robot hoạt động và bám vào line được

- Qua được những khúc cua

Hình 5 3 Bắt đầu rẽ trái

Hình 5 4 Rẽ trái thành công

Ngày đăng: 16/05/2022, 16:18

HÌNH ẢNH LIÊN QUAN

Hình 2.1 PIC16F877A - ĐIỀU KHIỂN MOBILE ROBOT bám VẠCH
Hình 2.1 PIC16F877A (Trang 7)
Hình 2.2 Sơ đồ chân PIC16F877A - ĐIỀU KHIỂN MOBILE ROBOT bám VẠCH
Hình 2.2 Sơ đồ chân PIC16F877A (Trang 8)
Hình 2.3 Cảm biến hồng ngoại TCRT500 0- FC123 - ĐIỀU KHIỂN MOBILE ROBOT bám VẠCH
Hình 2.3 Cảm biến hồng ngoại TCRT500 0- FC123 (Trang 10)
Hình 2 .5 Khi không có tín hiệu phản xạ - ĐIỀU KHIỂN MOBILE ROBOT bám VẠCH
Hình 2 5 Khi không có tín hiệu phản xạ (Trang 12)
Hình 2.4 Khi có tín hiệu phản xạ - ĐIỀU KHIỂN MOBILE ROBOT bám VẠCH
Hình 2.4 Khi có tín hiệu phản xạ (Trang 12)
Hình 2. 6 Module điều khiển động cơ L298N - ĐIỀU KHIỂN MOBILE ROBOT bám VẠCH
Hình 2. 6 Module điều khiển động cơ L298N (Trang 13)
Hình 2 .7 Sơ đồ chân của L298N - ĐIỀU KHIỂN MOBILE ROBOT bám VẠCH
Hình 2 7 Sơ đồ chân của L298N (Trang 14)
Hình 2 .8 Động cơ và bánh xe - ĐIỀU KHIỂN MOBILE ROBOT bám VẠCH
Hình 2 8 Động cơ và bánh xe (Trang 16)
Hình 2. 9 Khung xe - ĐIỀU KHIỂN MOBILE ROBOT bám VẠCH
Hình 2. 9 Khung xe (Trang 17)
Hình 2. 10 Pin 18650 - ĐIỀU KHIỂN MOBILE ROBOT bám VẠCH
Hình 2. 10 Pin 18650 (Trang 18)
Hình 3.1 Mạch nguyên lí của mobile robot - ĐIỀU KHIỂN MOBILE ROBOT bám VẠCH
Hình 3.1 Mạch nguyên lí của mobile robot (Trang 19)
Hình 3.3 Mạch in - ĐIỀU KHIỂN MOBILE ROBOT bám VẠCH
Hình 3.3 Mạch in (Trang 20)
Hình 3.2 Mạch PCB layout - ĐIỀU KHIỂN MOBILE ROBOT bám VẠCH
Hình 3.2 Mạch PCB layout (Trang 20)
Hình 3 .4 Mạch mô phỏng - ĐIỀU KHIỂN MOBILE ROBOT bám VẠCH
Hình 3 4 Mạch mô phỏng (Trang 21)
Hình 3 .5 Vạch line chính giữa - ĐIỀU KHIỂN MOBILE ROBOT bám VẠCH
Hình 3 5 Vạch line chính giữa (Trang 22)

TRÍCH ĐOẠN

TÀI LIỆU CÙNG NGƯỜI DÙNG

TÀI LIỆU LIÊN QUAN

w