Giới thiệu dự án

Trong bối cảnh tự động hóa công nghiệp và cuộc Cách mạng Công nghiệp 4.0, xe tự hành dẫn đường tự động (Automated Guided Vehicle - AGV) đóng vai trò xương sống trong các dây chuyền sản xuất thông minh và trung tâm logistics hiện đại. Theo các báo cáo nghiên cứu thị trường tự động hóa, nhu cầu triển khai AGV và robot di động (Mobile Robot) tăng trưởng với tốc độ CAGR trên 19.5% giai đoạn 2020–2027. Đồ án môn học "Thiết kế, chế tạo và điều khiển Robot dò line" của nhóm tác giả Trương Công Tây, Nguyễn Văn Triệu Vỹ, Đào Nguyên Thiên Vũ (ngành Kỹ thuật Cơ điện tử, Trường Đại học Bách Khoa – ĐHQG-HCM, dưới sự hướng dẫn của PGS. TS Võ Tường Quân) tập trung giải quyết bài toán cốt lõi: tối ưu hóa độ chính xác bám quỹ đạo phức tạp và tốc độ di chuyển của robot di động bánh xe vi sai.

       [ START: Nút A ]

Bài toán kỹ thuật (Problem Statement)

Các hệ thống robot dò line (Line Following Robot) truyền thống trong môi trường công nghiệp và học thuật thường đối mặt với các vấn đề kỹ thuật nghiêm trọng:

  • Hiện tượng trượt bánh xe (wheel slip) theo phương pháp tuyến khi chuyển hướng ở dải tốc độ cao ($v \ge 0.4\text{ m/s}$) tại các khúc cua có bán kính nhỏ ($R = 500\text{ mm}$).
  • Độ trễ đáp ứng của hệ thống cảm biến quang học rời rạc dẫn đến hiện tượng dao động lắc ngang (hunting oscillation) quanh tâm đường line rộng $26\text{ mm}$.
  • Sự bất đối xứng đặc tính cơ - điện giữa hai động cơ dẫn động độc lập gây ra sai lệch quỹ đạo trên các đoạn đường thẳng nếu không được nhận dạng hệ thống và bù sai số vận tốc chính xác.
  • Nghẽn cổ chai tính toán (computational bottleneck) khi một vi điều khiển đơn lẻ phải đồng thời xử lý đa kênh tín hiệu Analog-to-Digital Converter (ADC), giải mã Encoder tần số cao và thực thi thuật toán điều khiển phản hồi vòng kín.

Mục tiêu đề tài

  1. Thiết kế cơ khí chính xác: Tính toán động lực học, lựa chọn vật liệu, kết cấu khung gầm 3 bánh (2 bánh chủ động phía sau $D = 65\text{ mm}$ + 1 bánh mắt trâu kim loại dẫn hướng phía trước), đảm bảo trọng tâm thấp ($h \le 551\text{ mm}$) chống lật khi rẽ.
  2. Thiết kế hệ thống phần cứng điện - điện tử: Phát triển giàn 7 cảm biến hồng ngoại phototransistor TCRT5000 thu nhận tín hiệu analog liên tục, module công suất cầu H L298N và kiến trúc vi điều khiển phân cấp (Hierarchical Master-Slave Architecture).
  3. Mô hình hóa và nhận dạng hệ thống (System Identification): Xác định mô hình động học vi sai (Differential Drive Kinematics) và tìm hàm truyền đạt liên tục $G(s)$ của từng cụm Động cơ - Driver thông qua thực nghiệm và công cụ MATLAB System Identification Toolbox.
  4. Phát triển thuật toán điều khiển thông minh: Xây dựng thuật toán hiệu chuẩn cảm biến (Calibration) kết hợp giải thuật tính tâm line bằng xấp xỉ trọng số (Weighted Average Algorithm); thiết kế bộ điều khiển kép: bộ điều khiển PD bám quỹ đạo (Line Tracking) và bộ điều khiển PID điều chỉnh vận tốc góc từng bánh xe.
  5. Thực nghiệm sa bàn phức hợp: Chế tạo mô hình thực tế, kiểm chứng khả năng di chuyển chính xác qua chuỗi nút giao cắt phức tạp: $(\text{START}) A \to B \to C \to D \to E \to B \to F \to A \to G \to B \to D (\text{END})$ trên nền trắng, line đen rộng $26\text{ mm}$.

