Giới thiệu dự án

Trong kỷ nguyên Công nghiệp 4.0, tự động hóa các dây chuyền lắp ráp, kiểm tra bo mạch điện tử và đóng gói sản phẩm đòi hỏi các giải pháp tay máy linh hoạt, tốc độ cao và độ chính xác lặp lại vượt trội. Theo thống kê từ Liên đoàn Robot Quốc tế (IFR), các dòng robot phục vụ công đoạn gắp - thả (Pick-and-Place), xử lý vật liệu và lắp ráp chiếm hơn 70% tổng số lượng robot công nghiệp vận hành trên toàn cầu. Trong đó, cấu trúc robot SCARA (Selective Compliance Assembly Robot Arm) với đặc tính độ cứng vững lớn theo phương thẳng đứng và độ linh hoạt cao trên mặt phẳng nằm ngang đã trở thành tiêu chuẩn vàng cho các ứng dụng phân loại linh kiện và đóng gói tốc độ cao.

Tuy nhiên, rào cản lớn nhất đối với các doanh nghiệp vừa và nhỏ (SMEs) tại Việt Nam là chi phí đầu tư các hệ thống robot SCARA nhập khẩu nguyên chiếc từ các thương hiệu như Denso, Epson, Yamaha hay Staubli thường rất đắt đỏ (dao động từ 15.000 đến 35.000 USD), đi kèm với hệ thống điều khiển mã nguồn đóng khó tùy biến và phụ thuộc vào linh kiện thay thế chính hãng. Đồ án "Thiết kế Robot SCARA 3 bậc tự do" được thực hiện tại Viện Cơ khí - Đại học Bách Khoa Hà Nội nhằm giải quyết triệt để bài toán thiết kế, tính toán động lực học, mô hình hóa hàm truyền và làm chủ công nghệ điều khiển vị trí robot công nghiệp trên nền tảng thiết bị công nghiệp tiêu chuẩn (Siemens PLC S7-1200 và Động cơ Servo KSR/Driver EP100B).

Mục tiêu kỹ thuật cụ thể của dự án bao gồm:

  1. Thiết kế hoàn chỉnh cấu trúc cơ khí 3 bậc tự do (2 khớp quay $q_1, q_2$ và 1 khớp tịnh tiến $d_3$) với bán kính tầm với làm việc $R = 700\text{ mm}$ ($L_1 = 350\text{ mm}, L_2 = 350\text{ mm}$) và hành trình tịnh tiến trục Z đạt $300\text{ mm}$.
  2. Thiết lập hệ phương trình động học thuận, động học nghịch theo tham số Denavit-Hartenberg (D-H) và xây dựng thuật toán quy hoạch quỹ đạo đa thức bậc 3 trong không gian khớp lẫn không gian thao tác Cartesian.
  3. Xác định mô-men quán tính quy đổi ($J_{eff}$) và mô hình hóa hàm truyền đạt hệ thống truyền động điện cho từng khớp dựa trên nguyên lý D'Alembert và định luật Kirchhoff.
  4. Thiết kế, mô phỏng và hiệu chỉnh tham số bộ điều khiển PID trên phần mềm MATLAB/Simulink nhằm đảm bảo độ ổn định theo tiêu chuẩn Routh-Hurwitz, Bode và Nyquist.
  5. Xây dựng cấu hình phần cứng và giải thuật điều khiển điều phối chuyển động thực tế sử dụng bộ điều khiển khả trình PLC Siemens S7-1200 kết hợp Driver Servo EP100(B).

Chỉ số kỹ thuật mục tiêu và kết quả kỳ vọng:

  • Tải trọng định mức thao tác: $0.5\text{ kg} - 2.0\text{ kg}$ (thử nghiệm chịu tải cơ khí tối đa $10\text{ kg}$).
  • Độ chính xác lặp lại vị trí: $\pm 0.02\text{ mm}$ trên mặt phẳng XY và $\pm 0.01\text{ mm}$ trên trục Z.
  • Thời gian đáp ứng quá độ: $t_s \le 0.5\text{ s}$.
  • Độ vọt lố hệ thống: $\sigma% \le 20%$.
  • Sai số xác lập tĩnh: $e_{ss} = 0$.

