Giới thiệu dự án

Trong bối cảnh công nghiệp 4.0 và tự động hóa nhà kho thông minh (Smart Warehousing), hệ thống xe tự hành dẫn đường tự động (Automated Guided Vehicle - AGV) đóng vai trò then chốt trong chuỗi cung ứng logistics nội bộ. Theo các báo cáo công nghiệp tự động hóa, việc ứng dụng AGV giúp giảm đến 35% chi phí vận hành kho bãi và tăng năng suất điều vận lên hơn 40%. Tuy nhiên, các dòng robot dẫn đường công nghiệp đòi hỏi sự cân bằng khắt khe giữa độ chính xác bám quỹ đạo, thời gian đáp ứng thời gian thực và chi phí phần cứng tối ưu.

Đồ án chuyên ngành Cơ điện tử "Thiết kế Robot dò line" (Line Following Robot) được nghiên cứu và thực hiện tại Bộ môn Cơ điện tử – Khoa Cơ khí, Trường Đại học Bách Khoa – ĐHQG-HCM, dưới sự hướng dẫn của TS. Phùng Trí Công. Dự án tập trung giải quyết bài toán điều khiển chuyển động phi tuyến, định vị quỹ đạo chính xác cao cho robot di động hai bánh chủ động vi sai kết hợp bánh dẫn hướng tự lựa, giải quyết triệt để các hiện tượng trượt bánh, dao động lắc (hunting oscillation) và nguy cơ lật xe khi di chuyển qua các cung cua bán kính hẹp ở vận tốc cao.

                  +-----------------------------------+
                  |   BỘ CẢM BIẾN QUANG TCRT5000     |
                  |     (7 Kênh Analog - Calib mềm)  |
                  +-----------------+-----------------+
                                    | Tín hiệu ADC (10-bit)
                                    v
+-----------------------------------+-----------------------------------+
|               KHỐI ĐIỀU KHIỂN TRUNG TÂM (PIC18F4550)                  |
|  - Giải thuật xấp xỉ trọng số: Xác định tâm sai lệch e2, e3           |
|  - Bộ điều khiển phi tuyến Lyapunov: Tính toán vận tốc (v, w)          |
|  - Vòng điều khiển kín PID: Ổn định vận tốc góc động cơ               |
+-----------------------------------+-----------------------------------+
                                    | Tín hiệu PWM & Direction
                                    v
                  +-----------------+-----------------+
                  |      MẠCH CÔNG SUẤT TB6612FNG     |
                  +-----------------+-----------------+
                                    | Dòng điều khiển động lực
                                    v
                  +-----------------+-----------------+
                  |  2 ĐỘNG CƠ DC GA25-V1 + ENCODER  |
                  |    (Hệ dẫn động vi sai 2 bánh)   |
                  +-----------------------------------+

Mục tiêu kỹ thuật của dự án

  1. Thiết kế cơ cấu cơ khí chống lật: Tối ưu hóa kích thước khung gầm, tỷ lệ trọng tâm/vết bánh xe ($b/a$) nhằm đảm bảo độ đồng phẳng và triệt tiêu moment lật khi xe vào cua với bán kính $R_{min} = 500\text{ mm}$.
  2. Xây dựng module cảm biến quang học độ phân giải cao: Thiết kế mảng 7 cảm biến hồng ngoại TCRT5000 kết hợp thuật toán hiệu chuẩn phần mềm (Software Calibration) và giải thuật xấp xỉ trọng số liên tục nhằm đạt sai số phát hiện vị trí tâm line $e_{max} \le 3.17\text{ mm}$.
  3. Mô hình hóa động học và tổng hợp bộ điều khiển phi tuyến: Ứng dụng lý thuyết ổn định Lyapunov để kiểm soát sai số tư thế $(e_1, e_2, e_3)$, kết hợp bộ điều khiển PID vận tốc vòng kín cho 2 động cơ DC Geared Motor GA25-V1.
  4. Hiện thực hóa phần cứng nhúng tập trung: Tích hợp bộ vi điều khiển PIC18F4550 và mạch cầu H MOSFET TB6612FNG đảm bảo đáp ứng tần số lấy mẫu thời gian thực $t_s = 0.01\text{ s}$ ($10\text{ ms}$).

