Giới thiệu dự án

Trong bối cảnh các đợt bùng phát dịch bệnh truyền nhiễm quy mô lớn (điển hình như đại dịch COVID-19) và áp lực kiểm soát nhiễm khuẩn bệnh viện (Healthcare-Associated Infections - HAIs), công tác khử trùng bề mặt và không gian tại các khu vực cách ly, phòng bệnh và nhà xưởng đóng vai trò sống còn. Theo thống kê y tế dự phòng, phương pháp phun khử khuẩn thủ công truyền thống đặt nhân viên y tế vào rủi ro phơi nhiễm hóa chất khử khuẩn đậm đặc (gây kích ứng hô hấp, da) và nguy cơ lây nhiễm chéo cao dù đã trang bị bảo hộ chuyên dụng (PPE).

                            +-----------------------------+
                            |     ARDUINO MEGA 2560       |
                            |       (Master MCU)          |
                            +--------------+--------------+
                                           |
         +---------------------------------+---------------------------------+
         | (Digital / Analog)              | (UART / SPI)                    | (PWM / Digital)
+--------v--------+               +--------v--------+               +--------v--------+
| 5-Channel Line  |               |  Smart PID      |               |  Hệ thống phun  |
| Sensor Array    |               |  Driver Array   |               |  & Quạt BLDC    |
+-----------------+               +--------+--------+               +-----------------+
                                           |
                                  +--------v--------+
                                  | 4x Động cơ 24V  |
                                  | Planet + Encoder|
                                  +-----------------+

Vấn đề thực tiễn (Problem Statement)

  • Nhân viên vận hành phải mang bình phun áp lực tải trọng 15–20 kg trong thời gian dài, gây suy giảm thể lực và giảm độ phủ khử khuẩn.
  • Phương pháp thủ công để lại nhiều "điểm mù" khí động học trong các góc hẹp, gầm thiết bị mà vòi phun trực tiếp không tiếp cận tới.
  • Các mô hình robot tự hành dạng 2 bánh vi sai thông thường (Differential Drive) gặp hạn chế lớn về khả năng xoay xở trong hành lang hẹp hoặc góc cua gấp tại các cơ sở điều trị.

Mục tiêu nghiên cứu

  1. Thiết kế cơ khí toàn hướng: Chế tạo khung gầm robot sử dụng 4 bánh xe Omni $\varnothing 152\text{ mm}$ kết hợp cơ cấu cầu động (rocker bridge) triệt tiêu mất cân bằng tiếp xúc, đạt tải trọng định mức $160\text{ kg}$.
  2. Xây dựng hệ thống điều khiển đa chế độ: Tích hợp bộ xử lý trung tâm ATmega2560 hỗ trợ tự hành bám quỹ đạo (Line Tracking) với thanh cảm biến quang học 5 mắt và điều khiển thủ công từ xa thông qua tay cầm PS2 không dây tần số $2.4\text{ GHz}$.
  3. Tối ưu hóa hệ thống tán sương tầm xa: Kết hợp bơm áp lực $24\text{VDC}$ và động cơ không chổi than (BLDC) gắn cánh quạt định hướng, đẩy luồng sương khử trùng mịn bay xa tới $10\text{ m}$.

Phạm vi và giới hạn

  • Phạm vi: Hoạt động trên mặt sàn công nghiệp phẳng hoặc gồ ghề nhẹ (độ dốc $< 10^\circ$), dẫn hướng line tương phản cao (vạch đen trên nền trắng hoặc ngược lại) trong nhà xưởng, bệnh viện, hành lang văn phòng.
  • Giới hạn: Cảm biến quang học dễ chịu ảnh hưởng bởi ánh sáng môi trường cường độ cao ($> 10.000\text{ Lux}$); tầm kiểm soát không dây tối ưu trong bán kính $100\text{ m}$ không vật cản.

Phân tích và thiết kế giải pháp

Phân tích hiện trạng

