Giới thiệu dự án

Trong bối cảnh công nghiệp 4.0 và chuyển đổi số quy trình sản xuất, robot công nghiệp (Industrial Robots - IR) đóng vai trò then chốt nhằm nâng cao năng suất, giải phóng sức lao động và giảm thiểu rủi ro trong môi trường độc hại. Theo thống kê từ Liên đoàn Robot Quốc tế (IFR), mật độ robot trong các ngành chế tạo toàn cầu tăng trưởng bình quân trên 12%/năm, với xu hướng chuyển dịch mạnh mẽ từ các robot định vị chu trình cố định (Fixed-sequence robots) sang các robot cộng tác (Collaborative Robots - Cobots) có khả năng làm việc tương tác an toàn với con người trong không gian làm việc động.

Tuy nhiên, phần lớn cánh tay robot công nghiệp truyền thống trong các dây chuyền sản xuất tự động hoạt động theo nguyên lý điều khiển vòng hở hoặc vòng kín vị trí thuần túy mà không có khả năng cảm nhận lực tương tác từ môi trường. Khi xảy ra va chạm bất ngờ với vật thể hoặc người thao tác, hệ thống không kịp thời nhận diện lực cản, dẫn đến nguy cơ hỏng hóc cơ cấu chấp hành hoặc mất an toàn lao động nghiêm trọng. Hơn nữa, việc lập trình quỹ đạo cho robot truyền thống đòi hỏi kỹ sư chuyên môn cao, tiêu tốn thời gian hiệu chỉnh tọa độ điểm-điểm (Point-to-point) thay vì có thể trực tiếp cầm nắm để "dạy học" (Direct teaching / Lead-through programming).

Đề tài "Cánh tay máy tương tác 3 bậc tự do" (Interactive 3-DOF Robotic Manipulator) được nghiên cứu và chế tạo nhằm giải quyết triệt để các hạn chế trên thông qua việc tích hợp cảm biến mô-men xoắn (Torque Sensor) và giải thuật điều khiển phản hồi lực - vị trí kết hợp.