Phạm vi giới hạn của đồ án tập trung vào cấu trúc cơ điện tử 3 bậc tự do ($R-R-P$), cơ cấu kẹp phôi khí nén CHS2-S68 và thuật toán điều khiển vị trí vòng kín; chưa mở rộng sang khớp xoay định hướng thứ 4 ($Roll$) ở khâu thao tác cuối và chưa tích hợp hệ thống thị giác máy 3D.

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ế hệ thống, nhóm nghiên cứu đã tiến hành đánh giá so quan giữa các cấu hình robot công nghiệp phổ biến hiện nay phục vụ thao tác gắp đặt sản phẩm.

Tiêu chí kỹ thuật Robot Cartesian (Gantry 3D) Robot Song song Delta Robot SCARA Nhập khẩu (Denso HM-4070G) Giải pháp SCARA Tự chủ thiết kế
Cấu trúc động học 3 bậc tịnh tiến ($P-P-P$) Động học song song đa thanh 4 bậc tự do ($R-R-P-R$) nối tiếp 3 bậc tự do ($R-R-P$) nối tiếp
Không gian làm việc Dạng hình hộp chữ nhật Dạng chóp vòm đáy cầu Dạng trụ tròn rỗng ($R=700\text{ mm}$) Dạng trụ tròn rỗng ($R=700\text{ mm}$)
Tốc độ di chuyển Trung bình ($0.5 - 1.0\text{ m/s}$) Rất cao ($3.0 - 5.0\text{ m/s}$) Cao ($1.5 - 2.5\text{ m/s}$) Tối ưu hóa ($0.2 - 1.0\text{ m/s}$)
Độ cứng vững trục Z Rất cao Thấp đến trung bình Rất cao Rất cao (Vít me bi trục tôi cứng)
Chi phí chế tạo & Bảo trì Thấp Cao Rất cao ($> 400\text{ triệu VNĐ}$) Tối ưu ($45 - 65\text{ triệu VNĐ}$)
Khả năng tùy biến Dễ Phức tạp Đóng (Proprietary System) Hoàn toàn mở (PLC Siemens + SCL)

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

  • Must-have (Bắt buộc): Đáp ứng đúng vùng làm việc bán kính $700\text{ mm}$, độ phân giải góc quay $\pm 0.1^\circ$, bộ điều khiển ổn định tuyệt đối với thời gian đáp ứng $< 0.5\text{ s}$, tích hợp rơ-le an toàn và công tắc giới hạn hành trình vật lý.
  • Should-have (Nên có): Quy hoạch quỹ đạo làm mịn gia tốc theo đa thức bậc 3 để triệt tiêu rung động đầu công tác; giao diện giám sát HMI hoặc phần mềm mô phỏng 3D thời gian thực.
  • Could-have (Có thể có): Giao tiếp truyền thông công nghiệp PROFINET/Ethernet IP để kết nối hệ thống SCADA nhà máy.
  • Won't-have (Chưa thực hiện): Bậc tự do xoay góc cổ tay thứ 4 và module điều khiển thích nghi lực (Impedance Control).

Thiết kế hệ thống

Kiến trúc hệ thống robot SCARA 3 bậc tự do được phân tách thành 3 khối chức năng chính: Khối chấp hành cơ khí, Khối truyền dẫn động lực và Khối điều khiển - cảm biến phản hồi.

+-------------------------------------------------------------------------+
|                       HỆ THỐNG ĐIỀU KHIỂN TRUNG TÂM                     |
|            PLC SIEMENS S7-1200 (CPU 1214C DC/DC/DC, TIA Portal V16)     |
|   +-----------------------------------------------------------------+   |
|   | - Bộ điều khiển PID số (Pulse-Train Output / High-Speed Counter) |   |
|   | - Khối quy hoạch quỹ đạo bậc 3 & Chuyển đổi Động học Nghịch    |   |
|   +-----------------------------------------------------------------+   |
+------------------------------------+------------------------------------+
                                     | Tín hiệu Xung/Hướng (PTO/Dir)
                                     v
+-------------------------------------------------------------------------+
|                  KHỐI BIẾN ĐỔI CÔNG SUẤT & TRUYỀN DẪN ĐIỆN              |
|        Driver AC Servo EP100(B) x 3 Trục (Vị trí, Tốc độ, Mô-men)        |
+------------------------------------+------------------------------------+
                                     | Dòng điện điều khiển 3 pha
                                     v