Tiêu chí kỹ thuật Phun thủ công truyền thống Robot 2 bánh vi sai (AGV) Robot 4 bánh Omni (Đồ án)
Độ an toàn cho người Thấp (tiếp xúc trực tiếp) Tuyệt đối (vận hành từ xa) Tuyệt đối (vận hành từ xa/tự động)
Khả năng cơ động Phụ thuộc con người Cần bán kính quay vòng ($R > 0$) Di chuyển toàn hướng $360^\circ$ ($R = 0$)
Tải trọng chuyên chở $15 - 20\text{ kg}$ $40 - 80\text{ kg}$ Định mức tới $160\text{ kg}$
Tầm phân tán hóa chất $1.5 - 2.5\text{ m}$ $2.0 - 3.0\text{ m}$ Lên tới $10\text{ m}$ (nhờ quạt đẩy BLDC)
Chi phí đầu tư Thấp ban đầu, cao dài hạn Rất cao (yêu cầu sàn phẳng) Tối ưu, thích nghi địa hình

Phân tích yêu cầu hệ thống theo mô hình MoSCoW

  • Must Have: Hệ thống truyền động 4 bánh Omni độc lập; kiểm soát bám line tự động 5 kênh; cơ chế ngắt khẩn cấp; bơm phun sương áp suất cao $24\text{VDC}$.
  • Should Have: Quạt đẩy BLDC tăng tầm bao phủ hạt sương; mạch cầu động giữ tiếp xúc 4 bánh; driver Smart PID hồi tiếp xung encoder khép kín.
  • Could Have: Cảm biến siêu âm/hồng ngoại tránh chướng ngại vật phía trước; hiển thị trạng thái pin và áp suất qua màn hình phụ.
  • Won't Have (Giai đoạn này): Định vị SLAM bằng LiDAR 2D/3D; cánh tay robot thao tác mở cửa tự động.

Thiết kế kiến trúc hệ thống

+-------------------------------------------------------------------------------+
|                             KIẾN TRÚC ĐIỀU KHIỂN ROBOT                       |
+-------------------------------------------------------------------------------+
| [Cảm biến dò line 5 LED]  ---> [Arduino Mega 2560] <--- [Tay cầm PS2 2.4GHz] |
| [Encoder 500 xung/vòng]   ---> [  (ATmega2560)   ] ---> [Mạch Driver Smart]   |
+---------------------------------------+---------------------------------------+
                                        |
        +-------------------------------+-------------------------------+
        |                               |                               |
+-------v-------+               +-------v-------+               +-------v-------+
| 4x Động cơ    |               | Động cơ Bơm   |               | Động cơ Quạt  |
| Planet 24VDC  |               | Phun sương 24V|               | BLDC 3 pha    |
+---------------+               +---------------+               +---------------+

Ngăn xếp công nghệ (Technology Stack)

  • Thiết kế cơ khí: SolidWorks 2019 (Mô phỏng 3D Assembly, phân tích trọng tâm và ứng suất khung gầm).
  • Bộ vi điều khiển: Arduino Mega 2560 Rev3 (Microchip ATmega2560: xung nhịp $16\text{ MHz}$, $256\text{ KB}$ Flash, $8\text{ KB}$ SRAM, $4\text{ KB}$ EEPROM).
  • Phần mềm biên dịch: Arduino IDE v1.8.19 / Toolchain GCC-AVR.
  • Giao thức truyền thông: SPI (giao tiếp bộ thu PS2), UART đa điểm (giao tiếp Driver Smart PID), GPIO số (Digital I/O đọc thanh dò line).
+-------------------------------------------------------------------------------+
|                            PHÂN PHỐI NGUỒN ĐIỆN TỬ                             |
+-------------------------------------------------------------------------------+
| [2x Pin SamSung 18650 3.7V 3500mAh] ---> [Regulator 5V] ---> [MCU & Cảm biến] |
| [2x Ắc quy 12V 7.5Ah nối tiếp (24V)]---> [Nguồn chính]  ---> [Driver & Bơm]   |
| [1x Ắc quy 12V 12Ah độc lập]       ---> [ESC 30A]      ---> [Quạt đẩy BLDC]  |
+-------------------------------------------------------------------------------+

Phương pháp nghiên cứu và phát triển (Methodology)