Phạm vi và giới hạn kỹ thuật

  • Vận tốc thiết kế tối đa ($v_{max}$): $0.5\text{ m/s}$ (500 mm/s) trên sa bàn thực nghiệm.
  • Bán kính góc cua nhỏ nhất ($R_{min}$): $500\text{ mm}$.
  • Tải trọng danh định: Khung thân $M_1 = 2\text{ kg}$, tải trọng hàng hóa giả lập $M_2 = 2\text{ kg}$ (tổng khối lượng $4\text{ kg}$).
  • Điều kiện môi trường: Bề mặt đường đua phẳng tiêu chuẩn, vạch line trắng trên nền đen/sàn phẳng độ tương phản cao, ít bụi bẩn.

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

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

Khảo sát các cấu trúc robot dò line đoạt giải tại các cuộc thi quốc tế và ứng dụng công nghiệp cho thấy ba hướng tiếp cận tiêu biểu:

Mô hình / Giải pháp Cấu hình dẫn động Hệ thống cảm biến Ưu điểm kỹ thuật Nhược điểm & Hạn chế
CartisX04 (Japan Robotrace Winner) 4 bánh sau chủ động (2 DC), 1 bánh trước dẫn hướng chủ động 6 cụm IR + 2 Gyroscope Vận tốc cực đại $4.2\text{ m/s}$, cân bằng động tốt Cơ cấu lái phức tạp, trượt ngang lớn khi vào cua gắt
Silvestre (Spain Contest Winner) 2 bánh sau vi sai (2 DC), 1 bánh mắt trâu tự lựa 8 cụm IR $V_{max} = 2.24\text{ m/s}$, bán kính quay vòng nhỏ, cơ khí gọn Dễ mất ổn định động học, nhạy cảm với độ phẳng bề mặt
Fireball (Chibots USA Winner) 4 bánh chủ động độc lập (4 DC) 16 cụm IR Lực kéo lớn, bám đường tốt, $V_{max} = 3.0\text{ m/s}$ Kết cấu nặng nề, khó đồng phẳng 4 bánh, thuật toán phức tạp
Giải pháp Đề tài 2 bánh sau vi sai (GA25), 1 bánh mắt trâu kim loại 7 cụm IR TCRT5000 + ADC 10-bit Kết cấu tối ưu chi phí, bám line mượt nhờ Lyapunov, chống lật $b/a = 0.4$ Giới hạn tốc độ $0.5\text{ m/s}$ do băng thông vi điều khiển tầm trung

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

  • Must have (Bắt buộc): Hệ thống vi sai 2 bánh độc lập; mảng cảm biến IR phát hiện line liên tục; bộ điều khiển Lyapunov ổn định tiệm cận; mạch bảo vệ quá dòng động cơ.
  • Should have (Nên có): Thuật toán tự hiệu chuẩn cảm biến khi khởi động; bộ điều khiển PID lấy mẫu $10\text{ ms}$; cơ cấu hạ thấp trọng tâm chống lật.
  • Could have (Có thể mở rộng): Đoạn giải mã mã vạch/junction 90 độ phục vụ phân luồng; telemetry truyền dữ liệu không dây qua Bluetooth/ZigBee.
  • Won't have (Không thực hiện): Xử lý thị giác máy tính qua Camera (loại bỏ do độ trễ thuật toán lớn và chi phí tính toán cao đối với phần cứng nhúng thấp).

Thiết kế hệ thống

+-----------------------------------------------------------------------------+
|                          SƠ ĐỒ PHÂN PHỐI NGUỒN VÀ ĐIỆN TỬ                   |
+-----------------------------------------------------------------------------+
 [ Nguồn Pin LiPo 12V ]
       |
       +---> [ LM2596 Step-Down 12V->5V ] ----> [ PIC18F4550 MCU ]
       |                                   |
       |                                   +--> [ 7x TCRT5000 IR Sensors ]
       |
       +---> [ AMS1117 Step-Down 5V->3.3V ] -> [ Mạch Logic Ngoại vi ]
       |
       +---> [ TB6612FNG Dual H-Bridge ] -----> [ Motor DC 1 (Trái) + Encoder ]
                                          +---> [ Motor DC 2 (Phải) + Encoder ]