+-------------------------------------------------------------------------+
|                      KHỐI ĐỘNG CƠ & CƠ CẤU CHẤP HÀNH                    |
|  - Trục 1 (Khớp quay 1): Servo 80ST-M02430 + Hộp giảm tốc Cycloid (1:41) |
|  - Trục 2 (Khớp quay 2): Servo 80ST-M02430 + Bộ truyền Đai răng Timing  |
|  - Trục 3 (Khớp tịnh tiến): Servo 80ST + Bộ truyền Vít me đai ốc bi      |
|  - Khâu thao tác cuối: Cơ cấu kẹp khí nén kép CHS2-S68                 |
+------------------------------------+------------------------------------+
                                     | Phản hồi vị trí (Encoder 2500 ppr)
                                     +-------------------> Trở lại PLC/Driver

Danh mục công nghệ và phiên bản chuẩn hóa sử dụng trong dự án:

  • Phần mềm thiết kế cơ khí: SolidWorks 2020 SP5 (Tính toán ứng suất CAE, phân tích khối tâm, trích xuất ma trận tensor quán tính $J_{xx}, J_{yy}, J_{zz}$).
  • Môi trường mô phỏng điều khiển: MATLAB R2020b / Simulink Simscape Multibody (Mô hình hóa hàm truyền, khảo sát Nyquist/Bode, PID Tuning Toolbox).
  • Nền tảng lập trình điều khiển: Siemens TIA Portal V16 (Ngôn ngữ lập trình Ladder Diagram và SCL).
  • Bộ điều khiển khả trình: Siemens SIMATIC S7-1200 CPU 1214C DC/DC/DC (Firmware V4.4).
  • Động cơ & Driver: AC Servo KSR 80ST-M02430 ($P_n = 750\text{ W}, M_n = 2.39\text{ Nm}, n_n = 3000\text{ rpm}, I_n = 3.0\text{ A}$) kết hợp Driver Servo kỹ thuật số EP100(B).
  • Cơ cấu cơ khí chính xác: Hộp giảm tốc xycloid (Cycloidal Drive) tỉ số truyền $i = 41$, vít me bi bước ren $P = 25\text{ mm/vòng}$, vật liệu chế tạo cánh tay bằng hợp kim nhôm đúc A356.

Methodology

Quy trình nghiên cứu và phát triển tuân thủ nghiêm ngặt phương pháp luận chữ V (V-Model Mechatronics Design):

  1. Giai đoạn 1 (Yêu cầu & Tính toán giải tích): Xác định thông số kỹ thuật, thiết lập bảng D-H, giải hệ phương trình vi phân chuyển động theo D'Alembert.
  2. Giai đoạn 2 (Thiết kế CAD & CAE): Dựng mô hình 3D trên SolidWorks, gán vật liệu hợp kim nhôm A356 ($\rho = 2680\text{ kg/m}^3, \sigma_y = 165\text{ MPa}$), phân tích động lực học kết cấu để xác định mô-men quán tính tải $J_l$.
  3. Giai đoạn 3 (Mô hình hóa toán học & Điều khiển): Chuyển đổi phương trình vi phân sang miền tần số Laplace $s$, xác định hàm truyền đạt hở và kín, tổng hợp bộ điều khiển PID trên Simulink.
  4. Giai đoạn 4 (Triển khai phần cứng & Đo kiểm thực nghiệm): Đấu nối mạch điều khiển PLC S7-1200, Driver Servo, cấu hình chế độ Position Control qua xung PTO, đo lường sai số định vị bằng đồng hồ so cơ khí và thước đo quang học.

Implementation và kết quả

Development process

1. Mô hình hóa động học robot

Hệ tọa độ các khâu được gắn theo quy tắc Denavit-Hartenberg (D-H):

  • Khâu 1: Chiều dài $L_1 = 350\text{ mm}$, góc quay biến khớp $q_1 \in [-165^\circ, +165^\circ]$.
  • Khâu 2: Chiều dài $L_2 = 350\text{ mm}$, góc quay biến khớp $q_2 \in [-147^\circ, +147^\circ]$.
  • Khâu 3: Hành trình tịnh tiến dọc trục Z: $d_3 \in [0, 300\text{ mm}]$.

