Giới thiệu dự án

Trong bối cảnh công nghiệp 4.0 và tự động hóa kho vận hiện đại, các dòng xe tự hành AGV (Automated Guided Vehicle) và Mobile Robot đóng vai trò xương sống nhằm tối ưu hóa chuỗi cung ứng, giải phóng sức lao động và nâng cao độ chính xác trong vận chuyển nội bộ. Dự án "Thiết Kế, Chế Tạo và Điều Khiển Robot Dò Line" được thực hiện bởi nhóm sinh viên Khoa Cơ khí – Bộ môn Cơ điện tử, Trường Đại học Bách Khoa – ĐHQG TP.HCM dưới sự hướng dẫn của ThS. Phạm Công Bằng. Đề tài tập trung giải quyết trọn vẹn bài toán tích hợp hệ thống cơ điện tử: từ tính toán động lực học cơ khí, thiết kế mạch điện tử công suất, tối ưu hóa khối cảm biến quang điện đến lập trình thuật toán điều khiển bám quỹ đạo kín (Closed-loop Following Tracking) có tải trọng.

+-------------------------------------------------------------------------+
|                    HỆ THỐNG ROBOT DÒ LINE CƠ ĐIỆN TỬ                    |
|                                                                         |
|  [Khối Cảm Biến 7x TCRT5000] ---> [Xử Lý Ngưỡng ADC / Trọng Số]         |
|                                                  |                      |
|                                                  v                      |
|  [Hồi Tiếp Encoder 11x4 CPR] <---> [MCU ATmega2560 - Thuật Toán PID]    |
|                                                  |                      |
|                                                  v                      |
|  [Khối Nguồn Cách Ly 12V/9V] ----> [Driver L298N] ---> [2x DC GA25]     |
+-------------------------------------------------------------------------+

Vấn đề kỹ thuật và Thách thức cốt lõi

  1. Sự mất ổn định cơ học khi mang tải trọng lớn: Khi robot mang tải trọng $2.0\text{ kg}$ (tương đương hoặc lớn hơn tự trọng xe) di chuyển ở vận tốc cao ($v \ge 0.4\text{ m/s}$), lực quán tính lớn dễ gây trượt bánh, mất thăng bằng hoặc lật xe khi vào các cung cua bán kính hẹp ($R = 500\text{ mm}$).
  2. Nhiễu quang học và vùng chết cảm biến: Cảm biến quang trở/hồng ngoại thông thường dễ bị ảnh hưởng bởi ánh sáng môi trường và khoảng cách lắp đặt không chuẩn xác, dẫn đến việc mất tín hiệu tại các giao cắt phức tạp (ngã tư, nút giao hình số 8, góc cua vuông $90^\circ$).
  3. Hiện tượng bất đối xứng của động cơ chấp hành: Hai động cơ DC giảm tốc dù cùng mã hiệu luôn có sai lệch cơ khí và đặc tuyến phi tuyến giữa phần trăm xung PWM và tốc độ thực tế, đòi hỏi thuật toán điều khiển vòng kín phản hồi nhanh.

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

  1. Thiết kế kết cấu cơ khí 3 bánh: Tối ưu hóa kích thước khung gầm ($300 \times 200 \times 100\text{ mm}$), đồ gá động cơ nhôm CNC chính xác cao và vị trí trọng tâm xe để đảm bảo tải trọng $2.0\text{ kg}$ không bị lật khi vào cua.
  2. Chế tạo dàn cảm biến mảng 7 kênh TCRT5000: Tính toán khoảng cách quang học ($h = 14\text{ mm}, D = 15\text{ mm}$) triệt tiêu hiện tượng giao thoa và mở rộng vùng nhận diện đường line đen $26\text{ mm}$ trên nền trắng.
  3. Xây dựng hệ thống điều khiển vòng kín PID kép: Sử dụng vi điều khiển ATmega2560 kết hợp mạch cầu H L298N và encoder quang học $11\text{ xung/vòng}$ để đồng bộ hóa tốc độ 2 bánh chủ động với chu kỳ lấy mẫu $T_s = 0.01\text{ s}$.
  4. Vận hành thực nghiệm trên sa bàn chuẩn: Hoàn thành quỹ đạo phức tạp $A \to B \to C \to D \to E \to F \to C \to G \to A \to C \to E$ trong thời gian dưới $30\text{ s}$, đạt vận tốc trung bình $\ge 0.4\text{ m/s}$.

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

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

