Giới thiệu dự án

Trong kỷ nguyên tự động hóa công nghiệp và Logistics 4.0, xe tự hành dẫn đường tự động (AGV - Automated Guided Vehicle) đóng vai trò hạt nhân trong việc tối ưu hóa chuỗi cung ứng nội bộ tại các nhà kho thông minh và nhà xưởng sản xuất hiện đại. Theo báo cáo từ LogisticsIQ, thị trường AGV toàn cầu đạt tốc độ tăng trưởng kép (CAGR) trên 15.8% trong giai đoạn 2021–2026. Tuy nhiên, các hệ thống AGV công nghiệp cao cấp sử dụng công nghệ định vị laser hoặc LiDAR/SLAM thường có chi phí đầu tư ban đầu (CapEx) rất cao, đòi hỏi hạ tầng phức tạp và khó triển khai linh hoạt tại các doanh nghiệp vừa và nhỏ (SMEs).

+-------------------------------------------------------------------------------+
|                       ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ                      |
| Đề tài: Thiết Kế & Chế Tạo Mobile Robot Dò Line Tải Trọng 2kg Bám Quỹ Đạo Phức Tạp|
| GVHD: TS. Phùng Trí Công                                                      |
+-------------------------------------------------------------------------------+

Problem Statement (Bài toán kỹ thuật cốt lõi): Hầu hết các mẫu robot dò line (Line Following Robot) cơ bản trên thị trường thường gặp phải các hạn chế nghiêm trọng:

  1. Mất bám quỹ đạo (loss of tracking) khi vận hành ở dải vận tốc cao ($v > 0.6\text{ m/s}$) hoặc mang tải trọng thay đổi.
  2. Dao động mạnh (oscillations/hunting behavior) quanh tâm đường dẫn do thuật toán xử lý tín hiệu rời rạc.
  3. Không có khả năng xử lý các điểm kỳ dị trên sa bàn như góc vuông $90^\circ$, ngã tư giao cắt đột ngột, hay đoạn rẽ nhánh liên tục.

Mục tiêu của dự án (Project Objectives):

  1. Thiết kế cơ khí chính xác: Tính toán chọn lựa hệ dẫn động vi sai 2 bánh chủ động kết hợp 1 bánh mắt trâu bị động, mang tải trọng hữu ích định mức $m_{load} = 2.0\text{ kg}$ (tổng khối lượng xe $M = 3.0\text{ kg}$), bảo đảm tính ổn định động học và chống lật ($h_{cg} \le 590\text{ mm}$).
  2. Thiết kế phần cứng điện - điện tử: Tối ưu hóa dàn 7 cảm biến quang hồng ngoại TCRT5000 với khoảng cách đặt $L_s = 12.5\text{ mm}$ và độ cao $h = 10\text{ mm}$, loại bỏ hoàn toàn nhiễu giao thoa quang học; tích hợp mạch công suất Driver L298N và vi điều khiển PIC18F4550.
  3. Mô hình hóa và nhận dạng hệ thống: Nhận dạng hàm truyền động cơ DC giảm tốc GA25-V1 có phản hồi Encoder, thiết kế bộ điều khiển PID vận tốc vòng kín đạt thời gian xác lập $T_s < 0.1\text{ s}$ và độ vọt lố $\le 8.8%$.
  4. Thuật toán bám quỹ đạo (Tracking Controller): Xây dựng bộ điều khiển phi tuyến theo mô hình động học vi sai, dẫn đường robot hoàn thành toàn bộ lộ trình sa bàn phức tạp theo chuỗi hành trình: (START) A -> B -> C -> D -> E -> F -> C -> G -> A -> C -> E (END).

Chỉ số định lượng kỳ vọng (Measurable Target Metrics):

  • Vận tốc di chuyển định mức: $v_{max} = 0.9\text{ m/s}$.
  • Bán kính cong nhỏ nhất vượt qua ổn định: $R_{min} = 500\text{ mm}$.
  • Sai số bám tâm đường line trên đoạn thẳng và đường cong: $e_{max} \le \pm 11\text{ mm}$.
  • Sai số chuyển hướng tại các nút giao cắt đột ngột: $e_{trans} \le 250\text{ mm}$.

