Bối cảnh và vấn đề nghiên cứu

Trong xu thế phát triển của cuộc Cách mạng Công nghiệp lần thứ tư, robot thông minh và các hệ thống tự hành đóng vai trò nòng cốt trong việc tự động hóa các dây chuyền sản xuất, kho bãi và dịch vụ hậu cần. Xuất phát từ thực tiễn sản xuất, xe tự dẫn hướng (AGV - Automated Guided Vehicle) và robot di động có khả năng bám quỹ đạo (dò line) giúp tối ưu hóa chu trình vận chuyển nguyên vật liệu, hoạt động liên tục 24/7 mà không phụ thuộc vào sức lao động thủ công của con người.

Tại Việt Nam, việc nghiên cứu, làm chủ công nghệ thiết kế và chế tạo robot di động vẫn còn nhiều khoảng trống. Phần lớn trang thiết bị AGV và robot công nghiệp hiện đại trong các doanh nghiệp đều phải nhập khẩu với chi phí cao, trong khi các cơ sở nghiên cứu trong nước chủ yếu dừng lại ở mức độ mô hình hóa lý thuyết hoặc thiếu tính đồng bộ giữa thiết kế cơ khí, phần cứng điện tử và thuật toán điều khiển.

Trước yêu cầu đó, đồ án môn học Thiết kế hệ thống Cơ điện tử với đề tài "Nghiên cứu, thiết kế robot dò line" được thực hiện nhằm giải quyết bài toán thiết kế hoàn chỉnh một mô hình robot tự hành bám vạch.

Nhiệm vụ nghiên cứu của đề tài được triển khai qua 5 bước:

  1. Phân tích, đánh giá và lựa chọn phương án khả thi về cơ khí, mạch điện và giải thuật điều khiển.
  2. Thiết kế hệ thống điện – điện tử, lựa chọn vi điều khiển, cảm biến và module công suất.
  3. Xây dựng giải thuật điều khiển dò đường và bám quỹ đạo.
  4. Lập trình điều khiển vi điều khiển và mô phỏng hệ thống.
  5. Thực nghiệm, đánh giá sai số và hiệu chỉnh mô hình.

Đối tượng nghiên cứu là hệ thống robot di động 3 bánh (2 bánh chủ động độc lập, 1 bánh đa hướng dẫn hướng) hoạt động trên bề mặt phẳng có bố trí đường line cố định với các điểm rẽ giao nhau.

Cơ sở lý thuyết và phương pháp nghiên cứu

Đồ án ứng dụng tổng hợp các cơ sở lý thuyết nền tảng của kỹ thuật cơ điện tử và điều khiển tự động:

  • Lý thuyết động học robot di động: Xây dựng ma trận chuyển đổi hệ tọa độ giữa hệ tọa độ tuyệt đối gắn với môi trường $(OXY)$ và hệ tọa độ tương đối gắn với tâm robot $(P X_r Y_r)$ thông qua ma trận quay $R(\theta)$.
  • Phương pháp động năng Lagrange: Xây dựng phương trình chuyển động cơ học dựa trên phương trình Euler-Lagrange để tính toán tổng động năng tịnh tiến, động năng quay của bánh xe và xác định mô-men kéo yêu cầu của động cơ: $$\frac{d}{dt}\left(\frac{\partial K}{\partial \dot{q}_i}\right) - \frac{\partial K}{\partial q_i} + \frac{\partial P}{\partial q_i} = Q_i$$
  • Lý thuyết mô hình hóa máy điện: Thiết lập phương trình cân bằng điện áp phần ứng, phương trình cân bằng mô-men điện từ và mô-men quán tính trục động cơ DC kích từ độc lập, từ đó rút ra hàm truyền đạt miền Laplace cho vận tốc góc $\omega(s)/U(s)$ và góc quay $\theta_m(s)/U(s)$.
  • Lý thuyết điều khiển PID: Ứng dụng giải thuật tỉ lệ - tích phân - vi phân để điều chỉnh vận tốc hai động cơ nhằm giữ tâm robot bám sát quỹ đạo vạch kẻ.

Phương pháp nghiên cứu thực tế bao gồm:

  • Phân tích - tổng hợp tài liệu chuyên ngành về robot thông minh và các giải pháp AGV.
  • Phương pháp tính toán giải tích xác định các thông số hình học và động học ($R = 0{,}0325\text{ m}$, $L = 0{,}112\text{ m}$).
  • Phương pháp thiết kế CAD 3D trên phần mềm SolidWorks.
  • Thiết kế mạch in nguyên lý và mạch 2D PCB trên phần mềm Altium Designer.
  • Mô phỏng hệ thống điều khiển bám line trên công cụ Matlab/Simulink.

