Báo cáo đồ án cơ điện tử: Thiết kế, chế tạo và điều khiển Robot dò line

Báo cáo đồ án cơ điện tử: Thiết kế, chế tạo và điều khiển Robot dò line. Gồm thiết kế cơ khí, hệ thống điện, mô phỏng và kết quả thực nghiệm.

Trường đại học

Trường Đại học Bách khoa

Chuyên ngành

Cơ điện tử

Người đăng

Ẩn danh

Thể loại

Đồ án thiết kế hệ thống cơ điện tử

2018

76
21
0

Phí lưu trữ

30 Point

Tóm tắt

I. Hướng dẫn toàn diện Đồ án Robot Dò Line cho sinh viên

Một đồ án Thiết kế Robot Dò Line là một trong những đề tài nền tảng và hấp dẫn nhất trong lĩnh vực cơ điện tử và robot học. Đây không chỉ là một bài tập kỹ thuật mà còn là cơ hội để sinh viên áp dụng kiến thức lý thuyết vào thực tiễn, từ thiết kế cơ khí, lựa chọn linh kiện, thiết kế mạch điện tử đến lập trình điều khiển. Line follower robot project (dự án robot đi theo vạch) mô phỏng các hệ thống tự hành dẫn đường (AGV) trong công nghiệp, giúp tự động hóa quy trình vận chuyển hàng hóa trong nhà máy, nhà kho. Mục tiêu cốt lõi của đồ án là chế tạo một robot có khả năng tự động di chuyển theo một đường vạch kẻ sẵn, thường là vạch đen trên nền trắng hoặc ngược lại. Để thực hiện thành công, cần có sự hiểu biết sâu sắc về nguyên lý hoạt động robot dò line, bao gồm cách cảm biến đọc dữ liệu, vi điều khiển xử lý tín hiệu và cơ cấu chấp hành điều chỉnh chuyển động. Một báo cáo đồ án robot dò line hoàn chỉnh thường bao gồm các chương chính như tổng quan, thiết kế cơ khí, thiết kế hệ thống điện, xây dựng thuật toán điều khiển, và cuối cùng là thực nghiệm và đánh giá kết quả. Đồ án này là bước đệm quan trọng cho các đồ án tốt nghiệp cơ điện tử phức tạp hơn sau này.

1.1. Nguyên lý hoạt động và cấu trúc cơ bản của robot dò line

Về cơ bản, nguyên lý hoạt động robot dò line dựa trên một vòng lặp điều khiển khép kín. Hệ thống cảm biến, thường là một dải cảm biến hồng ngoại dò line, sẽ liên tục quét bề mặt di chuyển. Khi cảm biến phát hiện vạch đen, tín hiệu phản xạ hồng ngoại sẽ yếu đi, và ngược lại trên nền trắng. Dữ liệu này được gửi về bộ não của robot – vi điều khiển. Vi điều khiển sẽ phân tích vị trí tương đối của robot so với tâm vạch line và tính toán sai số. Dựa trên sai số này, một thuật toán điều khiển sẽ quyết định cần điều chỉnh tốc độ của hai bánh xe như thế nào để đưa robot trở lại đúng quỹ đạo. Ví dụ, nếu robot lệch sang phải, vi điều khiển sẽ giảm tốc độ bánh phải và tăng tốc độ bánh trái để robot quay về bên trái. Quá trình này lặp lại liên tục với tần suất cao, tạo ra một chuyển động mượt mà bám theo đường line. Cấu trúc của một robot đi theo vạch đen bao gồm ba khối chính: Khối cảm biến (Sensor Block), Khối điều khiển (Control Block), và Khối chấp hành (Actuator Block).

1.2. Tổng hợp các linh kiện làm robot dò line cần thiết

