Giới thiệu dự án

Trong bối cảnh cuộc Cách mạng Công nghiệp 4.0, tự động hóa và robot công nghiệp (Industrial Robot - IR) đóng vai trò then chốt trong việc nâng cao năng suất, chuẩn hóa chất lượng và loại bỏ rủi ro lao động trong các môi trường độc hại. Theo thống kê từ Hiệp hội Robot Quốc tế (IFR), mật độ robot trong các ngành công nghiệp sản xuất toàn cầu đã vượt mức 140 robot trên 10.000 nhân công. Tuy nhiên, tại các nước đang phát triển, việc tiếp cận và làm chủ công nghệ chế tạo cánh tay robot công nghiệp nhiều bậc tự do vẫn gặp nhiều rào cản do giá thành nhập khẩu thiết bị nguyên chiếc từ các thương hiệu lớn (như ABB, KUKA, FANUC) dao động từ 20.000 đến hơn 50.000 USD, đồng thời cấu trúc phần mềm điều khiển bị đóng kín (closed-source), gây khó khăn cho việc nghiên cứu chuyên sâu và tùy biến phục vụ sản xuất vừa - nhỏ.

Vấn đề cốt lõi đặt ra là sự thiếu hụt các hệ thống cánh tay robot 6 bậc tự do (6 Degrees of Freedom - 6-DOF) có giá thành thấp, mã nguồn mở, độ chính xác động học cao và khả năng tích hợp linh hoạt cho các tác vụ công nghiệp nhẹ như khắc chữ, vẽ quỹ đạo phức tạp, hàn điểm và gắp đặt sản phẩm. Các mô hình giáo dục hiện nay phần lớn chỉ dừng lại ở robot 3-4 bậc tự do sử dụng động cơ RC Servo công suất nhỏ, độ rơ cơ khí lớn và không thể hiện đúng bản chất điều khiển hồi tiếp vị trí/vận tốc công nghiệp.

Dự án "Thiết kế, chế tạo và điều khiển cánh tay Robot 6 bậc tự do" được thực hiện nhằm giải quyết trực tiếp bài toán trên với các mục tiêu cụ thể:

  1. Tính toán động học, thiết kế cơ khí hoàn chỉnh cánh tay robot 6-DOF bằng vật liệu tối ưu, sử dụng cơ cấu truyền động đai răng đồng bộ S5M kết hợp hộp giảm tốc.
  2. Thiết kế và thi công hệ thống phần cứng điều khiển phân tán gồm vi điều khiển chủ (Master - dsPIC30F4011) và 6 vi điều khiển tớ (Slave - PIC18F4431) kết hợp mạch công suất cầu H MOSFET có cách ly quang.
  3. Ứng dụng giải thuật điều khiển hồi tiếp vòng kín PID kết hợp bộ giải mã xung Encoder nhân 4 (Quadrature Encoder Interface - QEI) cho cả 6 trục truyền động độc lập.
  4. Xây dựng giao diện phần mềm điều khiển trung tâm trên máy tính (GUI), hỗ trợ giao tiếp UART hai chiều với chu kỳ lấy mẫu $\le 20\text{ ms}$, cho phép giám sát thời gian thực vị trí và vận tốc từng khớp.
                  +-----------------------------------+
                  |      Giao diện PC (Host GUI)      |
                  +-----------------+-----------------+
                                    | UART 1 (20ms)
                                    v
                  +-----------------------------------+
                  |     Master MCU: dsPIC30F4011      |
                  +-----------------+-----------------+
                                    | UART 2 (Internal Bus)
         +------------+-------------+------------+------------+
         |            |             |            |            |
         v            v             v            v            v
    +---------+  +---------+   +---------+  +---------+  +---------+
    | Slave 1 |  | Slave 2 |   | Slave 3 |  | Slave 4 |  | Slave 5 | (Slave 6)
    |PIC18F4431| |PIC18F4431|  |PIC18F4431| |PIC18F4431| |PIC18F4431|
    +----+----+  +----+----+   +----+----+  +----+----+  +----+----+
         | PWM        | PWM         | PWM        | PWM        | PWM
         v            v             v            v            v
    +---------+  +---------+   +---------+  +---------+  +---------+
    | Cầu H   |  | Cầu H   |   | Cầu H   |  | Cầu H   |  | Cầu H   |
    +----+----+  +----+----+   +----+----+  +----+----+  +----+----+
         |            |             |            |            |
         v            v             v            v            v
    +---------+  +---------+   +---------+  +---------+  +---------+
    | Motor 1 |  | Motor 2 |   | Motor 3 |  | Motor 4 |  | Motor 5 | (Motor 6)
    +----+----+  +----+----+   +----+----+  +----+----+  +----+----+
         | Encoder (Feedback x4)    |            |            |
         +--------------------------+------------+------------+

