Giới thiệu dự án

Bối cảnh ngành và nguồn gốc vấn đề

Ngành công nghiệp tự động hóa và chế tạo robot tại Việt Nam cũng như toàn cầu đang trải qua giai đoạn chuyển mình mạnh mẽ với tốc độ tăng trưởng kép hàng năm (CAGR) đạt xấp xỉ 14.5% trong giai đoạn 2021–2028. Các hệ thống xe tự hành AGV (Automated Guided Vehicle) và robot hỗ trợ thao tác công nghiệp ngày càng đòi hỏi độ linh hoạt tối đa, khả năng di chuyển đa hướng (Omnidirectional Motion) và tính phản hồi thời gian thực với độ trễ tối thiểu dưới 20ms.

Trong bối cảnh đó, cuộc thi Sáng tạo Robot Châu Á - Thái Bình Dương (ABU Robocon 2024) do Việt Nam đăng cai tổ chức với chủ đề "Ngày mùa" – mô phỏng quá trình canh tác lúa nước trên các thửa ruộng bậc thang – đặt ra bài toán công nghệ khắt khe về việc tối ưu hóa hệ thống điều khiển robot bán tự động và robot điều khiển bằng tay (Manual Robot).

graph TD
    A[Yêu cầu đề thi Robocon 2024: Ngày mùa] --> B[Thách thức môi trường & Nhiệm vụ]
    B --> C[Di chuyển đa hướng vượt địa hình gập ghềnh]
    B --> D[Xử lý gắp - xoay 12 bó mạ và hút - bắn bóng]
    B --> E[Khống chế sai số tích lũy & Độ trễ truyền thông]
    C & D & E --> F[Giải pháp: Hệ thống điều khiển vi xử lý STM32F407 kết hợp IMU & Bánh Mecanum]

Phát biểu bài toán và các điểm nghẽn kỹ thuật (Pain Points)

Robot điều khiển bằng tay số 1 trong đề tài phải đối mặt với các vấn đề kỹ thuật trọng yếu:

  • Hiện tượng trượt và trôi dạt góc (Angular Drift) của hệ bánh Mecanum: Khi chuyển động trên bề mặt sân thi đấu có ma sát không đồng nhất và độ dốc tại các cầu nối mương nước, các con lăn $45^\circ$ của bánh Mecanum tạo ra lực ma sát trượt lớn, gây sai lệch hướng di chuyển (Yaw drift) từ $5^\circ - 15^\circ$ sau mỗi hành trình di chuyển $3\text{ m}$.
  • Độ trễ và mất gói tin trong môi trường đa tần số: Phương án điều khiển ban đầu qua sóng Wi-Fi/Android App phát sinh độ trễ dao động từ $80\text{ ms} - 250\text{ ms}$ cùng hiện tượng nghẽn sóng do can nhiễu từ các thiết bị xung quanh.
  • Xung đột dòng điện và xung nhiễu điện từ (EMI): Động cơ hút bóng công suất lớn (BLDC Lexy 200W, dòng khởi động $>15\text{A}$, tốc độ $80.000\text{ rpm}$) cùng các cuộn hút của van điện từ khí nén 24VDC gây sụt áp hệ thống và tạo tia lửa điện/hồ quang trên relay cơ học, dẫn đến hiện tượng treo (freeze) vi điều khiển.
  • Hạn chế về giới hạn kích thước và trọng lượng: Robot phải thỏa mãn kích thước ban đầu $\le 700 \times 700 \times 700\text{ mm}$, trọng lượng $\le 25\text{ kg}$, đồng thời phải mang đủ cơ số 8 bình khí nén $1.5\text{L}$ áp suất $6\text{ bar}$ và năng lượng vận hành liên tục $>1\text{ giờ}$.

Mục tiêu dự án

  1. Mục tiêu 1: Thiết kế và chế tạo hoàn chỉnh cấu trúc cơ điện tử cho Robot số 1 đáp ứng tiêu chuẩn ABU Robocon 2024 (kích thước xuất phát $\le 700\text{ mm}^3$, thi đấu $\le 900\text{ mm}^3$, trọng lượng tĩnh $\le 25\text{ kg}$).
  2. Mục tiêu 2: Phát triển hệ thống truyền động đa hướng 4 bánh Mecanum tích hợp cơ cấu treo cầu động (Rocker-bogie articulation) và thuật toán bù sai lệch góc Yaw theo thời gian thực sử dụng cảm biến quán tính IMU, giới hạn sai số góc $< 2^\circ$.
  3. Mục tiêu 3: Xây dựng phần cứng điều khiển nhúng chuyển đổi từ kiến trúc ESP32-S3 Wi-Fi sang vi điều khiển 32-bit ARM Cortex-M4 (STM32F407VET6) kết nối tay cầm không dây PS2 qua giao thức UART Bluetooth HC-05 (115.200 bps), hạ độ trễ phản hồi $< 15\text{ ms}$.
  4. Mục tiêu 4: Thiết kế mạch công suất cách ly quang học hoàn toàn (Optocoupler Isolation) kết hợp Relay bán dẫn DC-DC SSR-40DD và IC mảng đệm Darlington ULN2803 để triệt tiêu 100% hiện tượng xung ngược và sụt áp khi đóng ngắt tải cảm ứng.
  5. Mục tiêu 5: Tối ưu hóa chu trình thi đấu: hoàn thành gieo 12 bó mạ tại Vùng 1 trong thời gian $< 90\text{ s}$, hút và phóng chính xác $\ge 6$ hạt thóc sang Vùng 3, đóng góp tối thiểu 140 điểm trong tổng điểm liên minh.

