Giới thiệu dự án

Trong kỷ nguyên tự động hóa công nghiệp 4.0, các dây chuyền sản xuất vi điện tử, đóng gói dược phẩm và thực phẩm yêu cầu năng suất chu kỳ (cycle time) dưới 1 giây cùng độ chính xác lặp lại micromet. Theo các thống kê công nghiệp, việc sử dụng nhân công thủ công cho các công đoạn gắp, sắp xếp và phân loại phôi tốc độ cao chiếm tới 35-45% thời gian toàn chu kỳ và tiềm ẩn rủi ro lỗi vị trí lên đến 4.2%. Trong số các cấu hình robot công nghiệp, dòng robot SCARA (Selective Compliance Assembly Robot Arm) nổi bật nhờ độ cứng vững cao theo phương thẳng đứng (trục Z) và độ linh hoạt tối đa trên mặt phẳng ngang (X-Y), đáp ứng hoàn hảo yêu cầu gắp - đặt (pick-and-place) liên tục.

Vấn đề kỹ thuật cốt lõi đặt ra là: Làm thế nào để điều khiển một cánh tay robot SCARA 4 bậc tự do (4-DOF) chuyển động đồng bộ, bám bắt phôi chính xác trên băng tải đang chạy liên tục mà không làm gián đoạn dòng chuyền, đồng thời triệt tiêu rung lắc do quán tính chuyển động tốc độ cao gây ra.

Đồ án tốt nghiệp "Điều khiển Robot SCARA 4 trục gắp xếp sản phẩm" (Chuyên ngành Công nghệ Kỹ thuật Điều khiển và Tự động hóa, Đại học Sư phạm Kỹ thuật TP.HCM) giải quyết bài toán trên thông qua các mục tiêu cụ thể:

  1. Tái cấu trúc cơ khí, gia công bệ đỡ thép đặc (>100 kg) và tích hợp hệ thống động cơ servo công suất chuẩn hóa trên khung robot EPSON G6-551S.
  2. Thiết kế và thi công hệ thống tủ điện điều khiển công nghiệp, tích hợp bộ lọc nhiễu nguồn và mạng truyền thông cáp quang tốc độ cao.
  3. Xây dựng mô hình toán học động học thuận (Forward Kinematics) và động học nghịch (Inverse Kinematics) theo quy tắc Denavit-Hartenberg (D-H).
  4. Lập trình giải thuật điều khiển nội suy, bám đuổi tọa độ vật thể trên băng tải và bù góc định hướng cho trục xoay cuối bằng PLC Mitsubishi dòng Q.
  5. Thiết kế giao diện giám sát vận hành HMI GOT 1000 trực quan, cho phép điều khiển linh hoạt ở hai chế độ Manual (Thủ công) và Auto (Tự động).

Hệ thống hướng tới kết quả đo lường: robot thực hiện chu trình gắp từ băng tải, bù góc xoay và xếp chồng phôi (đường kính 25 mm, khối lượng 50 g) chính xác với sai số dưới ±0.5 mm ở tốc độ định mức. Phạm vi nghiên cứu tập trung vào bài toán Motion Control đa trục qua giao thức mạng chuyên dụng, giới hạn ở cấu trúc cơ khí 4 trục sẵn có và cơ cấu chấp hành nam châm điện 24VDC.

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

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

Trước khi thiết kế, các giải pháp tự động hóa gắp đặt phôi truyền thống được đặt lên bàn cân so sánh:

Tiêu chí Robot tọa độ Đề-các (Cartesian) Robot Delta (Song song) Robot SCARA điều khiển Bus Quang
Không gian lắp đặt Cồng kềnh, chiếm diện tích lớn Khung treo trên cao phức tạp Nhỏ gọn, lắp đặt linh hoạt trên bệ
Độ cứng vững trục Z Trung bình Thấp (chỉ gắp vật siêu nhẹ) Rất cao, chống uốn tốt
Tốc độ chu kỳ (PPM) Thấp (< 30 pick/phút) Rất cao (> 100 pick/phút) Cao (60 - 90 pick/phút)
Giao thức điều khiển Xung/Chiều truyền thống (Pulse/Dir) Bus mạng Motion chuyên biệt SSCNET III quang 150 Mbps
Chi phí triển khai Trung bình Rất cao Hợp lý, tối ưu cho nhà máy

