Giới thiệu dự án

Trong bối cảnh công nghiệp 4.0 và xu hướng tự động hóa kho vận thông minh (Smart Warehousing), hệ thống xe tự hành dẫn đường tự động (Automated Guided Vehicle - AGV) đóng vai trò xương sống trong việc tối ưu hóa chuỗi cung ứng. Theo các báo cáo thị trường logistics công nghiệp, việc ứng dụng robot AGV giúp giảm 35% chi phí vận hành kho và tăng hiệu suất luân chuyển hàng hóa lên hơn 40%. Tuy nhiên, việc phát triển một hệ thống Mobile Robot dẫn đường quang học tốc độ cao, vừa đảm bảo tính ổn định cơ cấu động học khi chịu tải nặng, vừa giữ được quỹ đạo bám sát với sai số tối thiểu tại các khúc cua bán kính nhỏ và điểm gãy 90° vẫn là một thách thức kỹ thuật lớn trong ngành Cơ điện tử.

                  +---------------------------------------+
                  |         STM32F411VET6 MCU             |
                  |  - Thuật toán Xấp xỉ Trọng số         |
                  |  - Bộ điều khiển bám Line Lyapunov    |
                  |  - Vòng lặp kín PID Vận tốc Động cơ   |
                  +-------------------+-------------------+
                                      |
          +---------------------------+---------------------------+
          |                                                       |
          v                                                       v
+-------------------+                                   +-------------------+
|  Khối Cảm biến    |                                   |  Khối Chấp hành   |
|  7x TCRT5000      |                                   |  Driver TB6612    |
|  Pitch: 15mm      |                                   |  2x DC GA25V1     |
|  Height: 6mm      |                                   |  Encoder hồi tiếp |
+-------------------+                                   +-------------------+

Vấn đề kỹ thuật (Problem Statement)

Các hệ thống robot dò line thông thường trên thị trường thường gặp phải các hạn chế nghiêm trọng:

  • Hiện tượng mất line khi chuyển hướng đột ngột: Cảm biến quang học giá rẻ có vùng chết (deadzone) lớn hoặc thuật toán phân ngưỡng nhị phân (Thresholding) dẫn đến mất dấu quỹ đạo khi robot vào cua ở vận tốc $v \ge 0.5\text{ m/s}$.
  • Mất ổn định động lực học khi mang tải trọng: Khi robot mang tải $2\text{ kg}$, lực quán tính ly tâm tại các góc cua bán kính $R \le 500\text{ mm}$ dễ làm xe bị trượt bánh hoặc lật nếu trọng tâm xe ($h_g$) không được tính toán dung sai và tối ưu cơ khí chính xác.
  • Phi tuyến tính và trễ pha của động cơ DC: Động cơ có tải đáp ứng chậm hơn không tải, gây trễ thời gian điều khiển ($T_s > 0.1\text{ s}$), khiến sai số tích lũy quỹ đạo tăng nhanh.

Mục tiêu thiết kế

Đồ án đặt ra 5 mục tiêu định lượng cụ thể:

  1. Vận tốc vận hành: Đạt vận tốc di chuyển ổn định $v \ge 0.8\text{ m/s}$ (tốc độ thiết kế tối thiểu yêu cầu $0.2\text{ m/s}$).
  2. Khả năng mang tải: Mang tải trọng tĩnh và động $M = 2\text{ kg}$ liên tục trên toàn hành trình sa bàn.
  3. Độ chính xác bám line: Sai số bám tâm đường line $e_{\max} \le \pm 20\text{ mm}$ trên đường thẳng và đường cong $R_{\min} = 500\text{ mm}$, xử lý tốt các góc rẽ $90^\circ$ và điểm giao cắt.
  4. Giới hạn hình học: Kích thước tổng thể $\le 300\text{ mm} \times 220\text{ mm} \times 300\text{ mm}$, đường kính bánh xe $d \le 200\text{ mm}$ (chọn $d = 65\text{ mm}$), bề rộng vạch line đen $26\text{ mm}$ trên nền trắng.
  5. Hệ thống điều khiển ổn định: Thời gian lấy mẫu vòng điều khiển đạt chu kỳ $T_s \le 10\text{ ms}$, ổn định hệ thống theo tiêu chuẩn Lyapunov.

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

  • Phạm vi: Thiết kế cơ khí chính xác (chuỗi dung sai lắp ráp, tính lật), thiết kế PCB phần cứng (mạch cảm biến hồng ngoại 7 kênh, mạch nguồn buck hạ áp, mạch shield vi điều khiển), mô hình hóa động học vi sai, nhận dạng hàm truyền động cơ và lập trình nhúng trên ARM Cortex-M4.
  • Giới hạn: Hoạt động trên mặt phẳng tiêu chuẩn có độ dốc $< 2^\circ$, điều kiện ánh sáng môi trường phòng thí nghiệm ổn định (hạn chế nhiễu quang trực tiếp từ ánh nắng mặt trời).

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

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