Giải pháp và kết quả kỳ vọng

Giải pháp tiếp cận là tích hợp mô hình hóa giải tích cơ cấu chuyển động với phương pháp xấp xỉ tín hiệu liên tục. Thay vì xử lý tín hiệu nhị phân on-off (digital thresholding), hệ thống đọc toàn bộ điện áp analog từ 7 cảm biến phototransistor, nội suy tọa độ tâm line với độ chính xác dưới milimét ($\pm 5\text{ mm}$ sai số cực đại), cấp tín hiệu sai số $e_2$ cho bộ điều khiển PD Master để điều chế xung PWM phân phối đến hai động cơ DC Servo GA25 có hồi tiếp Encoder.

Chỉ số kỹ thuật Giá trị kỳ vọng Giá trị thực nghiệm đạt được
Vận tốc di chuyển định mức ($v$) $\ge 0.40\text{ m/s}$ $0.40 - 1.00\text{ m/s}$
Bán kính cong nhỏ nhất ($R_{min}$) $500\text{ mm}$ $500\text{ mm}$ (vượt qua ổn định)
Sai số vị trí tâm line ($e_{max}$) $\le \pm 5.0\text{ mm}$ $\pm 3.2\text{ mm}$ (trung bình)
Tần số lấy mẫu hệ thống ($f_s$) $\ge 50\text{ Hz}$ $50\text{ Hz}$ ($T_s = 20\text{ ms}$)
Kích thước bao xe ($L \times W \times H$) $\le 350 \times 250 \times 350\text{ mm}$ $340 \times 210 \times 120\text{ mm}$

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

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

Nghiên cứu tiến hành phân tích, so sánh các mô hình robot bám line điển hình trong và ngoài nước nhằm đúc kết phương án kỹ thuật tối ưu.

+-------------------------------------------------------------------------------+
|                      BẢNG SO SÁNH GIẢI PHÁP HIỆN TRẠNG                        |
+-------------------+--------------------+--------------------+-----------------+
| Mẫu Robot         | Hệ thống Cảm biến  | Bộ điều khiển      | Hạn chế         |
+-------------------+--------------------+--------------------+-----------------+
| The Chariot       | QTR-6RC            | PID đơn vị         | Trượt ngang cua |
| CartisX04         | 3x Sharp GP2S700   | PID / Q-Learning   | Cơ khí phức tạp |
| IT Car Racing     | 7x TCRT5000        | Ackermann + Servo  | Bán kính cua lớn|
| ĐH Bách Khoa CK16 | 6x TCRT5000        | Tiêu chuẩn Lyapunov| Nhiễu cảm biến  |
+-------------------+--------------------+--------------------+-----------------+

Ma trận ưu tiên yêu cầu kỹ thuật (MoSCoW Matrix)

  • Must have: Hệ thống chuyển động vi sai 2 bánh chủ động gắn Encoder; giàn 7 cảm biến TCRT5000 bố trí ngang gầm xe; bộ điều khiển PID điều tốc hai động cơ độc lập; cơ chế bám line theo nút giao logic.
  • Should have: Kiến trúc xử lý Master-Slave tách biệt tác vụ đọc ADC và tác vụ tính toán quỹ đạo; thuật toán tự động hiệu chỉnh (Calibration) bù trừ trôi dạt quang học.
  • Could have: Mô hình hóa hàm truyền chính xác trên miền $s$ qua MATLAB System ID để xác định thông số $K_p, K_i, K_d$ tối ưu trước khi nạp vi điều khiển.
  • Won't have (in this phase): Hệ thống camera công nghiệp xử lý ảnh (do chi phí phần cứng và thời gian xử lý khung hình $6 - 10\text{ fps}$ không đáp ứng được yêu cầu thời gian thực tốc độ cao).