Dự án áp dụng mô hình phát triển hệ thống nhúng lai (Agile Mechatronics) chia làm 4 giai đoạn rõ ràng:

  1. Tính toán & Thiết kế CAD (Tuần 1–4): Tính chọn động cơ, tỷ số truyền hộp số hành tinh $1:19.2$, thiết kế khung nhôm $40 \times 40\text{ mm}$ trên SolidWorks 2019.
  2. Gia công & Lắp ráp phần cứng (Tuần 5–8): Phay tiện khớp nối bánh Omni, lắp ráp gối đỡ trục đứng OMEGA $\varnothing 15\text{ mm}$ cho cầu động, đấu nối tủ điện.
  3. Lập trình thuật toán & Nhúng firmware (Tuần 9–12): Lập trình giải mã động học bánh Omni, thuật toán bám line 5 trạng thái và thuật toán PID vận tốc.
  4. Thực nghiệm & Hiệu chuẩn (Tuần 13–15): Kiểm tra tải trọng $0 - 50\text{ kg}$, đo độ trôi bám line và bán kính phân tán hạt sương.

Implementation và kết quả

Quy trình phát triển và thuật toán cốt lõi

Ma trận động học chuyển động 4 bánh Omni (Holonomic Kinematics)

Robot sử dụng 4 bánh Omni bố trí lệch nhau góc $90^\circ$. Vận tốc góc của 4 bánh ($\omega_1, \omega_2, \omega_3, \omega_4$) được tính toán từ vector vận tốc chuyển động tịnh tiến ($v_x, v_y$) và vận tốc góc tự quay ($\omega_z$) theo phương trình:

$$\begin{bmatrix} \omega_1 \ \omega_2 \ \omega_3 \ \omega_4 \end{bmatrix} = \frac{1}{R} \begin{bmatrix} -\sin(\alpha_1) & \cos(\alpha_1) & L \ -\sin(\alpha_2) & \cos(\alpha_2) & L \ -\sin(\alpha_3) & \cos(\alpha_3) & L \ -\sin(\alpha_4) & \cos(\alpha_4) & L \end{bmatrix} \begin{bmatrix} v_x \ v_y \ \omega_z \end{bmatrix}$$

Trong đó: $R = 76\text{ mm}$ (bán kính bánh xe), $L$ là khoảng cách từ tâm robot đến tâm bánh xe, $\alpha_i \in {45^\circ, 135^\circ, 225^\circ, 315^\circ}$.

Thuật toán điều khiển động học trên nền tảng Arduino (C++)

#include <Arduino.h>

// Định nghĩa thông số hình học và hệ số xung
const float WHEEL_RADIUS = 0.076; // Bán kính bánh xe: 76mm
const float ROBOT_RADIUS = 0.250; // Khoảng cách tâm robot đến bánh: 250mm

struct WheelSpeed {
    int16_t w1, w2, w3, w4;
};

// Hàm tính toán vận tốc bánh xe từ lệnh điều khiển (vx: mm/s, vy: mm/s, w: rad/s)
WheelSpeed computeOmniKinematics(float vx, float vy, float wz) {
    WheelSpeed ws;
    // Bố trí 4 bánh đối xứng lệch góc 45, 135, 225, 315 độ
    float v1 = -0.7071 * vx + 0.7071 * vy + ROBOT_RADIUS * wz;
    float v2 = -0.7071 * vx - 0.7071 * vy + ROBOT_RADIUS * wz;
    float v3 =  0.7071 * vx - 0.7071 * vy + ROBOT_RADIUS * wz;
    float v4 =  0.7071 * vx + 0.7071 * vy + ROBOT_RADIUS * wz;

    // Chuyển đổi vận tốc dài sang RPM cho Driver Smart PID
    ws.w1 = (int16_t)((v1 / (2 * 3.14159 * WHEEL_RADIUS)) * 60.0);
    ws.w2 = (int16_t)((v2 / (2 * 3.14159 * WHEEL_RADIUS)) * 60.0);
    ws.w3 = (int16_t)((v3 / (2 * 3.14159 * WHEEL_RADIUS)) * 60.0);
    ws.w4 = (int16_t)((v4 / (2 * 3.14159 * WHEEL_RADIUS)) * 60.0);
    return ws;
}

Xử lý tín hiệu cảm biến dò line 5 kênh