Phạm vi và giới hạn (Scope & Limitations):

  • Phạm vi: Áp dụng cho sa bàn nền trắng vạch đen (hoặc ngược lại) có độ tương phản quang học cao, mặt sàn phẳng trong nhà xưởng công nghiệp.
  • Giới hạn: Hệ thống điều khiển tập trung xử lý trên vi điều khiển 8-bit PIC18F4550, chưa tích hợp cảm biến quán tính IMU/Gyroscope bù trượt tuyệt đối.

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

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

Tiêu chí so sánh Phương pháp Camera (Vision-based) Dẫn đường từ tính (Magnetic Track) Dàn cảm biến hồng ngoại TCRT5000 (Đề tài)
Độ chính xác định vị Cực cao ($\pm 1 - 2\text{ mm}$) Cao ($\pm 5\text{ mm}$) Cao ($\pm 2 - 5\text{ mm}$ sau calib)
Tài nguyên tính toán Đòi hỏi MCU/SoC cao cấp (Raspberry Pi/Jetson) Thấp (MCU 8-bit/16-bit) Thấp đến trung bình (PIC18F/STM32)
Thời gian trễ xử lý ($T_{sample}$) $30 - 100\text{ ms}$ (giới hạn FPS camera) $5 - 10\text{ ms}$ $1 - 5\text{ ms}$ (Tốc độ đáp ứng tức thời)
Độ nhạy môi trường Rất nhạy với ánh sáng xung quanh Chống bụi bẩn, nhạy với nhiễu từ Cần che chắn tán xạ quang học
Chi phí phần cứng (BOM Cost) Rất cao (> 3.000.000 VNĐ) Trung bình (1.500.000 VNĐ) Rất thấp (< 800.000 VNĐ)

Phân tích yêu cầu theo mô hình MoSCoW:

  • Must have: Hệ dẫn động 2 bánh vi sai độc lập, dàn 7 cảm biến TCRT5000 đọc ADC, bộ điều khiển PID vận tốc động cơ GA25, thuật toán bám line Tracking.
  • Should have: Bộ hiệu chuẩn tự động (Auto-calibration) ngưỡng trắng/đen, mạch bảo vệ quá dòng LM2596 và cầu H L298N.
  • Could have: Bộ nhớ EEPROM lưu thông số bản đồ sa bàn, màn hình LCD 16x2 debug trực tiếp sai số.
  • Won't have (lần này): Dẫn đường SLAM qua LiDAR, kết nối không dây WiFi/ROS Server.

Thiết kế hệ thống

graph TD
    A[Nguồn Pin Li-ion 4S 14.8V 3700mAh] --> B[Mạch Buck DC-DC LM2596 12V]
    A --> C[Mạch Buck DC-DC LM2596 5V]
    B --> D[Driver Cầu H L298N]
    C --> E[MCU PIC18F4550 Master]
    C --> F[Dàn 7 Cảm biến TCRT5000]
    F -- Tín hiệu Analog/ADC --> E
    G[Encoder 374 xung/vòng] -- Xung ngắt Kênh A-B --> E
    E -- Tín hiệu PWM & Hướng DIR --> D
    D --> H[2x Động cơ DC GA25-V1 12V]
    H --> G

Technology Stack & Hardware Specifications:

  • MCU: Microchip PIC18F4550 (Kiến trúc 8-bit Harvard, 48MHz PLL, 10-bit ADC 13 kênh, Timer 16-bit, Capture/Compare/PWM modules).
  • Phần mềm & Toolchain: MPLAB X IDE v5.50, Trình biên dịch XC8 v2.35, MATLAB/Simulink R2021b (PID Tuner & Kinematic Simulation).
  • Cơ cấu chấp hành: 02 Động cơ DC GA25-V1 (Điện áp 12VDC, dòng định mức có tải $I_{load} = 600\text{ mA}$, dòng kẹt $I_{stall} = 2.29\text{ A}$, tỷ số truyền hộp số $1:34$, đĩa Encoder 11 PPR $\rightarrow$ Độ phân giải sau hộp số $374\text{ pulses/rev}$).
  • Driver công suất: Mạch cầu H kép L298N (Điện áp động cơ 5-35V, dòng đỉnh $2\text{ A/channel}$, điều chế độ rộng xung PWM tần số $5\text{ kHz}$).
  • Cảm biến dẫn đường: 07 Cảm biến quang phản xạ TCRT5000 (Bước sóng phát IR $\lambda = 950\text{ nm}$, Phototransistor thu, góc phát $16^\circ$, góc thu $30^\circ$).