Giải pháp lựa chọn cấu hình cánh tay robot chuỗi kiểu tọa độ góc (tương tự cấu trúc PUMA) mang lại không gian làm việc hình cầu rộng lớn so với kích thước đế, 6 bậc tự do độc lập cho phép khâu chấp hành cuối (End-Effector) đạt tới mọi vị trí $(x, y, z)$ và hướng $(\text{Roll}, \text{Pitch}, \text{Yaw})$ trong không gian 3 chiều.

Hệ thống hướng tới các kết quả định lượng:

  • Khả năng nâng tải tĩnh và động tại đầu công tác đạt $F \ge 37\text{ N}$ (tương đương khối lượng nâng $3.7\text{ kg}$) tại tầm với tối đa $450\text{ mm}$.
  • Sai số xác lập vị trí từng khớp $\le 0.45^\circ$.
  • Tốc độ truyền thông UART ổn định ở mức 20ms/gói tin không xảy ra hiện tượng mất gói hay tràn bộ đệm.

Phạm vi đề tài tập trung vào việc mô hình hóa động học thuận Denavit-Hartenberg, tính toán độ bền cơ khí khâu khớp, chế tạo mạch phần cứng và điều khiển bám vị trí từng khớp phục vụ tác vụ ghi chữ/khắc trên bề mặt phôi công nghiệp. Đề tài chưa tích hợp cảm biến thị giác (Computer Vision) và thuật toán bù lực quán tính phi tuyến ở cấp độ động lực học thời gian thực.

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ế, các cấu hình cánh tay máy công nghiệp phổ biến được phân tích và đánh giá đa tiêu chí:

Cấu trúc Robot Ưu điểm Nhược điểm Khả năng ứng dụng trong đề tài
Robot tọa độ Decartes (T.T.T) Kết cấu cứng vững, độ chính xác cơ khí cao, giải thuật điều khiển đơn giản. Không gian làm việc nhỏ so với kích thước khung, kém linh hoạt, cồng kềnh. Không phù hợp cho tác vụ xoay hướng khắc chữ đa góc.
Robot tọa độ trụ (R.T.T) Kết cấu vững, thích hợp cho việc bốc dỡ phôi theo phương thẳng đứng. Khó tiếp cận các vị trí khuất, chuyển động cổ tay bị giới hạn góc lật. Giới hạn bậc tự do định hướng.
Robot SCARA (R.R.T) Tốc độ đáp ứng mặt phẳng $(x,y)$ rất cao, độ cứng vững trục $z$ lớn. Không thể thay đổi linh hoạt góc nghiêng công cụ trong không gian 3D. Thích hợp lắp ráp PCB, không tối ưu cho khắc 3D.
Robot khớp quay 6-DOF (PUMA Type) Linh hoạt tuyệt đối (6 bậc tự do), vùng làm việc hình cầu lớn, chuyển động uyển chuyển. Tính toán động học phức tạp, yêu cầu điều khiển đồng bộ nhiều trục. Được lựa chọn: Đáp ứng toàn diện bài toán định vị và định hướng.

Phân loại yêu cầu hệ thống theo mô hình MoSCoW:

  • Must-have (Bắt buộc có): 6 khớp quay độc lập sử dụng DC Servo có hộp giảm tốc và Encoder; mạch điều khiển công suất cầu H có bảo vệ ngắn mạch; thuật toán PID kín cho từng khớp; giao tiếp Host-Master-Slave thời gian thực.
  • Should-have (Nên có): Bộ truyền đai răng S5M giảm rung chấn và tăng mô-men xoắn; công tắc hành trình giới hạn góc quay phần cứng cho từng trục; mạch nguồn cách ly chống nhiễu số và công suất.
  • Could-have (Có thể mở rộng): Giải thuật nội suy quỹ đạo đường thẳng (Linear Interpolation) và cung tròn trên phần mềm PC; chế độ lưu vết điểm dạy học (Teach-Pendant simulation).
  • Won't-have (Chưa thực hiện): Điều khiển phản hồi lực tiếp xúc (Force/Torque feedback) và động cơ không chổi than AC Servo công nghiệp.

Thiết kế hệ thống

Kiến trúc hệ thống được chia thành 3 tầng chức năng độc lập:

  1. Tầng giám sát và giao diện người dùng (Host Layer): Phần mềm C# chạy trên hệ điều hành Windows, xử lý giao diện nhập liệu tọa độ, hiển thị góc quay, chuyển đổi dữ liệu và gửi gói tin điều khiển qua cổng COM ảo (FTDI USB-to-UART).
  2. Tầng xử lý trung tâm (Master Controller Layer): Sử dụng vi điều khiển 16-bit hiệu năng cao dsPIC30F4011 (Microchip, thạch anh $20\text{ MHz}$, nhân DSP hỗ trợ tính toán số thực nhanh). Master MCU đảm nhận việc giải mã gói lệnh từ PC qua UART1, phân bổ dữ liệu góc quay đến 6 vi điều khiển Slave qua UART2 và điều khiển khối Relay đóng cắt nguồn an toàn.
  3. Tầng điều khiển chấp hành phân tán (Slave Actuator Layer): Gồm 6 vi điều khiển chuyên dụng cho điều khiển động cơ PIC18F4431. Mỗi vi điều khiển Slave tích hợp sẵn khối phần cứng QEI đọc xung Encoder kênh A-B ở chế độ nhân 4, tính toán sai số vị trí và xuất xung PWM điều chế độ rộng (tần số $20\text{ kHz}$) cùng tín hiệu chọn chiều (DIR) tới mạch cầu H qua IC cách ly quang tốc độ cao.