// Logic phân tích trạng thái thanh dò line 5 LED (S1, S2, S3, S4, S5)
void processLineTracking(uint8_t sensorByte) {
    // sensorByte: bit 0->S1, bit 1->S2, bit 2->S3, bit 3->S4, bit 4->S5
    switch (sensorByte) {
        case 0b00100: // Cảm biến S3 ở giữa chạm line: Chạy thẳng
            setRobotMotion(200, 0, 0); 
            break;
        case 0b01100: // Lệch nhẹ sang phải: Bẻ lái trái nhẹ
        case 0b01000:
            setRobotMotion(180, -50, 0);
            break;
        case 0b00110: // Lệch nhẹ sang trái: Bẻ lái phải nhẹ
        case 0b00010:
            setRobotMotion(180, 50, 0);
            break;
        case 0b11000: // Lệch nhiều sang phải: Dịch ngang trái khẩn cấp
            setRobotMotion(100, -150, 0);
            break;
        case 0b00011: // Lệch nhiều sang trái: Dịch ngang phải khẩn cấp
            setRobotMotion(100, 150, 0);
            break;
        case 0b11111: // Gặp vạch ngang dừng hoặc ngã tư: Dừng hoàn toàn
        case 0b00000: // Mất line hoàn toàn: Dừng hệ thống phun & động cơ
            stopAllActuators();
            break;
    }
}

Thử nghiệm và đánh giá thực nghiệm

+-------------------------------------------------------------------------------+
|                      KẾT QUẢ THỬ NGHIỆM ĐỘ ỔN ĐỊNH VẬN HÀNH                   |
+-------------------------------------------------------------------------------+
| Độ lệch bám line (Line-tracking error) : +/- 4.2 mm (tại vận tốc 0.4 m/s)     |
| Bán kính phân tán sương mịn (Dispersal): 9.8 - 10.2 m (khi kích hoạt quạt BLDC)|
| Thời gian đáp ứng điều khiển PS2       : < 35 ms (tần số 2.4 GHz)             |
| Độ võng khung gầm tại tải 40kg tải thêm: < 0.8 mm (nhôm định hình 40x40)      |
+-------------------------------------------------------------------------------+

Kết quả đạt được so với mục tiêu ban đầu

Hạng mục chức năng Mục tiêu thiết kế Kết quả thực nghiệm Mức độ hoàn thành
Khả năng chịu tải khung gầm $100\text{ kg}$ $160\text{ kg}$ tĩnh ($60\text{ kg}$ động) Đạt $160%$
Vận tốc di chuyển tối đa $0.5\text{ m/s}$ $0.65\text{ m/s}$ Đạt $130%$
Tầm phun khử khuẩn $5.0\text{ m}$ $10.0\text{ m}$ (nhờ quạt BLDC) Đạt $200%$
Số đầu phun sương hoạt động 6 đầu phun 10 đầu phun áp lực Đạt $166%$
Độ chính xác bám line Sai số $< 10\text{ mm}$ Sai số trung bình $\pm 4.2\text{ mm}$ Đạt yêu cầu

Đổi mới và đóng góp

Cải tiến kỹ thuật nổi bật

  1. Cơ cấu cầu động cân bằng mặt sàn (Rocker Bridge System): Khác với các kết cấu 4 bánh Omni cố định thường bị mất lực bám khi sàn mấp mô, hệ thống sử dụng trục Inox ty trượt $\varnothing 15\text{ mm}$ mạ Crom kết hợp 2 gối đỡ vòng bi chữ OMEGA (UCP/KP002, khối lượng $70\text{ g}$). Cầu động chia khung đáy thành 2 nửa bán độc lập, đảm bảo cả 4 bánh xe luôn tiếp xúc $100%$ với mặt sàn.
  2. Cơ chế khuếch tán sương hạt mịn cưỡng bức: Tích hợp động cơ BLDC tốc độ cao ($> 10.000\text{ RPM}$) thổi luồng khí định hướng phía sau dàn 10 vòi phun sương $24\text{VDC}$, tăng tầm bao phủ thêm $300%$ so với đầu phun áp lực đơn thuần, giúp khử khuẩn các ngóc ngách mà robot không cần trực tiếp đi vào.
  3. Mạch Smart PID Driver phân tán: Sử dụng vi điều khiển chuyên dụng cho từng kênh driver nhận xung Encoder ($500\text{ PPR}$), xử lý phản hồi vị trí/vận tốc với tần số lên đến $10\text{ MHz}$, giải phóng hoàn toàn năng lực tính toán cho chip Master ATmega2560.

