Thiết Kế Hệ Thống Điều Khiển Robot Dò Line

Báo cáo đồ án thiết kế hệ thống cơ điện tử với đề tài chế tạo robot dò line, cung cấp kiến thức và ứng dụng thực tiễn trong ngành.

• Đề tài: Thiết Kế Hệ Thống Điều Khiển Robot Dò Line

Mục lục chi tiết

• 1. PHẦN 1: TỔNG QUAN
• 1.1. Tổng quan về Mobile Robot
• 1.2. Phân loại Mobile robot
• 1.3. Cách định hướng di chuyển của Mobile Robot
• 1.4. Ứng dụng của Mobile robot
• 1.5. Tổng quan về robot dò line
• 1.6. Một số mô hình robot dò line trong các cuộc thi
• 1.7. Các thành phần xe dò line
• 2. PHẦN 2: LỰA CHỌN PHƯƠNG ÁN
• 3. PHẦN 3: THIẾT KẾ CƠ KHÍ
• 3.1. Tính toán kích thước Xe
• 3.2. Tính toán công suất cho động cơ
• 3.3. Điều kiện để xe vào cua mà không bị trượt
• 3.4. Dung sai lắp ghép đồ gá động cơ
• 3.5. Gia công đồ gá động cơ
• 3.6. Các tấm để xe
• 4. PHẦN 4: THIẾT KẾ HỆ THỐNG ĐIỆN
• 4.1. Thiết kế khối cảm biến dò line
• 4.2. Các yêu cầu khi lựa chọn cảm biến
• 4.3. Phương án 1: Đọc tín hiệu Digital bằng thanh cảm biến BED-1000
• 4.4. Phương án 2: Đọc tín hiệu Analog bằng cảm biến TCRC 5000
• 4.5. Tính toán thiết kế thành cảm biến
• 4.6. Chọn cách đặt cảm biến
• 4.7. Bố trí các cảm biến
• 4.8. Xử lý tín hiệu cảm biến
• 4.9. Khối driver và động cơ
• 4.10. Điều khiển động cơ hai bánh xe
• 5. PHẦN 5: THIẾT KẾ PHÂN LẬP TRÌNH
• 5.1. Sơ đồ khối hệ thống điều khiển
• 5.2. Ví dụ điều khiển Arduino Atmega 2560
• 5.3. Sơ đồ khối điều khiển
• 5.4. Chạy thực nghiệm robot dò line
• 6. PHẦN 6: KẾT QUẢ THỰC NGHIỆM
• 6.1. Kết quả thực nghiệm
• 6.2. Đề xuất phương án hiệu chỉnh thiết kế
• TÀI LIỆU THAM KHẢO

Tóm tắt

I. Tổng quan A Z về Thiết Kế Hệ Thống Robot Dò Line

Việc thiết kế hệ thống điều khiển robot dò line là một bài toán kinh điển trong lĩnh vực cơ điện tử và robotics, đóng vai trò nền tảng cho nhiều ứng dụng phức tạp hơn như xe tự hành AGV. Một line follower robot về cơ bản là một robot di động (mobile robot) được lập trình để di chuyển bám theo một vạch kẻ (line) được vẽ sẵn trên một bề mặt. Quỹ đạo của robot hoàn toàn phụ thuộc vào cấu trúc của sa bàn. Sự phát triển của công nghệ đã cho phép chế tạo các robot ngày càng tinh vi, không chỉ ứng dụng trong các cuộc thi công nghệ mà còn trong công nghiệp, vận chuyển hàng hóa trong kho bãi. Các hệ thống dẫn đường cho mobile robot rất đa dạng, từ laser guidance, magnetic tape guidance (băng từ) cho đến wire guidance. Trong đó, phương pháp dò line bằng cảm biến quang học là phổ biến nhất nhờ chi phí hợp lý và dễ triển khai. Một hệ thống robot dò đường hoàn chỉnh bao gồm ba thành phần chính không thể tách rời: cơ khí, điện - điện tử, và thuật toán điều khiển. Phần cơ khí quyết định sự ổn định, khả năng bám đường và chịu tải. Phần điện tử là bộ não của robot, bao gồm vi điều khiển, các loại cảm biến hồng ngoại, và driver động cơ. Cuối cùng, thuật toán là linh hồn của hệ thống, quyết định độ chính xác, tốc độ và khả năng xử lý các tình huống phức tạp như góc cua gấp hay ngã rẽ. Việc hiểu rõ từng thành phần và mối liên kết giữa chúng là chìa khóa để xây dựng một robot hoạt động hiệu quả, đáp ứng các yêu cầu của một đồ án môn học hay một sản phẩm thực tế.

1.1. Nguyên lý hoạt động cơ bản của Line Follower Robot

Nguyên lý cốt lõi của một line follower robot dựa trên sự phản xạ ánh sáng. Hệ thống thường bao gồm một dãy các cặp phát-thu hồng ngoại, ví dụ như cảm biến hồng ngoại (IR sensor), được gắn dưới gầm robot. LED phát sẽ chiếu một luồng tia hồng ngoại xuống bề mặt. Nếu bề mặt là màu trắng (hoặc màu sáng), ánh sáng sẽ phản xạ lại mạnh và phototransistor (bộ thu) sẽ nhận được tín hiệu. Ngược lại, nếu bề mặt là màu đen (hoặc màu tối), ánh sáng sẽ bị hấp thụ gần như hoàn toàn, và bộ thu nhận được rất ít hoặc không có tín hiệu. Vi điều khiển sẽ đọc các giá trị tín hiệu này, thường là tín hiệu analog, để xác định vị trí tương đối của robot so với vạch kẻ đen. Dựa trên dữ liệu từ dãy cảm biến, thuật toán dò line sẽ tính toán độ lệch (sai số) và gửi lệnh điều khiển đến driver động cơ. Lệnh này điều chỉnh tốc độ quay của hai bánh xe một cách độc lập, giúp robot tự động điều chỉnh hướng đi để giữ cho vạch kẻ luôn nằm ở trung tâm của dãy cảm biến.