Yêu cầu người dùng được phân loại theo mô hình MoSCoW:

  • Must have (Bắt buộc): Điều khiển đồng bộ 4 trục SCARA, nội suy đường thẳng, gắp/nhả bằng nam châm điện, chế độ dừng khẩn cấp E-Stop, truyền thông cáp quang không mất xung.
  • Should have (Nên có): Bù góc tự động theo hướng phôi, giám sát vị trí thực thời gian thực trên HMI, 2 chế độ vận hành Manual/Auto.
  • Could have (Có thể có): Mở rộng kết nối camera xử lý ảnh công nghiệp Cognex qua Ethernet TCP/IP.
  • Won't have (Chưa thực hiện): Tự thiết kế toàn bộ kết cấu cơ khí cánh tay mới từ đầu; tích hợp cảm biến lực (force sensor) đa trục tại giác hút.

Thiết kế hệ thống

Kiến trúc hệ thống được phân tầng rõ ràng từ tầng điều khiển, tầng truyền động đến tầng chấp hành:

[ Màn hình HMI GOT 1000 ] <--- RS-232 / Ethernet ---> [ PLC Mitsubishi Q03UDCPU ]
                                                                 |
                                              [ Module QD75MH4 / QD75MH1 ]
                                                                 | (SSCNET III - 150 Mbps Fiber)
                                     +---------------------------+---------------------------+
                                     |                                                       |
                          [ Driver MR-J3W-44B ]                                   [ Driver MR-J4W2-22B ]
                           (2 trục 400W/400W)                                      (2 trục 200W/100W)
                             |               |                                       |               |
                         [Trục 1]        [Trục 2]                                [Trục 3]        [Trục 4]
                        HG-KR43         HG-KR43B                                HG-KR23B        HF-KP23B
                       (Khớp vai)      (Khớp khuỷu)                            (Trục tịnh tiến Z) (Trục xoay R)

Cấu hình phần cứng và thông số kỹ thuật chi tiết:

  • Bộ điều khiển lập trình: Mitsubishi Q03UDCPU (Tốc độ xử lý lệnh cơ bản LD: 0.0095 µs, bộ nhớ chương trình 120 KB, hỗ trợ quản lý tối đa 4096 điểm I/O).
  • Module điều khiển vị trí:
    • QD75MH4: Điều khiển 4 trục qua mạng cáp quang SSCNET III (chu kỳ bus 0.44 ms, tốc độ truyền thông 150 Mbps, quản lý 600 điểm dữ liệu định vị/trục).
    • QD75MH1: Điều khiển độc lập 1 trục servo kéo băng tải.
  • Hệ thống truyền động Servo & Driver:
    • Driver 2 trục MR-J3W-44B (Input: 1/3 pha 220VAC, công suất 400W x 2) kéo Động cơ AC Servo HG-KR43 (Trục 1: 400W) và HG-KR43B (Trục 2: 400W có phanh điện từ).
    • Driver 2 trục MR-J4W2-22B (Input: 1/3 pha 220VAC, công suất 200W x 2) kéo Động cơ AC Servo HG-KR23B (Trục 3 tịnh tiến Z: 200W có phanh) và HF-KP23B (Trục 4 xoay: 100W).
    • Driver đơn MR-J3-10B kéo Servo kéo băng tải 100W qua bộ truyền đai puly tỉ lệ 1:1.5.
  • Module mở rộng: Digital Output QY42P (ngõ ra bán dẫn Transistor bảo vệ quá dòng), Ethernet Interface QJ71E71-100 kết nối mạng nhà máy.
  • Cơ cấu chấp hành cuối: Nam châm điện 24VDC điều khiển qua Relay trung gian từ ngõ ra QY42P.
  • Hệ thống bảo vệ nguồn: Bộ lọc nhiễu AC Noise Filter WYFS20T1AD, MCCB chống quá tải NF30-FA và CB tép CB30-BA.

Methodology