Để bắt đầu một line follower robot project, việc lựa chọn linh kiện làm robot dò line là bước đầu tiên và cực kỳ quan trọng. Các thành phần chính bao gồm: 1) Khung xe: Phổ biến nhất là khung xe robot 3 bánh với hai bánh chủ động và một bánh tự do (bánh bi cầu hoặc bánh đa hướng) để đảm bảo sự linh hoạt. 2) Cảm biến: Dải cảm biến hồng ngoại như module cảm biến TCRT5000 là lựa chọn phổ biến do giá thành rẻ và độ nhạy tốt. 3) Vi điều khiển: Các dòng như lập trình Arduino (cho người mới bắt đầu) hoặc vi điều khiển STM32 (cho các ứng dụng yêu cầu tốc độ xử lý cao) được sử dụng rộng rãi. 4) Mạch điều khiển động cơ: Mạch cầu H L298N hoặc TB6612FNG là các module thông dụng để điều khiển chiều và tốc độ của động cơ. 5) Động cơ: Động cơ DC giảm tốc cung cấp đủ mô-men xoắn để robot di chuyển ổn định. 6) Nguồn điện: Pin Lipo hoặc pin sạc 18650 cung cấp năng lượng cho toàn bộ hệ thống.

II. Những thách thức chính khi thực hiện đồ án Robot Dò Line

Việc thực hiện một đồ án Thiết kế Robot Dò Line không chỉ đơn thuần là lắp ráp linh kiện mà còn đối mặt với nhiều thách thức kỹ thuật. Một trong những khó khăn lớn nhất là việc xử lý tín hiệu từ cảm biến một cách chính xác, đặc biệt khi robot di chuyển ở tốc độ cao hoặc gặp các đoạn cua gấp, giao lộ phức tạp. Nhiễu từ môi trường bên ngoài như ánh sáng mặt trời hoặc ánh đèn có thể ảnh hưởng đến độ chính xác của cảm biến hồng ngoại dò line. Bên cạnh đó, việc thiết kế cơ khí cũng là một bài toán cần cân nhắc kỹ lưỡng. Sự thiếu chính xác trong lắp ráp, độ đồng trục của động cơ, hay sự phân bổ trọng lượng không hợp lý có thể khiến robot di chuyển không ổn định, bị trượt bánh hoặc lật khi vào cua. Thách thức lớn nhất nằm ở phần thuật toán điều khiển. Một thuật toán đơn giản có thể hoạt động tốt ở tốc độ thấp nhưng sẽ thất bại khi tăng tốc. Việc tinh chỉnh các thông số của thuật toán PID cho robot dò line đòi hỏi sự kiên nhẫn và nhiều lần thử nghiệm để đạt được sự cân bằng giữa tốc độ và độ ổn định. Cuối cùng, việc thiết kế mạch in PCB gọn gàng, chống nhiễu cũng là một yếu tố quan trọng quyết định sự thành công của dự án.

2.1. Lựa chọn và bố trí module cảm biến TCRT5000 tối ưu

Lựa chọn và bố trí cảm biến là yếu tố quyết định độ chính xác của robot. Module cảm biến TCRT5000 là phổ biến, nhưng hiệu quả phụ thuộc vào cách bố trí. Số lượng cảm biến, khoảng cách giữa các cảm biến và khoảng cách từ cảm biến đến mặt sàn đều phải được tính toán cẩn thận. Nếu khoảng cách quá gần, robot dễ mất dấu line ở các đoạn cong. Nếu quá xa, độ nhạy sẽ giảm. Tài liệu nghiên cứu gốc đề xuất khoảng cách giữa hai cảm biến liên tiếp là 15mm và chiều cao so với mặt sàn là 6mm sau khi thực nghiệm. Việc bố trí cảm biến theo một hàng ngang và sử dụng phương pháp xấp xỉ trọng số để xác định tâm line giúp tăng độ chính xác so với việc chỉ đọc giá trị bật/tắt (digital).

2.2. Các vấn đề trong thiết kế cơ khí và động học robot