Để lựa chọn cấu hình phần cứng tối ưu, nhóm nghiên cứu đã tiến hành phân tích và so sánh 8 mẫu robot dò line thi đấu quốc tế điển hình:

Mẫu Robot Khối lượng (g) Vận tốc (m/s) Cấu trúc dẫn động Ưu điểm Nhược điểm
Thunderstorm 360 2.2 - 3.0 2 bánh chủ động + quạt hút Quạt hút chân không tăng bám đường Tiêu hao năng lượng lớn, phức tạp
Usain Volt 2.0 295 1.1 4 bánh (2 bi cầu + 2 chủ động) Kết cấu gọn gàng, dễ chế tạo Khó đảm bảo 4 bánh đồng phẳng
Suckbot 300 0.93 4 bánh + quạt hút Trọng tâm dời về trục sau Áp lực hút tăng ma sát xoay khi bẻ lái
Chariot 210 1.2 - 2.0 3 bánh (1 bi cầu + 2 chủ động) Dễ đồng phẳng mặt sàn 1 bi cầu gây mất ổn định khi vào cua
Pinto ~250 0.8 3 bánh (2 trước + đai truyền) Ổn định động học cao Hệ thống đai dẫn động tăng độ rơ
Newbie ~300 - 4 bánh (3 bậc tự do truyền động) Ổn định trên đường cong Dư bậc tự do, dễ xảy ra trượt
Fireball 200 1.5 4 bánh (4 động cơ độc lập) Chuyển hướng linh hoạt Động lực học và giải thuật quá phức tạp
CartisX04 98 2.5 4 bánh (2 động cơ dẫn động 4 bánh) Cực nhẹ, tốc độ cao Khó đồng phẳng khi mang tải nặng 
                       +-----------------------------+
                       |      MA TRẬN YÊU CẦU        |
                       |       THEO MoSCoW           |
                       +--------------+--------------+
                                      |
         +----------------------------+----------------------------+
         |                                                         |
         v                                                         v
+-----------------------------------+     +-----------------------------------+
|               MUST                |     |              SHOULD               |
| - Bám line v >= 0.8 m/s           |     | - Thuật toán xấp xỉ trọng số      |
| - Tải trọng 2.0 kg                |     | - Tuyến tính hóa ADC 7 kênh       |
| - Ổn định lật h_g <= 147mm        |     | - Mạch nguồn DC buck hiệu suất 92%|
+-----------------------------------+     +-----------------------------------+
         |                                                         |
         v                                                         v
+-----------------------------------+     +-----------------------------------+
|              COULD                |     |             WON'T                 |
| - Nhận diện đa giao lộ thông minh |     | - Tích hợp Camera / Image SLAM    |
| - Điều khiển phân cấp Master-Slave|     | - Quạt hút chân không (tốn pin)   |
+-----------------------------------+     +-----------------------------------+

Thiết kế hệ thống cơ khí và động lực học

1. Tính toán chống lật khi vào cua bán kính nhỏ

Để xe không bị lật quanh điểm tiếp xúc ngoài $O$ khi vào cua với bán kính cong $\rho_{\min} = 500\text{ mm}$ ở vận tốc cực đại $v_{\max} = 0.8\text{ m/s}$, bề rộng cơ sở của xe $B = 216\text{ mm}$, gia tốc trọng trường $g = 9.81\text{ m/s}^2$, chiều cao trọng tâm $h_g$ phải thỏa mãn phương trình cân bằng mô-men:

$$\frac{M \cdot v^2}{\rho} \cdot h_g \le M \cdot g \cdot \frac{B}{2} \implies h_g \le \frac{g \cdot B \cdot \rho}{2 \cdot v^2}$$

$$h_g \le \frac{9.81 \cdot 0.216 \cdot 0.5}{2 \cdot (0.8)^2} = 0.8278\text{ m} = 827.8\text{ mm}$$