Nội dung chính theo từng chương

Chương 1: Tổng quan về robot thông minh và đề tài robot dò line

Chương này khái quát tiến trình phát triển của robot thông minh trên thế giới từ mốc năm 2015 – thời điểm trí tuệ nhân tạo bắt đầu được tích hợp sâu rộng vào cơ điện tử. Tác giả phân loại robot thông minh theo môi trường ứng dụng gồm: xe tự dẫn hướng (AGV), robot dịch vụ trong nhà, robot thương mại và robot chuyên dụng (y tế, quân sự, thám hiểm không gian, cứu hộ).

Đồng thời, chương 1 phân tích chiến lược phát triển công nghiệp robot của các cường quốc:

  • Hoa Kỳ: Chương trình Hợp tác Sản xuất Tiên tiến (AMP 2011), Kế hoạch Robot Quốc gia (National Robot Plan), lộ trình "The Robot Roadmap" (2013, 2016) và Kế hoạch Robot Quốc gia 2.0.
  • Châu Âu: Chiến lược Công nghiệp 4.0 của Đức (2013) và các gói đầu tư trọng điểm của Pháp (129,6 triệu USD).
  • Nhật Bản: Chiến lược Phục hồi Nhật Bản (2014) và Chiến lược Mới về Robot (2015).
  • Việt Nam: Đánh giá thực trạng tại các viện nghiên cứu, trường đại học (Đại học Bách khoa Hà Nội, Đại học Bách khoa TP.HCM, Viện Hàn lâm KH&CN Việt Nam...). Tác giả chỉ ra các hạn chế cố hữu về trang thiết bị vật lý, mức độ làm chủ công nghệ chế tạo và chi phí tiếp cận công nghệ của doanh nghiệp trong nước. Từ đó xác định sự cần thiết của đề tài thiết kế robot dò line.

Chương 2: Mô hình động học, động lực học robot dò line

Nội dung chương 2 tập trung giải quyết bài toán toán học cho hệ chuyển động vi sai:

  • Động học: Xác định vận tốc dài $v_t$ và vận tốc góc $\omega$ của robot thông qua vận tốc góc của hai bánh xe bên phải ($\dot{\phi}_R$) và bên trái ($\dot{\phi}_L$). Thiết lập ma trận quan hệ vận tốc với bán kính bánh xe $R = 0{,}0325\text{ m}$ và khoảng cách hai bánh $L = 0{,}112\text{ m}$.
  • Động lực học: Sử dụng phương pháp Lagrange loại 2 với thế năng $P = 0$ (robot di chuyển trên mặt phẳng). Xác định tổng động năng $K = K_{tt} + K_b = 0{,}44\text{ kN}$ (tính toán quy đổi của hệ). Phương trình cân bằng mô-men giúp tính toán mô-men động cơ yêu cầu: $$M_{dc} = 0{,}002\text{ kNm} = 2\text{ Nm}$$
  • Lựa chọn động cơ: So sánh các dòng động cơ bước (Step Motor), Servo DC, DC gắn Encoder và Động cơ DC giảm tốc (động cơ vàng). Nhóm tác giả chọn loại động cơ DC giảm tốc có thông số: điện áp hoạt động $3\text{--}9\text{ VDC}$, dòng tiêu thụ $110\text{--}140\text{ mA}$, tỉ số truyền $1:120$, tốc độ $50\text{ rpm}$ (tại $3\text{V}$) và $83\text{ rpm}$ (tại $5\text{V}$).
Tiêu chí so sánh Động cơ bước Động cơ Servo DC Động cơ DC Encoder Động cơ DC giảm tốc (được chọn)
Ưu điểm Điều khiển vị trí góc bước chính xác Tốc độ cao, mô-men lớn, kiểm soát vị trí chuẩn Tốc độ tỉ lệ với điện áp, đặc tuyến tuyến tính Giá thành rẻ, dễ sử dụng, phù hợp mô hình nhỏ
Nhược điểm Hiện tượng trượt bước, tiêu hao điện giữ vị trí Mạch điều khiển phức tạp, giá thành cao Tản nhiệt kém, cần mạch đọc xung encoder Chịu tải trọng và mô-men thấp