1.2. Phân loại và ứng dụng thực tiễn của robot tự hành

Robot dò line là một phân nhánh của Mobile Robot (robot di động). Mobile Robot có thể được phân loại theo nhiều cách: theo môi trường hoạt động (trong nhà, ngoài trời, trên không, dưới nước) hoặc theo phương pháp di chuyển (bánh xe, bánh xích, chân). Các phương pháp định hướng phổ biến bao gồm Laser guidance, Magnetic spot guidance, và Wire guidance. Ứng dụng của mobile robot vô cùng rộng rãi. Trong thám hiểm không gian, robot Opportunity của NASA là một minh chứng điển hình. Trong môi trường nguy hiểm, robot Scorpion của Toshiba được dùng để dọn dẹp nhà máy hạt nhân Fukushima. Đặc biệt trong công nghiệp, các xe tự hành AGV (Automated Guided Vehicle) sử dụng công nghệ tương tự robot dò đường để vận chuyển hàng hóa trong các nhà kho và nhà máy, giúp tối ưu hóa chuỗi cung ứng. Ngay cả trong đời sống hàng ngày, robot hút bụi thông minh cũng là một dạng mobile robot có khả năng tự lập bản đồ và tìm đường. Những ứng dụng này cho thấy tầm quan trọng của việc nghiên cứu và thiết kế hệ thống điều khiển robot dò line.

II. Phương pháp lựa chọn linh kiện cho Robot Dò Line tối ưu

Giai đoạn lựa chọn linh kiện là bước nền tảng quyết định hiệu năng và chi phí của toàn bộ dự án thiết kế hệ thống điều khiển robot dò line. Một lựa chọn sai có thể dẫn đến hiệu suất kém, khó gỡ lỗi và tăng chi phí không cần thiết. Quá trình này đòi hỏi sự cân nhắc kỹ lưỡng giữa các yếu tố kỹ thuật và ngân sách. Đối với bộ não của robot, việc lựa chọn vi điều khiển là quan trọng nhất. Arduino phổ biến cho người mới bắt đầu nhờ cộng đồng hỗ trợ lớn và thư viện phong phú. STM32 cung cấp hiệu năng xử lý cao hơn, phù hợp cho các thuật toán phức tạp. Trong khi đó, Raspberry Pi có thể đảm nhiệm các tác vụ xử lý ảnh nếu robot sử dụng camera. Về cảm biến, cảm biến hồng ngoại như TCRT5000 là lựa chọn phổ biến nhất cho việc dò line, cung cấp tín hiệu analog cho phép xác định vị trí chính xác. Về cơ cấu chấp hành, động cơ DC có gắn encoder là phương án tối ưu để điều khiển tốc độ chính xác. Để điều khiển động cơ này, cần một driver động cơ phù hợp như L298N hoặc L293D, có khả năng đảo chiều và điều khiển tốc độ qua PWM. Cuối cùng, khung xe robot và nguồn cấp cũng cần được tính toán cẩn thận để đảm bảo sự ổn định, cân bằng và thời gian hoạt động đủ lâu cho các bài thử nghiệm. Mỗi thành phần đều là một mắt xích quan trọng, và sự tương thích giữa chúng sẽ tạo nên một hệ thống robot hoàn chỉnh và hiệu quả.

2.1. Lựa chọn vi điều khiển Arduino STM32 hay Raspberry Pi

Việc lựa chọn vi điều khiển (MCU) phụ thuộc vào yêu cầu của bài toán. Đối với các đồ án môn học cơ bản, Arduino (cụ thể là Arduino Atmega2560 được đề cập trong tài liệu) là một lựa chọn tuyệt vời. Nó có ưu điểm là dễ sử dụng, cộng đồng lớn, nhiều thư viện hỗ trợ cho driver động cơ và cảm biến, giúp việc lập trình robot trở nên nhanh chóng. Tuy nhiên, nếu yêu cầu robot xử lý các thuật toán PID phức tạp với tốc độ lấy mẫu cao, STM32 sẽ là lựa chọn mạnh mẽ hơn nhờ tốc độ xử lý vượt trội và nhiều bộ ngoại vi phần cứng chuyên dụng. Trong trường hợp muốn phát triển robot dò line sử dụng camera và các thuật toán xử lý ảnh, Raspberry Pi sẽ là phương án phù hợp nhất, vì nó hoạt động như một máy tính nhúng hoàn chỉnh có khả năng chạy hệ điều hành và các thư viện xử lý ảnh phức tạp.

2.2. Phân tích các loại cảm biến hồng ngoại và driver động cơ

Cảm biến là "đôi mắt" của robot. Cảm biến hồng ngoại (IR sensor) như TCRT5000 là lựa chọn tối ưu cho việc dò line. Chúng cung cấp tín hiệu analog, phản ánh chính xác khoảng cách và độ phản xạ của bề mặt, từ đó giúp thuật toán xác định vị trí của robot một cách mịn màng thay vì chỉ có hai trạng thái ON/OFF như tín hiệu digital. Về cơ cấu chấp hành, động cơ DC servo giảm tốc (ví dụ GA25 trong tài liệu) có tích hợp encoder là lựa chọn lý tưởng. Encoder cung cấp phản hồi về tốc độ và vị trí, rất cần thiết cho điều khiển PID chính xác. Để điều khiển các động cơ này, cần một mạch công suất, hay còn gọi là driver động cơ. L298N là một module phổ biến, có khả năng điều khiển hai động cơ DC độc lập, hỗ trợ điều khiển tốc độ bằng PWM và đảo chiều quay. Việc lựa chọn đúng driver có khả năng chịu dòng đủ lớn cho động cơ là rất quan trọng để tránh quá tải và hư hỏng.

III. Hướng dẫn Thiết Kế Hệ Thống Điện và Cảm Biến Dò Line