Ứng dụng thực tế và triển khai

Kịch bản ứng dụng (Use Cases)

  • Bệnh viện dã chiến & Khu cách ly y tế: Tự động phun dung dịch Cloramin B hoặc cồn y tế dọc theo hành lang định sẵn mà không cần sự hiện diện của nhân viên y tế.
  • Nhà xưởng sản xuất thực phẩm / Dược phẩm: Khử khuẩn phòng sạch định kỳ vào ban đêm theo lộ trình line dán sẵn.
  • Tòa nhà văn phòng & Trường học: Điều khiển thủ công bằng tay cầm PS2 làm sạch các khu vực hội trường, thang máy, sảnh đón khách.
+-------------------------------------------------------------------------------+
|                         SƠ ĐỒ BỐ TRÍ TRIỂN KHAI THỰC TẾ                       |
+-------------------------------------------------------------------------------+
|                                                                               |
|   [Vạch Line Dẫn Hướng]  ========================> [Khu Vực Cần Khử Khuẩn]    |
|                                       |                                       |
|                                [Robot Phun]                                   |
|                                [Quạt BLDC ] ---> Phun sương xa 10m            |
|                                                                               |
|   [Nhân viên điều khiển] <--- Bán kính 100m (PS2 2.4GHz)                      |
|                                                                               |
+-------------------------------------------------------------------------------+

Phân tích hiệu quả kinh tế (Cost-Benefit & ROI)

  • Chi phí chế tạo mô hình thử nghiệm: ~12.500.000 VNĐ (thấp hơn $80%$ so với robot y tế nhập khẩu).
  • Tiết kiệm nhân công: 1 robot đảm đương khối lượng công việc của 3 nhân viên phun khử khuẩn thủ công.
  • Thời gian hoàn vốn (ROI): Ước tính từ 2.5 đến 4 tháng khi ứng dụng tại các cơ sở y tế quy mô 100 giường bệnh.

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

Hạn chế kỹ thuật hiện tại

  • Phương pháp bám line yêu cầu dán vạch dẫn hướng vật lý trên sàn, làm giảm tính linh hoạt khi môi trường cần thay đổi luồng di chuyển liên tục.
  • Hệ thống cảm biến hồng ngoại 5 mắt dễ bị suy giảm độ nhạy nếu mặt sàn ướt phản xạ ánh sáng mạnh hoặc bụi hóa chất bám vào bề mặt thấu kính quang học.
  • Nguồn cấp sử dụng kết hợp pin Li-ion 18650 và ắc quy chì khiến trọng lượng khối nguồn còn nặng (~$6.5\text{ kg}$).

Hướng phát triển tiếp theo

  • Tích hợp SLAM & Navigation: Thay thế thanh dò line bằng cảm biến LiDAR 2D (RPLiDAR A1/A2) kết hợp mạch máy tính nhúng (Raspberry Pi 4 / Jetson Nano) chạy ROS2 để tự dựng bản đồ 2D không gian và tự tìm đường tối ưu.
  • Hệ thống cảm biến an toàn đa tầng: Bổ sung cảm biến siêu âm chống va chạm và cảm biến phát hiện người bằng thân nhiệt hồng ngoại (PIR) nhằm tự động ngắt vòi phun khi có người bước vào vùng làm việc.
  • Nâng cấp công nghệ pin: Chuyển đổi toàn bộ sang pack pin Lithium Iron Phosphate ($\text{LiFePO}_4$) $24\text{V} - 30\text{Ah}$ tích hợp mạch sạc không dây tự động (Auto-docking station).