Thiết kế cơ khí ảnh hưởng trực tiếp đến sự ổn định động học. Đối với khung xe robot 3 bánh, vị trí của bánh xe tự do (bánh bi cầu) rất quan trọng. Đặt nó ở phía trước hay sau đều ảnh hưởng đến khả năng bẻ lái và sự ổn định khi vào cua. Một vấn đề khác là tính toán và lựa chọn động cơ DC giảm tốc. Động cơ phải có đủ mô-men xoắn để thắng ma sát và gia tốc nhanh, đồng thời phải có tốc độ tối đa phù hợp với mục tiêu thiết kế. Như trong tài liệu tham khảo, việc tính toán để xe không bị lật khi vào cua với bán kính cong 500mm là một yêu cầu quan trọng, ảnh hưởng đến chiều cao trọng tâm của robot. Đảm bảo độ đồng trục của hai động cơ cũng là một dung sai cơ khí cần được kiểm soát chặt chẽ.

III. Phương pháp thiết kế phần cứng cho Robot Dò Line hiệu quả

Thiết kế phần cứng là xương sống của một đồ án Thiết kế Robot Dò Line. Một hệ thống phần cứng được thiết kế tốt sẽ đảm bảo robot hoạt động ổn định và dễ dàng cho việc nâng cấp sau này. Quá trình này bắt đầu bằng việc vẽ sơ đồ nguyên lý robot dò line tổng thể, xác định sự kết nối giữa các khối chức năng. Vi điều khiển đóng vai trò trung tâm, và việc lựa chọn vi điều khiển STM32 thay vì Arduino mang lại lợi thế về tốc độ xử lý, số lượng bộ định thời (timer) và kênh ADC, rất quan trọng cho các ứng dụng tốc độ cao. Tiếp theo là thiết kế mạch cảm biến. Thay vì sử dụng các module bán sẵn, việc tự thiết kế mạch in PCB cho dải cảm biến cho phép tùy chỉnh khoảng cách và số lượng cảm biến, đồng thời tích hợp các mạch lọc nhiễu. Mạch nguồn cũng cần được thiết kế cẩn thận để cung cấp điện áp ổn định cho cả vi điều khiển (5V) và động cơ (12V) từ một nguồn pin duy nhất. Cuối cùng, việc lựa chọn và tích hợp mạch điều khiển động cơ như mạch cầu H L298N hay TB6612 phải phù hợp với công suất của động cơ DC giảm tốc đã chọn.

3.1. Phân tích lựa chọn vi điều khiển STM32 và động cơ DC

Trong các đồ án tốt nghiệp cơ điện tử, vi điều khiển STM32, cụ thể là dòng F4 như STM32F411VET, là một lựa chọn mạnh mẽ. Nó có xung nhịp cao (lên tới 100MHz), nhiều kênh ADC với tốc độ lấy mẫu nhanh, và hỗ trợ DMA, cho phép đọc dữ liệu từ nhiều cảm biến mà không làm gián đoạn CPU. Điều này cực kỳ hữu ích cho việc xử lý tín hiệu và thực thi thuật toán PID cho robot dò line ở tần số cao. Về động cơ, việc lựa chọn động cơ DC giảm tốc phải dựa trên tính toán động lực học. Cần xác định mô-men xoắn yêu cầu để thắng lực ma sát và đạt được gia tốc mong muốn, cũng như tốc độ vòng quay tối đa để đạt vận tốc mục tiêu. Tài liệu nghiên cứu đã tính toán và chọn động cơ DC servo GA25V1 với các thông số phù hợp cho robot mang tải 2kg.

3.2. Hướng dẫn thiết kế mạch in PCB cho các module chính

Việc thiết kế mạch in PCB (Printed Circuit Board) là một kỹ năng quan trọng. Đối với dải cảm biến, việc thiết kế PCB riêng giúp tối ưu hóa vị trí của các module cảm biến TCRT5000, đảm bảo khoảng cách đều và kết nối chắc chắn. Các đường mạch cần được thiết kế đủ rộng để chịu được dòng điện và tránh nhiễu chéo. Mạch nguồn cũng nên được thiết kế trên PCB, tích hợp các module giảm áp DC-DC (như LM2596) để tạo ra các mức điện áp 12V và 5V ổn định từ nguồn pin. Một PCB được thiết kế tốt không chỉ giúp hệ thống gọn gàng, chuyên nghiệp mà còn tăng độ tin cậy và giảm thiểu các lỗi do kết nối dây không ổn định. Việc sử dụng các phần mềm thiết kế như Altium, Eagle hay KiCad là cần thiết cho công đoạn này.