1. Lựa chọn Technology Stack & Phần cứng

  • Vi điều khiển chính: Microchip PIC18F4550 (Kiến trúc 8-bit RISC, thạch anh ngoài $20\text{ MHz}$, 14 kênh ADC 10-bit tích hợp, module Enhanced Capture/Compare/PWM).
  • Mạch công suất Driver: Toshiba TB6612FNG (Dual H-Bridge MOSFET, hiệu suất cao, điện áp $V_{CC} = 2.7 - 5.5\text{ V}$, $V_{IN_motor} \le 15\text{ V}$, dòng tải liên tục $1.2\text{ A/cầu}$, tần số PWM $100\text{ kHz}$).
  • Cảm biến quang học: Vishay TCRT5000 (Bộ phát LED hồng ngoại bước sóng $950\text{ nm}$ + Phototransistor NPN, khoảng cách hoạt động tối ưu $0.2 - 15\text{ mm}$).
  • Động cơ chấp hành: GA25-V1 DC Geared Motor (Điện áp $12\text{ V}$, công suất danh định $13.2\text{ W}$, tỷ số truyền hộp số kim loại, tốc độ không tải $320\text{ rpm}$, tích hợp Encoder đĩa quang 2 kênh A/B).
  • Môi trường phát triển & Mô phỏng: MATLAB R2016a / Simulink (Mô hình hóa động học và kiểm chứng ổn định Lyapunov); MPLAB X IDE & CCS C Compiler (Lập trình firmware C nhúng); SolidWorks 2016 (Thiết kế kết cấu cơ khí 3D).

2. Tính toán cơ cấu cơ khí và điều kiện chống lật

Robot sử dụng cấu hình 3 bánh gồm 2 bánh chủ động cao su đường kính $D = 80\text{ mm}$ ($r = 40\text{ mm}$) và 1 bánh mắt trâu chịu tải $50\text{ kg}$ đặt phía trước. Khối lượng toàn tải $M = 4\text{ kg}$ ($M_1 = 2\text{ kg}$, $M_2 = 2\text{ kg}$).

Khoảng cách vết bánh xe $a = 150\text{ mm}$, chiều dài tổng thể $L = 250\text{ mm}$ (tỷ lệ $L/W = 0.6$). Vị trí trọng tâm hệ thống được tính toán: $$x_G = \frac{m_1 x_{G1} + m_2 x_{G2}}{m_1 + m_2} = \frac{2 \cdot \frac{L}{2} + 2 \cdot \frac{L}{4}}{4} = \frac{3L}{8}$$

Lực pháp tuyến tác dụng lên các trục bánh xe: $$R_1 = \frac{3P}{8} = 14.7\text{ N}, \quad R_2 = \frac{5P}{8} = 24.5\text{ N}$$

Để chống lật khi xe vào cung cua bán kính $R = 0.5\text{ m}$ ở vận tốc $v = 0.5\text{ m/s}$, điều kiện cân bằng moment tại điểm tiếp xúc bánh ngoài: $$M_2 \ge M_1 \iff P \cdot \frac{a}{2} \ge F_{lt} \cdot b \iff \frac{b}{a} \le \frac{R \cdot g}{2 v^2} = \frac{0.5 \cdot 9.81}{2 \cdot (0.5)^2} = 9.81$$ Hệ thống chọn chiều cao trọng tâm $b = 60\text{ mm} \implies \frac{b}{a} = \frac{60}{150} = 0.4 \ll 9.81$, đảm bảo hệ số an toàn chống lật động học tuyệt đối.

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

Dự án áp dụng mô hình phát triển Cơ điện tử chữ V (Mechatronic V-Model Design Cycle):