Đối tượng hưởng lợi

  • Sinh viên & Học viên ngành Cơ điện tử / Tự động hóa: Tài liệu tham khảo toàn diện từ khâu thiết kế cơ khí 3D trên SolidWorks, tính toán ma trận động học 4 bánh Omni đến kỹ thuật lập trình nhúng điều khiển PID trên vi điều khiển AVR.
  • Kỹ sư R&D thiết kế Robot di động (AGV/AMR): Tham khảo giải pháp cơ cấu cầu động (rocker bridge) giải quyết bài toán tiếp xúc mặt sàn mấp mô cho các dòng xe tự hành bánh Omni.
  • Cơ sở y tế & Doanh nghiệp công nghiệp: Sở hữu phương án công nghệ giá thành tối ưu để tự chủ chế tạo các thiết bị khử khuẩn, làm sạch tự động bảo vệ sức khỏe người lao động.

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

1. Robot sử dụng cấu hình 4 bánh Omni có ưu điểm gì vượt trội so với 2 bánh vi sai truyền thống?

Kết cấu 4 bánh Omni bố trí lệch $90^\circ$ cho phép robot chuyển động toàn hướng phẳng (3 bậc tự do: tịnh tiến $X, Y$ và quay góc $\theta$). Robot có thể di chuyển ngang, chéo hoặc tự quay quanh tâm tại chỗ ($R = 0$) mà không cần đổi hướng đầu xe, cực kỳ thuận tiện trong các lối đi hẹp.

2. Làm thế nào để giải quyết hiện tượng trượt hoặc mất tiếp xúc của 4 bánh Omni khi qua địa hình gồ ghề?

Đồ án thiết kế hệ thống cầu động (rocker suspension) với trục mạ Crom $\varnothing 15\text{ mm}$ và cụm gối đỡ vòng bi OMEGA UCP. Cơ cấu này cho phép 2 cụm khung bánh dao động góc độc lập quanh trục đứng, duy trì lực ép tiếp xúc của cả 4 bánh xe liên tục trên mặt sàn.

3. Hệ thống phun sương kết hợp quạt BLDC hoạt động theo nguyên lý nào?

Động cơ bơm $24\text{VDC}$ nén dung dịch đẩy qua dàn 10 béc phun tạo các hạt sương kích thước micron. Ngay phía sau, quạt đẩy dẫn động bởi motor BLDC 3 pha tạo luồng gió áp lực cao cuốn các hạt sương phân tán theo hình phễu bay xa tới $10\text{ m}$, bao phủ toàn bộ các góc chết trong phòng.

4. Tại sao lại lựa chọn phương pháp dẫn đường bằng vạch màu (Line Tracking) thay vì băng từ?

Vạch màu đen/trắng thi công đơn giản bằng băng dán sàn công nghiệp, chi phí vật tư thấp, dễ thay đổi cấu hình đường đi và không làm thay đổi kết cấu bề mặt sàn nhà xưởng/bệnh viện.

5. Bo mạch Arduino Mega 2560 có bị quá tải khi vừa đọc cảm biến, vừa giải mã PS2 và điều khiển 4 động cơ không?

Không. Nhờ kiến trúc xử lý phân tán: 4 động cơ được quản lý vận tốc/vị trí độc lập bởi các mạch Driver Smart PID thông qua giao tiếp xung/chiều hoặc UART. Master MCU (ATmega2560) chỉ thực hiện giải thuật động học cấp cao và xử lý logic chuyển trạng thái.


Kết luận

Đề tài "Nghiên cứu, thiết kế, chế tạo mô hình robot tự hành phun khử khuẩn" đã giải quyết trọn vẹn bài toán tự động hóa công tác khử trùng bảo vệ sức khỏe con người trong môi trường độc hại. Bằng việc kết hợp hệ thống chuyển động toàn hướng 4 bánh Omni, cơ cấu cầu động chống trượt, mạch điều khiển Smart PID phân tán cùng giải pháp khuếch tán sương cưỡng bức qua quạt BLDC tầm xa $10\text{ m}$, mô hình chứng minh tính khả thi kỹ thuật vượt trội và hiệu quả kinh tế cao. Đây là nền tảng vững chắc để mở rộng phát triển thành các dòng robot dịch vụ thông minh (AMR) phục vụ đắc lực cho ngành y tế và công nghiệp trong tương lai.