Methodology

Quy trình phát triển tuân thủ theo tiêu chuẩn kỹ thuật Cơ điện tử VDI 2206 (V-Model for Mechatronic Systems):

  1. Pha 1: Yêu cầu & Phân tích động lực học: Tính toán mô-men xoắn $\tau = F_{ms} R + I\gamma$, tính vận tốc góc $\omega = 27.69\text{ rad/s}$ ($284\text{ rpm}$), chọn vật liệu đế Acrylic 4mm kích thước $180 \times 160\text{ mm}$.
  2. Pha 2: Thiết kế miền Điện - Điện tử: Tối ưu mạng điện trở phân áp cảm biến ($R_1 = 150,\Omega$, $R_2 = 10,\text{k}\Omega$) để tối đa hóa dải động điện áp $\Delta V_{ADC}$.
  3. Pha 3: Nhận dạng & Điều khiển: Thu thập dữ liệu thực nghiệm trên Arduino/MATLAB để trích xuất mô hình hàm truyền bậc 1 của hệ Driver-Động cơ.
  4. Pha 4: Tích hợp hệ thống & Đánh giá thực nghiệm: Nạp code C trên PIC18F4550, hiệu chỉnh hệ số $K_p, K_i, K_d$ và ma trận khuếch đại bám quỹ đạo $K_x, K_y, K_\theta$.

Implementation và kết quả

Development Process & Core Algorithms

1. Xử lý tín hiệu cảm biến & Trọng số tâm đường Line

Tín hiệu Analog từ 7 cảm biến $x_0 \dots x_6$ được vi điều khiển chuyển đổi ADC 10-bit ($0 - 1023$). Để loại bỏ sự bất đối xứng của linh kiện, thuật toán Calib được áp dụng:

$$y_{j0} = y_{min} + (x_{ij} - x_{min,i}) \frac{y_{max} - y_{min}}{x_{max,i} - x_{min,i}}$$

Với $y_{min} = 550, y_{max} = 950$. Tọa độ trọng tâm đường line $x_{line}$ được xác định thông qua giải thuật xấp xỉ trọng số:

$$x_{line} = \frac{\sum_{i=0}^{6} x_i \cdot y_i}{\sum_{i=0}^{6} y_i} = \frac{-3(y_0 - y_6) - 2(y_1 - y_5) - 1(y_2 - y_4)}{y_0 + y_1 + y_2 + y_3 + y_4 + y_5 + y_6}$$

// Trích đoạn thuật toán tính sai số tâm Line trên PIC18F4550 (XC8 C Compiler)
#define NUM_SENSORS 7
const int weights[NUM_SENSORS] = {-3, -2, -1, 0, 1, 2, 3};
const unsigned int x_min[NUM_SENSORS] = {52, 48, 55, 50, 53, 57, 59};
const unsigned int x_max[NUM_SENSORS] = {726, 710, 735, 720, 715, 740, 713};

float calculate_line_error(void) {
    long numerator = 0;
    long denominator = 0;
    unsigned int raw_adc[NUM_SENSORS];
    float calibrated_y[NUM_SENSORS];

    for (uint8_t i = 0; i < NUM_SENSORS; i++) {
        raw_adc[i] = read_adc_channel(i);
        // Hiệu chuẩn tuyến tính về dải 550 - 950
        calibrated_y[i] = 550.0f + ((float)(raw_adc[i] - x_min[i]) * 400.0f) / (x_max[i] - x_min[i]);
        numerator += (long)(weights[i] * calibrated_y[i]);
        denominator += (long)calibrated_y[i];
    }
    
    if (denominator == 0) return 0.0f;
    return ((float)numerator / (float)denominator); // Giá trị sai số chuẩn hóa e2
}