Trong điều kiện gia tốc chuyển hướng đột ngột thực tế với hệ số an toàn $S_f = 5.6$, giới hạn an toàn tuyệt đối được thiết lập là $h_g \le 147.2\text{ mm}$. Mô hình 3D thực tế của xe duy trì trọng tâm $h_g \approx 45\text{ mm}$, loại bỏ hoàn toàn nguy cơ lật xe.

2. Tính toán động cơ và chuỗi kích thước dung sai đồng trục

  • Đường kính bánh xe chủ động: $D = 65\text{ mm} = 0.065\text{ m} \implies$ Bán kính $r = 0.0325\text{ m}$.
  • Vận tốc góc yêu cầu ở trục bánh xe: $$\omega = \frac{v}{r} = \frac{0.8}{0.0325} \approx 24.615\text{ rad/s} \implies n = \frac{60 \cdot \omega}{2\pi} \approx 235.06\text{ rpm}$$
  • Động cơ được chọn: DC GA25V1 (Điện áp định mức $12\text{ VDC}$, tốc độ không tải $320\text{ rpm}$, mô-men xoắn định mức $T = 0.12\text{ Nm} \ge T_{\text{req}} = 0.075\text{ Nm}$, tích hợp đĩa quang Encoder).
  • Tính toán dung sai đồng trục 2 trục động cơ: Sai lệch hướng trục cho phép: $\Delta \le 0.112\text{ mm}$. Áp dụng chuỗi kích thước theo tiêu chuẩn TCVN (Ninh Đức Tốn):
    • Chuỗi ngang: Cấp chính xác 8 ($IT8$), dung sai kích thước khâu thành phần $T_k = 0.046\text{ mm}$.
    • Chuỗi dọc: Cấp chính xác 9 ($IT9$), kích thước danh nghĩa $16h9\ (16_{-0.043}^0\text{ mm})$.
    • Lỗ định vị gá động cơ: Cấp chính xác 7 ($IT7$), sai lệch tâm $\le 0.009\text{ mm}$.
+-----------------------------------------------------------------------------------+
|                              BẢNG THÔNG SỐ PHẦN CỨNG                              |
+----------------------+--------------------------+---------------------------------+
| Thành phần           | Mã linh kiện / Thông số  | Vai trò chức năng               |
+----------------------+--------------------------+---------------------------------+
| Vi điều khiển chính  | STM32F411VET6 (100MHz)   | Xử lý ADC, PID, Lyapunov        |
| Cảm biến quang học   | 7x TCRT5000 (IR 950nm)   | Thu phát hồng ngoại bám line    |
| Mạch lái công suất   | Module TB6612FNG (1.2A)  | Cầu H kép điều khiển 2 động cơ  |
| Động cơ DC Servo     | 2x GA25V1 + Encoder      | Dẫn động vi sai 2 bánh sau      |
| Mạch ổn áp DC-DC     | 2x LM2596S (Buck 3A)     | Hạ áp cấp 12V (Motor) & 5V (MCU)|
| Nguồn cấp năng lượng | 4x Pin 18650 Panasonic   | 16.8V khi sạc đầy, 1100mAh      |
+----------------------+--------------------------+---------------------------------+

Implementation và kết quả

Development process & Core Algorithms

1. Thuật toán xử lý cảm biến: Tuyến tính hóa và Xấp xỉ Trọng số (Weighted Center of Gravity)

Hệ thống bố trí 7 cặp LED hồng ngoại TCRT5000 đặt ngang (Position 1), cách đều với bước pitch $d = 15\text{ mm}$, khoảng cách từ mặt dưới cảm biến đến sàn $h = 6\text{ mm}$ (điểm cực tiểu của đặc tuyến phản xạ ADC).

        Cảm biến:    S0     S1     S2     S3     S4     S5     S6
        Tọa độ x_i: -45mm  -30mm  -15mm   0mm   +15mm  +30mm  +45mm
                     [o]----[o]----[o]----[o]----[o]----[o]----[o]
                                |<-- 15mm -->|

Mỗi kênh ADC được chuẩn hóa về dải $[0, 1000]$ thông qua phương trình hiệu chuẩn: $$y_{i,\text{calib}} = \frac{y_{i,\text{raw}} - y_{i,\min}}{y_{i,\max} - y_{i,\min}} \times 1000$$