Thiết kế hệ thống

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

  • Khung vỏ & Cơ khí: Nhựa tổng hợp gia công CNC, bánh xe cao su độ bám cao $D = 65\text{ mm}$, bánh mắt trâu kim loại chịu tải.
  • Động cơ chấp hành: 02 Động cơ DC Servo GA25-370 ($12\text{VDC}$, công suất $13.2\text{W}$, tốc độ định mức $280\text{ RPM}$, moment xoắn $1.88\text{ kg}\cdot\text{cm}$, hộp giảm tốc kim loại tỉ số truyền $1:34$).
  • Hồi tiếp vị trí: Đĩa Encoder quang học 11 xung/vòng, 2 kênh A-B lệch pha $90^\circ$, giải mã 4 sườn xung kết hợp hộp giảm tốc tạo độ phân giải $898\text{ xung/vòng}$ tại trục công tác.
  • Mạch điều khiển công suất: Module Driver L298N (Dual H-Bridge, dòng đỉnh $2\text{A}$ mỗi kênh, tích hợp bảo vệ nhiệt và diode triệt tiêu sức điện động ngược).
  • Mảng cảm biến: 07 Cặp LED phát hồng ngoại - Phototransistor TCRT5000 (bước sóng $950\text{ nm}$, góc quét mở rộng với trở kéo $R_1 = 62.5\ \Omega, R_2 = 2.56\text{ k}\Omega$).
  • Môi trường tính toán và mô phỏng: MATLAB/Simulink R2020a (System Identification Toolbox), Visual Studio Code, PlatformIO Embedded C/C++ Compiler.

Mô hình toán học động học robot di động (Kinematics Modeling)

Robot di chuyển bằng hai bánh dẫn động độc lập. Gọi $v$ là vận tốc dài và $\omega$ là vận tốc góc của robot tại trung điểm $A$ của trục hai bánh xe:

$$\begin{bmatrix} \dot{x}_A \ \dot{y}_A \ \dot{\theta} \end{bmatrix} = \begin{bmatrix} \cos\theta & 0 \ \sin\theta & 0 \ 0 & 1 \end{bmatrix} \begin{bmatrix} v \ \omega \end{bmatrix}$$

Mối quan hệ giữa vận tốc dài $v$, vận tốc góc $\omega$ với vận tốc góc của bánh trái ($\omega_L$) và bánh phải ($\omega_R$):

$$v = \frac{r(\omega_R + \omega_L)}{2}, \quad \omega = \frac{r(\omega_R - \omega_L)}{b}$$

Trong đó:

  • $r = 32.5\text{ mm}$: Bán kính bánh xe chủ động.
  • $b = 170\text{ mm}$: Khoảng cách giữa hai bánh xe chủ động.

Phương trình động học tại điểm bám quỹ đạo $C$ (cách điểm $A$ một khoảng $L$ dọc theo trục xe):

$$\begin{cases} \dot{x}_C = \dot{x}_A - L\dot{\theta}\sin\theta = v\cos\theta - L\omega\sin\theta \ \dot{y}_C = \dot{y}_A + L\dot{\theta}\cos\theta = v\sin\theta + L\omega\cos\theta \end{cases}$$

Vector sai số giữa điểm tracking $C$ và điểm tham chiếu trên đường line $R(x_R, y_R, \theta_R)$:

$$\begin{bmatrix} e_1 \ e_2 \ e_3 \end{bmatrix} = \begin{bmatrix} \cos\theta & \sin\theta & 0 \ -\sin\theta & \cos\theta & 0 \ 0 & 0 & 1 \end{bmatrix} \begin{bmatrix} x_R - x_C \ y_R - y_C \ \theta_R - \theta \end{bmatrix}$$

  • $e_1$: Sai số dọc trục xe (tiếp tuyến quỹ đạo).
  • $e_2$: Sai số lệch khoảng cách vuông góc từ tâm xe đến tâm đường line (pháp tuyến quỹ đạo).
  • $e_3$: Sai số góc hướng xe so với tiếp tuyến đường line.

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

Tuần 01 - 03: Khảo sát tổng quan, tính toán chọn động cơ GA25 & kết cấu 3 bánh
Tuần 04 - 06: Thiết kế CAD 3D, gia công khung gầm, tối ưu khoảng cách cảm biến
Tuần 07 - 09: Thiết kế mạch điện tử, xác định trở R1-R2, hiệu chuẩn 7 kênh TCRT5000
Tuần 10 - 12: Nhận dạng hàm truyền Matlab System ID, thiết kế PID/PD bám line
Tuần 13 - 15: Tích hợp hệ thống Master-Slave, chạy thử nghiệm sa bàn, tinh chỉnh

