Giới thiệu dự án

Trong kỷ nguyên Công nghiệp 4.0, tự động hóa đóng vai trò then chốt trong việc tối ưu hóa năng suất và nâng cao chất lượng sản phẩm. Theo báo cáo từ Liên đoàn Robot Quốc tế (IFR), ngành công nghiệp sản xuất điện tử và bán dẫn (3C Industry) đang dẫn đầu về mật độ ứng dụng robot, trong đó robot SCARA (Selective Compliance Assembly Robot Arm / Selective Compliance Articulated Robot Arm) chiếm hơn 40% thị phần robot lắp ráp nhờ đặc tính vận hành linh hoạt trong mặt phẳng ngang $XY$ và độ cứng vững vượt trội theo phương thẳng đứng $Z$.

           +---------------------------------------------------+
           |        HỆ THỐNG ĐIỀU KHIỂN ROBOT SCARA 3-DOF      |
           +---------------------------------------------------+
                                    |
          +-------------------------+-------------------------+
          |                                                   |
          v                                                   v
+-----------------------+                           +-------------------+
|  Mô Hình Hóa Toán Học |                           |  Phần Cứng & Vận  |
|  - D-H Kinematics     |                           |    Hành Thực Tế   |
|  - Lagrange II        |                           |  - STM32F407 MCU  |
|  - Cubic Trajectory   |                           |  - Yaskawa Servo  |
+-----------------------+                           |  - SGDV-5R5A      |
          |                                         +-------------------+
          v                                                   ^
+-----------------------+                                     |
|  Thiết Kế Điều Khiển  |                                     |
|  - MATLAB/Simulink    |-------------------------------------+
|  - PID Gain Tuning    |     (Xác thực mô hình & Tham số hóa)
|  - Simscape 3D Model  |
+-----------------------+

Vấn đề cốt lõi đặt ra trong các dây chuyền lắp ráp và gắp thả linh kiện (Pick-and-Place) tốc độ cao là hiện tượng rung động động học phi tuyến, sai lệch vị trí do quán tính thay đổi theo cấu hình cánh tay và thời gian xác lập (settling time) kéo dài nếu không có bộ điều khiển bù động lực học phù hợp. Đồ án "Thiết kế hệ thống điều khiển robot SCARA ba bậc tự do" do sinh viên Vũ Quang Huy thực hiện dưới sự hướng dẫn của TS. Nguyễn Trọng Du (Bộ môn Cơ điện tử - Trường Cơ khí, Đại học Bách Khoa Hà Nội) tập trung giải quyết bài toán điều khiển chuyển động chính xác cao cho mô hình robot SCARA 3 bậc tự do (3-DOF).

Mục tiêu cụ thể của dự án:

  1. Xây dựng hoàn chỉnh mô hình động học thuận (Forward Kinematics), động học ngược (Inverse Kinematics) và động lực học (Dynamics) bằng phương pháp Lagrange loại II.
  2. Thiết kế quỹ đạo chuyển động mượt mà không giật cục sử dụng đa thức bậc 3 (Cubic Polynomial Trajectory).
  3. Thiết lập hàm truyền đạt chi tiết cho hệ thống truyền động động cơ DC/Servo kèm hộp giảm tốc và trục vít me - đai ốc bi.
  4. Đánh giá tính ổn định hệ thống qua tiêu chuẩn Routh-Hurwitz và tiêu chuẩn Nyquist; thiết kế bộ điều khiển PID tối ưu hóa bằng công cụ MATLAB PID Tuner.
  5. Mô phỏng kiểm chứng chất lượng điều khiển trên nền tảng phối hợp MATLAB/Simulink R2023b và Simscape Multibody với mô hình CAD 3D xuất từ SolidWorks 2023.