Cách tiếp cận giải pháp và biện minh kỹ thuật

  • Chuyển đổi kiến trúc từ V1 (ESP32-S3) sang V2 (STM32F407VET6 + Smart PID + IMU): Kiến trúc V2 tách biệt hoàn toàn việc tính toán động học nghịch, vòng lặp điều khiển vận tốc kín (Closed-loop PID) cho 4 động cơ DC Planet và xử lý truyền thông không dây bằng phần cứng chuyên dụng, đảm bảo tính thời gian thực (Hard Real-Time).
  • Ứng dụng cơ chế bù sai lệch hướng di chuyển: Kết hợp ma trận động học Mecanum với giá trị phản hồi từ cảm biến la bàn số IMU qua cổng I2C/UART để tính toán sai số góc $e_\theta = \theta_{\text{target}} - \theta_{\text{current}}$, từ đó đưa thành phần hiệu chỉnh tốc độ góc $\Delta \omega$ trực tiếp vào vector vận tốc từng bánh xe.
Thông số đánh giá Giá trị định mức yêu cầu Giá trị thực nghiệm đạt được Mức độ hoàn thành
Kích thước ban đầu $\le 700 \times 700 \times 700\text{ mm}$ $680 \times 670 \times 690\text{ mm}$ $100%$
Trọng lượng tổng thể $\le 25.0\text{ kg}$ $22.4\text{ kg}$ Đạt ($89.6%$ ngưỡng max)
Vận tốc di chuyển cực đại $\ge 1.0\text{ m/s}$ $1.35\text{ m/s}$ $135%$
Sai số góc trôi khi di chuyển $< 5^\circ / 3\text{ m}$ $\le 1.8^\circ / 3\text{ m}$ Đạt tiêu chuẩn
Thời gian chu trình Vùng 1 $\le 90\text{ s}$ $76\text{ s}$ Rút ngắn $15.5%$
Tổng điểm trung bình/trận $\ge 140\text{ điểm}$ $160\text{ điểm}$ $114%$

Phạm vi và giới hạn đề tài

  • Phạm vi: Tập trung vào thiết kế phần cứng điện - điện tử, mạch phân phối nguồn công suất, lập trình firmware nhúng C/C++ trên STM32F407, thuật toán điều khiển bù góc cho hệ bánh Mecanum, và cơ chế chấp hành liên động (khí nén - động cơ bước Hybrid).
  • Giới hạn: Nghiên cứu không đi sâu vào phân tích ứng suất động lực học chi tiết của từng chi tiết cơ khí (thuộc phạm vi nhóm Cơ khí Robocon); chỉ tập trung vào tín hiệu điều khiển và độ ổn định hệ thống.

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

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

So sánh các giải pháp điều khiển robot

Tiêu chí Phương án 1: Smartphone App qua Wi-Fi (ESP32-S3) Phương án 2: Tay cầm RC máy bay (TX/RX PWM) Phương án 3: Tay cầm PS2 + Bluetooth HC-05 + STM32F4 (Đề xuất)
Độ trễ truyền nhận Cao ($80 - 250\text{ ms}$ do nghẽn mạng) Thấp ($10 - 20\text{ ms}$) Rất thấp ($8 - 15\text{ ms}$)
Phản hồi xúc giác Kém (chạm màn hình cảm ứng, dễ bấm trượt) Trung bình (cần gạt vật lý, cồng kềnh) Tối ưu (nút bấm cơ học, phản hồi lực tốt)
Độ ổn định tín hiệu Dễ bị suy hao do can nhiễu đa mạng 2.4GHz Tốt trong không gian mở Ổn định nhờ giao thức ghép cặp Master-Slave
Khả năng mở rộng ngoại vi Trung bình (bị giới hạn Timer/PWM) Thấp (giới hạn kênh PPM/PWM cố định) Rất cao (đa kênh DMA, Timer, CAN, UART)
Khả năng chống nhiễu công suất Thấp (relay cơ học gây reset ESP32) Phụ thuộc bo trung gian Tuyệt đối (Opto PC817 + SSR + Nguồn cách ly)