Dự án áp dụng quy trình phát triển kỹ thuật tuần tự nghiêm ngặt (Waterfall Model cải tiến) trong 15 tuần:

  • Tuần 1 - 4: Nghiên cứu cơ sở lý thuyết, lập mô hình động học D-H, khảo sát mạng SSCNET III và cấu hình Driver Mitsubishi.
  • Tuần 5 - 8: Cài đặt thông số Parameter động cơ, thiết kế sơ đồ mạch điện động lực/điều khiển, lập trình Ladder cơ sở trên phần mềm GX Works2.
  • Tuần 9 - 12: Tính toán gia công cơ khí bệ thép, gắn động cơ mới lên cánh tay EPSON G6-551S, thi công tủ điện chuẩn công nghiệp.
  • Tuần 13 - 15: Lập trình giải thuật động học thuận nghịch trên PLC, tối ưu đồng bộ nhiều trục, test tải và hiệu chỉnh sai số.

Đánh giá và giảm thiểu rủi ro:

  • Hiện tượng nhiễu xung tín hiệu: Loại bỏ hoàn toàn bằng cách sử dụng cáp quang SSCNET III thay thế cho phương pháp phát xung thông thường (CW/CCW).
  • Quán tính gây lệch tâm khi phanh khẩn cấp: Sử dụng bệ đỡ bằng thép khối nặng trên 100 kg, căn chỉnh hộp số điện tử (Electronic Gear Ratio) và đường cong gia/giảm tốc S-curve trong tham số của QD75MH4.

Implementation và kết quả

Development process

1. Mô hình hóa động học cánh tay Robot SCARA

Hệ tọa độ gắn trên các khớp tuân thủ quy ước Denavit-Hartenberg (D-H) với kích thước thực tế của robot EPSON G6-551S: Khâu 1 ($L_1 = 300\text{ mm}$), Khâu 2 ($L_2 = 250\text{ mm}$), Trục 3 tịnh tiến ($d_3$), Trục 4 quay ($\theta_4$).

Bảng tham số D-H của Robot:

Khớp $i$ $a_{i-1}$ (mm) $\alpha_{i-1}$ (deg) $d_i$ (mm) $\theta_i$ (deg)
1 0 0 0 $\theta_1$
2 300 0 0 $\theta_2$
3 250 0 $d_3$ 0
4 0 0 0 $\theta_4$

Ma trận chuyển đổi 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 & 0 & a_{i-1} \ \sin\theta_i\cos\alpha_{i-1} & \cos\theta_i\cos\alpha_{i-1} & -\sin\alpha_{i-1} & -d_i\sin\alpha_{i-1} \ \sin\theta_i\sin\alpha_{i-1} & \cos\theta_i\sin\alpha_{i-1} & \cos\alpha_{i-1} & d_i\cos\alpha_{i-1} \ 0 & 0 & 0 & 1 \end{bmatrix}$$

Thuật toán động học thuận (Forward Kinematics): Vị trí điểm tác động cuối $(P_x, P_y, P_z)$ và góc hướng $\phi$ được tính toán từ các biến khớp: $$\begin{cases} P_x = 300\cos(\theta_1) + 250\cos(\theta_1 + \theta_2) \ P_y = 300\sin(\theta_1) + 250\sin(\theta_1 + \theta_2) \ P_z = d_1 - d_3 \ \phi = \theta_1 + \theta_2 - \theta_4 \end{cases}$$

Mã nguồn tính toán Động học thuận trên MATLAB:

function [Px, Py, Pz, Phi] = scara_forward_kinematics(theta1, theta2, d3, theta4)
    % Kich thuoc cac link cua robot EPSON G6-551S (mm)
    L1 = 300; 
    L2 = 250;
    d1 = 180; % Chieu cao goc tham chieu truc Z
    
    % Tinh toan toa do diem cuoi
    t1_rad = deg2rad(theta1);
    t12_rad = deg2rad(theta1 + theta2);
    
    Px = L1 * cos(t1_rad) + L2 * cos(t12_rad);
    Py = L1 * sin(t1_rad) + L2 * sin(t12_rad);
    Pz = d1 - d3;
    Phi = theta1 + theta2 - theta4;