Việc thiết kế hệ thống điều khiển robot dò line đòi hỏi một hệ thống điện được xây dựng một cách khoa học và chính xác. Trọng tâm của hệ thống này là khối cảm biến, khối nguồn và khối điều khiển động cơ. Một thiết kế tốt sẽ đảm bảo tín hiệu ổn định, cấp nguồn đủ và hoạt động bền bỉ. Theo tài liệu tham khảo, nhóm nghiên cứu ban đầu gặp khó khăn với thanh cảm biến BFD-1000 do tín hiệu không ổn định. Điều này dẫn đến quyết định tự thiết kế mạch in PCB cho một dãy 7 cảm biến hồng ngoại TCRT5000. Việc tự thiết kế cho phép tối ưu khoảng cách giữa các cảm biến (15mm) và chiều cao so với mặt sàn (14mm) để đạt hiệu quả dò line tốt nhất. Sơ đồ nguyên lý của mỗi cảm biến được tính toán cẩn thận để đảm bảo dòng điện qua LED phát và độ nhạy của phototransistor là tối ưu. Tín hiệu analog thô từ cảm biến được đưa về các chân ADC của vi điều khiển để xử lý. Bên cạnh khối cảm biến, khối nguồn cũng rất quan trọng. Hệ thống sử dụng hai nguồn riêng biệt: một nguồn 9V cho Arduino và một nguồn 12V (từ 4 pin Lion) cho driver động cơ L298N, nhằm tránh sụt áp và nhiễu ảnh hưởng đến vi điều khiển. Toàn bộ mạch điện tử được kết nối một cách logic, đảm bảo tín hiệu được truyền nhận chính xác giữa các khối chức năng.

3.1. Thiết kế mạch nguyên lý cho cảm biến hồng ngoại TCRT5000

Sau khi gặp vấn đề với thanh cảm biến BFD-1000, phương án thiết kế mạch in PCB riêng sử dụng cảm biến TCRT5000 được lựa chọn. Mục tiêu là xây dựng một mạch điện tử có tín hiệu analog ổn định. Dựa trên tài liệu gốc, sơ đồ nguyên lý cho mỗi cảm biến được tính toán để tối ưu hóa hoạt động. Điện trở R1 được chọn để giới hạn dòng qua LED phát hồng ngoại ở mức an toàn nhưng vẫn đủ sáng (khoảng 37.5mA). Điện trở R2 được tính toán để phototransistor hoạt động trong vùng nhạy nhất, đảm bảo sự khác biệt tín hiệu giữa nền trắng và vạch đen là rõ rệt nhất. Việc tự thiết kế cho phép bố trí cảm biến nằm ngang, giúp tăng khả năng nhận biết đường line theo phân tích từ datasheet. Cách tiếp cận này cho thấy tầm quan trọng của việc hiểu sâu về linh kiện thay vì chỉ sử dụng module có sẵn.

3.2. Bố trí và xử lý tín hiệu analog từ dãy cảm biến

Với 7 cảm biến hồng ngoại được bố trí, việc xác định khoảng cách giữa chúng là cực kỳ quan trọng. Tài liệu đã tính toán và thực nghiệm để chọn ra khoảng cách tối ưu là 15mm. Khoảng cách này đủ gần để không bỏ sót line khi robot vào cua, nhưng cũng đủ xa để vùng quét của các cảm biến liền kề không chồng lấn gây nhiễu. Chiều cao tối ưu từ cảm biến đến mặt sàn được xác định là 14mm. Sau khi có tín hiệu analog từ 7 cảm biến, bước tiếp theo là xử lý tín hiệu analog. Vi điều khiển sẽ đọc giá trị ADC từ mỗi cảm biến. Một thuật toán trọng số (weighted average) thường được áp dụng. Mỗi cảm biến được gán một trọng số (ví dụ: -3, -2, -1, 0, 1, 2, 3), và vị trí của line được tính bằng tổng các giá trị cảm biến nhân với trọng số tương ứng, sau đó chia cho tổng các giá trị cảm biến. Kết quả là một giá trị sai số duy nhất, cho biết robot đang lệch trái hay phải so với tâm line.

3.3. Tích hợp driver động cơ L298N và khối nguồn cấp robot

Khối driver động cơ và nguồn cấp cho robot là trái tim của hệ thống truyền động. Tài liệu đã lựa chọn module L298N, một mạch cầu H phổ biến, để điều khiển động cơ DC. Module này được kết nối với Arduino thông qua các chân digital để điều khiển chiều quay (IN1, IN2, IN3, IN4) và các chân PWM để điều khiển tốc độ (ENA, ENB). Một điểm thiết kế quan trọng trong tài liệu là việc tách biệt nguồn. Nguồn cấp cho robot được chia làm hai: một nguồn 12V từ pin Lion cấp riêng cho L298N để vận hành động cơ, và một nguồn 9V khác cấp cho vi điều khiển. Việc này giúp vi điều khiển hoạt động ổn định, không bị ảnh hưởng bởi sụt áp đột ngột khi động cơ khởi động hoặc đảo chiều, một vấn đề thường gặp trong các thiết kế robot nghiệp dư.

IV. Bí quyết lập trình và tối ưu thuật toán điều khiển PID

Phần mềm và thuật toán là linh hồn quyết định sự thông minh và hiệu quả của robot. Trong dự án thiết kế hệ thống điều khiển robot dò line này, thuật toán PID (Proportional-Integral-Derivative) đóng vai trò trung tâm. Đây là một bộ điều khiển vòng kín, liên tục tính toán sai số (sự chênh lệch giữa vị trí hiện tại và vị trí mong muốn của line) và điều chỉnh công suất động cơ để giảm thiểu sai số này về 0. Việc lập trình robot được thực hiện trên nền tảng Arduino với ngôn ngữ C/C++. Lưu đồ giải thuật được xây dựng một cách logic, bắt đầu bằng việc đọc tín hiệu từ dãy 7 cảm biến, tính toán giá trị sai số vị trí. Giá trị sai số này sau đó được đưa vào bộ điều khiển PID. Khâu P (Tỷ lệ) tạo ra một lực điều khiển tỷ lệ với sai số hiện tại, giúp robot phản ứng nhanh. Khâu I (Tích phân) giúp khử sai số xác lập, đảm bảo robot sẽ quay về đúng tâm line. Khâu D (Vi phân) dự đoán xu hướng của sai số, giúp giảm vọt lố và làm cho robot di chuyển mượt mà hơn khi vào cua. Một thách thức lớn là việc tinh chỉnh các hằng số Kp, Ki, Kd. Quá trình này đòi hỏi nhiều lần thực nghiệm và hiệu chỉnh để đạt được đáp ứng tốt nhất, giúp robot vừa nhanh vừa ổn định.