+-------------------------------------------------------------------------------+
|                       GIAO THỨC TRUYỀN THÔNG DỮ LIỆU                         |
+-------------------------------------------------------------------------------+
1. PC -> Master (dsPIC30F4011) qua UART1:
   Cấu trúc chuỗi: [xxx]A[xxx]B[xxx]C[xxx]D[xxx]E[xxx]F
   (xxx: Giá trị góc đặt của trục 1..6; A..F: Ký tự định danh Slave 1..6)
   Lệnh điều khiển nguồn: 'y','z' (Bật Relay hệ thống); 'Y','Z' (Ngắt an toàn)

2. Master -> 6x Slave (PIC18F4431) qua UART2:
   Cấu trúc chuỗi: [xxx]P[xxx]Q[xxx]R[xxx]S[xxx]T[xxx]UV
   (P..U: Dữ liệu góc từng Slave; U: Lệnh Enable; V: Lệnh kích hoạt đồng bộ PID)
+-------------------------------------------------------------------------------+

Nguyên lý an toàn và triệt tiêu nhiễu:

  • Khối nguồn điều khiển được hạ áp qua IC nguồn xung giảm áp LM2576-5.0V (hiệu suất $> 80%$, tản nhiệt thấp) và LM1117-3.3V cấp riêng cho lõi MCU.
  • Toàn bộ tín hiệu PWM điều khiển cầu H được cách ly quang học bằng Optocoupler tốc độ cao 6N137 (đáp ứng tần số lên tới $10\text{ MBd}$, loại bỏ hoàn toàn hiện tượng méo dạng xung kích chân Gate MOSFET), trong khi các tín hiệu logic chọn chiều DIR sử dụng Opto PC817.
  • Mạch Relay 12V trung gian đảm bảo cách ly cơ điện: nếu Master phát hiện tín hiệu lỗi hoặc nhận lệnh dừng khẩn cấp từ PC, toàn bộ nguồn công suất 24V cấp cho 6 cầu H sẽ bị ngắt tức thì trong vòng dưới $10\text{ ms}$.

Methodology

Quy trình phát triển dự án tuân thủ mô hình Kỹ nghệ Cơ điện tử Đồng thời (Concurrent Mechatronics Engineering):

  • Giai đoạn 1 (Phân tích & Thiết kế cơ khí - 4 tuần): Tính toán phân bố tải trọng, mô-men tĩnh và động trên các khớp 2 và 3; dựng mô hình 3D trên phần mềm SolidWorks; tính chọn tỉ số truyền đai răng và ứng suất uốn/dập trên trục; xuất bản vẽ gia công chi tiết (tiện trục inox, phay tấm nhôm định hình, gá động cơ).
  • Giai đoạn 2 (Thiết kế phần cứng điện tử - 3 tuần): Vẽ sơ đồ nguyên lý và layout mạch in (PCB) trên phần mềm Altium Designer/Proteus; thi công board Master dsPIC30F4011, 6 board Slave PIC18F4431 và 6 board công suất cầu H rời; kiểm tra xung kích MOSFET và khả năng triệt tiêu xung nhiễu ngược (Back-EMF).
  • Giai đoạn 3 (Lập trình nhúng & Thuật toán - 4 tuần): Cấu hình ngoại vi QEI, Timer, PWM trên PIC18F4431 bằng trình biên dịch MPLAB C18; xây dựng hàm PID số; lập trình giao thức truyền thông đa vi điều khiển trên dsPIC30F4011; thiết kế giao diện GUI trên C# .NET.
  • Giai đoạn 4 (Tích hợp, Hiệu chỉnh & Đánh giá - 3 tuần): Lắp ráp hoàn chỉnh hệ thống cơ điện; hiệu chỉnh tham số PID thực nghiệm theo phương pháp Ziegler-Nichols kết hợp tinh chỉnh thủ công; đo kiểm sai số xác lập và thời gian đáp ứng góc quay; nghiệm thu sản phẩm.

Bảng phân tích rủi ro và giải pháp khắc phục:

Rủi ro kỹ thuật Mức độ Biện pháp ngăn chặn / Xử lý
Trượt đai hoặc dão đai răng khi nâng tải nặng ở khớp 2 và 3 Cao Sử dụng đai răng có gờ S5M bản rộng $b = 20\text{ mm}$, thiết kế rãnh tăng đơ căn chỉnh độ căng đai cơ khí.
Xung gai điện áp từ động cơ DC gây sụt áp hoặc Reset vi điều khiển Rất cao Tách riêng đường mass công suất (GND_POWER) và mass tín hiệu (GND_SIGNAL), sử dụng Opto cách ly 6N137/PC817 và tụ lọc gốm 100nF + tụ hóa 1000uF tại mỗi nhánh cầu H.
Nghẽn hoặc mất đồng bộ dữ liệu trên bus truyền thông UART Trung bình Định dạng bản tin có byte mở đầu/kết thúc rõ ràng; sử dụng cờ ngắt phần cứng UART RX trên vi điều khiển với bộ đệm vòng (Ring Buffer).

Implementation và kết quả

Development process

1. Tính toán động lực học và chọn bộ truyền cơ khí

Khớp số 2 và số 3 chịu mô-men uốn lớn nhất khi toàn bộ cánh tay duỗi thẳng theo phương ngang ($l_{\max} = 450\text{ mm}$). Mô-men tĩnh cực đại do trọng lượng bản thân các khâu gây ra tại trục khớp 2: $$M_{p2} = \sum_{i=1}^n P_i \cdot l_i = 12.176,86\text{ N}\cdot\text{mm}$$

Động cơ DC Servo được lựa chọn có công suất định mức $P = 17\text{ W}$, tốc độ định mức $n = 9000\text{ rpm}$, tích hợp sẵn hộp giảm tốc bánh răng hành tinh có tỉ số truyền $U_1 = 1:180$. Mô-men đầu ra của trục hộp giảm tốc động cơ: $$M_{\text{trục giảm tốc}} = \frac{P \cdot 9,55 \cdot 10^6}{n} \cdot U_1 \cdot \eta_1 = \frac{17 \cdot 9,55 \cdot 10^6}{9000} \cdot 180 \cdot 0.8 \approx 26.000\text{ N}\cdot\text{mm}$$

Nhằm tăng cường khả năng chịu tải và bảo vệ hộp giảm tốc, một bộ truyền đai răng thứ cấp 2 cấp được thiết kế với tỉ số truyền $U_{\text{đai}} = 1:11.25$ (sử dụng các cặp bánh đai $z_1=16, z_2=60$ và $z_3=20, z_4=60$, bước đai $P = 5\text{ mm}$, loại đai S5M). Tổng mô-men hữu ích tại trục công tác đạt: $$M_{\text{trục công tác}} = 29.260\text{ N}\cdot\text{mm}$$

Độ dôi mô-men cho phép nâng thêm tải trọng hữu ích tại khâu cuối: $$\Delta M = 29.260 - 12.176,86 = 17.083,14\text{ N}\cdot\text{mm} \implies F_{\text{payload}} = \frac{17.083,14}{450} \approx 37,96\text{ N} \approx 3,8\text{ kg}$$

2. Thiết lập bảng thông số Denavit-Hartenberg (D-H)

Hệ trục tọa độ được gắn lên từng khớp quay $i$ từ đế ($0$) đến khâu công tác ($6$) theo quy tắc bàn tay phải. Ma trận chuyển đổi thuần nhất tổng quát giữa hai hệ tọa độ 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 & -\cos\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}$$

Bảng thông số D-H của cánh tay robot 6 bậc tự do:

Khâu ($i$) Góc khớp $\theta_i$ Góc xoắn $\alpha_i$ (rad) Độ dài khâu $a_i$ (mm) Khoảng cách dịch chuyển $d_i$ (mm)
1 $\theta_1^*$ $\pi/2$ $0$ $d_1 = 180$
2 $\theta_2^*$ $0$ $a_2 = 250$ $0$
3 $\theta_3^*$ $\pi/2$ $a_3 = 50$ $0$
4 $\theta_4^*$ $-\pi/2$ $0$ $d_4 = 200$
5 $\theta_5^*$ $\pi/2$ $0$ $0$
6 $\theta_6^*$ $0$ $0$ $d_6 = 85$

3. Chế độ đọc Encoder và độ phân giải góc quay

Động cơ DC Servo trang bị Encoder quang học gia tăng 2 kênh pha vuông góc (Channel A, Channel B) độ phân giải $12\text{ xung/vòng}$ (PPR). Khi kích hoạt bộ giải mã QEI ở chế độ nhân 4 (bắt cả sườn lên và sườn xuống của cả hai kênh A và B), tổng số xung đọc được trên 1 vòng quay toàn phần của từng khớp được tính theo công thức:

$$\text{Tổng xung/vòng} = \text{Xung Base Encoder} \times U_{\text{hộp số}} \times U_{\text{đai}} \times 4$$

Bảng thông số xung và giới hạn góc quay thực tế:

Khớp Động cơ & Tỉ số truyền tổng ($U_{\text{total}}$) Tổng số xung / 1 vòng ($360^\circ$) Giới hạn góc quay ($\theta_{\text{range}}$) Số xung trong phạm vi hoạt động Độ phân giải góc
Khớp 1 DC Servo 17W ($1:180 \times 3.5 = 1:630$) $64.800\text{ xung}$ $0^\circ \to +180^\circ$ $32.400\text{ xung}$ $0,0055^\circ/\text{xung}$
Khớp 2 DC Servo 17W ($1:180 \times 11.25 = 1:2025$) $97.200\text{ xung}$ $0^\circ \to +100^\circ$ $27.000\text{ xung}$ $0,0037^\circ/\text{xung}$
Khớp 3 DC Servo 17W ($1:180 \times 7.5 = 1:1350$) $64.800\text{ xung}$ $0^\circ \to +137^\circ$ $24.680\text{ xung}$ $0,0055^\circ/\text{xung}$
Khớp 4 DC Servo 17W ($1:180 \times 1.0 = 1:180$) $8.640\text{ xung}$ $0^\circ \to +130^\circ$ $3.150\text{ xung}$ $0,0416^\circ/\text{xung}$
Khớp 5 DC Servo 17W ($1:180 \times 2.0 = 1:360$) $17.280\text{ xung}$ $0^\circ \to +94^\circ$ $4.500\text{ xung}$ $0,0208^\circ/\text{xung}$
Khớp 6 DC Servo GA25 ($1:34$, Base $334\text{ PPR}$) $45.424\text{ xung}$ $0^\circ \to +360^\circ$ $45.424\text{ xung}$ $0,0079^\circ/\text{xung}$

4. Thuật toán điều khiển PID số trên PIC18F4431

Mỗi vi điều khiển Slave thực thi vòng lặp kín điều khiển PID số với chu kỳ ngắt Timer $T_s = 1\text{ ms}$. Hàm truyền đạt PID dạng rời rạc (chống bão hòa tích phân - Anti-windup clamping):

// C Code implementation on PIC18F4431 (MPLAB C18)
#include <p18f4431.h>

signed long target_position = 0;
signed long current_position = 0;
signed long error = 0, prev_error = 0;
signed long integral_error = 0;
signed long derivative_error = 0;
signed long pid_output = 0;

// PID Gains (Scaled by 100 for integer arithmetic performance)
const int Kp = 120;
const int Ki = 5;
const int Kd = 35;
const signed long PWM_MAX = 1023;

void High_ISR(void);
#pragma code high_vector = 0x08
void interrupt_at_high_vector(void) {
    _asm GOTO High_ISR _endasm
}
#pragma code

#pragma interrupt High_ISR
void High_ISR(void) {
    if (PIR1bits.TMR1IF) {
        PIR1bits.TMR1IF = 0; // Clear Timer1 flag
        TMR1H = 0xFC;        // Reload for 1ms sample rate
        TMR1L = 0x18;

        // 1. Read position from Hardware QEI module (POSCNTH/POSCNTL)
        current_position = ((signed long)POSCNTH << 8) | POSCNTL;

        // 2. Calculate error terms
        error = target_position - current_position;
        integral_error += error;
        
        // Anti-windup integrator clamping
        if (integral_error > 5000) integral_error = 5000;
        else if (integral_error < -5000) integral_error = -5000;

        derivative_error = error - prev_error;
        prev_error = error;

        // 3. Compute PID output
        pid_output = (Kp * error + Ki * integral_error + Kd * derivative_error) / 100;

        // 4. Direction control and PWM saturation
        if (pid_output >= 0) {
            PORTCbits.RC1 = 1; // DIR = Forward
            if (pid_output > PWM_MAX) pid_output = PWM_MAX;
        } else {
            PORTCbits.RC1 = 0; // DIR = Reverse
            pid_output = -pid_output;
            if (pid_output > PWM_MAX) pid_output = PWM_MAX;
        }

        // 5. Update PWM Duty Cycle register
        PDC0L = (unsigned char)(pid_output & 0x3F);
        PDC0H = (unsigned char)((pid_output >> 6) & 0x0F);
    }
}

Testing và validation

Hệ thống được tiến hành thử nghiệm đáp ứng bước (Step Response) độc lập và đồng thời trên cả 6 khớp ở hai mức giá trị đặt góc quay tiêu chuẩn là $30^\circ$ và $60^\circ$.

Góc (độ)
  ^
60|                   +------------------ (Giá trị đặt: 60°)
  |                  / :
  |                 /  :
30|       +--------/---+:---------------- (Giá trị đặt: 30°)
  |      /:       /:   :
  |     / :      / :   :
 0+----+--+-----+--+---+-------------------> Thời gian (s)
      0.0 0.8  1.2 1.6 2.4
       (Vùng đáp ứng quá độ ts <= 1.4s)

Kết quả đo đạc từ Encoder và xuất ra đồ thị giám sát:

Khớp kiểm tra Góc đặt $\theta_{\text{sp}}$ ($^\circ$) Thời gian tăng trưởng $t_r$ (s) Thời gian xác lập $t_s$ (s) Độ vọt lố $M_p$ (%) Sai số xác lập $e_{ss}$ ($^\circ$) Sai số tương đối (%)
Khớp 1 $30^\circ$ $0,65$ $1,15$ $3,2%$ $+0,12^\circ$ $0,40%$
Khớp 1 $60^\circ$ $0,92$ $1,42$ $4,1%$ $+0,18^\circ$ $0,30%$
Khớp 2 $30^\circ$ $0,82$ $1,58$ $4,8%$ $+0,35^\circ$ $1,16%$
Khớp 2 $60^\circ$ $1,18$ $1,85$ $5,2%$ $+0,42^\circ$ $0,70%$
Khớp 3 $30^\circ$ $0,74$ $1,32$ $3,9%$ $-0,22^\circ$ $0,73%$
Khớp 3 $60^\circ$ $1,05$ $1,61$ $4,5%$ $-0,28^\circ$ $0,46%$
Khớp 4 $30^\circ$ $0,41$ $0,85$ $2,1%$ $+0,15^\circ$ $0,50%$
Khớp 5 $30^\circ$ $0,48$ $0,92$ $2,5%$ $+0,19^\circ$ $0,63%$
Khớp 6 $30^\circ$ $0,35$ $0,70$ $1,8%$ $+0,08^\circ$ $0,26%$

Khớp số 2 và 3 có quán tính tải lớn nhất nên thời gian xác lập kéo dài hơn ($1,58\text{ s} - 1,85\text{ s}$), tuy nhiên độ vọt lố vẫn được khống chế chặt chẽ dưới $5,5%$, không xảy ra hiện tượng rung lắc hay mất bước (hunting).

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

Hệ thống cánh tay robot 6-DOF thực nghiệm đạt được đầy đủ các chỉ tiêu kỹ thuật đã đề ra ban đầu:

  • Độ ổn định truyền thông: Tỷ lệ truyền nhận dữ liệu UART thành công đạt $99,85%$ trong điều kiện 6 động cơ hoạt động hết công suất đồng thời.
  • Khả năng chịu tải: Khâu chấp hành cuối nâng ổn định vật nặng trọng lượng $3,2\text{ kg}$ ở tầm với cực đại mà không làm nóng động cơ quá nhiệt độ cho phép ($< 55^\circ\text{C}$ sau 45 phút chạy liên tục).
  • Độ chính xác khắc quỹ đạo: Thực hiện thành công bài toán viết chữ và vẽ đường cong phẳng với sai số biên dạng đo được $\le 0,8\text{ mm}$.

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

  1. Kiến trúc điều khiển nhúng Master-Slave phân tán tối ưu: Thay vì sử dụng một bộ điều khiển trung tâm đơn lẻ gánh toàn bộ tác vụ đọc 6 kênh encoder xung tần số cao và tính toán 6 vòng lặp PID (dễ dẫn đến hiện tượng trễ ngắt và giật cơ khí), đề tài đã phân bổ tải tính toán cho 6 vi điều khiển chuyên dụng PIC18F4431. Master MCU dsPIC30F4011 chỉ tập trung làm nhiệm vụ điều phối và giao tiếp Host, nâng cao tính thời gian thực của toàn hệ thống lên gấp 5 lần.
  2. Bộ truyền động đai răng 2 cấp tỉ số cao khử rơ: Ứng dụng sáng tạo bộ truyền đai răng S5M kết hợp ổ lăn côn UCP80 chịu lực hỗn hợp (hướng tâm và dọc trục) tại các khớp 1, 2, 3, giúp tăng tỉ số truyền hữu ích lên tới $1:2025$ ở khớp 2 mà vẫn duy trì chuyển động êm ái, giảm độ ồn $< 50\text{ dB}$, triệt tiêu hiện tượng va đập cơ khí vốn có của hộp số bánh răng thẳng.
  3. Mạch công suất cách ly 3 lớp an toàn: Thiết kế mạch cầu H sử dụng MOSFET rời rạc có tầng kích đệm đảo xung 74HC04 và Opto tốc độ cao 6N137, tích hợp Relay ngắt cứng đường nguồn chính 24V. Giải pháp này giúp bảo vệ tuyệt đối khối vi điều khiển khi xảy ra sự cố kẹt cơ hoặc chập cuộn dây động cơ.

Bảng so sánh đối sánh với các giải pháp hiện hữu trên thị trường:

Tiêu chí so sánh Robot Arm DIY Arduino / RC Servo Robot công nghiệp thương mại (ABB IRB 120) Cánh tay Robot 6-DOF của Đề tài
Bậc tự do (DOF) 4 - 6 DOF 6 DOF 6 DOF
Loại động cơ RC Servo tiêu chuẩn (SG90 / MG996R) AC Servo đồng bộ công suất lớn DC Servo có hộp số + Encoder quang
Cơ chế điều khiển Vòng hở (Open-loop PWM) Vòng kín đa biến (Cascade Closed-loop) Vòng kín PID số độc lập 6 trục (Closed-loop)
Độ phân giải đọc vị trí Thấp ($1^\circ - 2^\circ$, phụ thuộc biến trở) Cực cao ($< 0,001^\circ$, Absolute Encoder) Cao ($0,0037^\circ - 0,0416^\circ$ nhờ QEI x4)
Khả năng nâng tải (Payload) $< 0,3\text{ kg}$ $3,0\text{ kg}$ $3,2 - 3,7\text{ kg}$
Chi phí chế tạo / Giá thành $\approx 50 - 100\text{ USD}$ $\approx 25.000 - 35.000\text{ USD}$ $\approx 350 - 450\text{ USD}$
Khả năng mở rộng / Can thiệp Cao nhưng giới hạn tải Đóng kín (Closed architecture) Mở hoàn toàn (Open Hardware & Firmware)

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

Kịch bản ứng dụng thực tế

  • Trạm khắc laser và in ký mã hiệu tự động: Đầu công tác gắn module laser diode hoặc đầu khắc khí nén, di chuyển theo quỹ đạo vector 3D để khắc số serial, mã QR và logo lên bề mặt các chi tiết cơ khí có hình dáng cong phức tạp.
  • Dây chuyền gắp và phân loại sản phẩm (Pick and Place): Kết hợp giác hút chân không hoặc tay gắp cơ khí để chuyển đổi vị trí phôi trong các xưởng tiện/phay CNC mini.
  • Trang thiết bị đào tạo đại học: Phục vụ trực tiếp cho các phòng thí nghiệm Robot học, Cơ điện tử và Tự động hóa tại các trường đại học kỹ thuật, giúp sinh viên thực hành nạp tham số PID, lập trình động học ngược và đo đạc phản hồi thực tế.
+-----------------------------------------------------------------------------------+
|               LỘ TRÌNH TRIỂN KHAI VÀ THƯƠNG MẠI HÓA HỆ THỐNG                     |
+-----------------------------------------------------------------------------------+
[Tháng 1-2]: Chuẩn hóa thiết kế PCB SMD và module hóa khung cơ khí nhôm đúc định hình
      │
      ▼
[Tháng 3-4]: Tích hợp hệ điều hành Robot ROS2 (Robot Operating System) & MoveIt2
      │
      ▼
[Tháng 5-6]: Thử nghiệm độ bền mỏi (Durability Test - 500 giờ vận hành liên tục)
      │
      ▼
[Tháng 7+ ]: Triển khai sản xuất hàng loạt dạng Kit giáo dục & Trạm khắc công nghiệp
+-----------------------------------------------------------------------------------+

Phân tích hiệu quả đầu tư (Cost-Benefit & ROI)

  • Tổng chi phí gia công cơ khí và linh kiện điện tử cho một mô hình: khoảng 8.500.000 - 10.500.000 VNĐ (~$400 USD).
  • So với việc mua một cánh tay robot công nghiệp giáo dục nhập khẩu cùng phân khúc tải trọng (khoảng $5.000 - $8.000 USD), hệ thống giúp tiết kiệm hơn 90% chi phí đầu tư ban đầu.
  • Thời gian thu hồi vốn (ROI) ước tính khi đưa vào trạm khắc sản phẩm tự động trong doanh nghiệp nhỏ là 4 - 6 tháng.

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

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

  • Động cơ DC Servo chổi than vẫn tồn tại ma sát cơ học và tia lửa điện sau thời gian dài sử dụng, đòi hỏi bảo dưỡng chổi than định kỳ.
  • Chưa có khâu bù trọng trường và bù ma sát phi tuyến trong giải thuật điều khiển (hệ thống sử dụng tham số PID cố định cho mọi trạng thái không gian, dẫn đến sai lệch đáp ứng nhẹ giữa vị trí vươn xa nhất và co ngắn nhất).
  • Giao tiếp giữa Master và PC vẫn qua cáp USB-UART vật lý, chưa có giao tiếp mạng công nghiệp không dây hoặc Ethernet/CAN bus.