Trước khi tiến hành thiết kế, nhóm nghiên cứu đã khảo sát và phân tích các mô hình robot dò line tiêu biểu trong các cuộc thi quốc tế và hệ thống AGV công nghiệp.

Cấu hình / Giải pháp Ưu điểm Nhược điểm Đánh giá độ phù hợp
Xe 4 bánh (4WD chủ động) Lực kéo phân bố đều, tải trọng lớn Giải thuật điều khiển phức tạp, trượt lớn khi cua góc nhỏ Không phù hợp (dễ trượt khi bo cua hẹp)
Xe 4 bánh (2 chủ động, 2 tự lựa) Cân bằng tĩnh tốt trên mặt phẳng Tiếp xúc mặt đường kém nếu sàn mấp mô, khó cua gắt Trung bình
Xe 3 bánh (2 chủ động sau, 1 mắt trâu trước) 3 điểm luôn tạo thành 1 mặt phẳng, bám đường tuyệt đối, linh hoạt Cần tính toán kỹ trọng tâm để tránh lật xe Tối ưu nhất (Chọn cho đề tài)
Mô hình The Chariot (LVBots) Tốc độ cao, vi điều khiển ATmega32u4, 6x QTR-8RC Cấu trúc chịu tải trọng thấp (< 0.5 kg) Tham khảo thuật toán điều khiển
Mô hình Silvestre (CosmoBot) MCU ARM7 LPC2148, thuật toán nhớ đường Chi phí phần cứng cao, thiết kế phức tạp Tham khảo giải thuật bám đường

Yêu cầu hệ thống theo mô hình MoSCoW

  • Must have: Chịu tải $2\text{ kg}$; Vận tốc $\ge 0.4\text{ m/s}$; Bán kính cua $R = 500\text{ mm}$; Vượt giao cắt số 8 và cua $90^\circ$; Điều khiển PID vòng kín.
  • Should have: Bộ che chắn quang học chống nhiễu lux môi trường; Cấu trúc module hóa tầng mica kép; Bảo vệ sụt áp MCU.
  • Could have: Thuật toán tự học đường (Q-learning); Khả năng tự động hiệu chỉnh thông số (Self-tuning Fuzzy PID).
  • Won't have: Giao tiếp không dây băng thông rộng; Hệ thống dẫn đường laser lidar/camera AI (nhằm tối ưu chi phí phần cứng).

Thiết kế hệ thống

1. Mô hình động học Differential Drive

Hệ thống sử dụng cơ cấu vi sai 2 bánh dẫn động độc lập bán kính $R = 32.5\text{ mm}$, khoảng cách giữa 2 bánh $L = 225\text{ mm}$.

$$\begin{bmatrix} \dot{x}_C \ \dot{y}_C \ \dot{\theta} \end{bmatrix} = \begin{bmatrix} \frac{1}{2}\cos\theta - \frac{d}{L}\sin\theta & \frac{1}{2}\cos\theta + \frac{d}{L}\sin\theta \ \frac{1}{2}\sin\theta + \frac{d}{L}\cos\theta & \frac{1}{2}\sin\theta - \frac{d}{L}\cos\theta \ -\frac{1}{L} & \frac{1}{L} \end{bmatrix} \begin{bmatrix} v_L \ v_R \end{bmatrix}$$

Trong đó:

  • $v = \frac{v_L + v_R}{2}$ là vận tốc dài tâm xe.
  • $\omega = \frac{v_R - v_L}{L}$ là vận tốc góc quay quanh trục đứng.
  • $d$ là khoảng cách từ tâm trục bánh xe đến điểm bám cảm biến $C$.
                       ^ y
                       |          [Bánh Mắt Trâu]
                       |                 |
                       +-----------------C-----------------+  ---
                       |                 |                 |   |
                       |                 | d               |   |
                       |                 v                 |   | b = 225mm
           [Động Cơ L] [================ M ===============] [Động Cơ R]
                       |               (x,y)               |   |
                       +-----------------------------------+  ---
                       |<------------ a = 144mm ---------->|