Ma trận ưu tiên yêu cầu người dùng (MoSCoW Matrix)

  • Must-have (Bắt buộc): Di chuyển đa hướng 4 trục Mecanum; Cơ cấu gắp đồng thời 6 bó mạ kết hợp cơ cấu xoay $180^\circ$; Cơ cấu hút và phóng hạt thóc áp lực cao; Chuyển mạch công suất không phát sinh hồ quang.
  • Should-have (Nên có): Tự động bù góc trôi theo la bàn số IMU; Khóa cứng bánh tự động khi dừng để chống phản lực; Hệ thống giám sát điện áp pin bằng phân áp trở ADC.
  • Could-have (Có thể có): Màn hình OLED hiển thị trạng thái áp suất và dòng tiêu thụ trực tiếp trên thân robot.
  • Won't-have (Chưa thực hiện): Tích hợp camera AI nhận diện hạt thóc và tự động căn chỉnh quỹ đạo (dành cho robot tự động số 2).

Thiết kế hệ thống

graph LR
    subgraph Controller_Unit [Khối Điều Khiển & Giao Tiếp]
        PS2[Tay cầm PS2 Thế Giới Chip] -->|Bluetooth 2.4GHz| HC05[Module Bluetooth HC-05]
        HC05 -->|UART 115200bps| STM32[Mainboard STM32F407VET6 ARM Cortex-M4]
        IMU[La bàn số - Module IMU] -->|I2C / UART| STM32
    end

    subgraph Power_Unit [Khối Phân Phối Nguồn]
        Bat24[Pin Lithium 24VDC] --> Boost[Mạch tăng áp J1H20 400W -> 36V]
        Bat12[Pin Lithium 12VDC] --> Buck[Mạch hạ áp LM2596 -> 5V]
    end

    subgraph Isolation_Driver [Khối Cách Ly & Trung Gian]
        STM32 -->|UART/PWM| SmartPID[4x Driver Smart PID]
        STM32 -->|PUL/DIR 5V| HBS57[Driver Hybrid HBS57 DSP]
        STM32 -->|GPIO Logic 3.3V| ULN[Mạch Opto PC817 + ULN2803]
        STM32 -->|GPIO Trigger| SSR[Solid State Relay SSR-40DD]
    end

    subgraph Actuators [Khối Chấp Hành]
        SmartPID -->|Closed Loop| M_Planet[4x Động cơ DC Planet + Bánh Mecanum]
        HBS57 -->|Feedback Encoder| M_Hybrid[Động cơ Hybrid Step 57HS3 3Nm]
        ULN -->|24VDC Drive| Solenoid[Dàn Van Khí Nén 5/2 SMC SY7220]
        SSR -->|36VDC High Current| BLDC[Động cơ hút Lexy 200W 80000rpm]
    end

Ngăn xếp công nghệ phần cứng và phần mềm (Tech Stack)

  • Vi điều khiển chính: STM32F407VET6 (32-bit ARM Cortex-M4 @ 168MHz, 512KB Flash, 192KB SRAM, Hardware FPU).
  • Vi điều khiển tiền nhiệm (Phiên bản V1): ESP32-S3 N16R8 (Xtensa Dual-Core 32-bit LX7 @ 240MHz, 16MB Flash, 8MB PSRAM).
  • Môi trường phát triển: Keil MDK-ARM v5.38 (C/C++ Embedded), STM32CubeMX v6.10, Android Studio Giraffe (dành cho bản V1), Altium Designer 23.0 (thiết kế PCB).
  • Cảm biến và Driver chuyên dụng: Cảm biến IMU la bàn số, Driver vi bước Hybrid HBS57 DSP 32-bit, Driver Smart PID DC closed-loop.
  • Cơ cấu phân phối điện năng: Solid State Relay SSR-40DD (DC-DC 40A, switching $<1\text{ ms}$, cách ly quang $>2.5\text{kV}$), Mạch đệm dòng IC ULN2803 + Mạch cách ly quang PC817.

Phương pháp luận phát triển (Methodology)

Dự án áp dụng mô hình phát triển Agile/V-Model rút gọn kéo dài 16 tuần, chia làm 3 giai đoạn chính:

gantt
    title Tiến độ triển khai dự án Robot Robocon 2024
    dateFormat  YYYY-MM-DD
    section Giai đoạn 1: Nghiên cứu
    Phân tích luật thi & Tính toán động học       :a1, 2024-01-01, 21d
    Khảo sát linh kiện & Thiết kế sơ đồ nguyên lý:a2, after a1, 14d
    section Giai đoạn 2: Thiết kế & Chế tạo
    Thiết kế mạch PCB Altium & Gia công cơ khí   :b1, after a2, 28d
    Lắp ráp V1 ESP32-S3 & Viết App Android       :b2, after b1, 21d
    section Giai đoạn 3: Thử nghiệm & Nâng cấp V2
    Thử nghiệm V1 & Nhận diện lỗi trôi/nhiễu     :c1, after b2, 14d
    Nâng cấp V2 STM32F407 + IMU + PS2            :c2, after c1, 21d
    Hiệu chỉnh chiến thuật & Thi đấu chính thức   :c3, after c2, 14d