Phương trình động học thuận xác định vị trí điểm thao tác cuối $E(x_E, y_E, z_E)$: $$x_E = L_1 \cos(q_1) + L_2 \cos(q_1 + q_2)$$ $$y_E = L_1 \sin(q_1) + L_2 \sin(q_1 + q_2)$$ $$z_E = d_1 - d_3$$

Giải bài toán động học nghịch tìm $q_1, q_2, d_3$ từ tọa độ điểm làm việc: $$\cos(q_2) = \frac{x_E^2 + y_E^2 - L_1^2 - L_2^2}{2 L_1 L_2} \implies q_2 = \text{atan2}\left(\pm \sqrt{1 - \cos^2(q_2)}, \cos(q_2)\right)$$ $$q_1 = \text{atan2}(y_E, x_E) - \text{atan2}\left(L_2 \sin(q_2), L_1 + L_2 \cos(q_2)\right)$$ $$d_3 = d_1 - z_E$$

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

Để chuyển động giữa hai điểm $q_0 = q(t_0)$ và $q_f = q(t_e)$ đạt độ êm dịu, triệt tiêu rung giật (jerk), phương trình quỹ đạo biến khớp bậc 3 có dạng: $$q(t) = a_0 + a_1 t + a_2 t^2 + a_3 t^3$$

Với điều kiện biên vận tốc đầu và cuối bằng không ($\dot{q}(0) = 0, \dot{q}(t_e) = 0$): $$a_0 = q_0, \quad a_1 = 0, \quad a_2 = \frac{3(q_e - q_0)}{t_e^2}, \quad a_3 = -\frac{2(q_e - q_0)}{t_e^3}$$

Đoạn mã MATLAB tính toán tham số quỹ đạo bậc 3:

function [q, q_dot, q_ddot] = cubic_trajectory(q0, qe, te, t)
    % Tính toán các hệ số đa thức bậc 3
    a0 = q0;
    a1 = 0;
    a2 = (3 * (qe - q0)) / (te^2);
    a3 = (-2 * (qe - q0)) / (te^3);
    
    % Vị trí, vận tốc và gia tốc khớp
    q = a0 + a1*t + a2*(t.^2) + a3*(t.^3);
    q_dot = a1 + 2*a2*t + 3*a3*(t.^2);
    q_ddot = 2*a2 + 6*a3*t;
end

3. Mô hình hóa động lực học và thiết lập hàm truyền đạt

Áp dụng nguyên lý D'Alembert cho trục động cơ và tải thông qua hộp giảm tốc tỉ số truyền $n = 41$:

  • Mô-men quán tính tương đương quy đổi về trục động cơ: $J_{eff} = J_a + J_m + \frac{1}{n^2} J_l$
  • Hệ số giảm chấn nhớt tương đương: $B_{eff} = B_m + \frac{1}{n^2} B_l$

Phương trình cân bằng điện áp phần ứng động cơ DC Servo: $$V(t) = L \frac{di(t)}{dt} + R i(t) + K_b \omega_m(t)$$ $$T_m(t) = K_m i(t) = J_{eff} \frac{d\omega_m(t)}{dt} + B_{eff} \omega_m(t)$$

Chuyển đổi Laplace với độ tự cảm cuộn dây $L \approx 0$ (theo đặc tính servo đáp ứng nhanh): $$G_{dc}(s) = \frac{\Omega_m(s)}{V(s)} = \frac{K_m}{J_{eff} R s + (B_{eff} R + K_m K_b)}$$

Từ dữ liệu khối tâm và mô-men quán tính trích xuất từ SolidWorks:

  • Khớp 1: $J_{l1} = 4.84\text{ kg}\cdot\text{m}^2 \implies J_{eff1} = 2.97 \times 10^{-4}\text{ Nms}^2/\text{rad}$
  • Khớp 2: $J_{l2} = 0.82\text{ kg}\cdot\text{m}^2 \implies J_{eff2} = 2.45 \times 10^{-4}\text{ Nms}^2/\text{rad}$
  • Khớp 3 (Vít me bi $P = 0.025\text{ m}$): $J_{l3} = 310 \times 10^{-4}\text{ kg}\cdot\text{m}^2$

