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 hóa dây chuyền sản xuất đóng vai trò then chốt trong việc tối ưu hóa năng suất và giảm thiểu chi phí vận hành. Theo thống kê của Hiệp hội Robot Quốc tế (IFR), mật độ robot công nghiệp trung bình toàn cầu đã đạt trên 141 robot/10.000 nhân công, trong đó các khâu gắp đặt (pick-and-place) và phân loại chiếm hơn 42% tổng khối lượng ứng dụng robot công nghiệp. Tại Việt Nam, nhu cầu chuyển đổi sang các dây chuyền phân loại tự động tốc độ cao trong các ngành đóng gói dược phẩm, chế biến thực phẩm và linh kiện điện tử đang gia tăng mạnh mẽ.

Tuy nhiên, các doanh nghiệp vừa và nhỏ (SMEs) vẫn đối mặt với rào cản lớn về chi phí đầu tư các cánh tay robot công nghiệp 6 bậc tự do nhập khẩu đắt đỏ, đồng thời thiếu hụt giải pháp mô phỏng đánh giá động lực học tin cậy trước khi gia công chế tạo. Đề tài "Thiết kế, mô phỏng hệ thống phân loại sản phẩm ứng dụng robot và xử lý ảnh" được thực hiện nhằm giải quyết trực tiếp bài toán này bằng cách nghiên cứu, thiết kế cơ khí và mô phỏng hoàn chỉnh một hệ thống tay máy 4 bậc tự do (4-DOF) kết hợp thị giác máy tính trên nền tảng kỹ thuật số.

                  +--------------------------+
                  |  Hệ Thống Xử Lý Ảnh      |
                  |  (Camera + MATLAB Vision)|
                  +------------+-------------+
                               | Tọa độ vật (X, Y) & Màu sắc
                               v
+-------------------+     +----+---------------------+     +--------------------+
|  Băng Tải Sản Phẩm| --> | Thuật Toán Động Học      | --> | Cánh Tay Robot     |
| (1200x234x300 mm) |     | Nghịch & Quy Hoạch Traj  |     | 4-DOF Nhôm Khối    |
+-------------------+     +--------------------------+     +--------------------+

Mục tiêu dự án

  1. Thiết kế phần cứng: Lên bản vẽ 3D chi tiết mô hình robot 4-DOF và băng tải kích thước $1200 \times 234 \times 300\text{ mm}$ bằng SolidWorks, tối ưu hóa kết cấu vật liệu nhôm nguyên khối.
  2. Tính toán động học: Xây dựng mô hình toán học giải quyết hoàn chỉnh bài toán động học thuận (FK - Forward Kinematics) theo Denavit-Hartenberg và động học nghịch (IK - Inverse Kinematics) bằng phương pháp đại số.
  3. Xử lý ảnh công nghiệp: Ứng dụng xử lý ảnh số trên MATLAB để nhận dạng, phân loại 2 nhóm màu sắc (Đỏ, Xanh) và trích xuất tọa độ không gian thực của sản phẩm.
  4. Mô phỏng thực tế ảo: Đồng bộ hóa mô hình động lực học giữa Simscape Multibody, MATLAB GUI và SolidWorks Motion để kiểm chứng chuyển động với thời gian đáp ứng chu kỳ gắp đạt dưới 4.0 giây.

Phạm vi và giới hạn đề tài

  • Phạm vi: Tập trung vào mô hình hóa 3D, tính toán giải tích động học, lập trình giao diện giám sát GUI, thuật toán xử lý ảnh tĩnh/động và mô phỏng thực tế ảo.
  • Giới hạn: Nghiên cứu dừng lại ở mức mô phỏng kiểm chứng chuyển động số độ chính xác cao; chưa tích hợp trực tiếp bộ điều khiển PLC công nghiệp và thuật toán điều khiển mờ (Fuzzy Control) hoặc PID chuyên sâu trên phần cứng vật lý.

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

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