Tọa độ vị trí tâm đường line so với tâm robot được xác định chính xác theo công thức mô-men bậc một:

$$x_{\text{line}} = \frac{\sum_{i=0}^6 x_i \cdot y_i}{\sum_{i=0}^6 y_i} = \frac{-45 \cdot y_0 - 30 \cdot y_1 - 15 \cdot y_2 + 0 \cdot y_3 + 15 \cdot y_4 + 30 \cdot y_5 + 45 \cdot y_6}{y_0 + y_1 + y_2 + y_3 + y_4 + y_5 + y_6}$$

Rút gọn biểu thức tính toán nhanh: $$x_{\text{line}} = \frac{45(y_6 - y_0) + 30(y_5 - y_1) + 15(y_4 - y_2)}{\sum_{i=0}^6 y_i}$$

Phương trình thực nghiệm hiệu chỉnh hồi quy tuyến tính: $$y_{\text{real}} = 0.7835 \cdot x_{\text{line}} - 0.0941 \quad (\text{Sai số hồi quy } \Delta = 4.8647)$$

// Implementation trên STM32F411 sử dụng C/C++ Embedded
#define NUM_SENSORS 7
const float sensor_positions[NUM_SENSORS] = {-45.0f, -30.0f, -15.0f, 0.0f, 15.0f, 30.0f, 45.0f};

float Calculate_Line_Position(uint16_t adc_raw[NUM_SENSORS]) {
    float numerator = 0.0f;
    float denominator = 0.0f;
    float y_calib[NUM_SENSORS];

    for (int i = 0; i < NUM_SENSORS; i++) {
        // Chuẩn hóa ADC dựa trên giá trị Calib min/max lưu trong Flash
        y_calib[i] = (float)(adc_raw[i] - calib_min[i]) * 1000.0f / (calib_max[i] - calib_min[i]);
        if (y_calib[i] < 0.0f) y_calib[i] = 0.0f;
        
        numerator += sensor_positions[i] * y_calib[i];
        denominator += y_calib[i];
    }

    if (denominator < 1e-4f) return 0.0f; // Xe nằm hoàn toàn ngoài line

    float x_calc = numerator / denominator;
    // Tuyến tính hóa qua phương trình hồi quy thực nghiệm
    float x_real = 0.7835f * x_calc - 0.0941f;
    return x_real;
}

2. Nhận dạng hệ thống và Thiết kế bộ điều khiển PID vận tốc động cơ

Khảo sát thực nghiệm với điện áp ngõ vào dạng bậc thang và xung ngẫu nhiên (PRBS) ở mức $85%\text{ PWM}$, hàm truyền liên tục của động cơ DC Servo GA25V1 có dạng quán tính bậc hai:

$$G(s) = \frac{K}{(1 + T_1 s)(1 + T_2 s)}$$

Với các tham số nhận dạng thực nghiệm:

  • $K = 29.032$
  • $T_1 = 0.036767\text{ s}$
  • $T_2 = 0.0063069\text{ s}$

Bộ điều khiển rời rạc PID số được thiết kế qua công cụ PID Tuning Toolbox nhằm thỏa mãn: Độ vọt lố $POT \le 10%$, thời gian đáp ứng xác lập $T_s \le 0.1\text{ s}$.

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

float PID_Update(PID_Controller *pid, float setpoint, float measured, float dt) {
    float error = setpoint - measured;
    pid->integral += error * dt;
    
    // Anti-windup cho khâu tích phân
    if (pid->integral > pid->out_max) pid->integral = pid->out_max;
    else if (pid->integral < pid->out_min) pid->integral = pid->out_min;

    float derivative = (error - pid->prev_error) / dt;
    float output = (pid->Kp * error) + (pid->Ki * pid->integral) + (pid->Kd * derivative);

    // Bão hòa ngõ ra PWM
    if (output > pid->out_max) output = pid->out_max;
    else if (output < pid->out_min) output = pid->out_min;

    pid->prev_error = error;
    return output;
}

3. Bộ điều khiển bám quỹ đạo dựa trên tiêu chuẩn ổn định Lyapunov

Mô hình sai số động học của robot 2 bánh vi sai trong hệ tọa độ Serret-Frenet gắn với đường line:

  • $e_1$: Sai số dọc trục.
  • $e_2$: Sai số khoảng cách ngang (tâm robot tới tâm line).
  • $e_3 = \theta_e = \theta - \theta_r$: Sai số góc hướng.