Chương 3: Thiết kế hệ thống cơ khí robot dò line

Chương 3 khảo sát và đánh giá 6 phương án kết cấu cơ khí cho robot:

  • Phương án 1: 2 bánh chủ động không cân bằng.
  • Phương án 2a: 3 bánh (2 bánh chủ động phía sau, 1 bánh đa hướng bị động phía trước).
  • Phương án 2b: 3 bánh (2 bánh chủ động phía trước, 1 bánh bị động phía sau).
  • Phương án 3a: 4 bánh cơ bản (2 chủ động, 2 bị động).
  • Phương án 3b: 4 bánh có hệ thống treo độc lập.
  • Phương án 3c: 4 bánh chủ động toàn phần.

Nhóm tác giả quyết định lựa chọn Phương án 2a nhờ ưu điểm đảm bảo cả 3 bánh luôn tiếp xúc mặt phẳng, kết cấu cơ khí đơn giản, bán kính quay vòng nhỏ và dễ điều khiển qua cua. Sau khi chốt phương án, bản vẽ 3D và 2D chi tiết của khung gầm và cụm truyền động được hoàn thiện trên phần mềm SolidWorks.

Chương 4: Thiết kế hệ thống điều khiển xe dò line

Chương này đi sâu vào thiết kế phần cứng và kiến trúc điều khiển:

  • Khối xử lý trung tâm: Sử dụng vi điều khiển Arduino Nano nền tảng MCU ATmega328P-AU (thạch anh $16\text{ MHz}$, 32KB Flash, 2KB SRAM, 14 chân Digital có 6 chân PWM, 8 kênh Analog 10-bit từ A0 đến A7, chip nạp CH340, tích hợp IC hạ áp LM1117).
  • Khối công suất: Sử dụng module driver động cơ TB6612 (mạch cầu H kép, dòng tải liên tục $1{,}2\text{ A}$ mỗi kênh, dòng đỉnh $3{,}2\text{ A}$, tần số điều chế PWM lên đến $100\text{ kHz}$, tích hợp bảo vệ quá nhiệt và quá áp).
  • Khối cảm biến dò đường: Sử dụng thanh cảm biến hồng ngoại 5 mắt (IR Sensor) hoạt động theo nguyên lý phản xạ ánh sáng (bước sóng ngoài vùng ánh sáng đỏ do William Herschel phát hiện). Giá trị nhị phân trả về tương ứng với từng trạng thái lệch vạch kẻ.
  • Thiết kế mạch in: Toàn bộ sơ đồ nguyên lý và bản vẽ mạch in PCB 2 lớp được thiết kế trên phần mềm Altium Designer.

Chương 5: Mô phỏng chuyển động của xe dò line

Chương cuối cùng xây dựng mô hình toán và thực hiện mô phỏng hệ thống trên Matlab/Simulink:

  • Mô hình hóa toán học động cơ DC kích từ độc lập với hệ phương trình vi phân vi mô mạch điện phần ứng và cân bằng cơ học trục quay: $$U = L\frac{di}{dt} + Ri + K_e\omega$$ $$M = J\frac{d\omega}{dt} + B\omega + M_t$$
  • Rút ra hàm truyền đạt vị trí góc: $$G_{dc}(s) = \frac{\Theta_m(s)}{U(s)} = \frac{K_{td}}{T_1 s + T_2 s^2 + s^3}$$
  • Thông số mô phỏng động cơ: $K_e = 0{,}01\text{ Vs/rad}$, $K_m = 0{,}01\text{ Nm/A}$, $J_m = 0{,}5\text{ kg}\cdot\text{m}^2$, tốc độ $n = 130\text{ rpm}$.
  • Thiết lập bộ điều khiển PID trên Simulink, sử dụng công cụ PID Tuner để hiệu chỉnh đáp ứng ngõ ra, kiểm tra chất lượng bám quỹ đạo với các trường hợp lệch tâm vạch kẻ.

Thiết kế kỹ thuật và triển khai hệ thống

Kiến trúc phần cứng và sơ đồ khối