Đánh giá rủi ro và giải pháp suy giảm (Risk Matrix)

  • Rủi ro 1: Kênh bánh xe Mecanum khi lên dốc. Giải pháp: Thiết kế khung gầm thép mạ kẽm CNC tích hợp cụm cầu động (Rocker articulation) cho phép khung xoay linh hoạt biên độ $\pm 8^\circ$, đảm bảo cả 4 bánh luôn tiếp xúc mặt phẳng sân.
  • Rủi ro 2: Cháy MOSFET cầu H do dòng đảo chiều. Giải pháp: Bổ sung module Smart PID tích hợp thuật toán Soft-start/Soft-stop và diode xả ngược (Flyback diodes) công suất cao.
  • Rủi ro 3: Tụt áp khí nén trong chuỗi thao tác liên tục. Giải pháp: Ghép nối song song 8 bình tích khí áp lực cao $1.5\text{L}$, bố trí van xả nhanh và giới hạn hành trình xilanh ở mức tối ưu $150\text{ mm}$.

Implementation và kết quả

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

1. Động học bánh xe Mecanum và tích hợp bù góc lệch IMU

Robot sử dụng cấu hình 4 bánh Mecanum $4\text{ inch}$ ($100\text{ mm}$) bố trí dạng chữ X. Vector vận tốc dài của robot $(V_x, V_y)$ và vận tốc góc $(\omega)$ được quy đổi thành vận tốc góc của từng bánh xe $(\omega_1, \omega_2, \omega_3, \omega_4)$ theo phương trình động học:

$$\begin{bmatrix} \omega_1 \ \omega_2 \ \omega_3 \ \omega_4 \end{bmatrix} = \frac{1}{R} \begin{bmatrix} 1 & -1 & -(L_x + L_y) \ 1 & 1 & (L_x + L_y) \ 1 & 1 & -(L_x + L_y) \ 1 & -1 & (L_x + L_y) \end{bmatrix} \begin{bmatrix} V_x \ V_y \ \omega_z + \Delta \omega \end{bmatrix}$$

Trong đó:

  • $R = 0.05\text{ m}$ là bán kính bánh xe.
  • $L_x = 0.25\text{ m}, L_y = 0.22\text{ m}$ là khoảng cách từ tâm robot đến các trục bánh xe.
  • $\Delta \omega = K_p \cdot e_\theta + K_i \int e_\theta dt + K_d \frac{de_\theta}{dt}$ là thành phần hiệu chỉnh góc Yaw từ bộ điều khiển PID dựa trên dữ liệu IMU với $e_\theta = \theta_{\text{setpoint}} - \theta_{\text{IMU}}$.

2. Mã nguồn triển khai thuật toán tính toán tốc độ và bù sai lệch góc (C/C++ STM32)

#include "stm32f4xx_hal.h"
#include "math.h"

#define WHEEL_RADIUS      0.05f   // Bán kính bánh xe: 50mm
#define LX_PLUS_LY        0.47f   // Lx + Ly (m)
#define MAX_PWM_OUTPUT    1000.0f // Độ phân giải xung PWM điều khiển

typedef struct {
    float Kp, Ki, Kd;
    float prev_error;
    float integral;
} PID_Controller;

PID_Controller yaw_pid = { .Kp = 4.2f, .Ki = 0.05f, .Kd = 0.85f, .prev_error = 0.0f, .integral = 0.0f };

float Compute_Yaw_Correction(float target_yaw, float current_yaw, float dt) {
    float error = target_yaw - current_yaw;
    // Chuẩn hóa sai số góc trong khoảng [-180, 180] độ
    while (error > 180.0f)  error -= 360.0f;
    while (error < -180.0f) error += 360.0f;

    yaw_pid.integral += error * dt;
    // Chống bão hòa tích phân (Anti-windup)
    if (yaw_pid.integral > 100.0f) yaw_pid.integral = 100.0f;
    if (yaw_pid.integral < -100.0f) yaw_pid.integral = -100.0f;

    float derivative = (error - yaw_pid.prev_error) / dt;
    yaw_pid.prev_error = error;

    return (yaw_pid.Kp * error + yaw_pid.Ki * yaw_pid.integral + yaw_pid.Kd * derivative);
}

void Calculate_Mecanum_Velocities(float Vx, float Vy, float omega_cmd, float target_yaw, float current_yaw, float dt, int16_t pwm_out[4]) {
    // Nếu không có lệnh xoay chủ động từ cần joystick, kích hoạt bù góc IMU
    float omega_effective = omega_cmd;
    if (fabs(omega_cmd) < 0.05f) {
        omega_effective = Compute_Yaw_Correction(target_yaw, current_yaw, dt);
    } else {
        yaw_pid.integral = 0.0f; // Reset tích phân khi người dùng chủ động bẻ lái
    }

    // Tính toán ma trận động học
    float w1 = (Vx - Vy - omega_effective * LX_PLUS_LY) / WHEEL_RADIUS;
    float w2 = (Vx + Vy + omega_effective * LX_PLUS_LY) / WHEEL_RADIUS;
    float w3 = (Vx + Vy - omega_effective * LX_PLUS_LY) / WHEEL_RADIUS;
    float w4 = (Vx - Vy + omega_effective * LX_PLUS_LY) / WHEEL_RADIUS;

    float w_array[4] = {w1, w2, w3, w4};
    float max_val = 0.0f;

    // Chuẩn hóa tỉ lệ vector để tránh vượt quá giới hạn PWM cực đại
    for (int i = 0; i < 4; i++) {
        if (fabs(w_array[i]) > max_val) max_val = fabs(w_array[i]);
    }

    float scale = (max_val > MAX_PWM_OUTPUT) ? (MAX_PWM_OUTPUT / max_val) : 1.0f;
    for (int i = 0; i < 4; i++) {
        pwm_out[i] = (int16_t)(w_array[i] * scale);
    }
}