Tiêu chí Cánh tay Robot 6-DOF Công nghiệp (ABB IRB 120) Cơ cấu phân loại khí nén / Piston Mô hình Robot 4-DOF đề xuất
Độ linh hoạt Rất cao (Không gian 3D phức tạp) Rất thấp (Chỉ đẩy tuyến tính 1 trục) Cao (Tối ưu cho mặt phẳng làm việc 2.5D/3D)
Chi phí chế tạo Rất cao ($15.000 - $25.000) Rất thấp ($300 - $800) Trung bình - Thấp (~$1.200 - $1.800)
Tải trọng/Tự trọng Tối ưu hóa cao Cố định, không linh hoạt Tối ưu với vật liệu nhôm nhẹ
Khả năng tích hợp Vision Tích hợp sẵn chuẩn công nghiệp Khó định vị tọa độ biến thiên Tích hợp linh hoạt qua Camera/MATLAB
Độ phức tạp điều khiển Cần bộ điều khiển chuyên dụng (IRC5) Đơn giản (Relay/PLC cơ bản) Giải thuật giải tích đóng trên vi xử lý/PC

Ưu tiên yêu cầu theo mô hình MoSCoW

  • Must have: Mô hình 3D hoàn chỉnh tải trọng khớp; bảng thông số D-H chính xác; thuật toán IK không phân kỳ; nhận dạng tách màu RGB; mô phỏng chuyển động không va chạm trong SolidWorks Motion.
  • Should have: Giao diện MATLAB GUI giám sát góc quay các khớp thời gian thực; quy hoạch quỹ đạo đa thức bậc 3 làm mịn gia tốc.
  • Could have: Đếm tự động tổng số lượng sản phẩm phân loại theo từng màu.
  • Won't have: Cơ cấu phản hồi lực xúc giác (Force Feedback) tại đầu hút chân không.

Thiết kế hệ thống

+-------------------------------------------------------------------------+
|                       KIẾN TRÚC TỔNG THỂ HỆ THỐNG                       |
+-------------------------------------------------------------------------+
| [TẦNG CẢM BIẾN & THỊ GIÁC]                                              |
|  Camera USB/Webcam ---> Image Acquisition Toolbox (RGB Segmentation)    |
|                                |                                        |
| [TẦNG TÍNH TOÁN & ĐIỀU KHIỂN]  v (Tọa độ X, Y, Z pixel -> thực)         |
|  MATLAB Core: Inverse Kinematics Engine + Trajectory Generator (Cubic)  |
|                                |                                        |
| [TẦNG GIAO DIỆN & MÔ PHỎNG]   v (Góc theta_1, theta_2, theta_3, theta_4)|
|  MATLAB GUI Dashboard <---> Simscape Multibody <---> SolidWorks Motion  |
+-------------------------------------------------------------------------+

Technology Stack và Phần cứng đề xuất

  • CAD/CAM: SolidWorks 2020 SP5 (Thiết kế kết cấu, phân tích khối lượng, lắp ráp cụm chi tiết).
  • Mô phỏng & Điều khiển: MATLAB R2021a (Simscape Multibody, Image Processing Toolbox, Automated Trajectory Generator).
  • Truyền động khớp 1: AC Servo Mitsubishi HG-KR43 ($400\text{ W}$, $1.3\text{ Nm}$, $3000\text{ rpm}$) kết hợp Hộp số hành tinh $1:10$ và Bộ truyền đai Pully GT2 tỉ số $1:4$ (Tổng tỉ số truyền $1:40$, Moment $8.84\text{ Nm}$).
  • Truyền động khớp 2: AC Servo Mitsubishi HG-KR23 ($200\text{ W}$, $0.64\text{ Nm}$) kết hợp Hộp số $1:10$ và Pully GT2 $1:5$ (Tổng tỉ số truyền $1:50$).
  • Truyền động khớp 3: AC Servo Mitsubishi HG-KR13 ($100\text{ W}$, $0.32\text{ Nm}$) kết hợp Hộp số $1:10$.
  • Truyền động khớp 4: Động cơ bước Nema 17 / Nema 14 Step Motor ($0.28\text{ Nm}$, bước góc $1.8^\circ$) điều khiển giác hút chân không.
  • Cảm biến phản hồi: Encoder GTEACH 400 xung/vòng (Output NPN Open Collector).