Yêu cầu hệ thống -----------------------------> Kiểm thử nghiệm thu (Sa bàn)
    \                                                 /
   Thiết kế kiến trúc --------------> Kiểm thử tích hợp (Hardware-in-the-loop)
       \                                   /
      Thiết kế chi tiết ------> Kiểm chứng module (PID Motor / Sensor Calibration)
          \                           /
           Hiện thực hóa & Chế tạo mô hình

Kế hoạch triển khai và Đánh giá rủi ro

Giai đoạn Nội dung công việc Deliverables chính Rủi ro kỹ thuật Phương án xử lý (Mitigation)
Milestone 1 (Tuần 1-2) Khảo sát, tính toán động học và động lực học Bản vẽ CAD SolidWorks, bảng chọn công suất Sai lệch tính chọn moment động cơ Chọn hệ số dự phòng an toàn công suất $\times 2.5$
Milestone 2 (Tuần 3-4) Thiết kế mạch nguyên lý, Layout PCB nguồn & Driver Mạch in điều khiển PIC18F4550, module 7 sensor Nhiễu nguồn xung do cầu H tác động lên ADC Tách biệt mass số (GND) và mass công suất (PGND)
Milestone 3 (Tuần 5-6) Mô phỏng thuật toán Lyapunov trên MATLAB Script mô phỏng sai số $(e_1, e_2, e_3)$ Thuật toán không hội tụ tại điểm uốn Tối ưu hóa khoảng cách đặt cảm biến $d = 100\text{ mm}$
Milestone 4 (Tuần 7-8) Tích hợp hệ thống, Tune thông số PID, chạy thực nghiệm Robot hoàn thiện, báo cáo kỹ thuật Cảm biến bị bão hòa quang do ánh sáng ngoài Thuật toán Dynamic Software Calibration

Implementation và kết quả

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

1. Thuật toán hiệu chuẩn và Xấp xỉ trọng số tâm Line

Tín hiệu điện áp analog từ 7 cảm biến hồng ngoại TCRT5000 được chuyển đổi qua bộ ADC 10-bit ($0 - 1023$). Để loại bỏ sự bất đồng nhất giữa các linh kiện quang bán dẫn, công thức chuẩn hóa động được thực thi:

$$y_{j0} = y_{min} + (x_{j,i} - x_{min,i}) \cdot \frac{y_{max} - y_{min}}{x_{max,i} - x_{min,i}}$$ (với $y_{min} = 200$, $y_{max} = 1010$)

Tọa độ vị trí tâm line thực tế $x_{line}$ được xác định bằng giải thuật xấp xỉ trọng số liên tục: $$x_{line} = \frac{\sum_{i=1}^{7} x_i \cdot y_i}{\sum_{i=1}^{7} y_i}$$

// Firmware snippet: Calibration and Weighted Average Line Calculation
#define NUM_SENSORS 7
const int sensor_pos[NUM_SENSORS] = {-45, -30, -15, 0, 15, 30, 45}; // Vị trí tọa độ (mm)
const int calib_min[NUM_SENSORS]  = {360, 350, 366, 387, 365, 352, 346};
const int calib_max[NUM_SENSORS]  = {1020, 1016, 1022, 998, 1022, 997, 1023};

float calculate_line_error(void) {
    long sum_weighted = 0;
    long sum_raw = 0;
    int adc_val[NUM_SENSORS];
    float norm_val[NUM_SENSORS];

    for(int i = 0; i < NUM_SENSORS; i++) {
        adc_val[i] = read_adc_channel(i);
        // Chuẩn hóa miền giá trị [200 - 1010]
        norm_val[i] = 200.0 + (float)(adc_val[i] - calib_min[i]) * 810.0 / (calib_max[i] - calib_min[i]);
        if(norm_val[i] < 200.0) norm_val[i] = 200.0;
        if(norm_val[i] > 1010.0) norm_val[i] = 1010.0;

        sum_weighted += (long)(norm_val[i] * sensor_pos[i]);
        sum_raw += (long)norm_val[i];
    }

    if(sum_raw == 0) return 0.0;
    float x_center = (float)sum_weighted / (float)sum_raw;
    // Phương trình xấp xỉ tuyến tính thực nghiệm: y = 0.9983 * x - 1.0
    return (0.9983 * x_center - 1.0);
}