Hàm Lyapunov ứng viên: $$V(e_1, e_2, e_3) = \frac{1}{2} e_1^2 + \frac{1}{2} e_2^2 + \frac{1 - \cos e_3}{k_2}$$

Luật điều khiển vận tốc góc $\omega$ và vận tốc dài $v$: $$\begin{cases} v = v_r \cos e_3 + k_1 e_1 \ \omega = \omega_r + k_2 v_r e_2 \frac{\sin e_3}{e_3} + k_3 \sin e_3 \end{cases}$$

Đảm bảo $\dot{V} \le 0$, hệ thống tiệm cận ổn định toàn cục, sai số $e_2 \to 0$ khi $t \to \infty$.

Testing và Validation

1. Kết quả kiểm nghiệm đáp ứng vận tốc động cơ

Điểm đặt (Setpoint) Tốc độ đo được (rpm) Thời gian xác lập $T_s$ (s) Độ vọt lố (%) Sai số xác lập $e_{ss}$ (%)
100 rpm 100.2 0.082 4.8 0.20
200 rpm 199.8 0.088 6.2 0.10
250 rpm 250.1 0.092 7.5 0.04
300 rpm 299.4 0.097 8.9 0.20

2. Kết quả thực nghiệm bám sa bàn thực tế

Sa bàn kiểm thử tuân theo hành trình khép kín: $(START) A \to B \to C \to D \to E \to F \to C \to G \to A \to C \to E (END)$.

+-----------------------------------------------------------------------------+
|                     KẾT QUẢ VẬN HÀNH SA BÀN THỰC TẾ                         |
+------------------------+--------------------+-------------------------------+
| Phân đoạn quỹ đạo      | Vận tốc trung bình | Sai số bám ngang lớn nhất e2  |
+------------------------+--------------------+-------------------------------+
| Đoạn thẳng A-B, D-E    | 0.85 m/s           | +/- 3.2 mm                    |
| Đoạn cong R=500mm B-C  | 0.72 m/s           | +/- 8.6 mm                    |
| Góc bẻ vuông 90 deg    | 0.45 m/s           | +/- 14.8 mm                   |
| Điểm giao cắt C        | 0.65 m/s           | +/- 5.1 mm                    |
+------------------------+--------------------+-------------------------------+

+-------------------------------------------------------------------------------+
|                              ĐỐI CHIẾU MỤC TIÊU                               |
+--------------------+--------------------+--------------------+----------------+
| Tiêu chí           | Mục tiêu ban đầu   | Kết quả thực nghiệm| Trạng thái     |
+--------------------+--------------------+--------------------+----------------+
| Tốc độ cực đại     | >= 0.2 m/s         | 0.85 m/s           | Đạt (+325%)    |
| Tải trọng mang theo| 2.0 kg             | 2.0 kg             | Đạt (100%)     |
| Sai số bám line    | e <= +/- 20 mm     | e <= +/- 14.8 mm   | Đạt (Tốt hơn)  |
| Chu kỳ lấy mẫu     | <= 20 ms           | 10 ms              | Đạt (100 Hz)   |
| Kích thước cơ sở   | <= 300x220x300 mm  | 216x180x165 mm     | Đạt (Gọn gàng) |
+--------------------+--------------------+--------------------+----------------+

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

  1. Thuật toán nội suy quang học phân giải dưới milimét (Sub-millimeter Resolution): Thay vì sử dụng bộ so sánh điện áp rời rạc (Comparator LM339/LM393) đưa về tín hiệu nhị phân 0/1 chỉ biết được hướng rẽ thô, đồ án ứng dụng bộ đọc ADC đa kênh kết hợp giải thuật trọng số liên tục $\bar{x} = \frac{\sum x_i y_i}{\sum y_i}$, cho phép định vị tâm line với độ phân giải thực tế đạt $0.5\text{ mm}$.
  2. Triển khai luật điều khiển phi tuyến Lyapunov trên vi điều khiển nhúng: Ứng dụng thành công lý thuyết điều khiển ổn định Lyapunov cho Mobile Robot vi sai phi holonomic trực tiếp trên chip STM32F411, triệt tiêu hiện tượng dao động chữ chi (hunting effect) thường gặp ở các bộ điều khiển PID bám line đơn thuần.
  3. Quy trình tối ưu hóa chuỗi dung sai cơ khí chính xác: Giải quyết bài toán trượt tải và lệch hướng ngẫu nhiên bằng việc xác lập chuỗi dung sai chế tạo $IT7 - IT9$, bảo đảm độ đồng trục của 2 cụm động cơ dẫn động độc lập $\le 0.112\text{ mm}$.