end

Thuật toán động học nghịch (Inverse Kinematics): Khi biết trước tọa độ mục tiêu $(P_x, P_y, P_z)$, góc xoay của các khớp được giải bằng phương pháp hình học giải tích (xét trường hợp khử cấu hình Elbow-Right với $\theta_2 > 0$): $$OA = \sqrt{P_x^2 + P_y^2}$$ $$\theta_2 = \arccos\left(\frac{P_x^2 + P_y^2 - L_1^2 - L_2^2}{2 L_1 L_2}\right)$$ $$\theta_1 = \text{atan2}(P_y, P_x) - \arccos\left(\frac{L_1^2 + P_x^2 + P_y^2 - L_2^2}{2 L_1 \sqrt{P_x^2 + P_y^2}}\right)$$ $$d_3 = d_1 - P_z$$ $$\theta_4 = \theta_1 + \theta_2 - \phi$$

2. Hiện thực hóa thuật toán trên PLC Mitsubishi bằng GX Works2

Các phép toán lượng giác thực dấu phẩy động (Floating-point Math) được tối ưu hóa trực tiếp trong tập lệnh Ladder của Q03UDCPU:

|--[ M0 (Tính Động Học Nghịch) ]----------------------------------------|
|                                                                       |
|--[ EMD* D100 D100 D110 ]---- ( D110 = Px^2 )                          |
|--[ EMD* D102 D102 D112 ]---- ( D112 = Py^2 )                          |
|--[ E+ D110 D112 D114 ]------ ( D114 = Px^2 + Py^2 = OA^2 )            |
|--[ ESQRT D114 D116 ]-------- ( D116 = OA )                            |
|                                                                       |
|--[ E- D114 E152500.0 D120 ]- ( D120 = OA^2 - L1^2 - L2^2 )           |
|--[ E/ D120 E150000.0 D122 ]- ( D122 = cos(Theta2) )                   |
|--[ E_ACOS D122 D130 ]------- ( D130 = Theta2 rad )                    |
|--[ E* D130 E57.2958 D132 ]-- ( D132 = Theta2 degree )                 |
|                                                                       |
|--[ DMOV D132 U0\G1500 ]----- ( Truyen goc Theta2 vao QD75 Target Pos) |
+-----------------------------------------------------------------------+

Testing và validation

Hệ thống đã trải qua 500 chu trình kiểm tra liên tục dưới các kịch bản vận hành khác nhau nhằm đánh giá tính ổn định của bus truyền thông và độ chính xác cơ khí:

[Phôi trên băng tải] ---> [Vào vùng bắt điểm] ---> [Robot hạ Z gắp phôi] ---> [Nâng Z & Bù góc] ---> [Xếp chồng 3 tầng]

Bảng kết quả thử nghiệm thực tế:

Kịch bản kiểm thử Số lần thử Tỷ lệ thành công Thời gian chu kỳ trung bình Sai số vị trí trung bình
Gắp phôi tĩnh tại bàn cấp phôi 100 100% 1.15 s ±0.12 mm
Bám bắt phôi động trên băng tải (v = 0.1 m/s) 150 98.6% 1.35 s ±0.28 mm
Xếp chồng 3 phôi thẳng đứng có bù góc xoay 45° 150 98.0% 1.42 s ±0.35 mm
Chạy chế độ Manual từng trục qua HMI 100 100% Đáp ứng < 50 ms Tuyệt đối theo Encoder

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

  1. Hoàn thiện phần cứng: Tủ điện được lắp đặt thẩm mỹ, phân tách rõ ràng giữa máng điện động lực 220VAC và máng tín hiệu điều khiển 24VDC/Fiber; hệ thống lọc nhiễu Noise Filter WYFS20T1AD triệt tiêu hoàn toàn hiện tượng sụt áp và sóng hài bậc cao.
  2. Hiệu năng vận hành:
    • Hoàn thành đầy đủ 100% các tính năng gắp tĩnh, gắp động, nội suy đường thẳng và xếp chồng phôi.
    • Thời gian đáp ứng của vòng điều khiển Motion đạt 0.44 ms nhờ mạng SSCNET III.
    • Robot chạy êm, khử triệt để hiện tượng rung lắc đầu tác động cuối nhờ bệ thép đặc 100 kg chịu tải tốt.

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

  1. Chuyển đổi công nghệ điều khiển Bus Quang tiên tiến: Thay vì sử dụng bộ phát xung điều khiển động cơ bước/servo thông thường vốn bị giới hạn tần số xung (< 200 kpps) và dễ suy hao do nhiễu môi trường công nghiệp, đề tài ứng dụng SSCNET III/H kết nối trực tiếp giữa QD75MH4 và Driver servo, nâng tốc độ truyền thông lên 150 Mbps với khả năng đọc hồi tiếp mã hóa vòng quay tuyệt đối (Absolute Encoder 18-bit) theo thời gian thực.
  2. Tối ưu hóa không gian tủ điện với Driver đa kênh: Sử dụng MR-J3W-44B và MR-J4W2-22B (điều khiển đồng thời 2 trục trên 1 thân Driver) giúp giảm 50% diện tích chiếm chỗ trong tủ điện, giảm 60% khối lượng dây nối so với việc lắp 4 driver đơn lẻ.
  3. Hiện thực hóa bài toán động học nghịch trực tiếp trên thanh ghi PLC: Toàn bộ thuật toán biến đổi ma trận D-H và hàm lượng giác giải tích được tính toán trực tiếp trong chu kỳ quét của CPU Mitsubishi mà không cần thông qua máy tính công nghiệp (IPC) trung gian, giúp giảm độ trễ vòng lặp điều khiển xuống dưới 10 ms.

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

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

  • Dây chuyền sản xuất bo mạch SMT: Gắp và đặt các linh kiện điện tử có định hướng từ khay cấp phôi lên bảng mạch in.
  • Ngành dược phẩm & thực phẩm: Phân loại vỉ thuốc, chai lọ từ băng chuyền đóng gói và xếp vào thùng carton theo định dạng ma trận 3x3 hoặc 4x4.

Phân tích Chi phí - Hiệu quả (Cost-Benefit & ROI)

  • Chi phí đầu tư ước tính: ~85.000.000 VNĐ (tận dụng khung cơ khí, trang bị PLC dòng Q, 5 bộ Servo Mitsubishi, module QD75 và tủ điện hoàn chỉnh).
  • So sánh với robot nhập khẩu nguyên chiếc: Chi phí chỉ bằng 25 - 30% so với việc mua mới một hệ robot SCARA công nghiệp đồng bộ (dao động từ 280.000.000 đến 350.000.000 VNĐ).
  • Thời gian hoàn vốn (ROI): Ước tính từ 7 đến 9 tháng khi thay thế 02 công nhân đóng gói thủ công trong dây chuyền vận hành 2 ca/ngày.

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

  • Hạn chế kỹ thuật hiện tại:
    • Khung robot EPSON G6-551S tái sử dụng có độ rơ cơ khí nhất định tại các khớp nối dây đai truyền động sau thời gian dài sử dụng.
    • Phân hệ xử lý ảnh công nghiệp bằng Camera Cognex (đọc mã QR/Barcode và định vị tọa độ tự động) chưa kịp tích hợp vào chu trình điều khiển vòng kín do các gián đoạn khách quan trong quá trình thi công thực nghiệm.
  • Hướng phát triển tiếp theo:
    • Tích hợp Camera Cognex thông qua Module Ethernet QJ71E71-100 sử dụng giao thức Socket Communication để truyền tọa độ $(X, Y, \theta)$ của phôi tự động về PLC.
    • Ứng dụng giải thuật bù sai số cơ khí và quy hoạch quỹ đạo chuyển động mượt (Jerk-limited Trajectory Planning) để tăng tốc độ chu kỳ gắp đặt lên dưới 0.8 giây/phôi.

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

  • Sinh viên & Học viên ngành Tự động hóa: Tài liệu tham khảo toàn diện về giải thuật động học robot SCARA và phương pháp lập trình điều khiển chuyển động nhiều trục bằng tập lệnh PLC nâng cao.
  • Kỹ sư tích hợp hệ thống (System Integrators): Cẩm nang kỹ thuật thực chiến về cách cấu hình mạng SSCNET III, ghép nối Driver servo đa kênh và thiết kế tủ điện chống nhiễu đạt chuẩn công nghiệp.
  • Doanh nghiệp vừa và nhỏ (SMEs): Mô hình mẫu khả thi để nâng cấp, nội địa hóa các cánh tay robot cũ trong nhà xưởng nhằm tiết kiệm chi phí tự động hóa dây chuyền.

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

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