IV. Bí quyết lập trình và tối ưu thuật toán cho Robot Dò Line

Phần mềm và thuật toán là linh hồn quyết định trí thông minh và hiệu suất của robot đi theo vạch đen. Sau khi hoàn thiện phần cứng, bước tiếp theo là xây dựng code robot dò line. Quá trình lập trình bao gồm ba phần chính: đọc và xử lý tín hiệu cảm biến, thực thi thuật toán điều khiển, và xuất tín hiệu PWM để điều khiển động cơ. Việc xử lý tín hiệu từ dải cảm biến hồng ngoại dò line không chỉ đơn giản là đọc giá trị. Cần phải hiệu chuẩn (calibration) các cảm biến để đồng bộ hóa dải giá trị của chúng, sau đó sử dụng phương pháp xấp xỉ trọng số để tính toán vị trí chính xác của tâm line. Thuật toán điều khiển phổ biến và hiệu quả nhất là bộ điều khiển PID (Proportional-Integral-Derivative). Thuật toán PID cho robot dò line giúp robot phản ứng nhanh với sai số (thành phần P), triệt tiêu sai số ổn định (thành phần I), và giảm dao động khi bám line (thành phần D). Việc tinh chỉnh các hằng số Kp, Ki, Kd là một quá trình thực nghiệm tỉ mỉ để đạt được hiệu suất tối ưu. Ngoài ra, việc sử dụng các công cụ mô phỏng Proteus hoặc Matlab/Simulink có thể giúp kiểm tra thuật toán trước khi triển khai trên robot thật.

4.1. Kỹ thuật xử lý tín hiệu và tuyến tính hóa dải cảm biến

Tín hiệu analog thô từ dải module cảm biến TCRT5000 thường không đồng đều giữa các cảm biến ngay cả trong cùng điều kiện. Do đó, bước hiệu chuẩn là bắt buộc. Quá trình này bao gồm việc ghi lại giá trị nhỏ nhất (trên vạch đen) và lớn nhất (trên nền trắng) của mỗi cảm biến, sau đó sử dụng một công thức tuyến tính hóa để ánh xạ các giá trị này vào một dải chung, ví dụ từ 0 đến 1000. Sau khi hiệu chuẩn, vị trí của line được tính bằng công thức trung bình có trọng số. Công thức này nhân giá trị của mỗi cảm biến với vị trí tương đối của nó và chia cho tổng giá trị của tất cả các cảm biến. Kết quả là một giá trị số thực biểu thị sai số của robot so với tâm line, cung cấp đầu vào chính xác cho bộ điều khiển.

4.2. Hướng dẫn triển khai thuật toán PID cho robot dò line

Việc triển khai thuật toán PID cho robot dò line là chìa khóa để đạt được tốc độ và sự ổn định. Đầu tiên, cần xác định một tốc độ cơ sở cho robot. Sau đó, sai số (error) tính được từ cảm biến sẽ được đưa vào bộ điều khiển PID. Đầu ra của bộ điều khiển PID là một giá trị điều chỉnh (correction). Giá trị này sẽ được cộng vào tốc độ của một bánh và trừ đi khỏi tốc độ của bánh còn lại. Ví dụ, tốc_độ_phải = tốc_độ_cơ_sở + correction; tốc_độ_trái = tốc_độ_cơ_sở - correction. Việc tinh chỉnh ba hệ số Kp, Ki, Kd là quan trọng nhất. Kp quyết định mức độ phản ứng tức thời. Ki giúp loại bỏ sai số tĩnh khi robot chạy thẳng. Kd giúp giảm vọt lố và dao động khi robot vào và ra khỏi cua. Phương pháp Ziegler-Nichols hoặc thử và sai có hệ thống thường được sử dụng để tìm ra bộ ba hệ số tối ưu.

V. Đánh giá kết quả và ứng dụng thực tiễn của Robot Dò Line