Giải pháp kỹ thuật được đề xuất sử dụng kiến trúc điều khiển kín với phản hồi vị trí thời gian thực, kết hợp giữa bộ vi điều khiển ARM Cortex-M4 (STM32F407 Discovery) và bộ điều khiển Servo Yaskawa SGDV-5R5A công suất 400W. Kết quả kỳ vọng đạt được là cánh tay robot có tầm với 970 mm, hành trình trục $Z$ đạt 400 mm, tải trọng định mức 5–10 kg, triệt tiêu hoàn toàn sai lệch tĩnh ($e_\infty = 0$), độ vọt lố kiểm soát dưới 12% và thời gian xác lập giảm từ hàng trăm giây xuống dưới 0.5 s. Phạm vi đồ án giới hạn ở mô hình 3 bậc tự do (2 khớp xoay, 1 khớp tịnh tiến), bỏ qua biến dạng đàn hồi của vật liệu và giả định các khâu là vật rắn tuyệt đối.

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

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

Trong các hệ thống phân loại và gắp đặt sản phẩm hiện nay, ba cấu trúc robot phổ biến nhất gồm: Robot tọa độ Descartes (Cartesian), Robot SCARA và Robot chuỗi khớp 6 bậc tự do (6-DOF Articulated Robot).

Tiêu chí so sánh Robot Descartes Robot SCARA (Đề tài) Robot 6-DOF Articulated
Không gian làm việc (Footprint) Lớn, cồng kềnh, khung bao chiếm diện tích Nhỏ gọn, lắp bệ đơn, vùng làm việc trụ tròn Linh hoạt nhất, chiếm diện tích chân đế nhỏ
Tốc độ gắp thả (Cycle time) Trung bình (0.8 – 1.2 s/chu kỳ) Rất cao (< 0.4 – 0.5 s/chu kỳ) Trung bình - Khá (0.6 – 0.9 s/chu kỳ)
Độ cứng vững trục Z Rất cao Cực cao (thuận lợi cho ép/chèn chốt) Phụ thuộc vào tư thế khớp (dễ uốn)
Độ phức tạp điều khiển Đơn giản (chuyển động độc lập) Trung bình (cần giải động học ngược) Rất cao (yêu cầu bộ xử lý ma trận 6x6)
Chi phí đầu tư Thấp ($3,000 – $5,000) Tối ưu ($5,000 – $10,000) Rất cao ($20,000 – $50,000)

Trên thị trường, các dòng robot thương mại như Denso HM-G, Fanuc SR-6iA và Epson G-Series sở hữu độ chính xác cao nhưng hệ thống phần mềm đóng kín, chi phí chuyển giao lớn và khó tùy biến thuật toán điều khiển chuyên sâu.

Yêu cầu người dùng đối với hệ thống được xác định theo mô hình MoSCoW:

  • Must have (Bắt buộc): Hoàn thành nội suy quỹ đạo điểm - điểm (PTP) và đường dẫn liên tục (CP); triệt tiêu sai lệch tĩnh vị trí; thời gian đáp ứng dưới 1 s; đảm bảo ổn định tuyệt đối theo tiêu chuẩn Routh/Nyquist.
  • Should have (Nên có): Giao diện GUI điều khiển trực quan trên MATLAB; khả năng mô phỏng 3D tương tác lực Simscape; hỗ trợ xuất xung vị trí Pulse/Direction chuẩn công nghiệp.
  • Could have (Có thể có): Chế độ nội suy đường tròn, xoắn ốc 3D; thuật toán tự động bù trọng trường $G(q)$.
  • Won't have (Chưa thực hiện đợt này): Nhận dạng ảnh xử lý thị giác máy 2D/3D (Machine Vision) và cảm biến lực xúc giác 6 trục ở đầu công tác.

Thách thức kỹ thuật lớn nhất nằm ở tính chất phi tuyến của ma trận khối lượng $M(q)$ và ma trận lực Coriolis/ly tâm $C(q, \dot{q})$ khi hai cánh tay chuyển động với gia tốc lớn, gây hiện tượng can nhiễu mô-men chéo giữa khớp 1 và khớp 2.

                   +-----------------------------+
                   |  Giao diện điều khiển (GUI) |
                   |     (MATLAB / C++ App)      |
                   +-----------------------------+
                                  |
                                  | RS-232 / UART
                                  v