flowchart TD
    Start([Bắt đầu chu kỳ điều khiển]) --> Read_PS2[Đọc dữ liệu UART từ Bluetooth HC-05]
    Read_PS2 --> Read_IMU[Đọc góc Yaw hiện tại từ cảm biến IMU]
    Read_IMU --> Check_Rotation{Người dùng có bẻ cần xoay?}
    Check_Rotation -- Có --> Manual_Yaw[Omega = Omega_Joystick & Reset PID Integral]
    Check_Rotation -- Không --> Auto_PID[Tính delta_Omega bằng thuật toán PID Yaw]
    Manual_Yaw --> Kinematics_Calc[Giải mã ma trận động học nghịch 4 bánh Mecanum]
    Auto_PID --> Kinematics_Calc
    Kinematics_Calc --> Norm_PWM[Chuẩn hóa vector xung PWM ra dải 0-1000]
    Norm_PWM --> Output_Driver[Truyền dữ liệu điều khiển tới 4x Smart PID qua Timer DMA]
    Output_Driver --> End([Kết thúc chu kỳ])

Thử nghiệm và kiểm chuẩn (Testing & Validation)

Kịch bản kiểm thử và kết quả thực nghiệm

Hệ thống đã trải qua hơn 120 giờ chạy thử nghiệm liên tục trên mô hình sân thi đấu chuẩn:

Kịch bản kiểm thử Phương pháp đánh giá Kết quả phiên bản V1 (Wi-Fi) Kết quả phiên bản V2 (PS2 + IMU)
Độ trễ truyền gói lệnh Phân tích xung Logic Analyzer $124.5\text{ ms} \pm 35\text{ ms}$ $11.2\text{ ms} \pm 1.8\text{ ms}$
Độ lệch hướng khi tịnh tiến $5\text{ m}$ Đo trắc địa laser sai số quỹ đạo Trôi lệch $14.2^\circ$ ($48\text{ cm}$) Trôi lệch $\le 1.6^\circ$ ($4.5\text{ cm}$)
Thời gian đáp ứng van khí nén Đo chu kỳ kích áp xilanh 150mm $120\text{ ms}$ (Relay cơ gây trễ) $28\text{ ms}$ (Mạch Opto + ULN2803)
Độ sụt áp khi kích quạt 80.000 rpm Đo điện áp nguồn vi điều khiển qua Oscilloscope Sụt áp $-1.8\text{V}$ (gây treo MCU) Ổn định $\pm 0.05\text{V}$ (nhờ SSR-40DD)
Tỉ lệ lấy mạ thành công (12/12 bó) 30 lần thao tác liên tục $63.3%$ ($19/30$ lần) $96.7%$ ($29/30$ lần)

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

Các cải tiến kỹ thuật đột phá

  1. Thiết kế cơ cấu khung gầm cầu động (Rocker Articulation Suspension): Khác với khung gầm nguyên khối thông thường dễ bị treo bánh xe khi qua các gờ mấp mô, thiết kế chia khoang liên kết khớp động học giúp 4 bánh Mecanum luôn duy trì áp lực tiếp xúc đồng đều lên mặt sàn, triệt tiêu $85%$ hiện tượng trượt tự do của các con lăn phụ.
  2. Hệ thống đóng ngắt công suất Solid-State hoàn toàn: Ứng dụng Relay bán dẫn DC-DC SSR-40DD kết hợp bộ đệm quang Opto-isolated ULN2803 thay thế toàn bộ relay cơ điện. Cải tiến này loại bỏ hoàn toàn tia lửa điện hồ quang, nâng tuổi thọ linh kiện đóng ngắt lên gấp 50 lần và triệt tiêu xung nhiễu điện từ (EMI) tác động vào vi xử lý.
  3. Cơ chế kẹp mạ đối xứng $180^\circ$ dẫn động bằng động cơ bước Hybrid Closed-loop: Tích hợp động cơ bước lai servo 57HS3 ($3\text{Nm}$) kết hợp driver HBS57 công nghệ vi xử lý DSP 32-bit và bộ truyền bánh răng tỉ số truyền $1/16$. Giải pháp này cho phép cụm kẹp lấy đồng thời 6 bó mạ chỉ trong một lần hạ cơ cấu, xoay lật góc chính xác tuyệt đối mà không có hiện tượng mất bước (loss of steps).