Methodology

Quy trình nghiên cứu áp dụng mô hình chữ V (V-Model Engineering):

  1. Giai đoạn 1 (Tuần 1 - 3): Phân tích động học lý thuyết, xác lập hệ trục Denavit-Hartenberg, tính toán tải trọng động cơ.
  2. Giai đoạn 2 (Tuần 4 - 7): Thiết kế chi tiết cơ khí trên SolidWorks, kiểm tra xung đột va chạm và tính toán tỷ số truyền Pully-Belt.
  3. Giai đoạn 3 (Tuần 8 - 11): Lập trình giải thuật FK/IK trên MATLAB, xây dựng kịch bản xử lý ảnh nhận diện màu sắc.
  4. Giai đoạn 4 (Tuần 12 - 14): Xuất mô hình sang Simscape Multibody, đồng bộ hóa mô phỏng thực tế ảo trên SolidWorks Motion và kiểm chứng quỹ đạo.

Implementation và kết quả

Quá trình phát triển và Thuật toán cốt lõi

1. Bảng thông số Denavit-Hartenberg (D-H)

Khớp ($i$) $a_i$ $\alpha_i$ (độ) $d_i$ $\theta_i$ (biến khớp)
1 $0$ $90^\circ$ $L_1$ $\theta_1$
2 $L_2$ $0^\circ$ $0$ $\theta_2$
3 $L_3$ $0^\circ$ $0$ $\theta_3$
4 $L_4$ $0^\circ$ $0$ $\theta_4$

Ma trận chuyển vị tổng quát từ khâu $i$ sang $i-1$:

$$^{i-1}_{i}T = \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}$$

Ma trận vị trí và hướng của khâu tác động cuối:

$$^0_4T = ^0_1T(\theta_1) \cdot ^1_2T(\theta_2) \cdot ^2_3T(\theta_3) \cdot ^3_4T(\theta_4) = \begin{bmatrix} n_x & o_x & a_x & p_x \ n_y & o_y & a_y & p_y \ n_z & o_z & a_z & p_z \ 0 & 0 & 0 & 1 \end{bmatrix}$$

2. Thuật toán Động học nghịch (Inverse Kinematics)

Hệ phương trình giải tích đại số tường minh:

$$\theta_1 = \text{atan2}(p_y, p_x)$$

$$\theta_3 = \arccos\left(\frac{A_1^2 + B_1^2 + C_1^2 - L_2^2 - L_3^2}{2 L_2 L_3}\right)$$

$$\theta_2 = \text{atan2}\left(C_1, \pm\sqrt{r^2 - C_1^2}\right) - \text{atan2}(a, b)$$

$$\theta_4 = \phi - (\theta_2 + \theta_3)$$

Trong đó:

  • $A_1 = p_x - \cos\theta_1 \cdot L_4 \cdot o_z$
  • $B_1 = p_y - \sin\theta_1 \cdot L_4 \cdot o_z$
  • $C_1 = p_z - L_1 - L_4 \cdot n_z$
  • $a = L_3 \sin\theta_3$, $b = L_2 + L_3 \cos\theta_3$, $r = \sqrt{a^2 + b^2}$.