2. Mô hình hóa động học vi sai và Bộ điều khiển Lyapunov

Phương trình trạng thái động học vi sai của robot tại điểm tâm cầu sau $C(x_C, y_C)$ với góc hướng $\varphi$:

$$\begin{bmatrix} \dot{x}_C \ \dot{y}_C \ \dot{\varphi}_C \end{bmatrix} = \begin{bmatrix} \frac{r \cos\varphi}{2} & \frac{r \cos\varphi}{2} \ \frac{r \sin\varphi}{2} & \frac{r \sin\varphi}{2} \ \frac{r}{b} & -\frac{r}{b} \end{bmatrix} \begin{bmatrix} \omega_r \ \omega_l \end{bmatrix}$$

Sai số tư thế giữa điểm bám mong muốn $R(x_R, y_R, \varphi_R)$ và robot được chuyển đổi về hệ quy chiếu gắn trên robot: $$\begin{bmatrix} e_1 \ e_2 \ e_3 \end{bmatrix} = \begin{bmatrix} \cos\varphi_C & \sin\varphi_C & 0 \ -\sin\varphi_C & \cos\varphi_C & 0 \ 0 & 0 & 1 \end{bmatrix} \begin{bmatrix} x_R - x_C \ y_R - y_C \ \varphi_R - \varphi_C \end{bmatrix}$$

Hàm mục tiêu Lyapunov được xác định: $$V = \frac{1}{2} e_1^2 + \frac{1}{2} e_2^2 + \frac{1 - \cos e_3}{k_2} \ge 0$$

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

Đạo hàm theo thời gian: $$\dot{V} = e_1(v_R \cos e_3 - v) + \frac{\sin e_3}{k_2}(k_2 v_R e_2 + \omega_R - \omega) = -k_1 e_1^2 - \frac{k_3}{k_2}\sin^2 e_3 \le 0$$ Do $\dot{V} \le 0$, hệ thống đảm bảo tính ổn định tiệm cận toàn cục theo tiêu chuẩn Lyapunov ($e_1, e_2, e_3 \to 0$ khi $t \to \infty$).

% MATLAB Implementation: Lyapunov Line Following Controller
function [v_cmd, w_cmd] = lyapunov_controller(e1, e2, e3, v_ref, w_ref, k1, k2, k3)
    % Tính toán vận tốc dài và vận tốc góc điều khiển
    v_cmd = v_ref * cos(e3) + k1 * e1;
    w_cmd = k2 * v_ref * e2 + w_ref + k3 * sin(e3);
end

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

1. Khảo sát tuyến tính hóa Driver động cơ: TB6612FNG vs L298N

Thực nghiệm cấp xung PWM ($0 - 100%$) đo tốc độ không tải cho thấy Driver TB6612FNG vượt trội về độ tuyến tính và dải chết (Dead-zone) so với Driver L298 cổ điển:

Duty Cycle PWM (%) Tốc độ Motor qua L298N (rpm) Tốc độ Motor qua TB6612FNG (rpm) Nhận xét đáp ứng
0 - 10% 0 0 Vùng chết khởi động
15% 14 40 TB6612 phản hồi sớm, dòng rò thấp
30% 122 86 TB6612 tuyến tính hoàn hảo ($Y = 0.18 \times \text{PWM}$)
50% 203 147 L298 bị phi tuyến mạnh do sụt áp $V_{CE(sat)} \approx 2\text{ V}$
75% 250 222 TB6612 duy trì độ dốc ổn định
100% 285 292 TB6612 khai thác tối đa công suất nguồn 
Tốc độ (rpm)
300 |                                      * (TB6612 - Tuyến tính)
250 |                              *   +   (L298 - Phi tuyến)
200 |                      *     +
150 |              *     +
100 |        *     +
 50 |  *   +
  0 +-------------------------------------- Duty Cycle PWM (%)
    0   15   30   45   60   75   90  100