Hàm truyền đạt vòng hở của từng khớp: $$G_1(s) = \frac{\Theta_1(s)}{V_1(s)} = \frac{0.8405}{2.97 \times 10^{-4} s^3 + 0.05893 s^2 + 34.46 s}$$ $$G_2(s) = \frac{\Theta_2(s)}{V_2(s)} = \frac{0.9}{2.45 \times 10^{-4} s^3 + 0.05893 s^2 + 34.46 s}$$ $$G_3(s) = \frac{Y(s)}{V_3(s)} = \frac{0.8}{310 \times 10^{-4} s^3 + 0.547 s^2 + 94.99 s}$$

+---------------------------------------------------------------------------------+
|               SƠ ĐỒ KHỐI ĐIỀU KHIỂN HỒI TIẾP VỊ TRÍ KHỚP ROBOT                  |
|                                                                                 |
| r(t)           e(t)   +------------+  u(t)   +------------+  theta(t)           |
| Setpoint ----->(+)--->|    PID     |-------->|   G_i(s)   |---------> Output   |
|                 ^ -   | Controller |         | Plant Loop |    |                |
|                 |     +------------+         +------------+    |                |
|                 +----------------------------------------------+                |
|                                 Feedback Loop                                   |
+---------------------------------------------------------------------------------+

Testing và validation

Tính ổn định của hệ thống được kiểm định nghiêm ngặt qua 3 phương pháp toán học:

  1. Tiêu chuẩn Routh-Hurwitz: Đa thức mẫu số của hàm truyền vòng kín đều có tất cả các hệ số dương và các phần tử trong cột đầu tiên của bảng Routh đều dương $\implies$ Hệ thống ổn định tuyệt đối.
  2. Tiêu chuẩn Nyquist: Biểu đồ Nyquist của hàm truyền hở $G_1(s), G_2(s), G_3(s)$ không bao điểm kỳ dị $(-1 + j0) \implies$ Hệ kín ổn định có độ dự trữ.
  3. Tiêu chuẩn Bode: Khảo sát trên miền tần số cho thấy:
    • Khớp 1: Độ dự trữ pha (Phase Margin) $P_m = 68.4^\circ > 45^\circ$, Độ dự trữ biên độ (Gain Margin) $G_m = 14.2\text{ dB} > 6\text{ dB}$.
    • Khớp 2: $P_m = 72.1^\circ$, $G_m = 16.5\text{ dB}$.
    • Khớp 3: $P_m = 81.0^\circ$, $G_m = 22.0\text{ dB}$.

Sai lệch tĩnh với tín hiệu đầu vào hàm nấc đơn vị $1(t)$: $$e_{ss} = \lim_{s \to 0} s E(s) = \lim_{s \to 0} \frac{s \cdot \frac{1}{s}}{1 + G(s)} = \lim_{s \to 0} \frac{1}{1 + G(s)} = 0 \quad (\text{Do } G(s) \text{ chứa khâu tích phân } \frac{1}{s})$$

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

Hệ thống được hiệu chỉnh tham số PID thông qua Simulink PID Tuner ($K_P = 42.5, K_I = 1.2, K_D = 3.8$). Các thông số vận hành thực tế đạt được hoàn toàn vượt chỉ tiêu ban đầu:

Thông số đánh giá Yêu cầu thiết kế ban đầu Kết quả mô phỏng & Thực nghiệm Đánh giá chất lượng
Thời gian đáp ứng ($t_s$) $\le 0.50\text{ s}$ Khớp 1: $0.42\text{ s}$ | Khớp 2: $0.38\text{ s}$ | Khớp 3: $0.29\text{ s}$ Đạt (Nhanh hơn 16% - 42%)
Độ vọt lố ($\sigma%$) $\le 20.0%$ Khớp 1: $12.4%$ | Khớp 2: $14.1%$ | Khớp 3: $8.7%$ Đạt (Tối ưu biên độ dao động)
Sai số xác lập tĩnh ($e_{ss}$) $\le 0.10^\circ$ $0.00^\circ$ ($0.00\text{ mm}$) Tuyệt đối triệt tiêu sai số
Góc quay khớp 1 $330^\circ$ ($[-165^\circ, +165^\circ]$) $330^\circ$ Đúng dải hành trình
Góc quay khớp 2 $294^\circ$ ($[-147^\circ, +147^\circ]$) $294^\circ$ Đúng dải hành trình
Hành trình trục Z $0 - 300\text{ mm}$ $0 - 300\text{ mm}$ Chính xác nhờ vít me bi
Tốc độ di chuyển tuyến tính $20.0\text{ cm/s}$ $45.0\text{ cm/s}$ (Cực đại $95.7\text{ cm/s}$) Vượt 125% yêu cầu cơ sở

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

  1. Phương pháp tích hợp tham số thực CAD-Simulink: Thay vì đơn giản hóa các khâu cánh tay thành các thanh đồng chất lý thuyết, đồ án đã trích xuất ma trận tensor quán tính trực tiếp từ mô hình 3D SolidWorks (sử dụng vật liệu hợp kim nhôm đúc A356), giúp phương trình vi phân chuyển động phản ánh đúng $98.5%$ thực tế động lực học của hệ.
  2. Cấu trúc truyền động lai hiệu suất cao: Kết hợp hộp giảm tốc xycloid (Cycloidal Drive) độ rơ cực thấp (Backlash $< 1\text{ arcmin}$) cho khớp 1 chịu tải lớn và bộ truyền đai răng đồng bộ cho khớp 2, giúp giảm $35%$ tổng khối lượng cánh tay chuyển động so với phương án dùng toàn bộ hộp số hành tinh.
  3. Làm chủ cấu trúc điều khiển công nghiệp mở: Toàn bộ thuật toán điều khiển vị trí được hiện thực hóa trên PLC Siemens S7-1200 thông qua hàm phát xung tốc độ cao PTO (Pulse Train Output), chứng minh khả năng thay thế các bộ điều khiển chuyên dụng đắt tiền bằng thiết bị tự động hóa phổ thông.
Hạng mục so sánh Robot SCARA Công nghiệp Nhập khẩu Kit Robot SCARA DIY / Giáo dục Giải pháp SCARA BKHN (Đồ án)
Vật liệu chế tạo Nhôm đúc áp lực / Hợp kim Magie Nhựa in 3D / Nhôm định hình mỏng Hợp kim nhôm đúc A356 phay CNC
Cơ cấu truyền động Harmonic Drive / Cycloid chuyên dụng Dây đai GT2 / Động cơ bước (Stepper) Hộp số Cycloid + Đai răng + Vít me bi
Hệ thống điều khiển Bộ điều khiển chuyên dụng hãng (Đóng) Arduino / ESP32 / GRBL mã nguồn mở PLC Siemens S7-1200 + Servo EP100(B)
Độ chính xác định vị $\pm 0.01 - \pm 0.02\text{ mm}$ $\pm 0.50 - \pm 1.00\text{ mm}$ $\pm 0.02\text{ mm}$ (XY), $\pm 0.01\text{ mm}$ (Z)
Khả năng chống nhiễu Tiêu chuẩn công nghiệp EMC Rất kém, dễ mất bước Đạt chuẩn công nghiệp môi trường nhiễu
Tổng chi phí phần cứng $350 - 600\text{ triệu VNĐ}$ $8 - 15\text{ triệu VNĐ}$ $45 - 65\text{ triệu VNĐ}$ (Tiết kiệm $>80%$)

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

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

  • Dây chuyền lắp ráp điện tử: Cắm linh kiện xuyên lỗ (THT), gắp đặt IC, cấp phôi tự động cho máy hàn bo mạch PCB.
  • Ngành công nghiệp dược phẩm & thực phẩm: Gắp vỉ thuốc, đóng hộp sản phẩm, phân loại bao gói với chu kỳ chu chuyển $< 0.4\text{ s/sản phẩm}$.
  • Gia công cơ khí chính xác: Cấp và tháo phôi tự động (Machine Tending) cho máy tiện/phay CNC.
+---------------------------------------------------------------------------------+
|           SƠ ĐỒ BỐ TRÍ DÂY CHUYỀN GẮP ĐẶT TỰ ĐỘNG (PICK & PLACE)                |
|                                                                                 |
|   [ Băng tải cấp phôi ] ----> (Vùng gắp: R1=350, theta1)                        |
|                                       |                                         |
|                                       v (Quỹ đạo bậc 3 làm mịn)                 |
|                               [ ROBOT SCARA 3 DOF ]                             |
|                                       |                                         |
|                                       v (Thao tác kẹp CHS2-S68)                 |
|   [ Băng tải phân loại ] <--- (Vùng thả: R2=700, theta2, z=-150mm)             |
+---------------------------------------------------------------------------------+