4.1. Xây dựng lưu đồ giải thuật cho hệ thống điều khiển

Trước khi viết code, việc xây dựng một lưu đồ giải thuật rõ ràng là bước không thể thiếu. Dựa trên phân tích từ tài liệu, lưu đồ bắt đầu bằng một vòng lặp vô tận. Trong mỗi vòng lặp, robot thực hiện tuần tự các bước: 1) Đọc giá trị analog từ 7 cảm biến hồng ngoại. 2) Tính toán sai số vị trí (error) dựa trên thuật toán trọng số. 3) Đưa giá trị sai số này vào hàm điều khiển PID để tính toán giá trị điều chỉnh (correction). 4) Tính toán tốc độ mục tiêu cho mỗi bánh xe. Tốc độ bánh trái sẽ bằng tốc độ cơ bản trừ đi giá trị điều chỉnh, và tốc độ bánh phải bằng tốc độ cơ bản cộng với giá trị điều chỉnh. 5) Gửi tín hiệu PWM tương ứng đến driver động cơ L298N. Lưu đồ cũng cần xử lý các trường hợp đặc biệt như khi robot mất line hoàn toàn hoặc tại các ngã rẽ phức tạp, giúp robot hoạt động một cách tin cậy.

4.2. Nguyên tắc và ứng dụng bộ điều khiển PID trong robot

Bộ điều khiển PID là giải pháp được hơn 90% các hệ thống điều khiển công nghiệp sử dụng. Trong robot dò đường, PID giúp robot bám line một cách thông minh thay vì chỉ chạy zig-zag như thuật toán ON-OFF. Nguyên tắc hoạt động của nó dựa trên ba thành phần: P (Proportional) phản ứng với sai số hiện tại, giúp robot bẻ lái ngay khi lệch khỏi line. I (Integral) tính tổng các sai số theo thời gian, giúp robot triệt tiêu các sai số nhỏ còn sót lại và đi thẳng vào tâm. D (Derivative) đo lường tốc độ thay đổi của sai số, có tác dụng hãm lại khi robot tiến về tâm quá nhanh, tránh hiện tượng vọt lố và dao động. Sự kết hợp của ba khâu này tạo ra một hệ thống điều khiển động cơ linh hoạt, giúp robot ổn định ở cả đường thẳng và các khúc cua khó.

4.3. Tinh chỉnh thông số Kp Ki Kd cho động cơ DC

Việc tinh chỉnh các hệ số Kp, Ki, Kd là phần khó khăn nhưng quan trọng nhất khi triển khai thuật toán PID. Không có một bộ thông số hoàn hảo cho mọi robot. Theo tài liệu, nhóm đã sử dụng công cụ PID Tuner của Matlab và kết hợp điều chỉnh thực tế. Phương pháp phổ biến là: 1) Bắt đầu với Ki và Kd bằng 0, tăng dần Kp cho đến khi robot bắt đầu dao động quanh line. 2) Giữ Kp, tăng dần Kd để giảm dao động và giúp robot chạy mượt hơn. 3) Cuối cùng, tăng nhẹ Ki để robot có thể tự điều chỉnh về chính xác tâm line trên đường thẳng. Quá trình này đòi hỏi sự kiên nhẫn và ghi chép cẩn thận các kết quả thử nghiệm. Tài liệu đã đưa ra các thông số PID cụ thể cho từng động cơ DC sau khi hiệu chỉnh, cho thấy sự khác biệt nhỏ về cơ khí giữa hai động cơ cũng cần được bù trừ bằng phần mềm.

V. Đánh giá kết quả thực nghiệm Hệ Thống Robot Dò Line

Giai đoạn thực nghiệm là thước đo chính xác nhất cho sự thành công của một dự án kỹ thuật. Sau khi hoàn tất việc thiết kế hệ thống điều khiển robot dò line, quá trình chạy thử và đánh giá trên sa bàn thực tế cung cấp những dữ liệu quý giá để hiệu chỉnh và cải tiến. Theo báo cáo thực tập và đồ án, robot sau khi lắp ráp hoàn chỉnh đã được tiến hành chạy thử nghiệm nhiều lần. Kết quả ấn tượng nhất là robot có thể hoàn thành sa bàn với thời gian xấp xỉ 27 giây, đạt vận tốc trung bình khoảng 0.42 m/s, đáp ứng và vượt mục tiêu thiết kế ban đầu (0.4 m/s). Việc này chứng tỏ sự kết hợp giữa thiết kế cơ khí vững chắc, hệ thống điện ổn định và thuật toán PID được tinh chỉnh tốt đã mang lại hiệu quả cao. Tuy nhiên, quá trình thực nghiệm cũng chỉ ra một số vấn đề tồn tại. Cụ thể, cảm biến đôi lúc bị nhiễu bởi ánh sáng môi trường, và sai số cơ khí trong việc lắp đặt động cơ làm giảm tính ổn định của xe. Những đánh giá này không chỉ xác nhận kết quả đạt được mà còn mở ra các hướng cải tiến quan trọng cho các phiên bản tiếp theo, chẳng hạn như thêm tấm che cho cảm biến hoặc tăng độ chính xác trong gia công cơ khí.