2. Tính toán động lực học và chống lật/trượt

  • Điều kiện không trượt bánh khi vào cua: Lực hướng tâm cực đại không được vượt quá lực ma sát nghỉ: $$\frac{m v^2}{R} \le \mu m g \implies v \le \sqrt{\mu g R} = \sqrt{0.8 \times 9.81 \times 0.5} \approx 1.98\text{ m/s}$$ Với $v_{\text{thực nghiệm}} = 0.42\text{ m/s} \le 1.98\text{ m/s}$, xe tuyệt đối an toàn không bị trượt văng.
  • Điều kiện không lật xe: Mô-men lật quanh bánh ngoài phải nhỏ hơn mô-men chống lật: $$\frac{m v^2}{R} h \le m g \frac{b}{2} \implies v \le \sqrt{\frac{g b R}{2 h}} = \sqrt{\frac{9.81 \times 0.225 \times 0.5}{2 \times 0.035}} \approx 3.97\text{ m/s}$$ (Với chiều cao trọng tâm $h = 35\text{ mm}$, khoảng cách 2 bánh $b = 225\text{ mm}$).
               Lực Quán Tính Ly Tâm (F_cf = m*v^2 / R)
                             <------ [ Trọng Tâm G ] (m = 2.5kg)
                                     |
                                     | h = 35mm
                                     v
                  -------------------O-------------------
                 /                                       \
          [Bánh Xe Trái]               b = 225mm    [Bánh Xe Phải]
          (Điểm Tựa Lật)                             (Phản Lực N_R)

3. Tính toán mạch quang điện mảng 7 cảm biến TCRT5000

Mạch cảm biến gồm LED phát hồng ngoại ($V_F = 1.25\text{ V}, I_F = 37.5\text{ mA}$) và Phototransistor thu ($I_C = 1.3\text{ mA}$).

  • Điện trở hạn dòng phát: $$R_1 = \frac{V_{CC} - V_F}{I_F} = \frac{5 - 1.25}{37.5 \times 10^{-3}} = 100,\Omega$$
  • Điện trở phân áp ngõ ra thu: $$R_2 = \frac{V_{CC} - V_{CE(\text{sat})}}{I_C} = \frac{5 - 0.6}{1.3 \times 10^{-3}} = 3384,\Omega \implies \text{Chọn } R_2 = 3.3\text{ k}\Omega$$
  • Khoảng cách bố trí cảm biến: Góc phát $\alpha = 16^\circ$, góc thu $\beta = 30^\circ$, khoảng cách giữa emitter và detector $d_s = 3.8\text{ mm}$. Khoảng cách tối ưu từ cảm biến tới mặt sàn được xác định qua thực nghiệm và hình học là $h = 14\text{ mm}$, khoảng cách tâm 2 sensor liền kề $D = 15\text{ mm}$ để phủ trọn vạch line đen rộng $26\text{ mm}$ mà không gây chồng lấn tín hiệu.

Methodology & Quy trình triển khai

Dự án áp dụng quy trình phát triển Cơ điện tử chữ V (V-Model Mechatronics Development) kéo dài trong 12 tuần:

Tuần 1-3: Nghiên Cứu Tổng Quan & Lựa Chọn Linh Kiện
       \                                               / Tuần 10-12: Thực Nghiệm & Tinh Chỉnh PID
        Tuần 4-6: Thiết Kế Cơ Khí 3D (SolidWorks)     /
                 \                                   / Tuần 8-9: Lập Trình Nhúng & Điều Khiển
                  Tuần 7: Chế Tạo Khung Gầm & Mạch --+
Giai đoạn Nhiệm vụ chính Sản phẩm bàn giao (Deliverables)
Tuần 1 - 3 Khảo sát bài toán, tính toán động lực học, chọn phương án Báo cáo thông số kỹ thuật, chọn động cơ GA25, MCU Mega 2560
Tuần 4 - 6 Thiết kế 3D SolidWorks, tính dung sai lắp ghép $\varnothing 6H7/h6$ Bản vẽ gia công CNC chi tiết gá nhôm, bản cắt mica 2 tầng
Tuần 7 Gia công cơ khí, hàn mạch công suất và mạch cảm biến Khung xe hoàn chỉnh, thanh 7 sensor TCRT5000, khối nguồn pin kép
Tuần 8 - 9 Lập trình ngắt Encoder, thuật toán lấy mẫu ADC, Tuning PID Firmware điều khiển vi sai, giao tiếp timer interrupt $10\text{ ms}$
Tuần 10 - 12 Chạy thực nghiệm trên sa bàn, chống nhiễu, đánh giá sai số Bảng dữ liệu thực nghiệm, thời gian hoàn thành cung đường $27\text{ s}$