Hệ thống yêu cầu nguồn cấp 1 pha hoặc 3 pha 220VAC (50/60Hz), công suất nguồn tối thiểu 2.5 kVA. Tầng điều khiển bắt buộc sử dụng PLC Mitsubishi dòng Q (như Q03UDCPU hoặc tương đương), module vị trí QD75MH4/MH1, các driver dòng MR-J3-B/MR-J4-B kết nối qua dây cáp quang SSCNET III chuyên dụng và hệ thống tiếp địa (Grounding) điện trở dưới 100 $\Omega$.

2. Làm thế nào để mở rộng hệ thống thêm trục chuyển động (ví dụ trục xoay băng tải thứ hai)?

Module QD75MH4 quản lý tối đa 4 trục. Để mở rộng thêm trục, người dùng chỉ cần cắm thêm module vị trí (như QD75MH1 cho 1 trục hoặc QD75MH2/MH4) lên thanh Base của PLC Q-Series, cấu hình thêm I/O Address trong GX Works2 và kết nối dây cáp quang nối tiếp (daisy-chain) tới Driver Servo mới mà không cần can thiệp vào mạch phần cứng hiện tại.

3. Tại sao mạng SSCNET III lại vượt trội hơn phương pháp điều khiển phát xung truyền thống?

Mạng SSCNET III sử dụng đường truyền sợi quang quang học tốc độ cao 150 Mbps, loại bỏ 100% hiện tượng mất xung do nhiễu điện từ trường của biến tần và động cơ công suất lớn. Ngoài ra, giao thức này cho phép đọc/ghi trực tiếp hàng trăm thông số trạng thái (vị trí hiện tại, tốc độ thực, dòng điện, mã lỗi servo) chỉ qua một sợi cáp quang duy nhất.

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

Cần kiểm tra độ căng dây đai răng và bôi trơn mỡ chuyên dụng cho thanh trượt bi trục Z định kỳ 6 tháng/lần; vệ sinh bụi bẩn quạt làm mát trên Driver MR-J3/J4; kiểm tra điện áp pin nuôi nhớ tọa độ tuyệt đối (Battery backup) trên Driver Servo và CPU định kỳ hàng năm.

5. Chi phí chế tạo và thời gian thu hồi vốn thực tế là bao nhiêu?

Tổng chi phí chế tạo hoàn chỉnh mô hình là khoảng 85 triệu VNĐ. Với năng suất gắp xếp đạt 40 - 50 sản phẩm/phút, hệ thống có thể thay thế 2 nhân công làm việc thủ công, giúp doanh nghiệp tiết kiệm khoảng 12 - 15 triệu VNĐ chi phí nhân công mỗi tháng, mang lại thời gian thu hồi vốn thực tế từ 7 đến 9 tháng.

Kết luận

Đồ án tốt nghiệp "Điều khiển Robot SCARA 4 trục gắp xếp sản phẩm" đã chứng minh tính khả thi và hiệu quả vượt trội của việc kết hợp mô hình toán học động học robot chính xác với công nghệ điều khiển chuyển động công nghiệp hiện đại từ Mitsubishi Electric. Việc làm chủ toàn bộ quy trình từ tính toán ma trận D-H, thiết kế tủ điện chuẩn hóa, cấu hình mạng cáp quang SSCNET III cho đến lập trình nội suy thời gian thực trên PLC Q03UDCPU mở ra hướng đi thực tiễn trong việc nâng cấp, tự chủ công nghệ điều khiển robot tại Việt Nam, mang lại giá trị kinh tế to lớn cho các dây chuyền đóng gói và lắp ráp tự động.