5.1. Phân tích kết quả vận hành robot trên sa bàn thực tế

Kết quả thực nghiệm được ghi lại chi tiết trong tài liệu là minh chứng rõ ràng nhất. Robot đã hoàn thành sa bàn phức tạp với thời gian nhanh nhất là 27 giây. Tốc độ này cho thấy bộ điều khiển PID đã hoạt động hiệu quả, cho phép robot duy trì tốc độ cao ở cả đoạn thẳng và giảm tốc hợp lý khi vào cua để không bị trượt bánh. Việc mô phỏng robot trước đó trên SolidWorks và tính toán động học đã giúp xác định các thông số cơ bản, nhưng kết quả thực tế mới là yếu tố quyết định. Bảng kết quả chạy thử qua các ngày cũng cho thấy quá trình cải tiến liên tục: từ 40 giây ở lần chạy đầu, sau khi thêm hộp che cảm biến và ổn định nguồn, thời gian đã giảm xuống còn 27 giây. Điều này nhấn mạnh tầm quan trọng của việc gỡ lỗi và tối ưu hóa hệ thống dựa trên dữ liệu thực tế.

5.2. Các lỗi thường gặp và phương án hiệu chỉnh thiết kế

Không có thiết kế nào là hoàn hảo ngay từ đầu. Báo cáo đã thẳng thắn chỉ ra các vấn đề gặp phải. Lỗi phổ biến nhất là cảm biến hồng ngoại bị nhiễu do ánh sáng từ môi trường bên ngoài, làm robot "nhìn" sai vạch. Giải pháp được đề xuất và áp dụng là làm thêm hộp che chắn cho cụm cảm biến. Một vấn đề khác là sự không đồng trục khi lắp đặt hai động cơ DC, gây ra sai lệch trong chuyển động. Điều này cho thấy tầm quan trọng của việc gia công cơ khí chính xác. Đề xuất hiệu chỉnh bao gồm việc tăng độ chính xác khi gia công đồ gá động cơ và thực hiện các thí nghiệm để đánh giá sai số vận tốc của từng động cơ, từ đó bù trừ trong phần mềm. Những kinh nghiệm này là bài học quý giá cho bất kỳ ai đang thực hiện một đồ án môn học về robot.

VI. Tương lai và hướng phát triển cho công nghệ Robot Dò Line

Dự án thiết kế hệ thống điều khiển robot dò line không chỉ dừng lại ở một sản phẩm hoàn chỉnh mà còn mở ra nhiều hướng phát triển và nâng cấp trong tương lai. Công nghệ robot dò line là nền tảng cơ bản cho các hệ thống phức tạp hơn. Một trong những ứng dụng trực tiếp và quan trọng nhất là trong lĩnh vực logistics và sản xuất tự động với các xe tự hành AGV. Các AGV trong nhà kho hiện đại sử dụng các nguyên tắc dò line (bằng băng từ hoặc vạch sơn) để vận chuyển hàng hóa một cách tự động, chính xác và hiệu quả. Hướng phát triển tiếp theo là nâng cao "trí thông minh" của robot. Thay vì chỉ sử dụng cảm biến hồng ngoại, các hệ thống tương lai có thể tích hợp camera và áp dụng các thuật toán xử lý ảnh. Điều này cho phép robot nhận diện các loại line phức tạp hơn, đọc mã vạch, hoặc thậm chí nhận diện và tránh các vật cản bất ngờ trên đường đi. Ngoài ra, việc áp dụng các thuật toán tự học như Q-learning hay mạng nơ-ron nhân tạo có thể giúp robot có khả năng "ghi nhớ" đường đi. Sau mỗi lần chạy, robot sẽ tự động tối ưu hóa các thông số điều khiển để hoàn thành sa bàn nhanh hơn trong các lần tiếp theo. Những cải tiến này sẽ biến một line follower robot đơn giản thành một hệ thống tự hành thông minh và linh hoạt hơn rất nhiều.

6.1. Ứng dụng robot dò line trong công nghiệp và xe tự hành AGV

Kiến thức từ việc thiết kế hệ thống điều khiển robot dò line là bước đệm vững chắc để tiến vào lĩnh vực tự động hóa công nghiệp. Các xe tự hành AGV là một ví dụ điển hình. Chúng sử dụng các nguyên tắc tương tự: một hệ thống cảm biến (thường là cảm biến từ hoặc camera) để đi theo một đường dẫn định trước, một vi điều khiển để xử lý logic, và một hệ thống điều khiển động cơ mạnh mẽ để di chuyển các tải nặng. Việc nắm vững thuật toán PID, thiết kế phần cứng và xử lý tín hiệu từ dự án robot dò line sẽ cung cấp những kỹ năng cốt lõi cần thiết để thiết kế và triển khai các hệ thống AGV trong môi trường nhà máy và kho bãi, góp phần vào cuộc cách mạng công nghiệp 4.0.

6.2. Nâng cao hệ thống bằng xử lý ảnh và thuật toán tự học

Để vượt qua giới hạn của cảm biến hồng ngoại, hướng đi tất yếu là sử dụng camera kết hợp với xử lý ảnh. Một camera có thể cung cấp cho robot một lượng thông tin khổng lồ về môi trường xung quanh, không chỉ là một vạch đen. Với xử lý ảnh, robot có thể nhận diện các giao lộ phức tạp, đọc các chỉ dẫn, và dò line với độ chính xác cao hơn. Hơn nữa, các thuật toán học máy (Machine Learning) có thể được áp dụng. Ví dụ, robot có thể được "dạy" cách phản ứng với các loại cua khác nhau bằng cách phân tích dữ liệu từ hàng ngàn lần chạy thử. Điều này mở ra khả năng tự tối ưu hóa, giúp robot không chỉ bám theo line mà còn tìm ra cách bám theo một cách hiệu quả nhất, một bước tiến lớn trong công nghệ lập trình robot tự hành.

Trích đoạn nội dung tài liệu