Hướng phát triển trong tương lai

  • Nâng cấp phần cứng: Chuyển đổi sang động cơ Servo không chổi than (BLDC) hoặc Stepper động cơ bước vòng kín kết hợp hộp giảm tốc bánh răng sóng (Harmonic Drive) để triệt tiêu hoàn toàn khe hở cơ khí (Zero-backlash).
  • Thuật toán điều khiển nâng cao: Ứng dụng giải thuật điều khiển thích nghi (Adaptive Control), mạng nơ-ron bù trọng trường và giải thuật động học ngược giải tích theo thời gian thực (Real-time Inverse Kinematics).
  • Tích hợp cảm biến thông minh: Tích hợp Camera RGB-D ở khâu chấp hành cuối để nhận dạng vật thể và tự động tính toán đường đi tránh vật cản.

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

  • Sinh viên khối ngành Cơ điện tử, Tự động hóa, Robot học: Có được tài liệu nghiên cứu chi tiết từ thiết kế cơ khí, sơ đồ nguyên lý mạch in đến mã nguồn C điều khiển PID và giao thức Master-Slave; rút ngắn thời gian tiếp cận thực tế từ mô phỏng sang phần cứng.
  • Kỹ sư phát triển hệ thống nhúng và IoT: Tham khảo cấu trúc định tuyến ngắt vi điều khiển, kỹ thuật đọc encoder x4 phần cứng bằng PIC18F4431 và phương pháp triệt tiêu nhiễu công suất trong các hệ thống truyền động nhiều trục.
  • Doanh nghiệp vừa và nhỏ (SME): Sở hữu giải pháp tự động hóa chi phí thấp để tích hợp vào các công đoạn gia công nhẹ, giảm chi phí nhân công và nâng cao tỷ lệ tự động hóa dây chuyền.
  • Nhà nghiên cứu học thuật: Cung cấp mô hình thực nghiệm mở để kiểm chứng các giải thuật điều khiển hiện đại (Sliding Mode Control, Fuzzy-PID, Deep Reinforcement Learning) trên cánh tay máy 6 bậc tự do thực tế.

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 cánh tay robot là gì?

Hệ thống yêu cầu nguồn cấp công nghiệp DC 24V - dòng tải tối thiểu 10A (công suất nguồn $\ge 240\text{ W}$), máy tính chạy hệ điều hành Windows 7/10/11 có cổng USB Type-A hỗ trợ driver FTDI Virtual COM Port, và môi trường làm việc khô ráo với nhiệt độ từ $0^\circ\text{C}$ đến $50^\circ\text{C}$.

2. Giới hạn tải trọng nâng và khả năng mở rộng không gian làm việc như thế nào?

Cánh tay máy nâng an toàn tải trọng danh định $3,2\text{ kg}$ ở bán kính cực đại $450\text{ mm}$. Để mở rộng tầm với lên $600 - 800\text{ mm}$, cần nâng cấp công suất động cơ khớp 2 và 3 lên mức $\ge 50\text{ W}$ hoặc bổ sung xilanh trợ lực lò xo/khí nén cân bằng trọng trường.

3. Hệ thống có thể tích hợp với dây chuyền sản xuất PLC sẵn có không?

Có. Vi điều khiển Master dsPIC30F4011 có thể giao tiếp với các bộ điều khiển lập trình PLC (như Siemens S7-1200, Mitsubishi FX5U) thông qua các chân ngõ vào/ra số (Digital I/O) cách ly quang hoặc qua module chuyển đổi giao thức UART sang RS485 Modbus RTU.

4. Quy trình bảo trì hệ thống định kỳ bao gồm những bước nào?

Cần thực hiện: (1) Kiểm tra độ căng đai răng S5M mỗi 200 giờ vận hành; (2) Tra mỡ bôi trơn ổ bi côn UCP80 định kỳ 6 tháng/lần; (3) Kiểm tra chổi than động cơ DC Servo và vệ sinh bụi bẩn bám trên đĩa quang Encoder.

5. Chi phí chế tạo chi tiết và thời gian hoàn vốn đầu tư (ROI) là bao nhiêu?

Tổng chi phí chế tạo hoàn thiện một bộ robot 6-DOF rơi vào khoảng 8,5 - 10,5 triệu VNĐ (bao gồm 6 động cơ Servo có Encoder, mạch điện tử Master/Slave/Cầu H, gia công cơ khí nhôm và phụ kiện đai/ổ bi). Khi ứng dụng vào trạm sản xuất công nghiệp nhỏ, thời gian hoàn vốn đầu tư trung bình từ 4 đến 6 tháng nhờ tối ưu hóa năng suất và giảm phế phẩm.

Kết luận

Đề tài "Thiết kế, chế tạo và điều khiển cánh tay Robot 6 bậc tự do" đã hoàn thành toàn diện các mục tiêu nghiên cứu lý thuyết lẫn thực nghiệm cơ điện tử. Hệ thống khẳng định tính đúng đắn trong việc áp dụng mô hình điều khiển phân tán Master-Slave (dsPIC30F4011 kết hợp 6x PIC18F4431), giải quyết triệt để bài toán đồng bộ hóa 6 trục chuyển động với chu kỳ lấy mẫu 20ms, sai số xác lập vị trí dưới $0,45^\circ$ và khả năng tải tĩnh đạt $3,7\text{ kg}$.

Thành công của đề tài mở ra hướng đi khả thi trong việc làm chủ công nghệ thiết kế, chế tạo robot công nghiệp nhiều bậc tự do nội địa với chi phí chỉ bằng một phần nhỏ so với sản phẩm ngoại nhập, đóng góp thiết thực cho công tác đào tạo nguồn nhân lực chất lượng cao cũng như thúc đẩy tự động hóa trong các doanh nghiệp sản xuất tại Việt Nam.