Implementation và kết quả

Development Process

1. Gia công cơ khí chính xác

  • Đồ gá động cơ: Sử dụng phôi nhôm nguyên khối kích thước $50 \times 32 \times 20\text{ mm}$, phay rãnh giữa và khoan lỗ bằng máy phay CNC chuyên dụng. Đảm bảo dung sai lắp ghép trục $\varnothing 6H7/h6$ và gờ định vị động cơ $P7/K7/h6$ nhằm triệt tiêu độ rơ lắc khi đổi chiều quay.
  • Thân xe: Cấu trúc tầng kép bằng vật liệu Mica dày $3\text{ mm}$. Tầng dưới bố trí tải trọng $2\text{ kg}$, cụm động cơ GA25 và bộ nguồn pin. Tầng trên gắn vi điều khiển Arduino Mega 2560 và module công suất L298N.

2. Thuật toán điều khiển nhúng trên Arduino ATmega2560

#include <Arduino.h>

// Định nghĩa chân phần cứng
const uint8_t PIN_ENA = 10, PIN_ENB = 5;
const uint8_t PIN_IN1 = 9,  PIN_IN2 = 8,  PIN_IN3 = 7,  PIN_IN4 = 6;
const uint8_t SENSOR_PINS[7] = {A0, A1, A2, A3, A4, A5, A6};

// Thông số bộ điều khiển PID
const double Kp_L = 10.0, Ki_L = 10.0, Kd_L = 5.0;
const double Kp_R = 10.0, Ki_R = 9.0,  Kd_R = 5.0;
const double BASE_SPEED_RPM = 260.0;

volatile long encLeftCount = 0, encRightCount = 0;
double errSumL = 0, lastErrL = 0;
double errSumR = 0, lastErrR = 0;

// Trọng số vị trí của 7 cảm biến TCRT5000
const int8_t WEIGHTS[7] = {-30, -20, -10, 0, 10, 20, 30};

int calculateLineError() {
    int weightedSum = 0;
    int activeSensors = 0;
    for (int i = 0; i < 7; i++) {
        int rawVal = analogRead(SENSOR_PINS[i]);
        if (rawVal > 512) { // Ngưỡng nhận diện line đen
            weightedSum += WEIGHTS[i];
            activeSensors++;
        }
    }
    if (activeSensors == 0) return 0; // Giữ nguyên trạng thái nếu mất line tạm thời
    return (weightedSum / activeSensors);
}

void computeMotorPID(double targetRPM_L, double targetRPM_R, double actualRPM_L, double actualRPM_R) {
    // PID Bánh Trái
    double errL = targetRPM_L - actualRPM_L;
    errSumL += errL * 0.01;
    double dErrL = (errL - lastErrL) / 0.01;
    int pwmL = constrain((int)(Kp_L * errL + Ki_L * errSumL + Kd_L * dErrL), 0, 255);
    lastErrL = errL;

    // PID Bánh Phải
    double errR = targetRPM_R - actualRPM_R;
    errSumR += errR * 0.01;
    double dErrR = (errR - lastErrR) / 0.01;
    int pwmR = constrain((int)(Kp_R * errR + Ki_R * errSumR + Kd_R * dErrR), 0, 255);
    lastErrR = errR;

    analogWrite(PIN_ENA, pwmL);
    analogWrite(PIN_ENB, pwmR);
}

Testing và validation

1. Khảo sát đặc tính phi tuyến của động cơ (Vòng hở vs Vòng kín)

Khi điều khiển vòng hở (Open-loop), sự mất cân bằng giữa hai động cơ dẫn đến sai số vận tốc nghiêm trọng. Bộ điều khiển PID vòng kín (Closed-loop) đã tuyến tính hóa hoàn toàn quan hệ giữa tín hiệu điều khiển và tốc độ thực tế.