Sau khi hoàn thành thiết kế và chế tạo, bước cuối cùng của đồ án Thiết kế Robot Dò Line là thực nghiệm và đánh giá. Giai đoạn này nhằm kiểm tra xem robot có đáp ứng được các mục tiêu thiết kế đã đề ra hay không, chẳng hạn như tốc độ tối đa, khả năng bám line ở các đoạn cong có bán kính nhỏ, và độ ổn định khi mang tải. Các thông số như sai số bám line, vận tốc tức thời của hai động cơ, và giá trị đầu ra của bộ điều khiển PID cần được ghi lại và phân tích. Việc so sánh kết quả thực nghiệm với kết quả mô phỏng Proteus hoặc Matlab có thể cung cấp những hiểu biết sâu sắc về hành vi của hệ thống. Một báo cáo đồ án robot dò line chất lượng cần có phần đánh giá chi tiết, bao gồm đồ thị, bảng biểu và nhận xét về những gì đã đạt được cũng như các hạn chế còn tồn tại. Từ đó, đề xuất các hướng cải tiến trong tương lai. Các hướng dẫn làm robot dò line thường nhấn mạnh tầm quan trọng của giai đoạn này để rút kinh nghiệm cho các dự án sau.

5.1. Phân tích kết quả thực nghiệm và hiệu suất bám line

Trong tài liệu nghiên cứu gốc, nhóm thực hiện đã tiến hành chạy thử robot trên sa bàn thực tế và thu thập dữ liệu. Kết quả cho thấy robot có khả năng bám theo quỹ đạo phức tạp, bao gồm các đoạn thẳng, cong và giao lộ. Vận tốc của hai động cơ DC giảm tốc được ghi lại cho thấy sự điều chỉnh liên tục để giữ robot trên đường line, phản ánh hoạt động hiệu quả của thuật toán PID cho robot dò line. Sai số thực tế (e2) cũng được đo lường và phân tích để đánh giá độ chính xác của hệ thống. Việc so sánh các giá trị này với mục tiêu thiết kế ban đầu (vận tốc tối đa 0.8 m/s, sai số tối đa 20mm) cho phép đánh giá mức độ thành công của đồ án.

5.2. Các ứng dụng thực tiễn và slide thuyết trình đồ án

Mặc dù là một đồ án học thuật, robot đi theo vạch đen có nhiều ứng dụng thực tiễn. Chúng là mô hình thu nhỏ của xe tự hành AGV (Automated Guided Vehicle) được sử dụng rộng rãi trong các nhà máy sản xuất, trung tâm logistics để vận chuyển vật liệu, hàng hóa tự động. Chúng cũng là nền tảng cho các cuộc thi robot trong và ngoài nước, nơi sinh viên có thể cạnh tranh và thể hiện kỹ năng kỹ thuật. Để trình bày kết quả đồ án, việc chuẩn bị một slide thuyết trình đồ án chuyên nghiệp là rất cần thiết. Slide cần trình bày ngắn gọn, logic các phần chính: đặt vấn đề, phương án thiết kế, kết quả thiết kế phần cứng và phần mềm, kết quả thực nghiệm và video demo robot hoạt động. Đây là cách hiệu quả để truyền đạt toàn bộ quá trình và thành quả của dự án đến hội đồng đánh giá.

03/10/2025

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

CHƯƠNG 1 : TỔNG QUAN 1. Giới thiệu chung Ngày nay, robot được đưa vào sử dụng rất nhiều trong công nghiệp, đời sống để thay thế con người, giải thoát con người khỏi môi trường làm việc nặng nhọc, nguy hiểm, độc hại cũng như để tăng năng suất. Một trong những ứng dụng đó là Robot AGV. Trong đồ án này, nhóm sẽ thiết kế một mô hình mobile robot đơn giản có khả năng bám line.