Đồ án tuân thủ mô hình phát triển chữ V (V-Model) kết hợp kiểm thử phần cứng trong vòng lặp (Hardware-in-the-Loop Testing):

  1. Đánh giá rủi ro (Risk Mitigation): Hiện tượng nhiễu ánh sáng môi trường ảnh hưởng tín hiệu phototransistor được xử lý bằng vỏ che chắn quang học kín dưới gầm xe ($h = 10\text{ mm}$) và thuật toán trừ giá trị nền động.
  2. Kế hoạch đảm bảo chất lượng (QA): Kiểm tra sai số điện áp ADC tại từng điểm đo cách đều $1\text{ mm}$, kiểm chứng tính hội tụ của thuật toán nhận dạng hàm truyền với độ trùng khớp (Fitness Value) $> 90%$.

Thực thi và kết quả

Quy trình phát triển phần cứng và giải thuật

1. Tính toán bố trí và hiệu chuẩn cảm biến TCRT5000

Khoảng cách từ mặt phát quang của cảm biến đến mặt sàn được xác định thực nghiệm tối ưu tại $h = 10\text{ mm}$. Với góc phát $\alpha = 16^\circ$ và góc nhận $\beta = 30^\circ$, bề rộng vùng quét hiệu dụng của một cảm biến là:

$$w_{sensor} = h \cdot \tan(16^\circ) + h \cdot \tan(30^\circ) - d = 10 \cdot \tan(16^\circ) + 10 \cdot \tan(30^\circ) - 3.8 \approx 5.45\text{ mm}$$

Khoảng cách lắp đặt giữa hai tâm cảm biến kế tiếp được lựa chọn là $d_{sensor} = 18\text{ mm}$ (thỏa mãn điều kiện $14.35\text{ mm} \le d_{sensor} \le 20.55\text{ mm}$) nhằm đảm bảo dải 7 cảm biến phủ kín bề rộng $108\text{ mm}$, không xuất hiện điểm mù khi đường line $26\text{ mm}$ dịch chuyển ngang.

Công thức chuẩn hóa (Calibration) đưa điện áp đọc được của cảm biến thứ $i$ về miền $[0, 1000]$:

$$ADC_{calib, i} = \frac{ADC_{raw, i} - ADC_{min, i}}{ADC_{max, i} - ADC_{min, i}} \times 1000$$

Thuật toán tính tọa độ tâm line thực tế $x_{line}$ sử dụng phương pháp trung bình xấp xỉ trọng số:

$$x_{line} = \frac{\sum_{i=0}^{6} (x_i \cdot ADC_{calib, i})}{\sum_{i=0}^{6} ADC_{calib, i}}$$

Trong đó $x_i \in {-54, -36, -18, 0, 18, 36, 54}\text{ mm}$ là khoảng cách hình học từ cảm biến thứ $i$ đến tâm trục đối xứng của giàn cảm biến.

/**
 * @brief Tinh toan toa do tam duong line tu 7 cam bien quang tro phototransistor
 * @param rawADC Mang gia tri analog truc tiep tu 7 kenh TCRT5000 (0 - 1023)
 * @return double Toa do sai lech tam line (mm) so voi tam robot (-54.0 den +54.0)
 */
double CalculateLinePosition(const uint16_t rawADC[7]) {
    static const int16_t SENSOR_POS[7] = {-54, -36, -18, 0, 18, 36, 54};
    static const uint16_t ADC_MIN[7]   = {29, 30, 29, 33, 33, 34, 35};
    static const uint16_t ADC_MAX[7]   = {1013, 964, 911, 889, 835, 798, 753};
    
    double weightedSum = 0.0;
    double totalADC = 0.0;
    
    for (uint8_t i = 0; i < 7; ++i) {
        // Rang buoc va chuan hoa tin hieu ADC
        uint16_t clampedVal = constrain(rawADC[i], ADC_MIN[i], ADC_MAX[i]);
        double calibratedVal = ((double)(clampedVal - ADC_MIN[i]) / 
                                (double)(ADC_MAX[i] - ADC_MIN[i])) * 1000.0;
        
        weightedSum += (double)SENSOR_POS[i] * calibratedVal;
        totalADC    += calibratedVal;
    }
    
    if (totalADC < 100.0) {
        // Truong hop robot lech hoan toan khoi duong line
        return 0.0; 
    }
    
    double calculatedX = weightedSum / totalADC;
    // Hieu chinh phi tuyen theo phuong trinh hoi quy thuc nghiem: y = 0.9949x + 0.1637
    return (0.9949 * calculatedX + 0.1637);
}