Duty Cycle PWM (%) Vận tốc vòng hở Trái (v/p) Vận tốc vòng hở Phải (v/p) Độ lệch vòng hở (%) Độ lệch sau khi có PID (%)
10 14 10 28.57% < 1.0%
20 144 140 2.78% < 0.5%
40 260 260 0.00% < 0.2%
60 300 300 0.00% < 0.2%
80 320 320 0.00% < 0.1%
100 328 332 1.22% < 0.1% 
Tốc Độ (RPM)
  350 |                                              *---* (Bão hòa ~330 RPM)
  300 |                                    *---*---*
  250 |                           *---*---*
  200 |                  *---*---*
  150 |         *---*---*
  100 |        /
   50 |       /  <-- Vùng chết phi tuyến thấp (PWM < 15%)
    0 +------+---------+---------+---------+---------+-----> PWM (%)
      0      20        40        60        80       100

2. Phân tích đáp ứng bước (Step Response) của bộ điều khiển PID

  • Thời gian xác lập ($t_s$): $< 0.04\text{ s}$ khi nhận lệnh thay đổi tốc độ từ $0 \to 216\text{ vòng/phút}$.
  • Độ vọt lố ($%OS$): $< 5.0%$, triệt tiêu hoàn toàn dao động lắc đuôi xe (hunting oscillation).
  • Chu kỳ ngắt lấy mẫu: $T_s = 0.01\text{ s}$ ($100\text{ Hz}$) đồng bộ hoàn hảo với bộ ngắt timer của ATmega2560.
Tốc Độ Động Cơ (v/p)
  250 |                +--+ (Độ vọt lố < 5%)
  216 |               /    \------------------------------- (Giá trị đặt 216 v/p)
      |              /
  150 |             /
      |            /
   50 |           /
    0 +----------+----------------------------------------> Thời gian (s)
      0       0.04s (Thời gian xác lập cực nhanh)

3. Nhật ký thử nghiệm sa bàn thực tế

Ngày thử nghiệm Số lần chạy Tỷ lệ thành công Thời gian nhanh nhất Nguyên nhân lỗi & Biện pháp khắc phục
17/11 10 5/10 (50%) $40\text{ s}$ Cảm biến bị nhiễu quang; Xe trượt bánh ở cua gắt.
19/11 10 7/10 (70%) $30\text{ s}$ Lắp thêm hộp chắn sáng cho mảng TCRT5000; Tinh chỉnh lại $K_p$.
14/12 10 7/10 (70%) $27\text{ s}$ Dây encoder bị lỏng tiếp xúc; Gia cố lại giắc cắm chống rung.
15/12 10 9/10 (90%) $27\text{ s}$ Thay thế module hạ áp công suất cấp nguồn riêng 5V/9V cho MCU.

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

+-------------------------------------------------------------------------+
|                  SO SÁNH MỤC TIÊU VÀ KẾT QUẢ THỰC NGHIỆM                |
|                                                                         |
|  Chỉ Tiêu                   Mục Tiêu Đề Ra        Kết Quả Đạt Được      |
|  ---------------------------------------------------------------------  |
|  Tải Trọng Mang Theo        2.0 kg                2.0 kg (Ổn định)      |
|  Vận Tốc Trung Bình         0.40 m/s              0.42 m/s (+5%)        |
|  Thời Gian Sa Bàn           < 30 s                27 s                  |
|  Bán Kính Cua Nhỏ Nhất      R = 500 mm            R = 500 mm (Không lật)|
|  Độ Vọt Lố Động Cơ          < 10%                 < 5%                  |
|  Độ Rơ Trục Cơ Khí          < 0.05 mm             Dung sai H7/h6 chuẩn  |
+-------------------------------------------------------------------------+

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

  1. Cải tiến mảng cảm biến chuyên dụng thay thế module thương mại: Thay vì dùng thanh cảm biến tích hợp sẵn BFD-1000 (khoảng cách sensor cố định, tín hiệu digital thô), nhóm đã tự thiết kế mảng 7 cảm biến TCRT5000 analog với thuật toán phân vùng ngưỡng động. Khoảng cách $D = 15\text{ mm}$ được tính toán chính xác theo góc mở quang học, giảm $35%$ tỷ lệ mất line ở góc cua $90^\circ$.
  2. Kiến trúc nguồn cách ly chống sụt áp: Thiết kế hệ thống 2 đường nguồn riêng biệt: Khối pin Li-ion $4S$ ($16.8\text{ V}$) qua mạch Buck hạ áp $12\text{ V}$ dòng cao chuyên cấp cho động cơ qua driver L298N; Khối pin $9\text{ V}$ độc lập cấp cho vi điều khiển Arduino Mega. Cấu trúc này triệt tiêu hoàn toàn hiện tượng reset vi điều khiển do sụt áp khi động cơ đảo chiều hoặc khởi động tải nặng $2\text{ kg}$.
  3. Chiến lược điều khiển lai (Hybrid Control Strategy) tại điểm giao cắt: Kết hợp bộ điều khiển vi sai PID liên tục với kỹ thuật đếm thời gian (Dead-reckoning Timer) tại các điểm giao cắt hình số 8, giúp xe duy trì hướng di chuyển thẳng trong $0.3\text{ s}$ mà không bị chuyển hướng sai do đọc nhầm nhánh line giao nhau.

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