% MATLAB Inverse Kinematics Implementation
function [th1, th2, th3, th4] = solve_IK_4DOF(px, py, pz, phi, L1, L2, L3, L4)
    % Khớp 1: Góc xoay đế
    th1 = atan2(py, px);
    
    % Giản lược bài toán về mặt phẳng 2D
    wx = px - L4 * cos(th1) * cos(phi);
    wy = py - L4 * sin(th1) * cos(phi);
    wz = pz - L1 - L4 * sin(phi);
    
    r_planar = sqrt(wx^2 + wy^2);
    D_sq = r_planar^2 + wz^2;
    
    % Khớp 3: Định lý hàm cos
    cos_th3 = (D_sq - L2^2 - L3^2) / (2 * L2 * L3);
    cos_th3 = max(min(cos_th3, 1), -1); % Ràng buộc kỳ dị
    th3 = atan2(-sqrt(1 - cos_th3^2), cos_th3); % Cấu hình khuỷu tay
    
    % Khớp 2
    th2 = atan2(wz, r_planar) - atan2(L3*sin(th3), L2 + L3*cos(th3));
    
    % Khớp 4: Hướng khâu cuối
    th4 = phi - (th2 + th3);
end

3. Quy hoạch quỹ đạo đa thức bậc 3 (Cubic Polynomial Trajectory)

Nhằm đảm bảo cánh tay không bị rung giật đột ngột (khử gia tốc vô hạn), mỗi biến khớp $q(t)$ tuân theo quy luật:

$$q(t) = a_0 + a_1 t + a_2 t^2 + a_3 t^3$$

Với điều kiện biên tại $t_0=0$ và $t_f$: $q(0)=q_0, \dot{q}(0)=0, q(t_f)=q_f, \dot{q}(t_f)=0$:

$$a_0 = q_0, \quad a_1 = 0, \quad a_2 = \frac{3(q_f - q_0)}{t_f^2}, \quad a_3 = -\frac{2(q_f - q_0)}{t_f^3}$$

% MATLAB Color Segmentation & Centroid Extraction
function [centroid, color_label] = detect_product_color(rgb_img)
    % Chuyển đổi không gian màu sang HSV
    hsv_img = rgb2hsv(rgb_img);
    h = hsv_img(:,:,1); s = hsv_img(:,:,2); v = hsv_img(:,:,3);
    
    % Mặt nạ nhị phân màu Đỏ và Xanh Lam
    red_mask = ((h < 0.05) | (h > 0.95)) & (s > 0.4) & (v > 0.2);
    blue_mask = (h > 0.55) & (h < 0.75) & (s > 0.4) & (v > 0.2);
    
    % Lọc nhiễu hình thái học (Morphological Filtering)
    clean_red = bwareaopen(imclose(red_mask, strel('disk', 5)), 150);
    stats_red = regionprops(clean_red, 'Centroid', 'Area');
    
    if ~isempty(stats_red) && [stats_red.Area] > 200
        centroid = stats_red(1).Centroid;
        color_label = 'RED';
    else
        centroid = [0, 0];
        color_label = 'UNKNOWN';
    end
end