+---------------------------------------------------------------+
|                Khối Vi Điều Khiển STM32F407                    |
|  - Trajectory Generator (Đa thức bậc 3)                       |
|  - Inverse Kinematics Core                                    |
|  - Bộ điều khiển PID số (Discrete PID)                        |
+---------------------------------------------------------------+
         |                     |                     |
         | Pulse/Dir           | Pulse/Dir           | Pulse/Dir
         v                     v                     v
+-----------------+   +-----------------+   +-----------------+
| Driver SGDV-5R5 |   | Driver SGDV-5R5 |   | Driver SGDV-5R5 |
|     Khớp 1      |   |     Khớp 2      |   |     Khớp 3      |
+-----------------+   +-----------------+   +-----------------+
         |                     |                     |
         v                     v                     v
+-----------------+   +-----------------+   +-----------------+
| Servo Yaskawa   |   | Servo Yaskawa   |   | Servo + Vít me  |
| 400W (Khâu 1)   |   | 400W (Khâu 2)   |   | bi (Khâu 3)     |
+-----------------+   +-----------------+   +-----------------+
         |                     |                     |
         +---------------------+---------------------+
                               |
                               v
                     [ Cánh Tay Robot 3-DOF ]

Thiết kế hệ thống

Hệ thống được tổ chức thành 3 tầng chức năng: Tầng giao diện giám sát cấp cao (Supervisory Layer), Tầng tính toán điều khiển thời gian thực (Real-time Controller Layer) và Tầng chấp hành công suất (Actuator Layer).

  • Technology Stack & Versions:
    • Phần mềm toán học & điều khiển: MATLAB R2023b, Simulink 10.8, Control System Toolbox, Simscape Multibody 7.7.
    • Thiết kế cơ khí 3D: Dassault Systèmes SolidWorks 2023 SP3.0.
    • Nền tảng nhúng: STM32CubeIDE v1.14.0, ARM CMSIS-DSP Library v5.9.0.
    • Cấu hình truyền động: Yaskawa SigmaWin+ Ver. 7.43.

Thông số hình học và cơ khí của cánh tay:

  • Khâu 1: Chiều dài $a_1 = 500\text{ mm}$, độ cao $d_1 = 500\text{ mm}$, khối tâm $l_1 = a_1/2$, góc quay $q_1 \in [-165^\circ, +165^\circ]$.
  • Khâu 2: Chiều dài $a_2 = 450\text{ mm}$, độ cao $d_2 = 100\text{ mm}$, khối tâm $l_2 = a_2/2$, góc quay $q_2 \in [-147^\circ, +147^\circ]$.
  • Khâu 3: Khớp trượt vít me bi bước $p = 10\text{ mm/vòng}$, hành trình $q_3 \in [0, 400\text{ mm}]$, khối lượng $m_3$.

Mô hình hóa toán học động cơ DC servo kết hợp tải được biểu diễn dưới dạng hàm truyền bậc 3:

$$G_{dc}(s) = \frac{\theta_m(s)}{U(s)} = \frac{K_{td}}{T_1 s^3 + T_2 s^2 + s}$$

Trong đó:

$$T_1 = \frac{\tau_t \tau_c R B_{td}}{K_m K_e + R B_{td}}, \quad T_2 = \frac{(\tau_t + \tau_c) R B_{td}}{K_m K_e + R B_{td}}, \quad K_{td} = \frac{K_m}{K_m K_e + R B_{td}}$$

Với $\tau_t = \frac{L}{R}$ là hằng số thời gian điện từ, $\tau_c = \frac{J_{td}}{B_{td}}$ là hằng số thời gian cơ học, $J_{td} = J_m + n^2 J_l$ và $B_{td} = B_m + n^2 B_l$. Đối với khâu 3 tịnh tiến, hàm truyền có thêm hệ số biến đổi truyền động vít me bi $K = \frac{p}{2\pi}$:

$$G_{\text{khâu 3}}(s) = \frac{n_3 K_{td} K}{T_1 s^3 + T_2 s^2 + s}$$

Methodology

Dự án áp dụng mô hình phát triển chữ V (V-Model) kết hợp phương pháp thiết kế dựa trên mô hình (Model-Based Design - MBD):

  1. Giai đoạn 1 (Tuần 1–4): Khảo sát tài liệu, phân tích động học D-H, tính toán động lực học Lagrange II.
  2. Giai đoạn 2 (Tuần 5–8): Thiết kế 3D CAD trên SolidWorks, xuất mô hình Simscape, mô hình hóa hàm truyền động cơ.
  3. Giai đoạn 3 (Tuần 9–12): Thiết kế quỹ đạo đa thức bậc 3, tổng hợp bộ điều khiển PID trên Simulink, kiểm tra tính ổn định Routh/Nyquist.
  4. Giai đoạn 4 (Tuần 13–16): Xây dựng giao diện GUI, mô phỏng tích hợp hệ thống đóng kín, tối ưu hóa thông số và đánh giá sai số.
Rủi ro tiềm ẩn Mức độ Biện pháp giảm thiểu
Sai số động học ngược tại điểm kỳ dị (Singularity) Cao Giới hạn không gian làm việc ($q_2 \neq 0^\circ, \pm 180^\circ$); dùng thuật toán atan2
Bão hòa điện áp/mô-men khi khởi động Trung bình Tích hợp khâu bão hòa (Saturation) và Anti-windup trong bộ điều khiển PID
Nhiễu tín hiệu xung tần số cao trên dây RS-232 Thấp Sử dụng cáp bọc kim chống nhiễu (Shielded Twisted Pair) và cách ly quang optocoupler

Implementation và kết quả

Development process

Quá trình triển khai toán học và thuật toán điều khiển được thực hiện qua các bước tính toán chuẩn xác:

1. Động học thuận và ngược (Kinematics)

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

  • Khâu 1: $\theta = q_1, d = d_1, a = a_1, \alpha = 0$
  • Khâu 2: $\theta = q_2, d = d_2, a = a_2, \alpha = 0$
  • Khâu 3: $\theta = 0, d = q_3, a = 0, \alpha = 0$

Phương trình tọa độ vị trí điểm công tác cuối $E(x_E, y_E, z_E)$:

$$\begin{cases} x_E = a_2 \cos(q_1 + q_2) + a_1 \cos(q_1) \ y_E = a_2 \sin(q_1 + q_2) + a_1 \sin(q_1) \ z_E = d_1 + d_2 + q_3 = 600 + q_3 \end{cases}$$

Giải bài toán động học ngược bằng phương pháp giải tích:

$$\cos(q_2) = \frac{x_E^2 + y_E^2 - a_1^2 - a_2^2}{2 a_1 a_2} \implies q_2 = \arccos\left(\frac{x_E^2 + y_E^2 - a_1^2 - a_2^2}{2 a_1 a_2}\right)$$

$$q_1 = \arctan\left(\frac{\sin(q_1)}{\cos(q_1)}\right) = \text{atan2}\left((a_1 + a_2 \cos q_2) y_E - a_2 \sin q_2 x_E, ; (a_1 + a_2 \cos q_2) x_E + a_2 \sin q_2 y_E\right)$$

$$q_3 = z_E - d_1 - d_2$$

2. Động lực học Lagrange loại II

Phương trình vi phân tổng quát:

$$M(q)\ddot{q} + C(q, \dot{q})\dot{q} + G(q) = \tau$$

Các phần tử của ma trận khối lượng đối xứng $M(q) \in \mathbb{R}^{3 \times 3}$:

$$m_{11} = \frac{m_1 a_1^2}{3} + m_2\left(\frac{a_2^2}{3} + a_1^2 + a_1 a_2 \cos q_2\right) + m_3(a_1^2 + a_2^2 + 2a_1 a_2 \cos q_2)$$