2. Nhận dạng hàm truyền động cơ (System Identification)

Để phục vụ việc tổng hợp bộ điều khiển chính xác, tín hiệu điện áp kích thích dạng bậc thang (Step PWM: $40% \to 60% \to 80% \to 100%$) được cấp vào động cơ với chu kỳ lấy mẫu $T_s = 20\text{ ms}$ ($f_s = 50\text{ Hz}$, thỏa mãn tiêu chuẩn Nyquist $f_s > 2 f_{max}$).

                 [ MATLAB System ID Toolbox ]
                     Hàm truyền G_A(s), G_B(s)

Thông qua công cụ System Identification của MATLAB với cấu hình 1 cực (1 pole), 0 điểm không (0 zeros), hàm truyền liên tục giữa tốc độ vòng quay ngõ ra $\Omega(s)$ ($\text{vòng/phút}$) và độ rộng xung ngõ vào $PWM(s)$ ($%$) được xác định chính xác:

$$\text{Động cơ A (Trái):} \quad G_A(s) = \frac{\Omega_A(s)}{PWM_A(s)} = \frac{52.17}{s + 19.57}$$

$$\text{Động cơ B (Phải):} \quad G_B(s) = \frac{\Omega_B(s)}{PWM_B(s)} = \frac{57.25}{s + 21.36}$$

Độ chính xác mô hình hóa (Model Fitness) của động cơ A đạt $91.4%$ và động cơ B đạt $92.8%$, chứng minh tính tuyến tính cao trong dải điều khiển từ $15%$ đến $100%$ PWM.

3. Thuật toán điều khiển bám line kết hợp (Dual-Loop Control)

/**
 * @brief Thuc thi vong dieu khien kep: PD Bam Line va PID Van Toc Dong Co
 */
void ControlLoop_Update(double targetVelocity, double lineErrorX) {
    // 1. Outer Loop: PD Controller tinh toan toc do goc can thiet (omega)
    static double prevLineError = 0.0;
    const double Kp_line = 0.045;
    const double Kd_line = 0.012;
    
    double dError = (lineErrorX - prevLineError) / 0.02; // Ts = 20ms
    double omega_cmd = Kp_line * lineErrorX + Kd_line * dError;
    prevLineError = lineErrorX;
    
    // 2. Chuyen doi kinematic sang van toc goc banh trai va phai
    double v_L_target = targetVelocity - (omega_cmd * 0.170 / 2.0); // b = 0.170m
    double v_R_target = targetVelocity + (omega_cmd * 0.170 / 2.0);
    
    // 3. Inner Loop: PID dieu khien xung PWM tung dong co
    Update_Motor_PID_Left(v_L_target);
    Update_Motor_PID_Right(v_R_target);
}

Thử nghiệm và đánh giá kết quả

Hệ thống được chạy thử nghiệm lặp lại 30 lần trên sa bàn chuẩn kích thước $4000 \times 3000\text{ mm}$ với quỹ đạo bao gồm các góc cua $90^\circ$, vòng xoay chữ S và các nút giao cắt $A, B, C, D, E, F, G$.

+-------------------------------------------------------------------------------+
|                       KẾT QUẢ ĐO ĐẠC THỰC NGHIỆM VẬN HÀNH                     |
+------------------------------+--------------------+---------------------------+
| Thông số kiểm thử            | Thiết kế đặt ra    | Thực nghiệm đo được       |
+------------------------------+--------------------+---------------------------+
| Tốc độ tối đa bám cua R=500mm| >= 0.40 m/s        | 0.65 m/s                  |
| Tốc độ trên đoạn thẳng       | >= 0.40 m/s        | 1.05 m/s                  |
| Thời gian xác lập (Ts)       | <= 0.40 s          | 0.28 s                    |
| Độ quá điều chỉnh (Overshoot)| <= 10.0 %          | 4.2 %                     |
| Sai số tĩnh bám tâm line     | <= 5.0 mm          | 1.8 mm                    |
| Tỉ lệ hoàn thành lộ trình    | 100 %              | 30/30 lần (100 %)         |
+------------------------------+--------------------+---------------------------+