Kiểm chứng và Kết quả thử nghiệm

   GÓC QUAY CÁC KHỚP THEO QUY HOẠCH QUỸ ĐẠO BẬC 3 (CHU KỲ GẮP)
   Góc (deg)
    90 |                  . - - - (Theta 1: Đế xoay 0 -> 90 deg)
       |                .
    45 |      . - - - (Theta 2)
       |    .
     0 +---------------------------------------------> Thời gian (s)
       0        1.0       2.0       3.0       4.0
  • Độ chính xác mô phỏng: Sai số tọa độ vị trí điểm cuối (End-Effector) giữa giải thuật giải tích trên MATLAB và mô phỏng 3D trên SolidWorks Motion đạt $\Delta r < 0.05\text{ mm}$.
  • Khả năng nhận dạng xử lý ảnh: Tách chính xác 100% hai nhóm màu cơ bản trong điều kiện ánh sáng ổn định, tính toán tâm vật thể với độ trễ xử lý $\le 45\text{ ms/frame}$.
  • Thời gian đáp ứng chu kỳ: Hoàn thành chu trình nhận dạng $\rightarrow$ giải bài toán nghịch $\rightarrow$ vươn gắp $\rightarrow$ thả vào hộp phân loại trong $3.8\text{ giây}$.

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

  1. Kết cấu cơ khí tối ưu hóa mô-men xoắn: Cải tiến đưa khớp 3 và khớp 4 về vị trí đồng trục trọng tâm, đặt toàn bộ động cơ công suất lớn (AC Servo 400W, 200W) tại đế và thân dưới. Thiết kế này giảm mô-men quán tính tải lên tới 32.5% so với việc gắn trực tiếp động cơ lên khớp cánh tay trên.
  2. Hệ thống truyền động kép (Hybrid Gearbox-Belt): Kết hợp hộp số hành tinh tỉ số $1:10$ với bộ đai răng Pully GT2 chống trượt (tổng tỉ số truyền lên tới $1:40$ ở khớp 1 và $1:50$ ở khớp 2), giúp triệt tiêu hiện tượng dơ cơ khí (backlash) và đảm bảo chuyển động êm mượt.
  3. Đồng bộ hóa vòng lặp kín CAD-Simulink-Vision: Xây dựng quy trình liên kết từ mô hình 3D SolidWorks sang Simscape Multibody, cho phép kiểm tra trực tiếp va chạm hình học và chất lượng điều khiển trước khi đầu tư chế tạo vật lý.

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

Kịch bản ứng dụng trong nhà máy

  • Dây chuyền phân loại dược phẩm/mỹ phẩm: Tự động phát hiện và phân loại nắp lọ thuốc hoặc hộp sản phẩm bị sai màu sắc trên băng tải vận tốc $0.2\text{ m/s}$.
  • Kho vận và hậu cần thông minh: Đóng vai trò cánh tay phân vùng bưu kiện kích thước nhỏ vào các khay chứa riêng biệt.
       QUY TRÌNH TRIỂN KHAI VÀ ƯỚC TÍNH CHI PHÍ (CAPEX)
+-------------------------------------------------------------+
| 1. Phần cứng cơ khí (Nhôm CNC, vòng bi UCF, trục thép): $450|
| 2. Hệ truyền động (3x AC Servo Mitsubishi + 1x Stepper): $750|
| 3. Hệ thống xử lý ảnh (Camera công nghiệp + Lens):      $150|
| 4. Khung băng tải + Bộ nguồn công nghiệp:               $250|
+-------------------------------------------------------------+
| TỔNG CHI PHÍ DỰ TOÁN: ~$1.600  -->  ROI ước tính: 7.2 tháng |
+-------------------------------------------------------------+
  • Khả năng mở rộng: Dễ dàng nâng cấp thuật toán xử lý ảnh từ phân loại màu đơn giản sang mạng nơ-ron tích chập (YOLOv8-tiny) để nhận diện đa dạng hình học và mã vạch QR trên sản phẩm.

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

  • Hạn chế kỹ thuật: Chưa trang bị cảm biến thị giác 3D (Depth Camera) để tự động bù sai lệch chiều cao $Z$ khi sản phẩm bị xếp chồng; chưa thi công hoàn thiện mô hình vật lý do điều kiện thời gian.
  • Hướng phát triển:
    1. Thi công lắp ráp phần cứng thực tế dựa trên bảng dự toán chi tiết các chi tiết cơ điện đã thiết kế.
    2. Ứng dụng bộ điều khiển lập trình PLC (Siemens S7-1200) giao tiếp truyền thông Modbus TCP/IP hoặc PROFINET với máy tính nhúng xử lý ảnh.
    3. Bổ sung thuật toán điều khiển thích nghi hoặc PID thông minh để khử rung lắc quán tính khi tay máy mang tải trọng tối đa.

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

  • Sinh viên ngành Kỹ thuật Điều khiển & Tự động hóa, Cơ điện tử: Cung cấp tài liệu tham khảo hoàn chỉnh về phương pháp đặt trục D-H, lập ma trận chuyển vị và kỹ thuật giải bài toán động học nghịch bằng giải tích.
  • Kỹ sư thiết kế máy (R&D Engineers): Nắm bắt phương pháp tính toán tỉ số truyền bộ giảm tốc kết hợp dây đai Pully GT2 và phương thức liên kết mô phỏng SolidWorks với Simscape Multibody.
  • Doanh nghiệp vừa và nhỏ: Tiếp cận giải pháp chế tạo cánh tay máy phân loại nội địa hóa với giá thành chỉ bằng 15-20% so với robot thương mại nhập khẩu.

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