2. Nhận dạng hàm truyền và Điều khiển PID vận tốc

Hàm truyền hệ thống động cơ – Driver được nhận dạng thực nghiệm dạng quán tính bậc nhất: $$P(s) = \frac{K_m}{1 + Ts} = \frac{0.18}{1 + 0.15s}$$

Sau khi hiệu chỉnh thông số qua MATLAB Simulink và nạp thực thi trên phần cứng:

  • Động cơ 1 (Trái): $K_p = 150, K_i = 0, K_d = 0.12 \implies T_s = 0.00831\text{ s} \ (8.31\text{ ms})$, Độ vọt lố $\text{Overshoot} = 0%$, Sai số xác lập $\text{POT} = 1.8%$.
  • Động cơ 2 (Phải): $K_p = 170, K_i = 0, K_d = 0.13 \implies T_s = 0.00895\text{ s} \ (8.95\text{ ms})$, Độ vọt lố $\text{Overshoot} = 0%$, Sai số xác lập $\text{POT} = 1.5%$.

3. Tối ưu hóa khoảng cách hình học mảng cảm biến

  • Độ cao gầm cảm biến thực nghiệm tối ưu: $h = 15\text{ mm}$ (vùng giao thoa ánh sáng phản xạ $X_d = 9.5\text{ mm}$).
  • Khoảng cách từ tâm trục bánh xe đến tâm thanh cảm biến: $d = 100\text{ mm}$ (cho sai số bám quỹ đạo nhỏ nhất trong dải quét $95 - 105\text{ mm}$).

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

+-----------------------------------------------------------------------------+
|               BẢNG ĐỐI CHIẾU MỤC TIÊU VÀ KẾT QUẢ THỰC TẾ                    |
+-----------------------------------------------------------------------------+
| Chỉ tiêu kỹ thuật         | Mục tiêu ban đầu  | Kết quả đạt được | Trạng thái |
+---------------------------+-------------------+------------------+------------+
| Vận tốc lớn nhất (v_max)  | 0.50 m/s          | 0.50 m/s         | HOÀN THÀNH |
| Bán kính cua hẹp nhất     | R = 500 mm        | R = 500 mm       | HOÀN THÀNH |
| Sai số vị trí tâm line    | e_max <= 4.5 mm   | e_max = 3.17 mm  | VƯỢT CHỈ TIÊU |
| Thời gian lấy mẫu ADC 7ch | < 10.0 ms         | 0.493 ms         | VƯỢT CHỈ TIÊU |
| Thời gian đáp ứng PID     | < 20.0 ms         | 8.31 - 8.95 ms   | VƯỢT CHỈ TIÊU |
| Khả năng chống lật (b/a)  | b/a <= 0.5        | b/a = 0.4        | HOÀN THÀNH |
+-----------------------------------------------------------------------------+

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

  1. Ứng dụng giải thuật điều khiển Lyapunov cho Robot di động vi sai: Thay vì sử dụng bộ điều khiển PID bám line đơn thuần (vốn dễ gây mất ổn định và dao động con lắc tại các khúc cua gấp), đồ án đã giải quyết bài toán bám quỹ đạo bằng giải thuật Lyapunov phi tuyến, chứng minh toán học sự hội tụ sai số toàn cục $\lim_{t\to\infty} e(t) = 0$.
  2. Kỹ thuật nội suy tâm sai lệch sub-millimeter: Việc kết hợp mảng 7 cảm biến hồng ngoại bố trí dọc, tối ưu hóa vùng giao thoa $X_d = 9.5\text{ mm}$ và thuật toán trọng số liên tục giúp hệ thống đạt độ chính xác phát hiện vị trí $3.1687\text{ mm}$, vượt trội so với các hệ thống rời rạc dùng giải thuật so sánh ngưỡng (vốn có sai số tối thiểu bằng khoảng cách giữa 2 mắt đọc, thường $> 10\text{ mm}$).
  3. Cấu trúc tuyến tính hóa phần cứng – phần mềm đồng bộ: Phân tích thực nghiệm sụt áp bán dẫn để thay thế L298 bằng TB6612FNG, kết hợp bộ tham số điều khiển thích nghi theo từng đoạn quỹ đạo (đoạn cong chuyển tiếp $v = 0.4\text{ m/s}, [k_1, k_2, k_3] = [1, 450, 0]$; đoạn nút giao $v = 0.2\text{ m/s}, [k_1, k_2, k_3] = [2, 350, 0]$).