ĐẠI HỌC QUOC GIA THÀNH PHÔ HỒ CHÍ MINH TRƯỜNG ĐẠI HỌC BÁCH KHOA KHOA CƠ KHÍ ~ BỘ MÔN CƠ ĐIỆN TỬ asTP.HCM BAO CAO DO AN THIET KE HE THONG CO DIEN TU DE TAI THIET KE, CHE TAO, DIEU KHIEN ROBOT DO LINE GVHD: Thdy Pham Céng Bang SVTH: Nguyễn Trấn Quốc Toàn 1613601 Nguyễn Văn Tùng 1614004 Tran Ngoc Tri 1613751 Mai Thành Nhân 1612345 TP. Hồ Chí Minh, 2019 MUC LUC MUC LUC coc ccs cescenscenseenaeeaeeaecaeeaeeaeesaeenesaaeeaaesaaeeaesaaeseaeeaaeeaaesaaeseaeaaeenaeenaeeas 1 MUC LUC HINH ANH o. 8 Phần 1: TONG QUAN. Téng quan vé Mobile Robot:.

Phân loại Mobile robot:. Cách định hướng di chuyển của Mobile Robot:.----2--5:s+- 10 LEIE đài ảnG ốố. Magnetic spot guidance (hay con goi là điểm từ):. Magnetic Tape guidance (hay còn gọi là băng từ):.

Ứng dụng của Mobile rObot:.---¿--2¿©22+©52+cx+2EE+EE2EEEerkrsrxrrrrsrxrrrree 13 1. Tổng quan về robot đò line:. ¿2-22 +¿©2++E£22E++EE+2EEtEEE+EESEEEEEerkerrxerrrerkeee 16 1. Một số mô hình robot đò line trong các cuộc thH:.

Các thành phần xe do line:. ¿22 2©22+2£+SE+EE+2EE+EE+EEEEE2EEvEEvrxrrxerxee 18 a. 2-2 2 +s<+SE+Se+E++E9EE9EE2E52321211211211211111221111111 1511. 21 * Phương pháp đọc tín hiệu cảm biến:.

Phần cấu trúc điều khiỂn: .--2- 2 2 +s+E+EE+EE+E2EEE21121311211 2112121111 xe 23 d. Bộ điều khiễn:. Mục tiêu và nhiỆm VỤ:. -- SG 2< 2231111111111 1 1111111111111 HH HH HH re 26 1.

Đề bài đặt ra:. Nhiệm vụ đặt ra: .- -- ---- - 1 S122 1111211 HS HH HH ng KH ke 26 1. 1e 26 Phần 2: LỰA CHỌN PHƯƠNG ÁN.-52-5252S2 x22 tt ErErrrrrrrie 28 MUC LUC QL. VE Co kts ce ccececcccccessessscsseessesuesucsussssesussucsuesssesassussussssesuesussucstsaesatsussucaneatessees 28 2.

VG pla MiG. Phurong an cam DiGh: ooo. Cầu tric didur KmiGI eee ececceccessessessessesseseccucsessesaesucsuesssessesucsucsaesuesucsnsateaesnessees 28 2. Bo didu biG.

cceccesseseesecsesecsuesecsucsssesucsucsucsussucsucsussesaesucssaesaesatesaesseees 28 Phan 3: THIẾT KẾ CƠ KHÍ. 2-2 2+ 2+2 +ESE+EE+EE+E+EE2EEE+EEEESEEEEEEEEEEEEEEErrrrree 29 3. Tính toán kích thước Xe. - -- -- - <3 3S SH HH9 111K n ng KH n TH 01 K51 1kg 29 3.

Tính toán công suất cho động cƠ:. Tính toán moment xoắn động cơ .--- 2-2 2++2+++++2x+2E2Ez+Ex+rxsrxered 31 3. Điều kiện để xe vào cua ma không bị trưỢt:. Điều kiện để xe vào cua mà không bị lật.

Các thông $6 CO DAN CUA XC ceececececcsssssscsesesesesesestsesusssssscscsssesesesesssestscseseseees 32 k2 ro nh. Dung sai lắp ghép đồ gá động cơ:. Gia công đỗ gá động cơ. Các tắm đểể Xe:.

- ¿- 2 se +s2SE2E1215211211211211211111211211111111 1221211212 1121111 021111111 re. 40 Phan 4: THIET KE HE THONG DIEN. 2-2 2© 2 +E+EE+EE+EE+EEEEEEESEEEEEEErrrkerrved 41 4. Thiết kế khối cảm biến đò linne:.

2-2-2 Ss+S£+E+SE+EE2EE2EE2EE2EE2EE2EEE. Các yêu cầu khi lựa chọn cảm biến.-2- 2 2+Sz+E+SE+EE+EE+Ereerxersee 41 4. Phương án 1: Đọc tín hiệu Digital bằng thanh cảm biến BED-1000:. Phương án 2: Đọc tín hiệu Analog băng cảm biến TCRC 5000.

Tính toàn thiết kế thành cảm biến:.- 2 ©222252+SE+2E22EE2EE22E2EESEEerkrrkered 43 b. Chọn cách đặt cảm biỀn:. 2-5252 SSSE+EE+EE9E2EE2E12152121211211211211111 1x xe 44 c. Bố trí các cảm biến:.

Xử lý tín hiệu cảm biến. Khối driver và động CƠ:. Điều khiển động cơ hai bánh xe? oo.cceccsccseessesssssssssssessessessessessessssesseeseeseeeseesees 50 Phân 5: THIẾT KÉ PHÂN LẬP TRÌNH .---22©2222222EE+EE2EE2EE22222E22E2E Lee. Sơ đồ khối hệ thống điều khiển:.---2-©22©2222E+EE+EE2EE22E2212212221221221 221 2Xe2 54 408i.