$$m_{12} = m_{21} = m_2\left(\frac{a_2^2}{3} + \frac{a_1 a_2 \cos q_2}{2}\right) + m_3(a_2^2 + a_1 a_2 \cos q_2)$$

$$m_{22} = \frac{m_2 a_2^2}{3} + m_3 a_2^2, \quad m_{33} = m_3, \quad m_{13} = m_{31} = m_{23} = m_{32} = 0$$

Ma trận Coriolis $C(q, \dot{q})$ với các ký hiệu Christoffel:

$$c_{11} = -\left(\frac{m_2}{2} + m_3\right) a_1 a_2 \dot{q}2 \sin q_2, \quad c{12} = -\left(\frac{m_2}{2} + m_3\right) (\dot{q}_1 + \dot{q}_2) a_1 a_2 \sin q_2$$

$$c_{21} = \left(\frac{m_2}{2} + m_3\right) a_1 a_2 \dot{q}1 \sin q_2, \quad c{22} = c_{13} = c_{23} = c_{31} = c_{32} = c_{33} = 0$$

Vector trọng lực: $G(q) = \begin{bmatrix} 0 & 0 & -m_3 g \end{bmatrix}^T$.

3. Thuật toán quy hoạch quỹ đạo đa thức bậc 3

Quỹ đạo nội suy giữa hai điểm $M(x_0, y_0, z_0)$ và $N(x_e, y_e, z_e)$ trong thời gian $t_e$:

$$s(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 bằng 0 tại $t=0$ và $t=t_e$:

$$a_0 = x_0, \quad a_1 = 0, \quad a_2 = \frac{3(x_e - x_0)}{t_e^2}, \quad a_3 = \frac{-2(x_e - x_0)}{t_e^3}$$

% MATLAB Implementation: Inverse Kinematics and Trajectory Generation
function [q1, q2, q3] = scara_inverse_kinematics(x, y, z, a1, a2, d1, d2)
    % Tinh bien khop q3 (Khop tinh tien)
    q3 = z - d1 - d2;
    
    % Tinh bien khop q2 theo dinh ly Cosine
    cos_q2 = (x.^2 + y.^2 - a1^2 - a2^2) / (2 * a1 * a2);
    cos_q2 = max(min(cos_q2, 1.0), -1.0); % Rang buoc mien [-1, 1]
    q2 = acos(cos_q2); % Chon cau hinh khuon tay elbow-down
    
    % Tinh bien khop q1 su dung atan2 tranh sai lech goc
    sin_q2 = sin(q2);
    det_kramer = a1^2 + a2^2 + 2 * a1 * a2 * cos_q2;
    cos_q1 = ((a1 + a2 * cos_q2) .* x + (a2 * sin_q2) .* y) ./ det_kramer;
    sin_q1 = ((a1 + a2 * cos_q2) .* y - (a2 * sin_q2) .* x) ./ det_kramer;
    q1 = atan2(sin_q1, cos_q1);
end

Testing và validation

Kiểm chứng tính ổn định bằng bảng tiêu chuẩn Routh-Hurwitz cho 3 hàm truyền vòng hở cho thấy tất cả các phần tử cột 1 đều dương:

  • Khâu 1: $a_0 = 5.259 \times 10^{-5}, a_1 = 0.4551, a_2 = 0.02039 \implies$ Ổn định.
  • Khâu 2: $a_0 = 9.123 \times 10^{-6}, a_1 = 0.4551, a_2 = 0.003539 \implies$ Ổn định.
  • Khâu 3: $a_0 = 7.904 \times 10^{-5}, a_1 = 0.4623, a_2 = 0.03066 \implies$ Ổn định.

Đồ thị Nyquist của cả 3 khâu đều không bao điểm $(-1 + j0)$, khẳng định hệ kín hoàn toàn ổn định theo tiêu chuẩn Nyquist.

Dap ung buoc nhay don vi Khop 1 & Khop 2:
y(t)
1.0 |                   +------------------------- (PID: Ts = 0.5s)
    |                  /
    |                 /
0.5 |                /
    |               /   . . . . . . . . . . . . . (Khong PID: Ts = 210s)
0.0 +--------------+-------------------------------> Thoi gian t (s)
    0             0.5                            210

So sánh chất lượng đáp ứng quá độ giữa hệ thống khi chưa có bộ điều khiển và khi áp dụng bộ điều khiển PID:

Thông số đáp ứng Khâu 1 (Chưa PID) Khâu 1 (Có PID) Khâu 2 (Chưa PID) Khâu 2 (Có PID) Khâu 3 (Chưa PID) Khâu 3 (Có PID)
Hệ số $K_p$ - 3181.468 - 5248.967 - 13279.113
Hệ số $K_i$ - 17229.578 - 71094.881 - 68743.440
Hệ số $K_d$ - 117.609 - 37.143 - 594.640
Thời gian tăng ($T_r$) 80.0 s 0.06 s 80.0 s 0.06 s 250.0 s 0.01 s
Thời gian xác lập ($T_s$) 210.0 s 0.50 s 210.0 s 0.50 s 700.0 s 0.40 s
Độ vọt lố ($\sigma%$) 0.0% 10.0% 0.0% 10.0% 0.0% 12.0%
Sai lệch tĩnh ($e_\infty$) 0.0 0.0 0.0 0.0 0.0 0.0

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

Hệ thống điều khiển số thiết kế đã hoàn thành toàn diện các mục tiêu đề ra:

  • Tốc độ đáp ứng: Giảm thời gian xác lập từ 210 s xuống 0.5 s ở Khâu 1 và 2 (cải thiện 99.76%), từ 700 s xuống 0.4 s ở Khâu 3 (cải thiện 99.94%).
  • Độ chính xác bám quỹ đạo: Sai số bám vị trí động của các biến khớp trong quá trình thực hiện chu trình Pick-and-Place gắp thả đạt $\Delta q_1 \approx 3.2 \times 10^{-4}\text{ rad}$, $\Delta q_2 \approx 2.8 \times 10^{-4}\text{ rad}$, $\Delta q_3 \approx 1.5 \times 10^{-5}\text{ m}$.
  • Tính ổn định quỹ đạo: Thử nghiệm thành công các quỹ đạo phức tạp: chuyển động đường thẳng không gian, chuyển động tròn (Circular interpolation) và quỹ đạo xoắn ốc 3D (Spiral interpolation), robot quay trở về điểm Home vị trí gốc an toàn không dao động.

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

  1. Phương pháp mô hình hóa tích hợp MBD toàn diện: Kết hợp thành công bài toán giải tích Lagrange loại II với mô hình hình học 3D Simscape Multibody, cho phép tái hiện chính xác tác động của mô-men Coriolis và ma sát nhớt mà không cần chế tạo phần cứng thử nghiệm tốn kém.
  2. Thuật toán điều khiển PID tham số tối ưu phân tán: Thay vì sử dụng bộ điều khiển đơn kênh cho toàn hệ thống, từng khớp được thiết lập bộ thông số $K_p, K_i, K_d$ độc lập theo đặc tính hàm truyền tải thực tế, giúp bù đắp sự chênh lệch lớn về quán tính giữa trục tịnh tiến $Z$ và các trục quay phẳng $XY$.
  3. Hiệu suất vượt trội so với các nghiên cứu tương đương: So với các mô hình robot SCARA sử dụng động cơ bước vòng hở truyền thống, giải pháp sử dụng động cơ Servo kết hợp bộ điều khiển PID kín giúp triệt tiêu hiện tượng trượt bước (Step loss), nâng cao độ chính xác lặp lên $\pm 0.01\text{ mm}$ và tăng tốc độ làm việc lên gấp 4 lần.

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

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

  • Lắp ráp bo mạch điện tử (SMT/PCB Assembly): Thực hiện gắn các linh kiện dán, cắm IC, hàn điểm với chu kỳ thao tác 0.45 s/linh kiện.
  • Phân loại và đóng gói dược phẩm: Tích hợp đầu hút chân không gắp vỉ thuốc, lọ vaccine vào hộp chứa liên tục 24/7 trong môi trường phòng sạch tiêu chuẩn ISO Class 5.
  • Gia công cơ khí nhẹ: Ứng dụng đầu khắc laser, bôi keo tự động (Dispensing) trên các bề mặt chi tiết phẳng phức tạp theo biên dạng CAD.
+-------------------------------------------------------------+
|               DÂY CHUYỀN SẢN XUẤT TỰ ĐỘNG                   |
+-------------------------------------------------------------+
                               |
         +---------------------+---------------------+
         |                                           |
         v                                           v
+------------------+                       +------------------+
| Cấp Phôi Tự Động |                       | Băng Tải Đầu Vào |
+------------------+                       +------------------+
         \                                           /
          \                                         /
           v                                       v
      +-------------------------------------------------+
      |        TRẠM GẮP THẢ ROBOT SCARA 3-DOF           |
      |   - Gắp linh kiện từ Băng tải (Tốc độ 0.5s)     |
      |   - Chèn chốt chính xác (Độ cứng vững trục Z)   |
      +-------------------------------------------------+
                               |
                               v
               +-------------------------------+
               | Kiểm Tra Chất Lượng (QC/Test) |
               +-------------------------------+
                               |
                               v
                     [ Đóng Gói Thành Phẩm ]

Phân tích hiệu quả kinh tế (Cost-Benefit & ROI)

Dự toán chi phí chế tạo hệ thống điều khiển và cơ khí mẫu thử:

  • Động cơ Servo Yaskawa 400W kèm Driver (3 bộ): $1,200
  • Cơ cấu cơ khí (Nhôm định hình, trục vít me bi C7, gia công phay CNC cánh tay): $600
  • Mạch điều khiển STM32F407, Nguồn tổ ong 24V/48V, Cảm biến hành trình quang: $150
  • Chi phí gia công lắp ráp & phần mềm: $250
  • Tổng chi phí chế tạo: $\approx $2,200 (So với mức giá $$12,000 – $18,000$ của các robot nhập khẩu cùng phân khúc).

Thời gian hoàn vốn (ROI): Với năng suất thay thế 2 công nhân thao tác thủ công (chi phí lương $800/tháng), thời gian thu hồi vốn đầu tư ước tính chỉ trong 2.8 đến 3.5 tháng.

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

  • Hạn chế kỹ thuật hiện tại: Mô hình toán học hiện tại chưa xét đến độ võng đàn hồi của cánh tay khi mang tải tối đa 10 kg ở tầm với cực đại 970 mm; hiện tượng ma sát tĩnh (Stiction) và khe hở cơ khí (Backlash) của hộp số chưa được bù phi tuyến.
  • Hướng phát triển:
    1. Tích hợp hệ thống thị giác máy tính (Machine Vision) sử dụng OpenCV và camera công nghiệp để nhận dạng vị trí và góc xoay của phôi ngẫu nhiên trên băng chuyền.
    2. Nâng cấp thuật toán điều khiển phi tuyến hiện đại: Điều khiển chế độ trượt (Sliding Mode Control - SMC) hoặc Điều khiển bù mô-men tính toán (Computed Torque Control) để thích nghi với tải trọng thay đổi liên tục.
    3. Mở rộng bậc tự do thứ 4 (khớp xoay $\theta_z$ ở đầu kẹp) để biến đổi thành cấu hình SCARA 4-DOF công nghiệp hoàn chỉnh.

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

  • Sinh viên ngành Cơ điện tử / Tự động hóa: Tài liệu tham khảo chuẩn mực về phương pháp thiết lập phương trình Lagrange II, mô hình hóa hàm truyền động cơ và quy hoạch quỹ đạo trên MATLAB.
  • Kỹ sư R&D tại doanh nghiệp: Nền tảng thiết kế sẵn có (Ready-to-use architecture) để tùy biến chế tạo các cánh tay máy phân loại sản phẩm chuyên dụng giá thành thấp.
  • Các cơ sở sản xuất vừa và nhỏ (SMEs): Cơ hội tiếp cận giải pháp tự động hóa nội địa hóa với chi phí chỉ bằng 20% thiết bị ngoại nhập, dễ bảo trì và làm chủ công nghệ.

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

1. Yêu cầu phần cứng tối thiểu để triển khai giải pháp điều khiển này trong thực tế là gì?

Cần một vi điều khiển có xung nhịp tối thiểu 84 MHz (như STM32F401/F407) hỗ trợ bộ tính toán dấu phẩy động FPU phần cứng, 3 bộ driver servo nhận xung tần số tối thiểu 200 kHz, nguồn một chiều công nghiệp 24V–48V công suất tối thiểu 1.5 kW và cảm biến giới hạn quang (Optical Endstop) cho từng trục.

2. Tại sao đồ án lại chọn quy hoạch quỹ đạo theo đa thức bậc 3 thay vì bậc 5?

Đa thức bậc 3 đảm bảo tính liên tục của vận tốc ($\dot{q}(t)$ liên tục), giúp robot không bị giật cục tại điểm bắt đầu và kết thúc, đồng thời thuật toán tính toán ma trận hệ số đơn giản, tiết kiệm tài nguyên xử lý của vi điều khiển nhúng thời gian thực mà vẫn đáp ứng tốt yêu cầu cơ bản của chuyển động gắp thả.

3. Làm thế nào để giải quyết hiện tượng can nhiễu mô-men giữa hai khớp xoay khi chuyển động tốc độ cao?

Hệ thống giải quyết thông qua việc tính toán ma trận Coriolis $C(q, \dot{q})$ trong động lực học và thiết lập hệ số $K_d$ đủ lớn trong bộ điều khiển PID độc lập ở từng khớp để tăng khả năng dập tắt dao động và triệt tiêu thành phần quán tính chéo.

4. Hệ thống có khả năng tự định vị về gốc (Homing) khi mất điện đột ngột không?

Có. Hệ thống sử dụng cảm biến quang điểm gốc kết hợp chức năng đọc xung Z-phase từ Encoder tuyệt đối/tương đối tích hợp sẵn trên động cơ Servo Yaskawa, cho phép thực hiện quy trình Homing chính xác đến từng micro-mét sau khi tái khởi động.

5. Chi phí bảo trì định kỳ cho cánh tay robot này là bao nhiêu?

Nhờ sử dụng động cơ servo không chổi than (Brushless AC Servo) và ổ bi dẫn hướng kín, chi phí bảo trì hàng năm rất thấp (dưới $100/năm), chủ yếu bao gồm tra mỡ bôi trơn trục vít me bi định kỳ 6 tháng/lần và kiểm tra độ căng dây đai truyền động.

Kết luận

Đồ án "Thiết kế hệ thống điều khiển robot SCARA ba bậc tự do" đã hoàn thành xuất sắc toàn bộ các nội dung nghiên cứu lý thuyết và kiểm chứng mô phỏng thực nghiệm. Bằng việc xây dựng thành công chuỗi mô hình toán học chặt chẽ từ động học, động lực học Lagrange II đến mô hình hóa phần cứng động cơ Servo và trục vít me bi, dự án đã cung cấp một phương pháp luận khoa học hoàn chỉnh trong thiết kế hệ thống cơ điện tử thông minh. Bộ điều khiển PID tối ưu hóa trên nền tảng MATLAB/Simulink R2023b đã chứng minh tính hiệu quả vượt trội, rút ngắn thời gian xác lập xuống dưới 0.5 s, triệt tiêu sai lệch tĩnh và đảm bảo tính ổn định tuyệt đối của hệ thống. Đây là tiền đề kỹ thuật vững chắc để hiện thực hóa các dòng robot công nghiệp mang thương hiệu Việt Nam với chi phí tối ưu trong tương lai gần.