graph TD
    subgraph CaiTien1 [Cơ cấu cơ học]
        C1[Khung gầm Cầu Động Rocker] --> D1[4 Bánh luôn bám sân 100%]
    end
    subgraph CaiTien2 [Mạch công suất điện tử]
        C2[SSR-40DD + ULN2803 + Opto] --> D2[Triệt tiêu 100% tia lửa điện & Nhiễu EMI]
    end
    subgraph CaiTien3 [Thuật toán nhúng]
        C3[Mecanum Kinematics + IMU Closed-loop] --> D3[Bù sai lệch góc Yaw tự động < 1.8 độ]
    end
    D1 & D2 & D3 --> Output[Hệ thống Robot Vận hành Tốc độ cao & Tin cậy]

So sánh với các giải pháp hiện hành

Đặc tính kỹ thuật Giải pháp truyền thống (Mở) Phiên bản V1 (ESP32-S3) Phiên bản V2 Đề xuất (STM32F4 + IMU)
Phương thức bù góc Hoàn toàn dựa vào mắt người điều khiển Không có thuật toán bù Tự động thích nghi thời gian thực qua PID IMU
Độ tin cậy liên lạc Cao nhưng giới hạn kênh điều khiển Dễ mất kết nối do nhiễu Wi-Fi Ghép cặp Bluetooth bảo mật phần cứng
Bảo vệ phần cứng Cầu chì nhiệt thụ động Diode thường, dễ sốc điện Cách ly quang đa tầng, bảo vệ quá dòng/áp
Độ chính xác góc quay tay gắp Sai số $\pm 5^\circ$ do trôi bước Step hở Sai số $\pm 3^\circ$ Sai số $< 0.1^\circ$ (Closed-loop Step-Servo)

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

Khả năng chuyển giao và ứng dụng thực tế

Kiến trúc phần cứng và giải pháp thuật toán phát triển trong đồ án có khả năng ứng dụng trực tiếp vào nhiều lĩnh vực công nghiệp thực tiễn:

  • Hệ thống xe tự hành AGV/AMR trong nhà kho thông minh (Smart Warehousing): Ứng dụng hệ thống truyền động Mecanum kết hợp la bàn số IMU giúp AGV di chuyển linh hoạt trong không gian hẹp giữa các kệ hàng, tịnh tiến ngang bốc xếp pallet mà không cần bán kính quay vòng.
  • Robot hỗ trợ nông nghiệp công nghệ cao: Cơ cấu gắp mạ tự định vị và hệ thống cấp khí nén áp lực cao có thể mở rộng thành hệ thống gieo trồng cây giống, thu hoạch nông sản tự động trong nhà kính.
  • Hệ thống quan trắc và can thiệp trong môi trường nguy hiểm: Khung gầm cầu động vượt địa hình cùng mạch điều khiển công suất chống nhiễu là nền tảng phù hợp cho robot thăm dò hầm mỏ, đường ống dẫn khí hoặc vùng nhiễm độc.
graph TD
    A[Nền tảng Công nghệ Robot Robocon 2024] --> B[Xe tự hành AGV/AMR Kho thông minh]
    A --> C[Robot Nông nghiệp Gieo cấy - Thu hoạch]
    A --> D[Robot Cứu hộ & Kiểm tra Môi trường Độc hại]
    B --> E[Tối ưu diện tích lối đi kho xưởng lên 35%]
    C --> F[Tự động hóa chu trình gắp đặt nông sản]
    D --> G[Vận hành an toàn qua điều khiển tầm xa chống nhiễu]

Phân tích chi phí và hiệu quả đầu tư (Cost-Benefit & ROI Analysis)

Bảng dự toán chi phí chế tạo hệ thống điều khiển

Hạng mục linh kiện Chủng loại kỹ thuật Số lượng Đơn giá (VND) Thành tiền (VND)
Vi điều khiển trung tâm Mainboard Robot STM32F407VET6 1 bo mạch 850.000 850.000
Driver điều khiển bánh xe Smart PID 30A DC Closed-loop 4 bộ 450.000 1.800.000
Động cơ bánh xe Động cơ DC Planet 24V có Encoder 4 chiếc 650.000 2.600.000
Cụm động cơ bước lai Hybrid Step-Servo 57HS3 + HBS57 1 bộ 1.450.000 1.450.000
Động cơ hút bóng áp lực BLDC Lexy 200W 80.000 rpm 1 chiếc 350.000 350.000
Thiết bị đóng ngắt công suất SSR-40DD + Mạch ULN2803 Opto 1 combo 320.000 320.000
Hệ thống van khí nén SMC 5/2 SY7220 + Dây dẫn + Khí 1 hệ 1.200.000 1.200.000
Cảm biến và phụ trợ Cảm biến IMU + Bluetooth HC-05 + PS2 1 bộ 650.000 650.000
Hệ thống nguồn 2x Pin Lithium (12V & 24V) + Mạch biến đổi DC 1 bộ 1.800.000 1.800.000
Tổng chi phí phần cứng — — — 11.020.000 VND
  • Hiệu quả kinh tế: So với việc nhập khẩu các hệ thống điều khiển AGV công nghiệp chuyên dụng (có giá dao động từ $45.000.000 - 80.000.000\text{ VND}$), giải pháp tự thiết kế giúp giảm $75 - 85%$ chi phí chế tạo mà vẫn đảm bảo đầy đủ các tính năng điều khiển động học phản hồi kín.

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