56 Phan 6: KET QUA THUC NGHIỆM.-2- 2 2+ 2+E2+EE+E+EeEE2EESEEEEEEEerkerkerrrree 58 6. Kết qua thyre nghi@me. Danh gid két qua thyre mghiGnns. Để xuất phương án hiệu chỉnh thiết k:.--- 2 22+22+2E+2E+EE+2E2EE+EE+rxerxerxee 59 Tài liệu tham khiảO:.

--- - G5 2216111231111 1111230 1111131111130 111123 1K nE H11 kcrưy 60 MUC LUC MUC LUC HINH ANH Ipihii08g.1: Robot chuyên động bằng bánh xe (a) và bánh xích (b).2: Robot truyền động băng chân.-- 2-52 ©2SE+SE+2E2EE2EE2EE2EEEEEEErreee 10 Hinh 1.2: Hé thong Laser guidance [5],.- 2-22 2¿©52+E22EE+EE++EE2EEvrxesrxerreerxee 10 Hinh 1.3: Magnetic spot guidance [6] oo.4: Nguyén tac hoạt động Magnetic spot guidance [7].5: Nguyên tắc hoat déng magnetic guidace [§].7: Robot Opportunity của NASA [10],.ẶSẶS S2 Sseirkkreeeerre 13 Hinh 1.8: Robot Scorpion cua TOSHIBA [1 1].9: Robot van chuyén hang hoa [12].10: Robot lau nhà Xiaomi Roboroek Gen 3 [13] .11: Robot 510 PackBot được sản xuất bởi iRobot.--2©5sss+e+zszesezevrsrs 15 Hinh 1.12: Robot phục vụ nhà hàng của LKK Group [1Š],.13: Robot dò line “The Chariot” (a) và sơ đồ nguyên lý của nó (b) [16].14: Robot dò line Silvestre (a) va sơ đồ nguyên lý (b) [L7].15: Mô hình xe dò line “Fireball” (a) và sơ đồ nguyên lý (b) [1§].16: Động cơ DC Servo giảm tốc GA25 [19].17: Động Cơ Bước Step Motor NEMA17 NEMA23 Stepper [20].- Ác S- 2< ST ST TH H1 1 11T H1 11T HH TH HH Hư 20 Hinh 1.19: Pixy2 CMUcam5 Smart Vision Sensor [2Ï]. ----+-<+<<+cs+cxssessecxs 21 Hinh 1.--- - -- SĂ 2< S113 S3 2512111151211 11111111 111 11 1 1 11H Hi He 21 Hinh 1.21: Nguyén ly cua cam bién quang dan .22: Tín hiệu đọc về digital .23: Thuật toán xấp xỉ đọc tín hiệu analog: xấp xỉ bậc hai (a) và theo trong sé (b) 111111511111 11 1111130111111 T1 T111 T111 TT TT TH TT TT TT TT TT T111 T111 TT.24: Điều khiển tập trung (Centralized control).-------¿-sz©c++csz+cs+2 23 Hình 1.25: Cấu trúc điều khiển phần cấp (Distributed control).1: Phương án xe 3 bánh 2 bánh sau dẫn động.1: Các lực tác dụng lên xe dò line. --- <5 5< <++< + *++<++sxe+eeeeeseeseeesee 29 MUC LUC Hinh 3. M6 hinh SolidWorks cla xe dO Ïlne.