Khả năng thương mại hóa và Ứng dụng

  • Hệ thống xe tự hành AGV trong nhà xưởng: Vận chuyển khay linh kiện, bán thành phẩm giữa các chuyền sản xuất may mặc, điện tử với đường dẫn băng từ hoặc dải phản quang dán sàn.
  • Robot phục vụ nhà hàng, bệnh viện: Vận chuyển đồ ăn, hồ sơ bệnh án, thuốc men dọc theo hành lang định sẵn với khả năng chịu tải $2\text{ - }5\text{ kg}$.
                 BẢNG PHÂN BỔ CHI PHÍ LINH KIỆN (BOM)
+------------------------------------+----------+-----------------------+
| Linh Kiện / Thiết Bị               | Số Lượng | Thành Tiền (VND)      |
+------------------------------------+----------+-----------------------+
| Động cơ DC GA25 kèm Encoder        | 2 cái    | 320,000               |
| Mạch điều khiển Arduino Mega 2560  | 1 bo     | 210,000               |
| Mạch công suất Driver L298N        | 1 mạch   | 45,000                |
| Cảm biến TCRT5000 + Linh kiện rời  | 7 bộ     | 50,000                |
| Gia công nhôm CNC + Khung Mica     | 1 bộ     | 250,000               |
| Bộ Pin Li-ion 4S + Pin 9V + Buck   | 1 bộ     | 180,000               |
+------------------------------------+----------+-----------------------+
| TỔNG CHI PHÍ PHẦN CỨNG             |          | 1,055,000 VND (~$45)  |
+------------------------------------+----------+-----------------------+

So với các kit AGV công nghiệp nhập khẩu có giá từ 15 đến 30 triệu VND, giải pháp tự chế tạo này tiết kiệm hơn $90%$ chi phí nhưng vẫn đảm bảo độ chính xác bám quỹ đạo cho các doanh nghiệp vừa và nhỏ (SMEs).

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

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

  • Độ đồng trục cơ khí: Việc lắp ráp 2 động cơ độc lập qua đồ gá nhôm thủ công vẫn tồn tại sai lệch góc nhỏ (< $1^\circ$), dẫn đến xu hướng lệch nhẹ khi chạy chế độ vòng hở.
  • Độ nhạy quang học ngoài trời: Dàn cảm biến TCRT5000 hoạt động tối ưu trong nhà; khi bị ánh nắng chiếu trực tiếp với cường độ cao (> 10,000 lux), cảm biến có thể bị bão hòa quang.