Đồ thị đáp ứng vận tốc góc của hai động cơ cho thấy sự bám sát giữa tốc độ tham chiếu và phản hồi thực tế từ Encoder. Hiện tượng trôi điểm không (zero drift) và dao động lắc khi chuyển hướng tại nút giao cắt được triệt tiêu hoàn toàn nhờ khâu vi phân $K_d$ trong bộ điều khiển PD bám line.

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

  1. Thuật toán giải mã tâm line liên tục thay vì rời rạc: Thay vì sử dụng trạng thái logic nhị phân 0/1 gây giật cục khi robot di chuyển qua lại giữa các cảm biến, đồ án phát triển phương pháp xấp xỉ trọng số analog kết hợp hàm hồi quy tuyến tính $y = 0.9949x + 0.1637$, mang lại độ phân giải không gian đạt mức dưới milimét ($\pm 0.5\text{ mm}$ độ nhạy cục bộ).
  2. Nhận dạng hệ thống thực nghiệm trên miền liên tục: Ứng dụng giải thuật bình phương tối thiểu mở rộng thông qua MATLAB System ID, lượng hóa chính xác sự sai lệch cơ khí giữa hai động cơ DC Servo GA25 ($K_{gain, A} = 2.66\text{ RPM/%PWM}$ so với $K_{gain, B} = 2.68\text{ RPM/%PWM}$), cho phép thiết kế thông số PID bù trừ độc lập cho từng kênh.
  3. Cấu trúc điều khiển phân cấp (Hierarchical Architecture): Phân định ranh giới rõ ràng giữa vi điều khiển cấp cơ sở (thu thập ADC đa kênh, lọc số, tính $x_{line}$) và vi điều khiển trung tâm (quản lý quỹ đạo trạng thái, bộ điều khiển kép), tăng thông lượng xử lý hệ thống thêm $45%$ so với các cấu trúc tập trung đơn chip.
+-------------------------------------------------------------------------------+
|                 SO SÁNH CÁC CHỈ SỐ CẢI TIẾN HIỆU NĂNG                         |
+--------------------+------------------+-------------------+-------------------+
| Tiêu chí           | Đồ án CK16KSCD   | Đề tài nhóm       | Mức cải thiện     |
+--------------------+------------------+-------------------+-------------------+
| Thuật toán bám     | Lyapunov rời rạc | PD xấp xỉ trọng số| Mượt hơn 60%      |
| Tốc độ trung bình  | 0.35 m/s         | 0.45 m/s          | Tăng +28.5%       |
| Tốc độ tối đa      | 0.40 m/s         | 0.65 m/s          | Tăng +62.5%       |
| Độ chính xác tâm   | +/- 8.0 mm       | +/- 3.2 mm        | Chính xác hơn 60% |
+--------------------+------------------+-------------------+-------------------+

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

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

  • Hệ thống AGV kéo hàng trong nhà máy may mặc / linh kiện điện tử: Dẫn hướng bằng băng từ hoặc dải line phản quang với chi phí bảo trì bề mặt thấp.
  • Xe cấp phát thuốc và vật tư y tế trong bệnh viện: Di chuyển tự động giữa các phòng bệnh theo các nút giao cắt định sẵn, giảm tải cho nhân viên y tế.
  • Bộ kit giáo dục STEM & Robot học: Nền tảng học tập thực nghiệm lý tưởng cho sinh viên ngành Cơ điện tử, Tự động hóa, Khoa học Máy tính về điều khiển chuyển động vi sai, xử lý tín hiệu analog và nhận dạng hệ thống.
       [ Lớp Nền Tảng (Base Kit) ]
  Khung vỏ 3 bánh + GA25 Motor + L298N + 7x TCRT5000 (Chi phí: ~$55 USD)
       [ Mở Rộng Ứng Dụng (Expansion) ]

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

  • Tổng chi phí chế tạo mẫu (BOM Cost): $\approx 1.250.000\text{ VNĐ}$ (Bao gồm 02 động cơ GA25 Encoder: $450.000\text{đ}$, Khung gầm & Bánh xe V2: $220.000\text{đ}$, Mạch L298N + 7 cảm biến TCRT5000 + Vi điều khiển: $380.000\text{đ}$, Pin Li-po 3S $11.1\text{V}$ & Mạch giảm áp LM2596: $200.000\text{đ}$).
  • Thời gian hoàn vốn (ROI): Triển khai trong các xưởng sản xuất nhỏ thay thế nhân công vận chuyển thủ công, thời gian thu hồi vốn ước tính dưới 03 tháng trên mỗi đơn vị AGV.

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

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

  • Độ nhạy quang học với ánh sáng tán xạ: Dù đã có tấm chắn bảo vệ, cảm biến TCRT5000 vẫn có thể bị sụt giảm độ tương phản khi làm việc dưới ánh nắng mặt trời trực tiếp hoặc nền sàn bóng gương có độ phản xạ cao.
  • Bánh mắt trâu dẫn hướng: Bánh mắt trâu kim loại phát sinh lực cản ma sát lăn và có xu hướng giật cục khi đi qua các khe rãnh hoặc mối nối sàn không đồng phẳng.
  • Mô hình động học 2D phẳng: Chưa tính đến trượt động lực học bánh xe (dynamic slip) khi vận hành ở dải tốc độ $v > 1.2\text{ m/s}$.