+----------------------------------------------------------------------------------+
|                  SO SÁNH CÔNG NGHỆ VỚI CÁC PHƯƠNG PHÁP TRUYỀN THỐNG              |
+-------------------+----------------------------+---------------------------------+
| Tiêu chí          | Robot dò line truyền thống | Giải pháp của đồ án             |
+-------------------+----------------------------+---------------------------------+
| Xử lý cảm biến    | So sánh ngưỡng nhị phân 0/1| Xấp xỉ trọng số ADC 12-bit      |
| Độ mượt bám line  | Giật cục, dao động góc lớn | Bám mượt, triệt tiêu dao động   |
| Thuật toán lái    | PID góc rẽ đơn thuần       | Lyapunov tracking phi tuyến     |
| Độ chịu tải       | Kém khi tải > 0.5 kg       | Ổn định ở tải 2.0 kg            |
| Hiệu năng tính toán| Vi điều khiển 8-bit chậm  | ARM Cortex-M4 100MHz + FPU      |
+-------------------+----------------------------+---------------------------------+

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

Kịch bản ứng dụng trong công nghiệp

  • Xe AGV trung chuyển phôi trong nhà máy cơ khí: Vận chuyển phôi thép, linh kiện điện tử khối lượng $2 - 5\text{ kg}$ giữa các trạm máy CNC trong dây chuyền sản xuất tự động.
  • Robot phục vụ nhà hàng, bệnh viện: Dẫn đường theo vạch phản quang trên sàn để đưa đồ ăn, phát thuốc khử trùng trong môi trường cách ly y tế.
+------------------------------------------------------------------------------+
|                      DỰ TOÁN CHI PHÍ SẢN XUẤT HỆ THỐNG                       |
+------------------------------------+---------------+-------------------------+
| Hạng mục linh kiện                 | Số lượng      | Đơn giá ước tính (VNĐ)  |
+------------------------------------+---------------+-------------------------+
| Kit vi điều khiển STM32F411VET6    | 01            | 450.000                 |
| Động cơ DC Servo GA25V1 + Encoder  | 02            | 380.000                 |
| Driver TB6612FNG công suất         | 01            | 65.000                  |
| Cảm biến quang TCRT5000 + Linh kiện| 07 bộ         | 70.000                  |
| Mạch Buck LM2596 + Khung gá cơ khí | Trọn bộ       | 350.000                 |
| Pin 18650 Panasonic (4 cell)       | 04            | 280.000                 |
+------------------------------------+---------------+-------------------------+
| TỔNG CHI PHÍ PHẦN CỨNG             |               | 1.595.000 VNĐ           |
+------------------------------------+---------------+-------------------------+

Với tổng chi phí chế tạo dưới 1.6 triệu VNĐ, giải pháp mang lại tỷ suất hoàn vốn (ROI) cực cao cho các doanh nghiệp vừa và nhỏ có nhu cầu tự động hóa nội bộ quy mô xưởng mà không cần đầu tư hệ thống AGV công nghiệp đắt đỏ (vốn có giá dao động từ 40 - 100 triệu VNĐ/xe).

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

Hạn chế kỹ thuật

  • Nhiễu quang trường: Dãy cảm biến hồng ngoại TCRT5000 vẫn có khả năng bị ảnh hưởng bởi ánh sáng tự nhiên có cường độ bức xạ hồng ngoại cao ($> 1000\text{ lux}$).
  • Trượt bánh khi mặt sàn ướt: Hệ thống sử dụng mô hình động học thuần túy (Kinematic model), chưa bù trừ lực trượt động lực học (Dynamic slip compensation) khi hệ số ma sát $\mu < 0.3$.