Các hạn chế kỹ thuật hiện tại

  • Sai số trôi dài hạn của cảm biến IMU (Long-term Drift): Cảm biến quán tính sử dụng trong đề tài là dòng cấp thấp, dễ bị ảnh hưởng bởi nhiệt độ và biến thiên từ trường cục bộ, dẫn đến sai số trôi góc lũy kế nếu robot hoạt động liên tục trên 15 phút mà không được hiệu chuẩn điểm không (Zero-point Calibration).
  • Dung lượng tích áp khí nén thụ động: Việc sử dụng các bình chứa khí tích áp sẵn làm giảm dần áp suất bắn bóng theo thời gian (áp suất giảm từ $6.0\text{ bar}$ xuống $3.5\text{ bar}$ sau 8 lần bắn liên tục), đòi hỏi người vận hành phải nạp khí định kỳ thủ công.

Định hướng nghiên cứu mở rộng

  1. Nâng cấp thuật toán định vị kết hợp (Sensor Fusion): Bổ sung cụm bánh xe đo cự ly đa hướng độc lập (Omni Tracking Wheels kèm Encoder quang học độ phân giải cao $1024\text{ PPR}$) kết hợp với thuật toán lọc Kalman mở rộng (EKF - Extended Kalman Filter) dung hợp dữ liệu IMU + Encoder.
  2. Tích hợp hệ điều hành thời gian thực (FreeRTOS): Tái cấu trúc firmware trên STM32F407 thành các Task độc lập đa nhiệm (Task đọc cảm biến, Task giải mã PS2, Task điều khiển PID động cơ, Task giám sát an toàn).
  3. Phát triển hệ thống thị giác máy tính (Computer Vision): Gắn kết module camera xử lý biên (như Raspberry Pi 4 hoặc Jetson Nano) truyền thông với bo STM32 qua giao thức CAN Bus để tự động hóa hoàn toàn chu trình nhận diện mạ và căn chỉnh góc bắn bóng vào Silo.

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

mindmap
  root((Đối Tượng Hưởng Lợi))
    Sinh viên Kỹ thuật
      Tài liệu tham khảo thực tế về thiết kế Robot
      Mã nguồn thuật toán động học Mecanum & C nhúng
    Kỹ sư Hệ thống Nhúng
      Mô hình chống nhiễu công suất với Opto & SSR
      Kiến trúc truyền thông thời gian thực độ trễ thấp
    Doanh nghiệp Tự động hóa
      Thiết kế AGV/AMR tối ưu chi phí thấp
      Giải pháp cơ cấu chấp hành khí nén - Step lai
    Nhà nghiên cứu Robotics
      Dữ liệu thực nghiệm sai số trôi bánh Mecanum
      Mô hình điều khiển thích nghi bù góc Yaw
  • Sinh viên chuyên ngành Điều khiển & Tự động hóa / Cơ điện tử: Tiếp cận tài liệu đồ án toàn diện từ lý thuyết động học, thiết kế sơ đồ mạch điện công suất, đến phương pháp lập trình vi điều khiển 32-bit thực chiến.
  • Kỹ sư phát triển sản phẩm (R&D Developers): Tham khảo giải pháp thiết kế mạch cách ly chống xung ngược, quy chuẩn layout bo mạch PCB chống nhiễu trong môi trường tải cảm ứng nặng.
  • Doanh nghiệp vừa và nhỏ (SMEs): Ứng dụng khung thiết kế phần cứng giá thành thấp ($<12\text{ triệu đồng}$) để phát triển các mẫu AGV vận chuyển vật tư nội bộ nhà xưởng, rút ngắn thời gian hoàn vốn đầu tư (ROI $< 6\text{ tháng}$).

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

1. Yêu cầu phần cứng và môi trường tối thiểu để triển khai nạp firmware cho hệ thống là gì?

Để biên dịch và nạp chương trình điều khiển cho bo mạch chính, hệ thống yêu cầu:

  • Máy tính cá nhân chạy hệ điều hành Windows 10/11 hoặc Linux Ubuntu 20.04 LTS.
  • Phần mềm Keil MDK-ARM v5.30 trở lên kèm bộ cài gói vi điều khiển STM32F4xx DFP Pack.
  • Mạch nạp phần cứng tiêu chuẩn ST-Link V2 hoặc J-Link kết nối qua cổng SWD (Serial Wire Debug gồm 4 chân: $3.3\text{V}$, GND, SWDIO, SWCLK).
  • Nguồn cấp thử nghiệm DC $12\text{V} - 24\text{V}$ dòng định mức tối thiểu $5\text{A}$ có tính năng bảo vệ ngắn mạch.

2. Làm thế nào để xử lý triệt để hiện tượng sai số trượt góc của hệ bánh Mecanum khi di chuyển tốc độ cao?