Hệ thống robot dò line được tích hợp thành một thể thống nhất bao gồm các phân hệ chính:

  1. Khối nguồn: Cung cấp điện áp một chiều thông qua pin và mạch ổn áp LM1117 (hạ áp 5V nuôi vi điều khiển).
  2. Khối cảm biến (Input): Module 5 mắt cảm biến hồng ngoại (IR1 – IR5) được xếp thẳng hàng ở đầu xe để đọc tín hiệu phản xạ từ bề mặt di chuyển.
  3. Khối xử lý (MCU): Arduino Nano nhận tín hiệu logic từ cảm biến, tính toán độ lệch quỹ đạo và thực thi thuật toán PID.
  4. Khối chấp hành (Output): Driver TB6612 nhận tín hiệu điều hướng và xung PWM từ Arduino để cấp dòng điện tương ứng cho 2 động cơ DC giảm tốc.

Bảng trạng thái cảm biến và ma trận sai số (Error)

Hệ thống dò đường phân loại 9 trạng thái lệch line dựa trên tín hiệu logic (0 hoặc 1) từ 5 mắt cảm biến hồng ngoại, tương ứng với trọng số sai số $Error \in [-4, +4]$:

Trạng thái lệch line IR1 IR2 IR3 (Tâm) IR4 IR5 Trọng số sai số (Error)
Lệch cực đại sang trái 1 0 0 0 0 +4
Lệch lớn sang trái 1 1 0 0 0 +3
Lệch vừa sang trái 0 1 0 0 0 +2
Lệch nhẹ sang trái 0 1 1 0 0 +1
Đúng tâm vạch kẻ 0 0 1 0 0 0
Lệch nhẹ sang phải 0 0 1 1 0 -1
Lệch vừa sang phải 0 0 0 1 0 -2
Lệch lớn sang phải 0 0 0 1 1 -3
Lệch cực đại sang phải 0 0 0 0 1 -4

Kết quả và đóng góp kỹ thuật

Kết quả đạt được

  • Về tính toán lý thuyết: Hoàn thiện mô hình động học và động lực học giải tích cho robot 3 bánh vi sai; xác định mô-men động cơ cần thiết $M_{dc} = 0{,}002\text{ kNm}$, bán kính bánh xe $R = 0{,}0325\text{ m}$, cự ly 2 bánh $L = 0{,}112\text{ m}$.
  • Về thiết kế cơ khí: Xây dựng mô hình hình học 3D hoàn chỉnh trên SolidWorks đáp ứng các yêu cầu cân bằng 3 điểm, đảm bảo độ đồng phẳng và khả năng rẽ linh hoạt tại các nút giao A, B, D.
  • Về phần cứng điện tử: Thiết kế thành công bo mạch nguyên lý và mạch in 2D PCB bằng phần mềm Altium Designer, tích hợp gọn gàng vi điều khiển Arduino Nano, IC điều khiển công suất TB6612 và thanh cảm biến 5 mắt.
  • Về mô phỏng: Xây dựng thành công mô hình toán học động cơ DC và thuật toán điều khiển PID trên Matlab/Simulink; tối ưu hóa thông số bộ điều khiển thông qua công cụ PID Tuner cho đáp ứng bám vạch ổn định.

Đóng góp kỹ thuật

Đồ án đã trình bày quy trình thiết kế khép kín một hệ thống cơ điện tử từ khâu mô hình hóa toán học, thiết kế cơ khí 3D, thiết kế mạch điện tử PCB cho đến kiểm chứng thuật toán trên phần mềm mô phỏng. Đây là tài liệu kỹ thuật có tính hệ thống cao, kết nối chặt chẽ giữa lý thuyết điều khiển tự động và phần cứng thực tế.

Hạn chế và hướng phát triển tiếp theo

Dựa trên nội dung nghiên cứu được trình bày trong tài liệu, đề tài còn tồn tại một số hạn chế:

  • Robot chỉ hoạt động tốt trên bề mặt hoàn toàn bằng phẳng, không có dốc nghiêng và vạch kẻ line phải liên tục không đứt đoạn.
  • Động cơ DC giảm tốc loại vàng có giới hạn về tải trọng và mô-men xoắn, hạn chế khả năng nâng cao tốc độ di chuyển hoặc mang tải nặng.
  • Hệ thống cảm biến 5 mắt chỉ xử lý tốt trong môi trường đủ độ tương phản màu sắc và không bị nhiễu bởi bức xạ ánh sáng ngoại vi cường độ mạnh.

Hướng phát triển tiếp theo được gợi ý bao gồm việc tích hợp thêm thuật toán tránh chướng ngại vật, nâng cấp cảm biến quang trở/camera xử lý ảnh và triển khai chế tạo mô hình thực tế để kiểm nghiệm độ bền cơ điện tử trong điều kiện công nghiệp.