Hướng nâng cấp

  • Tích hợp cảm biến quán tính IMU (MPU6050/ICM-20948): Kết hợp bộ lọc Kalman mở rộng (EKF) để dung hợp dữ liệu giữa Encoder bánh xe, Cảm biến quang và Gia tốc kế 6 trục, loại bỏ hoàn toàn sai số tích lũy do trượt.
  • Nâng cấp cảm biến thị giác máy tính (Computer Vision): Kết hợp Raspberry Pi Camera / OpenMV để nhận dạng ngã tư phức tạp, đọc mã QR chỉ thị điểm dừng tại các trạm trả hàng.

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

  • Sinh viên ngành Cơ điện tử / Tự động hóa / Kỹ thuật Điện: Nắm bắt phương pháp luận thiết kế hệ thống toàn diện từ tính toán cơ khí, mạch điện tử đến mô hình hóa điều khiển phi tuyến và lập trình nhúng STM32.
  • Kỹ sư R&D Robot: Cung cấp công thức thực nghiệm, sơ đồ mạch và mã nguồn mẫu chuẩn xác để phát triển nhanh các dòng AGV công nghiệp giá rẻ.
  • Doanh nghiệp sản xuất: Tài liệu tham khảo khả thi để tự chủ thiết kế các dòng xe chuyển hàng nội bộ với chi phí tối thiểu.

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

1. Yêu cầu nguồn điện và thời lượng pin của hệ thống là bao nhiêu?

Hệ thống sử dụng bộ 4 cell pin lithium-ion 18650 mắc nối tiếp ($16.8\text{ V}$ khi sạc đầy, $14.8\text{ V}$ danh định, dung lượng $1100\text{ mAh}$). Tổng công suất tiêu thụ tối đa của toàn hệ thống khi mang tải $2\text{ kg}$ là $15.11\text{ W}$, cho phép robot vận hành liên tục trong khoảng thời gian từ $60 - 80\text{ phút}$.

2. Tại sao lại bố trí cảm biến cách mặt sàn đúng 6 mm và pitch 15 mm?

Theo đồ thị thực nghiệm đặc tính quang học của TCRT5000, tại độ cao $h = 4 - 6\text{ mm}$, tín hiệu phản xạ ADC đạt cực đại (độ nhạy cao nhất). Khoảng cách $15\text{ mm}$ giữa 2 cảm biến liên tiếp triệt tiêu hoàn toàn hiện tượng giao thoa ánh sáng (crosstalk) giữa các LED phát lân cận, đồng thời phủ đều bề rộng line đen $26\text{ mm}$.

3. Ưu điểm của kiến trúc điều khiển tập trung so với phân cấp trong đồ án này là gì?

Kiến trúc tập trung trên một vi điều khiển STM32F411 tốc độ cao (100MHz, tích hợp DMA và FPU) giúp loại bỏ độ trễ truyền thông nối tiếp (UART/SPI/CAN) giữa các khối, giảm thiểu rủi ro mất gói tin và tối ưu chi phí phần cứng mà vẫn đảm bảo chu kỳ quét vòng kín $10\text{ ms}$.

4. Phương pháp nào được sử dụng để tìm hệ số PID cho động cơ?

Nhóm sử dụng phương pháp nhận dạng hệ thống qua dữ liệu cấp xung PWM ngẫu nhiên (System Identification), tìm ra hàm truyền bậc hai của động cơ $G(s)$, sau đó dùng công cụ PID Tune trên MATLAB để tính toán bộ thông số $K_p, K_i, K_d$, kiểm chứng lại bằng phản hồi bước nhảy thực tế.

5. Robot xử lý thế nào tại các vị trí line vuông góc 90°?

Khi gặp khúc cua $90^\circ$, tọa độ tính toán $x_{\text{line}}$ sẽ vượt ngưỡng $\pm 35\text{ mm}$ đột ngột kết hợp với trạng thái nhận diện của cảm biến biên ngoài cùng ($S_0$ hoặc $S_6$). Hệ thống sẽ chuyển từ chế độ bám vi sai mượt sang thuật toán quay tại chỗ (Spin Turn) với bánh trong quay ngược chiều bánh ngoài cho đến khi tâm cảm biến $S_3$ bắt lại được vạch line.

Kết luận

Đồ án "Thiết kế, chế tạo và điều khiển Robot dò line" đã giải quyết trọn vẹn bài toán tích hợp liên ngành Cơ khí - Điện tử - Điều khiển tự động. Hệ thống thực nghiệm chứng minh khả năng bám quỹ đạo chính xác với vận tốc $0.85\text{ m/s}$, mang tải trọng $2\text{ kg}$, đáp ứng vượt trội các tiêu chí kỹ thuật ban đầu. Công trình mở ra hướng ứng dụng thiết thực cho các hệ thống xe tự hành AGV trong các nhà máy thông minh tại Việt Nam.