Đây là mô hình cũng được ứng dụng nhiều trong thực tế như robot phục vụ trong nhà hàng, robot vận chuyển nguyên vật liệu, hàng hóa trong các nhà xưởng. Cấu trúc cơ bản của các xe dò line thông dụng 1. Thunderbolt Robot - Thunderstorm đã tham gia cuộc thi Astor Robot Challenge 2012, Sosnowiec, Poland (a) (b) Hình 1.1 : Thunderstorm (a) Xe đua Thunderstorm (b) Sơ đồ nguyên lý Bảng 1.1 : Thông số của Thunderstorm Thông số Giá trị Đơn vị L×W×H: 145×90×70 mm Khối lượng 360 g Tốc độ 2.2÷3 m/s Bánh xe ? mm  Ưu điểm: + Quạt hút tạo chân không bám nền giảm thiểu ảnh hưởng của lực ly tâm khi chạy ở đường cong. + Thanh phía trước hoạt động như một thanh lò xo, đảm bảo cho 2 bánh bi cầu và 2 bánh xe luôn tiếp xúc mặt đất.

 Nhược điểm: + Hao phí năng lượng cho quạt 1.0 Robot  Usain Volt 2.0 Robot tham gia cuộc thi LVBots Line Following Competition 2015, Las Vegas, USA. 2 ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ GVHD : TS.LÊ ĐỨC HẠNH (a) (b) Hình 1.0 Robot (a) Usain Volt 2.0 Robot (b) Sơ đồ nguyên lý Bảng 1.2 : Thông số của Usain Volt 2.0 Robot Thông số Giá trị Đơn vị L×W×H: 182×132×60 mm Khối lượng 295 g Tốc độ 1,1 (trung bình) m/s Bánh xe 60 mm  Ưu điểm: + Xe sử dụng 2 bánh bi cầu giúp ổn định khi vào đường cong + Thiết kế đơn giản, dễ chế tạo.  Nhược điểm: + Khó đồng phẳng với 4 bánh + Khó điều khiển đồng bộ 2 động cơ 3 ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ GVHD : TS.LÊ ĐỨC HẠNH 1. Suckbot Robot  Suckbot robot tham gia cuộc thi LVBots Line Following Competition 2015, Las Vegas, USA.3 : Suckbot robot (a) Suckbot Robot (b) Sơ đồ nguyên lý Bảng 1.3 : Thông số của Suckbot Thông số Giá trị Đơn vị L×W×H: ?×?×? mm Khối lượng 300 g Tốc độ 0.93( trung bình) m/s Bánh xe 70 mm  Ưu điểm: + Xe sử dụng 2 bánh bi cầu giúp ổn định khi vào đường cong + Quạt hút tạo chân không bám nền giảm thiểu ảnh hưởng của lực ly tâm khi chạy ở đường cong.

+ Toàn bộ hệ thống mạch điện, pin, động cơ được đặt phía sau, giữa 2 bánh xe chủ động giúp dời trọng tâm ra trục bánh xe, giảm momen xoay khi bẻ lái  Nhược điểm: + Quạt tạo áp suất hút giúp xe bám đường nhưng cũng tạo ra một áp lực giữa xe và mặt đường. Lực này là cho trọng tâm của xe bị đẩy ra xa trung điểm giữa 2 bánh xe chủ động và gia tăng moment khi xe bẻ lái. + Robot sử dụng 4 bánh dẫn đến khó đồng phẳng 4 ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ GVHD : TS.LÊ ĐỨC HẠNH 1. Chariot Robot  Chariot Robot tham gia cuộc thi LVBots Line Following Competition 2015, Las Vegas, USA.4 : Chariot Robot (a) Chariot Robot (b) Sơ đồ nguyên lý Bảng 1.4 : Thông số của Chariot Thông số Giá trị Đơn vị L×W×H: 145×90×70 mm Khối lượng 210 g Tốc độ 1.2÷2 m/s Bánh xe 70 mm  Ưu điểm: + Robot sử dụng 3 bánh dễ đồng phẳng  Nhược điểm: + Chỉ có một bánh bi cầu gây mất ổn định khi xe vào đường cong.