Hướng nâng cấp đề xuất

  1. Tích hợp cảm biến quán tính IMU (MPU6050): Sử dụng bộ lọc Kalman kết hợp dữ liệu Gyroscope/Accelerometer với Encoder để bù góc trượt tức thời khi xe vào cua ở tốc độ cao $> 0.8\text{ m/s}$.
  2. Nâng cấp thuật toán điều khiển: Ứng dụng giải thuật Self-tuning Fuzzy PID hoặc Reinforcement Learning (Q-learning) cho phép xe tự tối ưu hóa thông số vận tốc theo từng đoạn thẳng và đoạn cong của sa bàn sau mỗi vòng chạy thử.
  3. Mở rộng cảm biến dẫn đường từ tính (Magnetic Tape Guidance): Thay thế hoặc kết hợp cảm biến quang với dải từ trở để robot hoạt động bền bỉ trong môi trường kho bãi nhiều bụi bẩn.

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

  • Sinh viên ngành Cơ điện tử, Tự động hóa: Tài liệu mẫu chuẩn mực về phương pháp luận thiết kế hệ thống từ cơ học, điện - điện tử đến thuật toán điều khiển tự động PID.
  • Kỹ sư phát triển Robot & AGV: Cung cấp đầy đủ công thức tính toán động lực học, dung sai gia công nhôm CNC, thông số quang học cảm biến và mã nguồn thực thi đã được kiểm chứng.
  • Các doanh nghiệp sản xuất SME: Mô hình tham chiếu chi phí thấp để tự động hóa vận chuyển nội bộ quy mô vừa và nhỏ.

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

1. Yêu cầu kỹ thuật phần cứng tối thiểu để tái lập dự án là gì?

Cần tối thiểu 1 bo mạch vi điều khiển hỗ trợ ngắt ngoài và Timer 16-bit (khuyên dùng Arduino Mega 2560 hoặc STM32F103C8T6), 2 động cơ DC giảm tốc có Encoder $\ge 11\text{ xung/vòng}$, 1 mạch cầu H dòng đỉnh $\ge 2\text{A}$ (L298N hoặc IBT-2), và mảng tối thiểu 5 cảm biến hồng ngoại TCRT5000.

2. Tại sao nhóm chọn cấu trúc điều khiển tập trung thay vì phân cấp?

Cấu trúc điều khiển tập trung (Centralized Control) sử dụng 1 vi điều khiển ATmega2560 duy nhất giúp tiết kiệm không gian lắp đặt, giảm khối lượng xe, hạn chế độ trễ truyền thông qua bus I2C/CAN và giảm đáng kể chi phí phần cứng, hoàn toàn đáp ứng tốt tần số lấy mẫu $100\text{ Hz}$ của bài toán.

3. Làm thế nào để loại bỏ nhiễu ánh sáng môi trường tác động vào cảm biến TCRT5000?

Cần thực hiện đồng thời 3 giải pháp: (1) Thiết kế hộp che chắn quang học bao quanh dàn sensor; (2) Căn chỉnh khoảng cách quang học $h = 14\text{ mm}$ đúng vùng tiêu cự giao thoa; (3) Sử dụng thuật toán lọc trung vị và trừ ngưỡng ánh sáng nền trước khi tính toán trọng số vị trí.

4. Giải pháp chống sụt nguồn khi động cơ đề-pa mang tải 2kg?

Sử dụng 2 khối nguồn độc lập: 1 pack pin Li-ion 4S chuyên dụng cho mạch lực động cơ (qua Driver L298N) và 1 khối pin 9V riêng biệt cấp cho vi điều khiển. Bổ sung tụ hóa dung lượng lớn ($1000,\mu\text{F}$) tại đầu vào Driver để lọc xung áp ngược.

5. Chi phí dự toán và thời gian triển khai một mô hình tương tự?

Tổng chi phí phần cứng dao động từ $1,000,000$ đến $1,200,000\text{ VND}$. Thời gian thiết kế, gia công và tinh chỉnh thuật toán hoàn chỉnh mất khoảng 8 đến 12 tuần làm việc nhóm.

Kết luận

Đồ án môn học "Thiết Kế Hệ Thống Cơ Điện Tử: Robot Dò Line" đã hoàn thành xuất sắc toàn bộ các mục tiêu đặt ra: chế tạo thành công mẫu robot 3 bánh mang tải trọng $2.0\text{ kg}$, vận hành bám đường chính xác với vận tốc $0.42\text{ m/s}$ và thời gian hoàn thành sa bàn phức tạp chỉ $27\text{ s}$. Thành công của dự án khẳng định tầm quan trọng của việc kết hợp chặt chẽ giữa tính toán cơ học lý thuyết, thiết kế điện tử chống nhiễu và thuật toán điều khiển PID vòng kín tốc độ cao. Đây là nền tảng kỹ thuật vững chắc để phát triển lên các hệ thống robot tự hành AGV công nghiệp thông minh và linh hoạt hơn trong tương lai.