graph TD
    A[Người vận hành / Môi trường] -->|Lực tương tác F / Momen M| B(Cảm biến Momen Strain Gauge)
    B -->|Tín hiệu mV/V| C(Mạch khuếch đại 24-bit HX711)
    C -->|Tín hiệu số SPI| D[Vi điều khiển Slave ATmega328P]
    E[Giao diện PC GUI / C#] <-->|Giao tiếp UART/Serial| F[Vi điều khiển Master Arduino Mega 2560]
    F <-->|Giao tiếp liên VĐK I2C/Serial| D
    D -->|PWM / Direction| G[Mạch công suất Driver DC]
    G -->|Điện áp 12V-24V| H[Động cơ DC Servo + Hộp giảm tốc 1:180]
    H -->|Bộ truyền đai răng S5M U=1:3| I[Các khớp khâu 1, 2, 3 Robot]
    I -->|Encoder quang học xung AB| D

Mục tiêu nghiên cứu cụ thể

  1. Thiết kế cơ khí hoàn chỉnh: Tính toán tải trọng, độ bền kết cấu, truyền động đai răng và tối ưu hóa khối lượng động học cho cơ cấu cánh tay máy không gian 3 bậc tự do (3-DOF) dạng khớp quay (Revolute - R-R-R) kết hợp khâu công tác cuối.
  2. Nghiên cứu chế tạo cảm biến mô-men xoắn: Ứng dụng cầu điện trở biến dạng (Wheatstone Strain Gauge Bridge) kết hợp vi mạch chuyển đổi ADC chuyên dụng để đo lường mô-men uốn/xoắn tại các khớp theo thời gian thực.
  3. Phát triển phần cứng điều khiển phân tán: Xây dựng kiến trúc Master-Slave sử dụng vi điều khiển ATmega2560 và ATmega328P, đảm bảo cách ly tác vụ tính toán động học và vòng lặp điều khiển PID vị trí/lực tần số cao.
  4. Xây dựng giải thuật điều khiển động học và tương tác: Giải bài toán động học thuận (Forward Kinematics), động học nghịch (Inverse Kinematics) bằng phương pháp Denavit-Hartenberg (D-H), thiết lập bộ điều khiển PID chống bão hòa tích phân (Anti-windup) và phản hồi lực an toàn.
  5. Thiết kế phần mềm giao diện giám sát (GUI): Xây dựng bảng điều khiển trực quan trên máy tính giúp giám sát tọa độ các khớp, hiển thị biểu đồ đáp ứng xung encoder và hỗ trợ chế độ dạy học tương tác (Interactive Teaching Mode).

Phạm vi và chỉ tiêu kỹ thuật kỳ vọng

  • Tải trọng danh định (Payload): $0.5\text{ kg}$ tại tầm với lớn nhất.
  • Tốc độ làm việc đầu công tác: Đạt $v \ge 0.06\text{ m/s}$, tốc độ quay trục khớp $n_{\text{trục}} = 16\text{ rpm}$.
  • Độ chính xác lặp lại vị trí: Sai số $\le \pm 5\text{ mm}$.
  • Khả năng tương tác an toàn: Tự động giảm tốc hoặc dừng cơ cấu khi mô-men cản vượt ngưỡng ngưỡng giới hạn $M_{\text{limit}}$ cài đặt.
  • Phạm vi ứng dụng: Đào tạo thực hành Robot học, dây chuyền gắp-đặt chi tiết nhỏ (Pick-and-place), kiểm tra biên dạng sản phẩm và kiểm tra khuôn mẫu công nghiệp.

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

Phân tích hiện trạng công nghệ

Trong kỹ thuật robot, việc lựa chọn cấu hình hình học quyết định trực tiếp đến không gian làm việc (Workspace), độ cứng vững và thuật toán điều khiển:

Cấu hình Robot Ưu điểm kỹ thuật Nhược điểm Khả năng tương tác lực
Tọa độ Đề-các (Cartesian) Kết cấu cứng vững cao, thuật toán động học tuyến tính đơn giản. Vùng làm việc hạn chế so với kích thước khung, cồng kềnh, không linh hoạt. Kém, khó gắn cảm biến phản hồi theo góc quay.
Tọa độ Trụ (Cylindrical) Vùng làm việc dạng trụ tròn, độ cứng vững hướng kính tốt. Bị giới hạn không gian ở tâm, khó tiếp cận các góc nghiêng phức tạp. Trung bình, chỉ đo được lực dọc trục tịnh tiến.
SCARA Tốc độ cao, tối ưu tuyệt đối cho lắp ráp trên mặt phẳng ngang ($XY$). Không thể thay đổi hướng góc nghiêng trong không gian 3D, bậc tự do hạn chế. Tốt trên mặt phẳng, kém trong không gian 3 chiều.
Khớp bản lề / Tay người (Articulated / Anthropomorphic) Không gian làm việc cực đại so với thể tích cơ cấu, khả năng xoay linh hoạt tiếp cận mọi tọa độ. Mô hình động học phi tuyến tính phức tạp, biến dạng do mô-men uốn tại các khớp lớn. Rất cao, tối ưu hóa cho tương tác đa hướng và dẫn động dạy học.

Nhóm nghiên cứu quyết định lựa chọn cấu hình robot dạng cánh tay người (Articulated R-R-R) nhằm tối ưu hóa tính linh hoạt, giảm thiểu kích thước bệ đỡ và tạo điều kiện tối ưu để tích hợp cảm biến mô-men tại từng trục quay.

Ma trận yêu cầu hệ thống (MoSCoW)

  • Must-have (Bắt buộc): Cơ cấu 3 khớp quay dẫn động độc lập; vòng lặp PID điều khiển vị trí khép kín; cảm biến mô-men đo tải trọng; cơ chế ngắt khẩn cấp khi va chạm; giao diện GUI điều khiển tọa độ.
  • Should-have (Nên có): Chế độ dạy học bằng cách kéo thả cánh tay (Direct Manual Guidance); bù trọng trường tự động dựa trên mô hình động lực học tĩnh; hiển thị đồ thị sai số thời gian thực.
  • Could-have (Có thể mở rộng): Tích hợp cánh tay gắp khí nén/servo ở khâu chấp hành cuối; lưu trữ quỹ đạo chuyển động vào bộ nhớ EEPROM/Flash để lặp lại chu trình không cần PC.
  • Won't-have (Chưa thực hiện): Điều khiển bù trễ ma sát phi tuyến nâng cao; nhận dạng vật thể bằng thị giác máy tính 3D (Machine Vision).

Thiết kế hệ thống cơ - điện

1. Cơ khí chính xác và truyền động

  • Vật liệu chế tạo: Thân và cánh tay đòn khớp 2, khớp 3 sử dụng hợp kim nhôm Al 6061 gia công CNC với các rãnh gân tăng cứng dày $3\text{ mm}$, vừa đảm bảo triệt tiêu ứng suất tập trung uốn vừa giảm mô-men quán tính ($I_{yy}, I_{zz}$). Khung bệ đế ghép từ 3 tấm thép dày nhằm hạ thấp trọng tâm, chống lật khi vươn xa.
  • Trục truyền động: Chế tạo từ thép hợp kim C45 nhiệt luyện, ứng suất cắt cho phép $[\tau] = 63\text{ MPa}$. Đường kính trục thiết kế tính toán theo mô-men tương đương:

$$M_{\text{tđ}} = \sqrt{M_u^2 + 0.75 M_{x}^2} \implies d \ge \sqrt[3]{\frac{M_{\text{tđ}}}{0.1 [\sigma]}}$$

Kết quả tính toán đưa ra đường kính trục khớp 1: $d_1 = 25\text{ mm}$; trục khớp 2 và 3: $d_2 = d_3 = 10\text{ mm}$; trục đầu công tác: $d_4 = 8\text{ mm}$.

  • Bộ truyền đai răng: Sử dụng đai răng đồng bộ S5M (bước răng $P = 5\text{ mm}$, bề rộng đai $b = 10\text{ mm}$) kết hợp bánh đai dẫn $z_1 = 16$ răng ($D_1 = 25\text{ mm}$) và bánh đai bị dẫn $z_2 = 48$ răng ($D_2 = 75\text{ mm}$), mang lại tỉ số truyền $U = 3:1$ êm ái, khử hoàn toàn hiện tượng trượt bước và giảm rung động truyền từ motor.
  • Hệ thống ổ đỡ: Khớp 1 chịu tải trọng dọc trục và mô-men lật lớn sử dụng ổ bi đỡ-chặn một dãy 6205 ($d=25\text{ mm}, D=52\text{ mm}, B=15\text{ mm}$). Khớp 2 và 3 sử dụng cặp ổ bi đỡ-chặn 6200 ($d=10\text{ mm}, D=30\text{ mm}, B=9\text{ mm}$) có nắp chặn chắn bụi và triệt tiêu độ rơ dọc trục.

2. Cảm biến lực và mạch đo

  • Module cảm biến: 4 lá điện trở dán biến dạng (Foil Strain Gauges, điện trở $350,\Omega$, hệ số biến dạng Gauge Factor $K \approx 2.0$) dán đối xứng tại vùng tập trung ứng suất uốn lớn nhất của trục/gá khớp (được kiểm chứng qua mô phỏng phần tử hữu hạn ANSYS Mechanical).
  • Mạch đo Wheatstone Full-Bridge: Cung cấp khả năng tự bù nhiệt độ môi trường, xuất tín hiệu vi sai điện áp nhỏ cỡ $\text{mV}$.
  • Khuếch đại và số hóa: IC chuyên dụng HX711 chứa bộ tiền khuếch đại nhiễu thấp (PGA gain 128) và bộ chuyển đổi Analog-to-Digital 24-bit độ phân giải cao, truyền dữ liệu nối tiếp 2 dây (Clock - Data) về vi điều khiển.
       [ +E (Excitation +5V) ]
                |
          +-----+-----+
          |           |
       [ R1 ]       [ R2 ]  (Strain Gauges)
          |           |
[ Output + ]          [ Output - ] ---> Tín hiệu vi sai tới HX711 (A+ / A-)
          |           |
       [ R4 ]       [ R3 ]
          |           |
          +-----+-----+
                |
       [ -E (GND / 0V) ]

3. Bảng thông số công nghệ & Phần mềm hỗ trợ

Phân hệ Công nghệ / Linh kiện Phiên bản / Thông số kỹ thuật Vai trò hệ thống
CAD/CAM SolidWorks 2014 SP4.0 Thiết kế 3D, trích xuất mô-men quán tính ($I_{xx}, I_{yy}, I_{zz}$) và trọng tâm chi tiết
FEA Simulation ANSYS Workbench 15.0 Phân tích biến dạng đàn hồi, phân bố ứng suất von-Mises trên thân cảm biến
VĐK Master Arduino Mega 2560 ATmega2560 @ 16MHz, 8KB SRAM Nhận lệnh GUI, tính toán động học ngược (IK), lập quỹ đạo nội suy
VĐK Slave Arduino Uno / Nano ATmega328P @ 16MHz, 2KB SRAM Chạy vòng ngắt thời gian thực Timer2 cho thuật toán PID vị trí và đọc HX711
Động cơ & Driver DC Servo Motor + L298N/MOSFET Động cơ $17\text{W}$, Hộp số hành tinh $U=180$, Encoder 334 xung/vòng Cơ cấu chấp hành chuyển động các khớp
Nguồn cấp Switching Power Supply + LM2596 Input $24\text{V DC} \to$ Regulated $5\text{V/3A}, 12\text{V/5A}$ Cung cấp nguồn độc lập chống sụt áp và nhiễu sóng hài cho mạch logic

Phương pháp tính toán Động học (Kinematics Methodology)

Áp dụng phương pháp Denavit-Hartenberg (D-H) chuẩn, gắn các hệ trục tọa độ $O_i x_i y_i z_i$ lên từng khâu của robot:

Khâu ($i$) Góc xoay $\theta_i$ Khoảng dịch chuyển $d_i$ Độ dài khâu $a_i$ Góc xoắn $\alpha_i$
1 $\theta_1^*$ (Khớp 1) $d_1 = 120\text{ mm}$ $a_1 = 0\text{ mm}$ $+90^\circ$
2 $\theta_2^*$ (Khớp 2) $d_2 = 0\text{ mm}$ $a_2 = 175\text{ mm}$ $0^\circ$
3 $\theta_3^*$ (Khớp 3) $d_3 = 0\text{ mm}$ $a_3 = 115\text{ mm}$ $0^\circ$
4 (Tool) $\theta_4^*$ (Công tác) $d_4 = 0\text{ mm}$ $a_4 = 130\text{ mm}$ $0^\circ$

Ma trận biến đổi thuần nhất tổng quát giữa hai khâu liên tiếp:

$$^{i-1}T_i = \begin{bmatrix} \cos\theta_i & -\sin\theta_i\cos\alpha_i & \sin\theta_i\sin\alpha_i & a_i\cos\theta_i \ \sin\theta_i & \cos\theta_i\cos\alpha_i & -\sin\theta_i\sin\alpha_i & a_i\sin\theta_i \ 0 & \sin\alpha_i & \cos\alpha_i & d_i \ 0 & 0 & 0 & 1 \end{bmatrix}$$

Ma trận động học thuận toàn cục từ gốc đến điểm công tác:

$$^0T_4 = ,^0T_1(\theta_1) \cdot ,^1T_2(\theta_2) \cdot ,^2T_3(\theta_3) \cdot ,^3T_4(\theta_4)$$

Giải bài toán động học ngược (Inverse Kinematics) bằng phương pháp hình học giải tích: Tách góc quay $\theta_1 = \text{atan2}(P_y, P_x)$, sau đó giải phương trình phẳng lượng giác cho $\theta_2$ và $\theta_3$ dựa trên định lý hàm cosin, đảm bảo robot tiếp cận tọa độ đích $(P_x, P_y, P_z)$ trong không gian với thời gian tính toán $< 2\text{ ms}$ trên vi điều khiển 8-bit.

Implementation và kết quả

Quy trình phát triển và Thuật toán điều khiển

Hệ thống điều khiển nhúng được lập trình bằng C/C++ tối ưu hóa thời gian thực. Để loại bỏ hiện tượng vọt lố (overshoot) do tích lũy sai số khi tải thay đổi đột ngột, giải thuật PID số hóa kết hợp khâu chống bão hòa tích phân (Anti-windup) được triển khai trực tiếp bên trong ngắt định thời $10\text{ ms}$ ($100\text{ Hz}$):

// C++ Implementation of Discrete Joint Position PID with Anti-Windup
struct JointPID {
    float Kp, Ki, Kd;
    float setpoint;
    float integral;
    float prev_error;
    float out_min, out_max;
};

float compute_PID(JointPID &pid, float current_pos, float dt) {
    float error = pid.setpoint - current_pos;
    
    // Proportional term
    float P_out = pid.Kp * error;
    
    // Integral term with conditional clamping (Anti-windup)
    pid.integral += error * dt;
    float I_out = pid.Ki * pid.integral;
    
    // Derivative term (on measurement error)
    float derivative = (error - pid.prev_error) / dt;
    float D_out = pid.Kd * derivative;
    
    // Total raw control signal
    float output = P_out + I_out + D_out;
    
    // Clamping output to PWM limits [-255, 255]
    if (output > pid.out_max) {
        output = pid.out_max;
        pid.integral -= error * dt; // Prevent integral accumulation
    } else if (output < pid.out_min) {
        output = pid.out_min;
        pid.integral -= error * dt;
    }
    
    pid.prev_error = error;
    return output;
}

Tham số bộ điều khiển PID được xác định sơ bộ bằng phương pháp thực nghiệm Ziegler-Nichols dạng vòng kín (tăng $K_p$ đến điểm dao động giới hạn $K_u$, đo chu kỳ $T_u$), sau đó tinh chỉnh trực tiếp trên phần cứng:

  • Khớp 1: $K_p = 3.82$, $K_i = 0.045$, $K_d = 0.85$
  • Khớp 2: $K_p = 5.20$, $K_i = 0.080$, $K_d = 1.25$ (Yêu cầu $K_p$ cao hơn do chịu mô-men trọng trường lớn nhất khi duỗi thẳng)
  • Khớp 3: $K_p = 4.10$, $K_i = 0.060$, $K_d = 0.95$
+-----------------------------------------------------------------------+
|                       MA TRẬN KẾT NỐI PHẦN CỨNG                       |
+-----------------------------------------------------------------------+
| [Arduino Mega 2560] (Master)                                          |
|    |-- Serial0 (USB) <========> PC GUI (C# WinForms Application)      |
|    |-- Serial1 (Tx1/Rx1) <====> Arduino Uno (Slave 1: Joint 1 & 2)    |
|    |-- Serial2 (Tx2/Rx2) <====> Arduino Nano (Slave 2: Joint 3 & Tool)|
+-----------------------------------------------------------------------+
| [Arduino Uno/Nano] (Slaves)                                           |
|    |-- Pin D2, D3 (INT0, INT1) <--- Optical Encoder Channel A/B       |
|    |-- Pin D4, D5 (GPIO)       <--- HX711 (PD_SCK, DOUT) Torque ADC   |
|    |-- Pin D9, D10 (PWM/Dir)   ---> L298N Motor H-Bridge Driver       |
+-----------------------------------------------------------------------+

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

Thử nghiệm đáp ứng vị trí được tiến hành độc lập trên từng khớp với hai kịch bản xung đặt: $SP_1 = 3240\text{ xung}$ (tương ứng dịch chuyển góc $45^\circ$) và $SP_2 = 6480\text{ xung}$ (tương ứng dịch chuyển góc $90^\circ$).

Thông số đánh giá Khớp 1 ($SP = 6480$) Khớp 2 ($SP = 6480$) Khớp 3 ($SP = 6480$) Khâu công tác ($SP = 300$)
Thời gian tăng (Rise Time $t_r$) $0.85\text{ s}$ $1.10\text{ s}$ $0.92\text{ s}$ $0.25\text{ s}$
Thời gian xác lập (Settling Time $t_s$) $1.20\text{ s}$ $1.55\text{ s}$ $1.30\text{ s}$ $0.40\text{ s}$
Độ vọt lố (Overshoot $M_p$) $2.8%$ $4.6%$ $3.2%$ $1.5%$
Sai số xác lập tĩnh ($e_{ss}$) $\pm 8\text{ xung}$ ($\approx 0.11^\circ$) $\pm 12\text{ xung}$ ($\approx 0.16^\circ$) $\pm 9\text{ xung}$ ($\approx 0.12^\circ$) $\pm 1\text{ xung}$
Sai số vị trí đầu cuối ($XY$) — — — $\pm 3.2\text{ mm}$ (Mục tiêu $\le \pm 5\text{ mm}$)

Hiệu chuẩn cảm biến mô-men xoắn cho thấy hệ số tương quan tuyến tính giữa lực tác dụng và điện áp đầu ra HX711 đạt $R^2 = 0.994$. Thời gian trễ phát hiện lực va chạm khi robot đụng vật cản là $18\text{ ms}$, kích hoạt ngắt an toàn ngắt tín hiệu PWM động cơ trong vòng dưới $25\text{ ms}$, bảo vệ an toàn cơ cấu.

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

  1. Cảm biến mô-men xoắn tích hợp chi phí thấp: Thay vì sử dụng cảm biến lực 6 trục công nghiệp đắt đỏ (như ATI Force/Torque sensors có giá hàng nghìn USD), đề tài đã tự thiết kế kết cấu cơ khí đàn hồi và tích hợp cầu Strain Gauge + HX711 với tổng chi phí gia công dưới 50 USD, mở ra giải pháp khả thi cho các mô hình nghiên cứu và robot giáo dục.
  2. Kiến trúc điều khiển Master-Slave phân tán: Tách rời hoàn toàn luồng tính toán động học phi tuyến (trên Master Mega 2560) và luồng ngắt điều khiển PID tần số $100\text{ Hz}$ (trên các vi điều khiển Slave), loại bỏ hiện tượng "nghẽn cổ chai" tài nguyên phần cứng trên kiến trúc vi xử lý giá rẻ.
  3. Cơ chế tương tác lực hai chiều (Physical Human-Robot Interaction): Cánh tay máy cho phép người vận hành cầm trực tiếp vào khâu chấp hành để dẫn đường; hệ thống đo lực cản và điều khiển động cơ trợ lực chuyển động mượt mà, ghi nhận các điểm mút quỹ đạo vào bộ nhớ mà không cần viết mã lệnh phức tạp.

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

Tình huống ứng dụng thực tế

  • Đào tạo kỹ thuật chuyên sâu: Làm trang thiết bị thí nghiệm cho sinh viên các ngành Cơ điện tử, Tự động hóa, Kỹ thuật Robot thực hành các môn học: Lý thuyết điều khiển tự động, Động học Robot, Vi điều khiển và Kỹ thuật cảm biến.
  • Dây chuyền lắp ráp cơ khí chính xác nhẹ: Lắp ráp các linh kiện điện tử, linh kiện nhựa có kiểm soát lực nhấn; tự động ngắt nếu có chi tiết lắp lệch khớp để chống vỡ sản phẩm.
  • Kiểm tra biên dạng và đo kiểm tự động: Di chuyển đầu dò tiếp xúc nhẹ nhàng dọc theo bề mặt cong của chi tiết hoặc khuôn mẫu dập để quét biên dạng mà không gây trầy xước bề mặt.

Quy trình triển khai và lắp đặt

  1. Cân chỉnh cơ khí (Mechanical Zeroing): Gá đặt robot lên mặt bàn phẳng cố định; đưa các khớp về vị trí gốc vật lý (Home Position) bằng công tắc hành trình quang/từ.
  2. Hiệu chuẩn cảm biến lực (Torque Calibration): Thực hiện cân tải trọng tĩnh (0g, 100g, 200g, 500g) treo tại đầu công tác để hiệu chỉnh giá trị Scale Factor của HX711 và lưu vào bộ nhớ EEPROM.
  3. Cấu hình phần mềm: Kết nối cáp USB Serial với máy tính; mở phần mềm GUI C#; kiểm tra giao tiếp Ping Master-Slave; thiết lập các ngưỡng giới hạn mô-men an toàn ($M_{\text{max}}$).
  4. Vận hành thử nghiệm: Thực hiện lệnh di chuyển tự động (Auto trajectory) hoặc chuyển sang chế độ dẫn đường bằng tay (Manual Lead-through) để kiểm tra phản hồi lực.

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

Hạn chế kỹ thuật

  • Vật liệu và độ cứng vững: Do giới hạn gia công xưởng thực hành, một số khớp nối sử dụng phương pháp lắp ghép then-chốt có thể phát sinh độ rơ cơ khí nhỏ sau thời gian dài hoạt động liên tục.
  • Băng thông vi điều khiển 8-bit: Tần số xử lý $16\text{ MHz}$ của chip ATmega khiến việc nâng tần số lấy mẫu ngắt PID lên mức $\text{kHz}$ bị hạn chế.
  • Độ phân giải động lực học: Chưa tích hợp bộ lọc Kalman để triệt tiêu hoàn toàn nhiễu rung cơ học tần số cao trên tín hiệu cảm biến tải trọng khi động cơ quay nhanh.

Kế hoạch nâng cấp tương lai

  • Nâng cấp vi xử lý điều khiển trung tâm lên dòng ARM Cortex-M4/M7 (STM32F4/STM32H7) hoặc SoC chạy ROS (Robot Operating System) trên nền tảng Raspberry Pi 4 / Jetson Nano.
  • Ứng dụng hộp giảm tốc sóng điều hòa (Harmonic Drive) hoặc Cycloidal Drive không độ rơ thay cho bộ truyền đai răng, nâng độ chính xác lặp lại đạt mức $\pm 0.05\text{ mm}$.
  • Phát triển giải thuật điều khiển trở kháng nâng cao (Impedance Control / Admittance Control) giúp cánh tay robot đạt độ mềm dẻo (Compliance) hoàn hảo khi va chạm với vật thể đàn hồi.

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

  • Sinh viên & Học viên kỹ thuật: Tiếp cận một tài liệu nghiên cứu hoàn chỉnh từ khâu giải tích toán học, mô phỏng FEM trên ANSYS, thiết kế CAD trên SolidWorks đến lập trình điều khiển nhúng thực tế.
  • Kỹ sư R&D & Makers: Nắm vững sơ đồ nguyên lý mạch đo Wheatstone-HX711, kiến trúc Master-Slave liên vi điều khiển và code mẫu PID Anti-windup có thể tái sử dụng cho các dự án tự động hóa khác.
  • Doanh nghiệp vừa và nhỏ (SMEs): Có cơ sở thiết kế để chế tạo các module robot gắp đặt hoặc kiểm thử chất lượng sản phẩm nội bộ với mức đầu tư phần cứng thấp hơn 80% so với mua robot nhập khẩu.
  • Giảng viên & Nhà nghiên cứu: Sử dụng làm nền tảng mô hình thực nghiệm (Testbed) để triển khai các thuật toán điều khiển hiện đại: Fuzzy-PID, Adaptive Control, Trượt (Sliding Mode Control).

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

1. Cần những yêu cầu phần cứng nào để tự triển khai lại mô hình robot này?

Cần chuẩn bị: Khung hợp kim nhôm Al 6061 gia công CNC; 3 động cơ DC Servo kèm hộp giảm tốc $U=180$ và encoder quang; 1 bộ vi điều khiển Arduino Mega 2560; 2 Arduino Uno/Nano; 2 mạch cầu H công suất L298N (hoặc IBT-2 MOSFET driver); 1 bộ cảm biến Strain Gauge $350,\Omega$ kèm IC HX711; bộ truyền đai răng S5M; nguồn tổ ong $24\text{V-10A}$ và module giảm áp LM2596.

2. Làm thế nào để mở rộng robot từ 3 bậc tự do lên 4 hoặc 6 bậc tự do?

Để tăng bậc tự do: Cần bổ sung ma trận D-H cho các khâu tiếp theo; giải bài toán động học nghịch bằng phương pháp số học (Numerical IK - Jacobian Transpose hoặc Damped Least Squares) thay cho giải tích hình học; bổ sung thêm vi điều khiển Slave phụ trách các khớp cổ tay và nâng cấp công suất nguồn cấp.

3. Robot giao tiếp với máy tính bằng giao thức gì và có thể kết nối với ROS không?

Hiện tại robot giao tiếp qua cổng USB UART (Baudrate 115200 bps) với giao thức truyền gói tin nhị phân có Byte kiểm tra (Header - Data - Checksum). Hệ thống hoàn toàn có thể kết nối với hệ điều hành Robot (ROS 1/ROS 2) thông qua package rosserial_arduino hoặc micro-ROS để đồng bộ hóa với Rviz và MoveIt.

4. Cách khắc phục hiện tượng trôi điểm zero (Zero-drift) của cảm biến mô-men xoắn?

Hiện tượng trôi điểm zero trên mạch cầu Wheatstone do nhiệt độ được khắc phục bằng: (1) Bố trí mạch cầu đầy đủ 4 lá điện trở dán đối xứng; (2) Thực hiện thuật toán tự động cân bằng (Auto-Tare) tại thời điểm khởi động hệ thống; (3) Sử dụng bộ lọc thông thấp số (Digital Low-pass Filter) hoặc Exponential Moving Average (EMA) trên vi điều khiển:

$$S_t = \alpha \cdot Y_t + (1-\alpha) \cdot S_{t-1} \quad (\text{với } \alpha = 0.15)$$

5. Chi phí ước tính và thời gian hoàn vốn (ROI) khi ứng dụng vào sản xuất nhỏ là bao nhiêu?

Tổng chi phí linh kiện gia công và chế tạo mẫu rơi vào khoảng 8.000.000 - 12.000.000 VNĐ (tương đương 350 - 500 USD). Nếu ứng dụng vào công đoạn cấp phôi hoặc kiểm tra sản phẩm thay thế 1 nhân công thao tác đơn điệu, thời gian thu hồi vốn ước tính chỉ từ 2 đến 3 tháng.

Kết luận

Đề tài "Cánh tay máy tương tác 3 bậc tự do" của nhóm sinh viên Bùi Chế Linh và Nguyễn Trọng Nghĩa (Khoa Cơ khí Chế tạo Máy - ĐH Sư phạm Kỹ thuật TP.HCM) dưới sự hướng dẫn của TS. Cái Việt Anh Dũng đã hoàn thành xuất sắc toàn bộ các mục tiêu lý thuyết và thực nghiệm. Công trình chứng minh tính khả thi vượt trội của việc kết hợp cơ cấu cơ khí nhôm Al 6061 tối ưu, hệ thống truyền động đai răng S5M chính xác, mạch đo mô-men xoắn tích hợp Strain Gauge - HX711 và cấu trúc điều khiển phân tán Master-Slave. Với sai số vị trí đạt $\pm 3.2\text{ mm}$, khả năng nhận biết lực cản nhanh chóng và giao diện vận hành trực quan, đề tài đóng góp một giải pháp công nghệ giá trị cao, mở đường cho việc làm chủ công nghệ chế tạo robot cộng tác thông minh made-in-Vietnam phục vụ giáo dục và sản xuất hiện đại.