Pinto Robot  Pinto robot tham gia cuộc thi LVBots Line Following Competition 2015, Las Vegas, USA.5 : Pinto robot (a) Pinto robot (b) Sơ đồ nguyên lý 5 ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ GVHD : TS.LÊ ĐỨC HẠNH Bảng 1.5 : Thông số của Pinto Thông số Giá trị Đơn vị L×W×H: 210×130×120 mm Khối lượng ? g Tốc độ 0.8 (trung bình) m/s Bánh xe 60 mm  Ưu điểm: + Hai bánh chủ động nằm phía trước, 1 bánh bị động phía sau → ổn định động học cao. + Động cơ đặt lệch tâm, sử dụng đai truyền động cho 2 bánh chủ động giúp giảm bề ngang của Robot. Do đó, Robot nhẹ hơn và giả được lực ly tâm khi vào đường cong.  Nhược điểm: + Đai dẫn động làm cho thiết kế phức tạp hơn.

Newbie Robot  Newbie robot tham gia cuộc thi LVBots Line Following Competition 2015, Las Vegas, USA.6 : Newbie Robot (a) Newbie Robot (b) Sơ đồ nguyên lý Bảng 1.6 : Thông số của Newbie Thông số Giá trị Đơn vị L×W×H: ? Mm Khối lượng ? G Tốc độ ? m/s Bánh xe 28,42 Mm  Ưu điểm: + Robot sử dụng 4 bánh giúp ổn định khi vào đường cong. 6 ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ GVHD : TS.LÊ ĐỨC HẠNH  Nhược điểm: + Xe có 3 btd truyền động, do đó dư 1 btd → việc đk đồng bộ khó, xảy ra hiện tượng trượt. + Trên thực tế, xe vẫn chạy bám theo đường đua đủ 3 vòng, tuy nhiên tốc độ đua rất hạn chế. + Xe sử dụng 4 bánh gây khó đồng phẳng.

Fireball  Fireball tham gia cuộc thi Bot Brawl Contest(Peoria, Illinois) and then Chibots Summer 2010 Contest.7 : Fireball robot (a) Fireball robot (b) Sơ đồ nguyên lý Bảng 1.7 : Thông số của Fireball Thông số Giá trị Đơn vị L×W×H: 100×100×40 mm Khối lượng 200 g Tốc độ 1.5 (trung bình) m/s Bánh xe ? mm  Ưu điểm: + Kết cấu đơn giản. Mỗi bánh điều khiển bởi 1 động cơ. Do đó, giúp ổn định khi vào đường cong. Bốn động cơ được điều khiển cùng lúc giúp robot dễ dàng chuyển hướng.

 Nhược điểm: + Khó đồng phẳng + Cần phải điều khiển 4 động cơ cùng lúc nên động lực học và bộ điều khiển phức tạp. 7 ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ GVHD : TS.LÊ ĐỨC HẠNH 1. CartisX04  CartisX04 tham gia cuộc thi Japan Robottrace contest 2014.8 : Cartis X04 (a) Catris X04 (b) Sơ đồ nguyên lý Bảng 1.8 : Thông số của Cartis Thông số Giá trị Đơn vị L×W×H: 175×153×40 mm Khối lượng 98 g Tốc độ 2.5 (trung bình) m/s Bánh xe ? mm  Ưu điểm: + Cấu trúc đơn giản. Robot có 2 động cơ và mỗi động cơ điều khiển 2 bánh.

Do đó, xe ổn định khi vào đường cong.  Nhược điểm: + 4 bánh→ khó đồng phẳng. 8 ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ GVHD : TS.LÊ ĐỨC HẠNH 1. Cấu trúc cơ bản của xe dò line Từ tổng quan, chúng ta có rất nhiều lựa chọn cho thiết kế cơ khí.9 : Một vài sơ đồ nguyên lý thiết kế cơ khí 1.

Cảm biến : - Mạch cảm biến chịu trách nhiệm theo dõi đường line và phản hồi tới bộ điều khiển vị trí hiện tại của cảm biến liên quan đến đường line sao cho xe có thể theo dõi đường line. Việc lựa chọn cảm biến sẽ ảnh hưởng một phần đến độ chính xác để theo dõi đường line. Có nhiều loại cảm biến khác nhau có thể được sử dụng với phạm vi độ chính xác khác nhau tùy thuộc vào yêu cầu của người dùng. - Để đạt được yêu cầu theo dõi các đoạn gãy đột ngột của quỹ đạo đường line, lựa chọn cảm biến phải có độ nhạy thích hợp.