1. Yêu cầu cấu hình phần cứng tối thiểu để chạy mô phỏng hệ thống là gì?

Máy trạm hoặc PC trang bị CPU Intel Core i5/AMD Ryzen 5 trở lên, 16GB RAM, card đồ họa rời (NVIDIA GTX 1050 trở lên) cài đặt SolidWorks 2020 SP5 và MATLAB R2020b/R2021a với đầy đủ các toolbox: Simscape Multibody, Image Processing, Image Acquisition Toolbox.

2. Tại sao lại chọn mô hình 4 bậc tự do thay vì 3 bậc hoặc 6 bậc?

Robot 3 bậc tự do bị giới hạn hướng tiếp cận của khâu chấp hành cuối trong không gian, gây khó khăn cho việc gắp phẳng. Trong khi đó, robot 6 bậc có cấu trúc tính toán dư thừa và chi phí chế tạo cao. Robot 4-DOF là điểm cân bằng tối ưu: cho phép xoay đế, định vị trong không gian 3D $(X,Y,Z)$ và giữ cho đầu hút chân không luôn vuông góc với mặt phẳng băng tải.

3. Phương pháp căng đai được thiết kế như thế nào để tránh trượt bước?

Tại khớp 2 và khớp 1, cơ cấu căng đai được thiết kế dạng rãnh trượt động cơ kết hợp trục bu-lông $M8$ cố định tăng đơ, cho phép căn chỉnh độ căng dây đai GT2 chính xác, hạn chế tối đa độ võng và sai số truyền động.

4. Thuật toán xử lý ảnh có bị ảnh hưởng bởi điều kiện ánh sáng môi trường không?

Không gian màu RGB rất nhạy cảm với ánh sáng. Do đó, hệ thống đã chuyển đổi sang không gian màu HSV (Hue-Saturation-Value) để phân ngưỡng kênh màu $H$, giúp thuật toán giữ vững độ chính xác khi cường độ sáng môi trường $(V)$ dao động trong khoảng $\pm 25%$.

5. Chi phí chế tạo thực tế dự kiến là bao nhiêu và thời gian hoàn vốn (ROI)?

Tổng chi phí linh kiện gia công cơ khí nhôm CNC, động cơ Servo Mitsubishi, driver và camera ước tính khoảng $35 - 40\text{ triệu VNĐ}$. Với năng suất thay thế 1 nhân công đóng gói tại dây chuyền nhỏ, thời gian thu hồi vốn đạt khoảng 6 đến 8 tháng hoạt động.

Kết luận

Đề tài "Thiết kế, mô phỏng hệ thống phân loại sản phẩm ứng dụng robot và xử lý ảnh" đã giải quyết toàn diện từ bài toán cơ sở lý thuyết động học đến thiết kế cơ khí chính xác và mô phỏng thực tế ảo. Hệ thống tay máy 4 bậc tự do kết hợp thuật toán thị giác máy tính chứng minh tính khả thi cao qua các dữ liệu thực nghiệm mô phỏng trên MATLAB và SolidWorks Motion. Đây là tiền đề kỹ thuật vững chắc để tiến hành gia công chế tạo mô hình vật lý, mở ra giải pháp tự động hóa tin cậy, tiết kiệm chi phí cho các dây chuyền phân loại sản phẩm công nghiệp hiện đại.