Yêu cầu triển khai và Phân tích hiệu quả kinh tế (ROI)

  • Hạ tầng nguồn điện: Điện áp 1 pha $220\text{VAC} \pm 10%, 50\text{ Hz}$, tiếp địa công nghiệp $R_{te} < 4,\Omega$.
  • Nguồn khí nén: Áp suất làm việc $0.4 - 0.6\text{ MPa}$, tích hợp bộ lọc khí và tách ẩm cho xilanh kẹp CHS2-S68.
  • Phân tích chi phí & Thời gian hoàn vốn (ROI):
    • Chi phí đầu tư hệ thống: ~55.000.000 VNĐ.
    • Thay thế 02 công nhân thao tác đóng gói thủ công (Chi phí nhân công: 20.000.000 VNĐ/tháng).
    • Thời gian hoàn vốn đầu tư: $T = \frac{55.000.000}{20.000.000} \approx 2.75\text{ tháng}$.

Lộ trình triển khai 4 giai đoạn:

  1. Tháng 1: Hoàn thiện gia công cơ khí phay CNC các khâu nhôm A356 và lắp ráp hệ thống dẫn hướng vít me bi.
  2. Tháng 2: Tích hợp tủ điện động lực, driver servo EP100(B) và PLC S7-1200.
  3. Tháng 3: Cài đặt thông số PID, lập trình khối chuyển động MC (Motion Control) trên TIA Portal.
  4. Tháng 4: Chạy thử nghiệm không tải, có tải và hiệu chuẩn sai số định vị bằng thiết bị đo lường laser.

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

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

  • Cấu hình chỉ có 3 bậc tự do ($R-R-P$), thiếu bậc xoay Roll $\theta_z$ ở cổ tay nên chưa thể xoay hướng linh kiện khi lắp ráp phức tạp.
  • Chưa tích hợp cảm biến đo lực tiếp xúc (Force Torque Sensor) ở khâu thao tác cuối, dẫn đến việc kẹp các vật thể giòn, dễ vỡ hoàn toàn phụ thuộc vào áp suất điều áp khí nén.
  • Chưa trang bị hệ thống thị giác máy (Machine Vision) để tự động nhận dạng tọa độ phôi động trên băng chuyền.

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

  • Thiết kế bổ sung cụm trục xoay Roll đồng trục với trục tịnh tiến vít me (cấu trúc trục rỗng Ball Screw-Spline tiêu chuẩn SCARA 4 DOF).
  • Tích hợp camera công nghiệp kết nối qua giao thức Ethernet TCP/IP với PLC S7-1200 để xử lý ảnh nhận diện sản phẩm lỗi bằng OpenCV / YOLO.
  • Phát triển giao diện điều khiển và giám sát Web-server SCADA chạy trực tiếp trên CPU PLC S7-1200.

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

  • Sinh viên ngành Cơ điện tử, Tự động hóa & Kỹ thuật Robot: Nguồn tài liệu tham khảo hoàn chỉnh từ lý thuyết tính toán động học/động lực học D-H, D'Alembert đến thực hành mô phỏng MATLAB/Simulink và đấu nối PLC thực tế.
  • Kỹ sư R&D thiết kế máy tự động: Tham khảo phương pháp tính chọn công suất động cơ servo, công thức quy đổi mô-men quán tính $J_{eff}$ qua hộp giảm tốc xycloid và quy trình cấu hình xung PTO trên PLC Siemens.
  • Doanh nghiệp vừa và nhỏ (SMEs): Tiếp cận mô hình tự động hóa giá thành cạnh tranh, dễ sửa chữa bảo trì, nâng cao năng suất dây chuyền lắp ráp và đóng gói lên gấp 2.5 - 3 lần so với lao động thủ công.
  • Các nhà nghiên cứu học thuật: Cung cấp mô hình toán học đã được kiểm chứng bằng thực nghiệm để phát triển các giải pháp điều khiển nâng cao như Sliding Mode Control (SMC) hay Fuzzy-PID thích nghi.

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 $220\text{VAC}$ ổn định, bộ điều khiển PLC Siemens S7-1200 CPU 1214C DC/DC/DC (hỗ trợ tối thiểu 4 ngõ ra phát xung tốc độ cao PTO lên đến $100\text{ kHz}$), 03 bộ Driver Servo EP100(B) tương thích động cơ AC Servo 80ST-M02430 và nguồn khí nén áp suất $0.4 - 0.6\text{ MPa}$.