+ Camera : Camera được sử dụng để chụp ảnh đường line, nhận dạng đường phức tạp, bị gãy thông qua xử lý hình ảnh, trả lại vị trí bánh xe và độ lệch. 9 ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ GVHD : TS.LÊ ĐỨC HẠNH Hình 1.10 : Raspberr Pi Camera 1/4-Inch 5-Megapixel.11 : CMUcam3 (left) CMUcam5 (right)  Ưu điểm : độ chính xác cao 30 frames/sec  Nhược điểm : Khối lượng công việc xử lý của camera khá nhiều, nếu vi điều khiển có tốc độ xử lý chậm, sự kết hợp giữa camera và bộ điều khiển sẽ ảnh hưởng đến xe. + Quang trở : Điện trở của LDR thay đổi theo cường độ ánh sáng đi vào LDR (LUX). Khi sử dụng LDF, màu của các đèn led không quan trọng lắm vì nó phụ thuộc vào cường độ ánh sáng.

Tuy nhiên, đường cong đặc trưng của photon không tuyến tính.13 : Mối quan hệ giữa cường độ ánh sáng và điện trở suất của LDR 10 ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ GVHD : TS.LÊ ĐỨC HẠNH  Ưu điểm : đơn giản, dễ sử dụng và rẻ  Nhược điểm : thời gian đáp ứng chậm khoảng 30 m/s gây ra thay đổi giá trị điện trở khi đèn sáng và mất khoảng 40 m/s để trở về giá trị điện trở ban đầu khi đèn tắt. + Cảm biến hồng ngoại : Thường được sử dụng ngày nay. Khi tia hồng ngoại phát ra từ đèn LED, nếu có bộ phản xạ hồng ngoại, cảm biến hồng ngoại hoạt động và tạo ra điện áp giữa hai đèn LED. Led phát và thu phải được đặt cách nhau với bề mặt của đường sao cho vùng hoạt động của chúng cản trở lẫn nhau và không trùng với bộ tiếp giáp.

 Ưu điểm : tốc độ phản hồi nhanh tầm ns, đơn giản dễ sử dụng  Nhược điểm : dễ bị ánh sáng ảnh hưởng đến kết quả Hình 1.14 : Cảm biến hồng ngoại TCRT5000 Hình 1.15 : Vũng nhiễu của led thu và led phát 1. Cách bố trí cảm biến : - Có 3 cách bố trí cảm biến : + Theo hàng + Ma trận + Profile 11 ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ GVHD : TS.LÊ ĐỨC HẠNH a.16 : Các phương pháp bố trí cảm biến a. Thuật toán xử lý tín hiệu : Tín hiệu đọc từ cảm biến sẽ được xử lý bằng thuật toán xấp xỉ hoặc so sánh để tìm ra vị trí tướng đối của robot dò line với tâm đường line Hình 1.17 : Tín hiệu đọc từ cảm biến - Tín hiệu được xử lý bằng cách sử dụng phương pháp xấp xỉ: Hình 1.18 : Xử lý tín hiệu cảm biến bằng phương pháp xấp xỉ + Độ lớn của tín hiệu từ cảm biến (y1, y2,…, yn) được sử dụng để tính vị trí của đường line. Có thể sử dụng phương pháp xấp xỉ bậc hai, xấp xỉ trọng số, tuyến tính,.

+ Thời gian xử lý phụ thuộc vào thời gian đọc của giá trị tương tự trong tất cả các cảm biến, vì vậy phải mất một thời gian xử lý lâu, tuy nhiên phương pháp này cung cấp kết quả chính xác cao 12 ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ GVHD : TS.LÊ ĐỨC HẠNH - Tín hiệu được xử lý bằng phương pháp so sánh: Hình 1.

Nội dung được bảo vệ bản quyền — Tải xuống đầy đủ