Hệ bánh Mecanum chuyển động dựa trên sự phân rã lực của các con lăn nghiêng $45^\circ$, do đó không thể loại bỏ ma sát trượt cơ học. Giải pháp tối ưu gồm 2 bước phối hợp:

  1. Phần cứng: Bố trí cơ cấu khung cầu động để đảm bảo phân bổ tải trọng $25\text{kg}$ đều lên 4 điểm tiếp xúc bánh xe, ngăn chặn bánh bị nhấc bổng mất ma sát.
  2. Phần mềm: Sử dụng bộ điều khiển PID hồi tiếp góc thời gian thực từ cảm biến IMU. Khi nhận thấy góc Yaw bị trôi khỏi góc đặt mong muốn ($\theta_{\text{target}}$), hàm bù góc sẽ tự động tính toán vi sai vận tốc giữa cặp bánh bên trái và bên phải, tạo ra ngẫu lực kéo robot quay ngược lại trục chuyển động chuẩn.

3. Tại sao không sử dụng trực tiếp Relay cơ học 24V để điều khiển động cơ hút bóng Lexy 200W?

Động cơ hút bóng BLDC Lexy có dòng khởi động thực tế lên tới trên $15\text{A}$ và tốc độ quay cực cao ($80.000\text{ rpm}$). Khi đóng ngắt mạch bằng relay cơ khí thông thường:

  • Hồ quang điện xuất hiện giữa các tiếp điểm cơ khí sinh nhiệt cao, gây hiện tượng dính tiếp điểm (hàn dính) hoặc cháy rỗ bề mặt tiếp xúc sau một vài chu kỳ.
  • Hiện tượng phóng điện tạo ra xung điện áp ngược (Back-EMF) cực lớn cảm ứng vào đường nguồn $5\text{V}/3.3\text{V}$, làm tê liệt vi điều khiển.
  • Việc thay thế bằng Relay bán dẫn Solid-State Relay (SSR-40DD) với cơ chế đóng ngắt qua chất bán dẫn Opto-TRIAC/MOSFET giúp triệt tiêu hoàn toàn tia lửa điện và ngăn chặn nhiễu truyền dẫn.

4. Hệ thống có thể tích hợp thêm cảm biến LiDAR để nâng cấp thành robot tự hành hoàn toàn được không?

Hoàn toàn khả thi. Bo mạch vi điều khiển STM32F407VET6 vẫn còn các giao tiếp ngoại vi tốc độ cao như UART2/UART3, SPI, I2C và mạng CAN Bus. Nhà phát triển có thể kết nối thêm cảm biến Laser LiDAR 2D (như RPLiDAR A1/A2) qua cổng UART hoặc truyền dữ liệu từ máy tính nhúng ROS2 (Robot Operating System) để xây dựng bản đồ 2D SLAM và tự động điều hướng tránh vật cản.

5. Chi phí bảo trì định kỳ và tuổi thọ hoạt động của hệ thống là bao nhiêu?

Hệ thống được thiết kế theo tiêu chuẩn công nghiệp với các linh kiện bán dẫn không tiếp điểm cơ học:

  • Chi phí bảo trì: Ước tính dưới $500.000\text{ VND/năm}$, chủ yếu tập trung vào việc thay thế gioăng phớt khí nén và lớp đệm silicone chống mòn tại các đầu ngón tay kẹp mạ.
  • Tuổi thọ hoạt động: Khung cơ khí thép mạ kẽm và hệ thống mạch bán dẫn có độ bền vận hành liên tục $> 3.000\text{ giờ}$ làm việc trước khi cần đại tu hoặc cân chỉnh cơ cấu bánh răng xoay.

Kết luận

Đồ án tốt nghiệp "Thiết kế hệ thống điều khiển cho robot điều khiển bằng tay Robocon 2024" của tác giả Trần Quốc Huy (ngành Kỹ thuật Điều khiển và Tự động hóa, Trường Đại học Phenikaa) đã hoàn thành xuất sắc các mục tiêu nghiên cứu và ứng dụng thực tiễn đề ra. Thông qua quá trình lặp thiết kế và thực nghiệm từ phiên bản V1 (ESP32-S3 điều khiển qua Smartphone) đến phiên bản cải tiến V2 (STM32F407 kết hợp tay cầm PS2, hệ truyền động Mecanum bù góc IMU và mạch công suất Solid-State), đề tài đã giải quyết trọn vẹn các thách thức cốt lõi về độ trễ truyền thông, hiện tượng trôi dạt góc và xung nhiễu điện từ.

Kết quả thực nghiệm tại giải đấu ABU Robocon 2024 khẳng định tính ổn định cao, khả năng đáp ứng thời gian thực vượt trội của hệ thống với thời gian hoàn thành khu vực thi đấu chỉ $76\text{ s}$ và độ chính xác gắp đặt đạt $96.7%$. Đây không chỉ là công trình phục vụ cuộc thi kỹ thuật mà còn cung cấp tài liệu tham khảo giá trị cao, mở ra hướng ứng dụng rộng rãi trong chế tạo robot tự hành AGV, thiết bị nâng hạ công nghiệp và nông nghiệp thông minh tại Việt Nam.