Hướng nâng cấp và phát triển

  1. Nâng cấp cảm biến thị giác máy tính (Computer Vision): Tích hợp camera OpenMV hoặc module camera ESP32-CAM kết hợp thuật toán xử lý ảnh thời gian thực, cho phép nhận diện đồng thời vạch kẻ đường, biển báo và vật cản 3D.
  2. Thuật toán điều khiển thông minh thích nghi: Phát triển bộ điều khiển mờ tự chỉnh định tham số (Self-Tuning Fuzzy PID) hoặc ứng dụng thuật toán học tăng cường Q-Learning giúp robot tự động tối ưu hóa vận tốc theo bán kính khúc cua của từng cung đường sau mỗi lượt chạy.
  3. Cải tiến cơ cấu cơ khí: Thay thế bánh mắt trâu bằng bánh xe đa hướng Omni-wheel hoặc cơ cấu treo độc lập có giảm chấn để duy trì khoảng cách cảm biến $h = 10\text{ mm}$ cố định trên địa hình gồ ghề.

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

+-------------------------------------------------------------------------------+
|                      GIÁ TRỊ MANG LẠI CHO CÁC NHÓM ĐỐI TƯỢNG                  |
+----------------------+--------------------------------------------------------+
| Đối tượng            | Giá trị thực tiễn và định lượng                        |
+----------------------+--------------------------------------------------------+
| Sinh viên Cơ điện tử | Bộ tài liệu mẫu về tính toán động học, vẽ CAD,         |
|                      | nhận dạng hàm truyền động cơ bằng Matlab System ID     |
+----------------------+--------------------------------------------------------+
| Kỹ sư Nhúng / IoT    | Kiến trúc phân cấp Master-Slave và thuật toán xấp xỉ   |
|                      | trọng số xử lý ADC tốc độ cao, khử nhiễu tín hiệu      |
+----------------------+--------------------------------------------------------+
| Doanh nghiệp SME     | Bản thiết kế AGV chi phí thấp (~$55 USD), dễ chế tạo,  |
|                      | khả năng triển khai ngay cho vận chuyển nội bộ         |
+----------------------+--------------------------------------------------------+
| Nhóm nghiên cứu      | Dữ liệu thực nghiệm về hàm truyền Laplace của DC Servo |
|                      | GA25 và mô hình tham chiếu sai số bám line             |
+----------------------+--------------------------------------------------------+

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

1. Yêu cầu kỹ thuật tối thiểu để triển khai và vận hành robot là gì?

Hệ thống yêu cầu nguồn cấp DC từ $11.1\text{V}$ đến $12.6\text{V}$ (Pin Li-Po 3S dung lượng $\ge 2200\text{ mAh}$, dòng xả tối thiểu $20\text{C}$), mạch giảm áp Buck LM2596 cung cấp nguồn $5\text{V}/3\text{A}$ ổn định cho vi điều khiển và mảng cảm biến. Bề mặt di chuyển cần có độ phẳng cao (độ gồ ghề $< 2\text{ mm}$), đường line đen có độ rộng tiêu chuẩn $26\text{ mm} \pm 5\text{ mm}$ trên nền sáng tương phản.

2. Giới hạn mở rộng tốc độ của robot và giải pháp khắc phục khi bị trượt bánh?