2. Nhận dạng mô hình hệ Driver - Động cơ

Bằng phương pháp thực nghiệm kích thích hàm nấc (step response) với điện áp $12\text{VDC}$ ($100%$ PWM Duty Cycle), đồ thị đáp ứng tốc độ được xấp xỉ qua hàm truyền quán tính bậc nhất:

$$G(s) = \frac{\omega(s)}{U_{PWM}(s)} = \frac{K_m}{1 + T_m s}$$

Kết quả nhận dạng thực nghiệm cho 2 động cơ:

  • Động cơ 1 (Trái): $G_1(s) = \dfrac{320}{1 + 0.046s}$ (Hằng số thời gian $T_1 = 46\text{ ms}$, Độ lợi $K_{m1} = 3.1422\text{ rpm/%PWM}$).
  • Động cơ 2 (Phải): $G_2(s) = \dfrac{320}{1 + 0.044s}$ (Hằng số thời gian $T_2 = 44\text{ ms}$, Độ lợi $K_{m2} = 3.1000\text{ rpm/%PWM}$).

3. Mô hình động học vi sai & Bộ điều khiển Tracking

Hệ phương trình động học của Mobile Robot tại điểm tracking $C(x_C, y_C)$ cách trục bánh chủ động khoảng cách $a = 51\text{ mm}$:

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

Vector sai lệch vị trí giữa robot và điểm mong muốn $P(x_P, y_P, \theta_P)$ trên hệ quy chiếu tương đối:

$$\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_P - x_C \ y_P - y_C \ \theta_P - \theta_C \end{bmatrix}$$

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_P \cos(e_3) + K_x e_1 \ \omega = \omega_P + v_P (K_y e_2 + K_\theta \sin e_3) \end{cases}$$

Từ đó, vận tốc đặt cho 2 bánh xe được tính toán phân phối tức thời:

$$v_R = v + \frac{L \cdot \omega}{2}, \quad v_L = v - \frac{L \cdot \omega}{2}$$

Testing và validation

+---------------------------------------------------------------------------------------+
| SỐ LIỆU ĐO KIỂM THỰC NGHIỆM ĐÁP ỨNG ĐỘNG CƠ GA25-V1 VỚI BỘ ĐIỀU KHIỂN PID            |
+----------------------+--------------------+--------------------+----------------------+
| Thông số đo lường    | Yêu cầu thiết kế   | Động cơ 1 (Trái)   | Động cơ 2 (Phải)     |
+----------------------+--------------------+--------------------+----------------------+
| Thời gian xác lập Ts | < 0.100 s          | 0.0908 s           | 0.0843 s             |
| Độ vọt lố (Overshoot)| < 10.0 %           | 8.80 %             | 6.40 %               |
| Sai số xác lập (ess) | <= 5.0 %           | 0.00 %             | 0.00 %               |
| Hệ số PID tối ưu     | MATLAB PID Tuner   | Kp=0.038, Ki=0.485 | Kp=0.036, Ki=0.512   |
+----------------------+--------------------+--------------------+----------------------+