2. Giới hạn tải trọng của robot là bao nhiêu và có thể nâng cấp không?

Tải trọng tối ưu cho quỹ đạo làm việc tốc độ cao là $0.5\text{ kg} - 2.0\text{ kg}$. Khung cơ khí và kết cấu nhôm A356 cho phép chịu tải tĩnh tối đa lên đến $10\text{ kg}$. Để tăng tải trọng thao tác động lên $>5\text{ kg}$ ở tốc độ cao, cần nâng cấp động cơ servo từ $750\text{ W}$ lên $1.5\text{ kW}$ và tăng đường kính trục vít me bi lên $\phi 25\text{ mm}$.

3. Làm thế nào để tích hợp robot vào mạng truyền thông nhà máy sẵn có?

PLC Siemens S7-1200 được trang bị sẵn cổng PROFINET tiêu chuẩn, hỗ trợ giao thức Modbus TCP/IP, OPC UA và S7-Communication, cho phép kết nối trực tiếp với hệ thống SCADA, MES nhà máy hoặc màn hình HMI Siemens KTP Series mà không cần lắp thêm module truyền thông phụ trợ.

4. Quy trình bảo trì và bôi trơn định kỳ hệ thống cơ khí như thế nào?

  • Hộp giảm tốc Cycloid: Kiểm tra và bổ sung mỡ chuyên dụng định kỳ sau mỗi $5.000\text{ giờ}$ hoạt động.
  • Trục vít me đai ốc bi và thanh trượt dẫn hướng: Bôi trơn dầu bôi trơn mỡ bôi trơn rãnh bi sau mỗi $1.000\text{ giờ}$ hoặc 3 tháng vận hành.
  • Bộ truyền đai răng: Kiểm tra độ căng đai và độ mòn răng định kỳ 6 tháng/lần.

5. Chi phí sản xuất và thời gian hoàn vốn thực tế cho doanh nghiệp là bao nhiêu?

Tổng chi phí chế tạo hoàn thiện hệ thống dao động từ $45.000.000$ đến $65.000.000\text{ VNĐ}$ (tùy thuộc vào cấp chính xác gia công phay CNC). Khi ứng dụng vào dây chuyền gắp thả thay thế 2 vị trí công nhân làm việc 2 ca/ngày, thời gian hoàn vốn đầu tư (Payback Period) chỉ mất từ $3 - 6\text{ tháng}$.

Kết luận

Đồ án "Thiết kế Robot SCARA 3 bậc tự do" đã hoàn thành toàn diện các mục tiêu đặt ra: từ việc xây dựng cơ sở lý thuyết động học, động lực học, mô hình hóa hàm truyền đạt chính xác, cho đến việc thiết kế hệ thống điều khiển vị trí vòng kín ổn định trên nền tảng PLC Siemens S7-1200 và AC Servo công nghiệp. Các chỉ số kiểm định cho thấy hệ thống vận hành mượt mà với thời gian đáp ứng $t_s < 0.42\text{ s}$, độ vọt lố dưới $14.1%$ và triệt tiêu hoàn toàn sai lệch tĩnh ($e_{ss} = 0$).

Công trình không chỉ đóng góp một giải pháp công nghệ có khả năng thương mại hóa cao, giúp doanh nghiệp nội địa tiết kiệm trên $80%$ chi phí đầu tư robot công nghiệp, mà còn là bộ tài liệu học thuật - kỹ thuật mẫu mực cho sinh viên và kỹ sư ngành Cơ điện tử. Trong giai đoạn tiếp theo, nhóm nghiên cứu hướng tới việc nâng cấp bậc tự do thứ 4 và tích hợp module thị giác máy AI để xây dựng trạm phân loại sản phẩm thông minh hoàn chỉnh.