Ở vận tốc trên $0.8\text{ m/s}$, quán tính lớn và lực ly tâm $F_{cf} = \frac{m v^2}{R}$ khi vào khúc cua $R = 500\text{ mm}$ có thể gây trượt ngang bánh xe. Để nâng giới hạn tốc độ lên $1.5 - 2.0\text{ m/s}$, cần nâng cấp lốp xe sang chất liệu cao su silicone có hệ số ma sát $\mu \ge 1.2$, hạ thấp trọng tâm xe ($h < 30\text{ mm}$) và bổ sung thuật toán giảm tốc chủ động trước khi tiếp cận điểm rẽ thông qua lập bản đồ đường đi (Path Memorization).

3. Hệ thống có khả năng tích hợp vào mạng điều phối trung tâm nhà máy không?

Hoàn toàn khả thi. Vi điều khiển trung tâm Master có thể được tích hợp thêm module truyền thông không dây ESP-NOW, Wi-Fi hoặc ZigBee để giao tiếp với hệ thống quản lý sản xuất (MES/Fleet Management), nhận lệnh điểm đến và báo cáo vị trí tức thời theo thời gian thực qua giao thức MQTT.

4. Quy trình bảo trì và hiệu chuẩn hệ thống cảm biến định kỳ như thế nào?

Cần vệ sinh bề mặt thấu quang của 7 phototransistor TCRT5000 bằng cồn isopropyl sau mỗi 50 giờ vận hành để tránh bụi công nghiệp làm suy giảm tín hiệu. Mỗi khi thay đổi môi trường ánh sáng sàn, kích hoạt chế độ Auto-Calibration nạp sẵn trong vi điều khiển: robot sẽ quét ngang đường line trong 3 giây để tự động cập nhật mảng giá trị $ADC_{min}$ và $ADC_{max}$ vào bộ nhớ EEPROM.

5. Chi phí đầu tư linh kiện và thời gian hoàn vốn khi ứng dụng vào sản xuất?

Tổng chi phí chế tạo phần cứng đơn chiếc là khoảng $1.250.000\text{ VNĐ}$ ($55\text{ USD}$). Khi sản xuất quy mô lô từ 50 bộ, chi phí tối ưu xuống dưới $850.000\text{ VNĐ}$. So với việc thuê nhân công vận chuyển nội bộ trong xưởng, một robot AGV loại này giúp tiết kiệm trung bình $4.000.000 - 6.000.000\text{ VNĐ}$ chi phí vận hành mỗi tháng, mang lại thời gian hoàn vốn (Payback Period) chỉ từ 1.5 đến 3 tháng.

Kết luận

Đồ án "Thiết kế, chế tạo và điều khiển Robot dò line" của nhóm sinh viên Trường Đại học Bách Khoa – ĐHQG-HCM đã giải quyết toàn diện và triệt để bài toán tự động hóa chuyển động bám quỹ đạo cho robot di động 3 bánh vi sai. Thông qua việc kết hợp chặt chẽ giữa tính toán cơ học động lực, kỹ thuật nhận dạng hệ thống thực nghiệm trên MATLAB và thuật toán điều khiển phân cấp hiện đại, công trình đạt được những kết quả ấn tượng:

  • Làm chủ hoàn toàn chu trình thiết kế - chế tạo từ phần cứng cơ điện tử đến thuật toán nhúng.
  • Xây dựng thành công thuật toán xác định vị trí line bằng xấp xỉ trọng số analog, nâng cao độ chính xác bám đường gấp 2.5 lần so với các giải pháp đọc rời rạc truyền thống.
  • Vận hành ổn định ở dải tốc độ $0.40 - 1.05\text{ m/s}$, vượt qua chính xác lộ trình đa nút giao cắt phức tạp với sai số bám tâm dưới $\pm 3.2\text{ mm}$.

Công trình không chỉ hoàn thành xuất sắc các mục tiêu học thuật đặt ra mà còn cung cấp một bản thiết kế mẫu (Reference Design) hoàn chỉnh, có tính ứng dụng cao và sẵn sàng chuyển giao cho các mô hình xe tự hành AGV công nghiệp cỡ nhỏ. Bạn đọc, sinh viên và các kỹ sư phát triển có thể tham khảo trực tiếp cấu trúc thuật toán và phương pháp luận của đồ án để ứng dụng vào các dự án nghiên cứu robot tự hành và điều khiển chuyển động nâng cao.