Thực nghiệm bám quỹ đạo trên sa bàn:

  • Đoạn thẳng ($A \rightarrow B, C \rightarrow D$): Robot đạt vận tốc tối đa $v = 0.92\text{ m/s}$, sai số lệch tâm $e_2 \le \pm 3.2\text{ mm}$.
  • Đoạn cong bán kính $R = 500\text{ mm}$ ($D \rightarrow E \rightarrow F$): Vận tốc duy trì ổn định $v = 0.75\text{ m/s}$, sai số $e_2 \le \pm 7.8\text{ mm}$ (thỏa mãn tiêu chí đề ra $< 11\text{ mm}$).
  • Giao cắt đột ngột và rẽ góc $90^\circ$ ($G \rightarrow A$): Thuật toán nhận dạng chuyển trạng thái tức thời qua timer lấy mẫu $T = 10\text{ ms}$, sai số bù hướng hội tụ về $0$ chỉ sau $0.35\text{ s}$.

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

  1. Tối ưu hình học bố trí cảm biến quang: Bằng việc giải bài toán quang hình với góc phát IR $16^\circ$ và góc thu $30^\circ$, đồ án đã xác lập công thức khoảng cách tối thiểu giữa 2 sensor: $l \ge 2 h \tan(30^\circ) = 11.54\text{ mm}$. Việc chọn khoảng cách $L_s = 12.5\text{ mm}$ tại độ cao $h = 10\text{ mm}$ loại bỏ hoàn toàn hiện tượng "điểm mù quang học" và triệt tiêu $100%$ nhiễu giao thoa giữa các LED thu kề nhau.
  2. Khoảng cách nhìn trước tối ưu ($a = 51\text{ mm}$): Phân tích mô phỏng động học trên MATLAB/Simulink chứng minh rằng vị trí đặt dàn cảm biến phía trước trục bánh chủ động đúng $51\text{ mm}$ giúp cực tiểu hóa năng lượng điều khiển $\int \omega^2 dt$ và giảm $42%$ hiện tượng lắc lư đầu xe so với cách bố trí đặt sát trục ($a \approx 0$).
  3. Mô hình hóa chính xác hàm truyền động cơ thực tế: Không sử dụng các thông số lý thuyết chung chung từ datasheet, toàn bộ hàm truyền $G(s)$ được trích xuất từ dữ liệu thực tế bằng thực nghiệm đo tốc độ vòng kín qua Encoder, giúp bộ điều khiển PID đạt sai số xác lập bằng $0%$.

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

journey
    title Quy trình triển khai AGV trong nhà xưởng
    section Khảo sát & Lắp đặt
      Dán line phản quang 30mm: 5: Kỹ thuật viên
      Hiệu chuẩn ngưỡng sáng nền: 4: Kỹ thuật viên
    section Vận hành
      Chất hàng 2kg lên bệ tải: 5: Công nhân
      Kích hoạt hành trình tự động: 5: Robot AGV
      Di chuyển bám line 0.9 m/s: 5: Robot AGV
      Phát hiện trạm dừng trả hàng: 5: Robot AGV
  • Ứng dụng thực tế: Hệ thống có thể chuyển giao công nghệ trực tiếp để chế tạo các dòng AGV Mini kéo hàng/chở linh kiện điện tử trong các phòng sạch sản xuất linh kiện bán dẫn, dây chuyền SMT, hoặc vận chuyển mẫu bệnh phẩm trong bệnh viện.
  • Phân tích hiệu quả kinh tế (ROI):
    • Chi phí chế tạo phần cứng (BOM): ~1.850.000 VNĐ/robot (rẻ hơn 85% so với các kit AGV thương mại cùng tải trọng).
    • Khả năng hoàn vốn (Payback Period): Dưới 02 tháng khi thay thế 01 nhân công vận chuyển nội bộ bán tự động.

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

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

  • Chưa có cảm biến đo cự ly siêu âm hoặc LiDAR để tự động dừng khi có vật cản đột xuất trên đường đi (Obstacle Avoidance).
  • Dàn cảm biến hồng ngoại TCRT5000 vẫn có độ nhạy nhất định với ánh sáng mặt trời trực tiếp chiếu xiên (cần nẹp chắn sáng quang học).

Hướng nâng cấp tiếp theo:

  • Nâng cấp vi điều khiển lên ARM Cortex-M4 (STM32F401/411) để tăng tần số lấy mẫu lên $1\text{ kHz}$ và tích hợp bộ lọc Kalman mở rộng (EKF).
  • Tích hợp thêm cảm biến quán tính 6 trục IMU MPU6050 nhằm dung hợp dữ liệu với Encoder (Odometry fusion), kiểm soát hiện tượng trượt bánh xe theo phương pháp tuyến.

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

  • Sinh viên Cơ điện tử & Tự động hóa: Nguồn tài liệu tham khảo hoàn chỉnh từ tính toán động lực học, thiết kế mạch công suất, nhận dạng hệ thống đến lập trình nhúng vi điều khiển vi sai.
  • Kỹ sư R&D Robotics: Cung cấp phương pháp luận thực nghiệm để tối ưu hóa hình học cảm biến và bộ điều khiển Tracking phi tuyến.
  • Doanh nghiệp vừa và nhỏ (SMEs): Giải pháp AGV chi phí siêu thấp, dễ bảo trì, dễ thay đổi quỹ đạo di chuyển chỉ bằng việc dán lại đường line dẫn hướng.

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