Ứ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 tự động trong nhà máy thông minh: Chuyên chở linh kiện điện tử, phụ tùng cơ khí giữa các trạm gia công CNC mà không cần tái cấu trúc hạ tầng phức tạp.
  • Robot vận chuyển thuốc và bệnh phẩm tại bệnh viện: Vận hành tin cậy, chuyển động êm ái, hạn chế tiếng ồn và tránh rung lắc chất lỏng y tế nhờ cơ cấu chống lật tối ưu.
                    +--------------------------------+
                    |    TRẠM NẠP / KHO TRUNG TÂM    |
                    +---------------+----------------+
                                    |
                        (Quỹ đạo vạch dẫn hướng)
                                    |
       +----------------------------+----------------------------+
       |                                                         |
       v                                                         v
+-------------------------------+         +-------------------------------+
|     TRẠM GIA CÔNG SỐ 1        |         |      TRẠM GIA CÔNG SỐ 2       |
| (Dừng chính xác nhờ Junction) |         | (Cung rẽ R=500mm chống lật)   |
+-------------------------------+         +-------------------------------+

Phân tích hiệu quả kinh tế (ROI Analysis)

  • Chi phí phần cứng mẫu (BOM): Ước tính dưới 1.500.000 VNĐ (~60 USD), thấp hơn 85% so với các module AGV công nghiệp nhập khẩu sử dụng cảm biến từ hoặc laser LiDAR.
  • Khả năng mở rộng (Scalability): Dễ dàng tích hợp thêm module RF/ESP32 để kết nối vào hệ thống điều phối trung tâm MES/WMS; nâng cấp động cơ không chổi than (BLDC) để nâng dải tải trọng lên $50 - 100\text{ kg}$.

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

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

  • Phụ thuộc vào chất lượng bề mặt sàn: Hệ thống dùng cảm biến quang học nên dễ bị suy giảm độ nhạy nếu mặt sàn bị trầy xước nặng hoặc bám dầu mỡ công nghiệp.
  • Năng lực tính toán của vi điều khiển 8-bit: Vi điều khiển PIC18F4550 bị giới hạn bộ nhớ và không hỗ trợ phần cứng dấu chấm động (FPU), khiến thời gian tính toán hàm lượng giác ($\sin, \cos$) của thuật toán Lyapunov tiêu tốn chu kỳ máy.

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

  • Chuyển đổi kiến trúc MCU sang 32-bit ARM Cortex-M4 (STM32F4 series): Nâng cao tần số lấy mẫu lên $1\text{ kHz}$ và tích hợp tính toán ma trận thực thời.
  • Kết hợp bộ lọc Kalman mở rộng (EKF): Kết hợp dữ liệu cảm biến hồng ngoại với cảm biến quán tính IMU 6-DOF (MPU6050) để bù sai số trượt bánh khi di chuyển ở tốc độ cao trên $1.5\text{ m/s}$.

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

  • Sinh viên & Kỹ sư Cơ điện tử: Cung cấp tài liệu tham khảo hoàn chỉnh từ thiết kế động học, tính toán cơ khí, mạch nhúng đến thuật toán điều khiển phi tuyến ứng dụng thực tế.
  • Nhà phát triển Robot di động: Tham khảo bộ thông số thực nghiệm về đáp ứng xung PWM của TB6612, giải thuật calib cảm biến quang học và cấu hình chống lật $b/a$.
  • Doanh nghiệp vừa và nhỏ (SMEs): Tiếp cận giải pháp chế tạo xe tự hành AGV nội bộ với chi phí siêu thấp, dễ dàng bảo trì và làm chủ công nghệ lõi.

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