-----csScsSx+sxssersessresrrereeeeke 33 Hinh 3.3: Kích thước 94 dOng CO oo. cece ceceeeeeeeceeceeseeseeseescescesaeeeeeaesaeeecenaesaeeeeenaesaees 34 Hình 3.4: Đồ gá động cơ sau khi hoàn thiện.-- 2© 2©22+++EE+EE+2Ez+EE+EE+rxerxeee 34 Hình 3.5: Các bước thực hiện gia công đỗ gá;.-----©2-©52©22SE22E2EE2EEEEerxerkeei 35 Hinh 3. 6: Kích thước mặt mica phía đưỚi.7: Kích thước mặt mica phía trÊn.----¿-©2¿-©+¿22++EE22EEESEE22EE22EE27112112112212211 21.10: Vận tốc xe và bánh trái, phải theo thời gian khi xe chạy thắng.1 L:Vận tốc xe và bánh trái, phải theo thời gian khi xe chạy cung tròn.1: Thanh cảm biến dò line hồng ngoại BED-1000 [22],.3: Mạch điện I cảm biến TCRC5000.-2- S2 SE SESE111 1111525111151 Exey 43 Hình 4.4: Đồ thị quan hệ giữa [F và I€ [23].--2-©22-52222++2 xe2Execxrsrxesrxerkecred 43 Hình 4.5: Đồ thị quan hệ I€Œ và V [244].----¿--¿©-2+-<+2E£+EE+EE+EEEEEEEEEEEEEerkrrkerreee 44 Hình 4.6: Ảnh hưởng của việc đặt cảm biến lên switching distance .7: Vùng hoạt động của cảm biến TCR.- 2-2 St SE SE EErErxererrree 45 Hình 4.8: Khoảng cách giữa 2 cảm biến D (mm).--2- ©5222 S222E22222EE+EEvrxerxeei 46 Hình 4.9: Phạm vi quét của 2 cảm biến liền kề.--©2-©52©52222+EE+EE+EE+EEcxeczeeei 46 Hình 4.10: Sơ đồ khối cảm biến.---2--252+ SS+ttEExtrtrEkrrttrrrrrrrrrrrrrrrrrrrrrirerried 47 Hình 4.11: Động cơ DC Servo giảm tốc GA25.13: Sơ đồ khối driver và động cơ [25].------©2+©52©222222EE+EE+EEerxerxecrxeee 48 Hình 4.14: Sơ đồ khố chung cho toàn hệ thống .--2--2-©522+2©52+2++2z++>xz+cxd 49 Hình 4.15: Quan hệ giữa phần trăm xung PWM và vận tốc động cơ trái (a) và phải (b) 1101111111111 111111111111 11 11 111111 11 111 11T Tá TH Tá Tá Tá Tà TT Tá TT TT Tá TT TT Tá Tàn Tá Tá 51 Hinh 4.16: So dé diéu khién van téc AGN CO .17: Mối quan hệ giữa phần trăm xung PWM đầu vào và vận tốc đông cơ trái G1840! 0707 8088.18: Mối quan hệ giữa phần trăm xung PWM đầu vào và vận tốc đông cơ phải G1840! 0707 8088.1: Sơ đồ hệ thống điều khiến.-- 2 2©22+2E+EE+EE+EE22EE2EE2EE22E221212212222ee.2: Ví điều khiên Arduino Atmega 2560 [26].---2--2¿©225522cxccescsee 54 5 MUC LUC Hình 5.3 Sơ đồ khối điều khiễn.-----¿-+222cc+tEEEkErrttErkrrrtrirrrriirrrried 55 Hình 5.1: Chạy thực nghiệm robot đò Ìine. ---- ©5555 5c *+x+s+sEEsexsekrxrreeeeeeree 58 MUC LUC BANG Bảng 1.1: Đánh giá ưu, nhược điểm sơ đồ nguyên lý .---2--222+2cs+cx+zxscxeei 18 Bang 1.2: So sánh giữa các phương pháp đọc cảm biến:.--2-©-222+2s+cxzc5ze: 23 Bang 1.3: So sánh cấu trúc điều khién tập trung và cấu trúc điều khiên phân cấp .1: Thông số xe đò line.-- 2-2 2©222EE2+E2EE+EE+EESEEEEE221222122122121212221 22C.1: So sánh sánh ưu nhược điểm của số lượng cảm biến dò line .2: Thông số kỹ thuật của thanh cảm biến đò line hồng ngoại BFD-1000.3: Thông số kỹ thuật của cảm biến TCR 5000.4: Các thông số của motor driver L298N.1: Các thông số của Arduino Atmega 2560.1: Két qua thurc nghigm .cccccccccssssssssssssssesssesssssnesssesssesssesseeseeseesseestesseeseeess 58 Yéu cau YEU CAU Đồ án môn học Thiết kế hệ thống cơ điện tử yêu cầu sinh viên thực hiện thiết ké, chế tạo và điều khiến robot đò line (Line following robot).

Robot sau khi hoan thanh phải đúng kích thước như yêu cầu và di chuyên đúng theo sa bàn line phăng có quỹ đạo di chuyển: A 3> B >C>D>E>F>C>3G>3A>3C3E và các kích thước như (hỉnh 1). Hình 1: Kích thước sa bàn MỤC TIỂU Do yêu cầu của đồ án môn học (ĐAMR) là thiết kế, chế tạo và điều khiển nên mục tiêu quan trọng nhất của robot dò line là bám line ôn định nhất có thể và thỏa mãn các yêu câu của bài toán. Phân công nhiệm vụ PHAN CONG NHIEM VU Tên thành viên Nhiém vu Nguyễn Văn Tùng Thiết kế lựa chọn kết cầu cơ khí Tính toán công suất động cơ Chọn động cơ Gia công đồ gá Vẽ 3D Mai Thành Nhân Sơ đồ nguyên lý Tìm kiếm tải liệu Làm báo cáo Tổng hợp báo cáo Nguyên Trân Quôc Toản Xuất bản vẽ 2D Xuất bản vẽ điện Thiết kế mạch điện Thiết kế cảm biến Lắp rap va hé tro chạy thực nghiệm Trần Ngọc Trí Mô phỏng động học Thiết kế thuật toán Thiết kế cảm biến Thiết kế và chọn bộ điều khiển Lập trinh Phan 1: Tong quan Phan 1: TONG QUAN 1. Téng quan vé Mobile Robot: Cùng với sự phát triển không ngừng của các ngành khoa học kỹ thuật, các ngành công nghiệp cũng phát triển nhanh chóng.

Việc áp dụng các máy móc hiện đại vào sản suất là một yêu cầu không thẻ thiếu trong các nhà máy nhằm tăng năng suất, tăng chất lượng và giảm giá thành sản phẩm. Song song với sự phát triển đó, công nghệ chế tạo Robot cũng phát triển nhanh chóng, đặc biệt là ở các nước phát triển, nhăm đáp các nhụ cầu về sản xuất, sinh hoạt, quốc phòng. Trong các họ robot, chúng ta không thê không nhắc tới Mobile Robot với những đặt thù riêng mà những loại robot khác không có. Mobile robot có khả năng tự đi chuyên, có nghĩa là chúng có khả năng tự điều hướng trong một môi trường không biết trước mà không cần các thiết bị hướng dẫn vật lý hoặc cơ điện.

Ngoài ra, mobile robot có thể dựa vào các thiết bị hướng dẫn cho phép nó di chuyền trên tuyến đường dẫn được xác định trước trong không gian được cho trước (robot tự điều khién), khác với các loại robot công nghiệp thường đặt gan nhu cé dinh va hoạt động bằng các cánh tay robot. Phan loai Mobile robot: Mobile robot có thê được phân loại theo các cách sau: *Phân loại theo môi trường mà chúng di chuyển: - Robot ngoàải trời và robot trong nhà. Thông thường chùng đước lắp bánh xe nhưng cũng có khi được trang bị bánh xích hoặc chân giống người hoặc động vật. - Robot trên không: như các loại máy bay không người lái, drones,.

- Robot dưới nước. Robot chuyên động bằng bánh xe [1] b. Robot chuyên động bằng bánh xích [2] Hình 1.1: Robot chuyên động bằng bánh xe (a) và bánh xích (b) 9 Phan 1: Tong quan a. Robot 6 chan giống nhện [3] b.

“Chó Robot” di chuyên bằng 4 chân [4] Hình 1.2: Robot truyền động bằng chân * Phân loại theo phương pháp di chuyển: - Robot di chuyển bằng bánh xe (hình I. - Robot di chuyên bằng bánh xích (hình 1. - Robot có chân, chân giỗng người hay giống động vật (hình I. Cách định hướng di chuyền của Mobile Robot: a.