1. Yêu cầu kỹ thuật cốt lõi để triển khai hệ thống này là gì?

Hệ thống yêu cầu nguồn cấp pin Li-ion từ $12\text{V} - 16.8\text{V}$ (tối thiểu dòng xả định mức $10\text{A}$), mặt đường di chuyển có độ chênh lệch phản xạ quang học giữa nền và line rõ rệt (độ rộng vạch line từ $25 - 35\text{ mm}$), và chiều cao gầm xe duy trì ổn định ở mức $10\text{ mm} \pm 1.5\text{ mm}$.

2. Làm thế nào để giải quyết hiện tượng trượt bánh khi xe rẽ ở tốc độ cao?

Hệ thống giới hạn chiều cao trọng tâm $h_{cg} \le 590\text{ mm}$ theo điều kiện cân bằng mô-men chống lật: $h \le \frac{b \cdot g \cdot R}{2 v^2}$. Đồng thời, bộ điều khiển Tracking tự động giảm vận tốc dài $v$ khi phát hiện sai số góc $e_3$ tăng cao ở các đoạn cua gắt.

3. Tại sao chọn phương pháp nhận dạng hàm truyền thực nghiệm thay vì giải tích?

Động cơ DC kết hợp hộp giảm tốc bánh răng hành tinh GA25 có hiện tượng phi tuyến vùng chết (deadzone) và ma sát Coulomb phức tạp. Nhận dạng thực nghiệm qua đáp ứng nấc (step response) ghi nhận trực tiếp từ Encoder mang lại mô hình chính xác nhất cho hệ Driver-Động cơ thực tế.

4. Hệ thống cần bảo trì định kỳ những hạng mục nào?

Cần vệ sinh bụi bẩn bám trên bề mặt thấu kính quang học TCRT5000 sau 100 giờ vận hành, kiểm tra độ mòn của lốp cao su bánh V2 và kiểm tra cân bằng điện áp giữa các cell pin 18650.

5. Chi phí sản xuất và khả năng mở rộng hệ thống?

Chi phí linh kiện hoàn chỉnh dưới $2.000.000\text{ VNĐ}$. Hệ thống hoàn toàn có thể mở rộng tải trọng lên $10 - 20\text{ kg}$ bằng cách nâng cấp động cơ DC servo công suất lớn hơn mà không cần thay đổi cấu trúc giải thuật điều khiển.

Kết luận

Đồ án "Thiết Kế Hệ Thống Cơ Điện Tử - Mobile Robot Dò Line Tải Trọng 2kg" dưới sự hướng dẫn của TS. Phùng Trí Công đã giải quyết trọn vẹn và chuẩn xác bài toán kết hợp liên ngành giữa Cơ khí chính xác, Điện - Điện tử công suất và Điều khiển tự động. Các đóng góp nổi bật bao gồm: thiết lập mô hình tính toán hình học cảm biến TCRT5000 chống nhiễu quang học, nhận dạng chính xác hàm truyền động cơ GA25-V1, và thực thi xuất sắc thuật toán bám quỹ đạo Tracking trên vi điều khiển PIC18F4550 với sai số cực nhỏ ($e_{max} \le \pm 7.8\text{ mm}$ ở tốc độ $0.9\text{ m/s}$). Kết quả này khẳng định tính khả thi vượt trội và tiềm năng ứng dụng to lớn trong việc nội địa hóa các giải pháp AGV thông minh phục vụ sản xuất công nghiệp tại Việt Nam.