1. Yêu cầu kỹ thuật tối thiểu để triển khai phần cứng của robot là gì?

Hệ thống yêu cầu nguồn cấp pin LiPo $11.1\text{ V} - 12\text{ V}$ dòng xả tối thiểu $20\text{ C}$, bộ vi điều khiển có ít nhất 7 kênh ADC 10-bit với thời gian chuyển đổi $t_{conv} < 1\text{ ms}$, 2 kênh timer xuất PWM tần số $> 10\text{ kHz}$, và mạch công suất chịu dòng liên tục $\ge 1.2\text{ A}$ mỗi động cơ.

2. Vì sao nhóm chọn thuật toán Lyapunov thay vì giải thuật PID bám line truyền thống?

Bộ điều khiển PID cổ điển chỉ xem xét sai số vị trí một chiều ($e_2$), không xử lý đồng thời sai số góc hướng xe ($e_3$) và sai số dọc ($e_1$). Khi xe vào các đoạn uốn lượn liên tục hoặc góc rẽ vuông, PID dễ bị vọt lố, bão hòa tín hiệu điều khiển dẫn đến mất line. Bộ điều khiển Lyapunov giải quyết trực tiếp mô hình phi tuyến của robot vi sai và đảm bảo ổn định toán học toàn cục.

3. Phương pháp hiệu chuẩn cảm biến bằng phần mềm hoạt động như thế nào khi có ánh sáng môi trường thay đổi?

Trước khi chạy, robot thực hiện chu trình quét mẫu qua bề mặt trắng và đen để ghi nhận giá trị thực tế $[x_{min,i}, x_{max,i}]$ của từng cảm biến. Thuật toán phần mềm sẽ ánh xạ dải tín hiệu này về miền quy chuẩn cố định $[200, 1010]$, triệt tiêu hoàn toàn sự sai lệch do lão hóa linh kiện hoặc cường độ ánh sáng môi trường.

4. Giải pháp chống lật của xe có áp dụng được khi tăng tải trọng không?

Hoàn toàn áp dụng được. Theo công thức cân bằng moment $\frac{b}{a} \le \frac{Rg}{2v^2}$, điều kiện chống lật độc lập với tổng khối lượng $M$ mà chỉ phụ thuộc vào tỷ lệ chiều cao trọng tâm $b$, khoảng cách vết bánh $a$, bán kính cua $R$ và vận tốc $v$. Khi chở hàng nặng, chỉ cần bố trí vị trí đặt tải sao cho trọng tâm tổng hợp không vượt quá $b = 60\text{ mm}$.

5. Dự toán chi phí và thời gian thu hồi vốn (ROI) khi ứng dụng trong xưởng sản xuất nhỏ?

Chi phí tự chế tạo một xe dẫn đường tiêu chuẩn là khoảng 1.500.000 – 3.000.000 VNĐ. Thay thế một nhân công vận chuyển thủ công (chi phí ~7.000.000 VNĐ/tháng), một hệ sinh thái 2-3 robot AGV có thể giúp xưởng thu hồi vốn đầu tư trong vòng chưa đầy 1 đến 2 tháng vận hành.

Kết luận

Đồ án "Thiết kế Robot dò line" đã hoàn thành toàn diện các mục tiêu đặt ra: từ mô hình hóa lý thuyết, tính toán kết cấu chống lật, thiết kế mạch điện tử công suất đến lập trình thuật toán điều khiển phi tuyến Lyapunov trên phần cứng PIC18F4550. Kết quả thực nghiệm khẳng định robot bám quỹ đạo mượt mà với sai số dưới $3.17\text{ mm}$, đạt vận tốc tối đa $0.5\text{ m/s}$ và vượt qua các cung cua bán kính hẹp $R = 500\text{ mm}$ với độ ổn định cao. Công trình đóng góp một giải pháp tham khảo giá trị cho các nghiên cứu ứng dụng xe tự hành dẫn đường thông minh trong lĩnh vực cơ điện tử và tự động hóa công nghiệp.