Giá trị tham khảo của đồ án

Tài liệu là nguồn tham khảo hữu ích cho:

  • Sinh viên ngành Kỹ thuật Cơ điện tử, Tự động hóa, Kỹ thuật Robot: Dùng làm tài liệu mẫu cho đồ án môn học thiết kế hệ thống cơ điện tử, đồ án tốt nghiệp hoặc các dự án xe tự hành bám vạch.
  • Các kỹ sư và nhóm nghiên cứu AGV: Tham khảo phương pháp tính toán động lực học Lagrange cho robot 2 bánh chủ động, quy trình thiết kế mạch điều khiển bằng Altium và phương pháp mô hình hóa động cơ DC trên Matlab/Simulink.
  • Các nội dung đáng tham khảo nhất:
    1. Phương pháp phân tích động học, động lực học và ma trận chuyển đổi tọa độ ở Chương 2.
    2. Bảng phân tích trạng thái 5 cảm biến và quy đổi trọng số sai số ở Chương 4 và Chương 5.
    3. Mô hình toán hàm truyền đạt động cơ DC phục vụ tinh chỉnh PID trên Simulink.

Câu hỏi thường gặp

1. Robot trong đồ án sử dụng cơ cấu chuyển động nào và vì sao lựa chọn?

Robot sử dụng cơ cấu 3 bánh vi sai (Phương án 2a) gồm 2 bánh chủ động độc lập bố trí phía sau và 1 bánh xe đa hướng bị động đặt phía trước. Kết cấu này được lựa chọn vì đảm bảo 3 bánh luôn tiếp xúc đồng phẳng với mặt đất, cơ khí đơn giản, khả năng quay vòng chuyển hướng linh hoạt và dễ điều khiển qua các khúc cua.

2. Các thông số động học chính của mô hình robot là bao nhiêu?

Theo tính toán ở Chương 2, bán kính bánh xe robot là $R = 0{,}0325\text{ m}$ ($32{,}5\text{ mm}$), khoảng cách giữa hai bánh xe chủ động là $L = 0{,}112\text{ m}$ ($112\text{ mm}$), và mô-men xoắn yêu cầu tính toán từ phương trình Lagrange là $M_{dc} = 0{,}002\text{ kNm}$ ($2\text{ Nm}$).

3. Hệ thống phần cứng điều khiển trung tâm và mạch công suất sử dụng linh kiện gì?

Khối vi điều khiển trung tâm sử dụng kit Arduino Nano (chip ATmega328P-AU, xung nhịp $16\text{ MHz}$, 8 kênh Analog). Khối điều khiển động cơ sử dụng module TB6612 hỗ trợ mạch cầu H kép, dòng tải liên tục $1{,}2\text{ A}$ mỗi kênh và hỗ trợ tần số PWM lên tới $100\text{ kHz}$.

4. Thuật toán dò đường xử lý tín hiệu cảm biến như thế nào để xác định độ lệch quỹ đạo?

Hệ thống sử dụng thanh 5 cảm biến hồng ngoại (IR1 đến IR5). Khi cảm biến bắt được vạch line, nó trả về mức logic 1 (ngược lại là 0). Thuật toán quy đổi 9 tổ hợp trạng thái cảm biến thành các mức sai số $Error$ từ $-4$ (lệch cực đại sang phải) đến $+4$ (lệch cực đại sang trái), với mức $0$ là vị trí lý tưởng (mắt IR3 ở giữa bắt trúng tâm vạch kẻ).

Kết luận

Báo cáo đồ án môn học "Nghiên cứu, thiết kế robot dò line" đã hoàn thành trọn vẹn mục tiêu nghiên cứu và thiết kế hệ thống robot tự hành vi sai 3 bánh. Đề tài đã giải quyết thành công bài toán động lực học bằng phương pháp Lagrange, xây dựng mô hình cơ khí 3D trên SolidWorks, thiết kế phần cứng điều khiển trên Altium Designer và mô phỏng thành công thuật toán điều khiển PID trên nền tảng Matlab/Simulink. Kết quả của đồ án cung cấp một khung thiết kế kỹ thuật hoàn chỉnh, làm nền tảng ứng dụng thiết thực cho việc phát triển các dòng xe tự hành AGV trong sản xuất thông minh.