Giới thiệu dự án

Trong kỷ nguyên Công nghiệp 4.0 và tự động hóa quy trình sản xuất, các dòng robot công nghiệp đóng vai trò then chốt trong việc nâng cao năng suất, độ ổn định và giảm thiểu sai sót do con người. Theo thống kê từ Hiệp hội Robot Quốc tế (IFR), phân khúc robot SCARA (Selective Compliance Assembly Robot Arm) chiếm hơn 28% tổng lượng robot công nghiệp phục vụ các dây chuyền lắp ráp điện tử, phân loại sản phẩm và đóng gói tự động tốc độ cao. Dù có tiềm năng ứng dụng khổng lồ, việc tự chủ tính toán, thiết kế cơ điện tử và xây dựng thuật toán điều khiển kín cho robot SCARA tại các doanh nghiệp chế tạo trong nước vẫn đối mặt với nhiều rào cản về mặt công nghệ và chi phí bản quyền thiết bị nước ngoài.

Đề tài "Thiết Kế Hệ Thống Điều Khiển Robot SCARA 3 Bậc Tự Do" (Mã học phần: ME5512 - Viện Cơ Khí, Trường Đại học Bách Khoa Hà Nội; do sinh viên Nguyễn Tiến Phát thực hiện dưới sự hướng dẫn của TS. Mạc Thị Thoa) tập trung giải quyết toàn diện bài toán từ mô hình hóa toán học động học - động lực học, phân tích ổn định hệ thống truyền động, đến thiết kế mô phỏng 3D trên MATLAB/Simulink và hoàn thiện giải pháp điều khiển thực thi bằng PLC công nghiệp kết hợp AC Servo Drive.

                  +-----------------------------------+
                  |   BÀI TOÁN QUỸ ĐẠO & ĐIỀU KHIỂN   |
                  +-----------------+-----------------+
                                    |
                                    v
     +------------------------------+------------------------------+
     |                                                             |
     v                                                             v
+----+----------------------------+  +-----------------------------+----+
|    PHÂN TÍCH ĐỘNG HỌC / ĐỘNG LỰC|  |   THIẾT KẾ PHẦN CỨNG & PLC   |
| - D-H Parameters, Jacobian      |  | - PLC Mitsubishi FX3G-40MR   |
| - Lagrange II: M(q), C(q,q'), G |  | - Panasonic Minas A5 Driver  |
| - Mô phỏng SimMechanics 3D      |  | - AC Servo + Vít me đai ốc bi|
+----+----------------------------+  +-----------------------------+----+
     |                                                             |
     +------------------------------+------------------------------+
                                    |
                                    v
                  +-----------------+-----------------+
                  | THUẬT TOÁN BÙ PHI TUYẾN & PID TUNE|
                  | e_ss = 0, Overshoot = 0%, t_s < 4s|
                  +-----------------------------------+

Mục tiêu cốt lõi của dự án

  1. Xây dựng mô hình toán học giải tích: Thiết lập hệ trục tọa độ Denavit-Hartenberg (D-H), giải phương trình động học thuận/ngược, xác định ma trận Jacobian vận tốc/gia tốc và giải hệ phương trình vi phân chuyển động Lagrange loại II.
  2. Mô hình hóa hệ thống truyền động: Trích xuất hàm truyền đạt $G(s)$ cho từng trục khớp dựa trên thông số quán tính từ mô hình 3D (SolidWorks) và các hằng số cơ điện của động cơ servo; kiểm tra tính ổn định hệ thống thông qua tiêu chuẩn Routh-Hurwitz, Nyquist và biểu đồ Bode.
  3. Thiết kế và tối ưu bộ điều khiển: Áp dụng phương pháp điều khiển bù phi tuyến theo momen động lực học (Computed Torque Control - PD theo momen) và thuật toán PID tuned để bám quỹ đạo gắp - đặt (Pick and Place).
  4. Mô phỏng trực quan hóa 3D: Xây dựng mô hình tương tác thời gian thực trên môi trường SimMechanics / Simscape Multibody, phân tích sai số bám quỹ đạo trong chu trình công tác $12.15\text{ s}$.
  5. Thiết kế phần cứng công nghiệp: Xây dựng sơ đồ nguyên lý mạch điện (khổ A0), đấu nối bộ điều khiển lập trình PLC Mitsubishi FX3G-40MR/DS với họ driver servo Panasonic Minas A5 qua giao tiếp phát xung tốc độ cao (Pulse/Direction).

Phạm vi và giới hạn nghiên cứu

  • Cấu hình động học: Robot SCARA 3 bậc tự do (RR-P: 2 khớp quay phẳng $\theta_1, \theta_2$ và 1 khớp tịnh tiến $d_3$ theo trục thẳng đứng thông qua trục vít me đai ốc bi).
  • Vùng không gian làm việc: Tầm với cực đại bán kính $R = 600\text{ mm}$ ($a_1 = 250\text{ mm}$, $a_2 = 350\text{ mm}$), hành trình trục $Z$ đạt $d_3 = 400\text{ mm}$.
  • Tải trọng danh định: Chịu tải thao tác $m_t = 20\text{ kg}$, vật liệu kết cấu các khâu bằng thép kỹ thuật C45 đã qua tối ưu hóa phân bố khối lượng.

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

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

Trong các dây chuyền lắp ráp công nghiệp, ba cấu hình robot chính thường được cân nhắc gồm: Robot nhiều bậc tự do (Articulated 6-Axis), Robot Delta (Song song) và Robot SCARA (Nối tiếp phẳng).

Tiêu chí kỹ thuật Robot SCARA (Đề tài nghiên cứu) Robot 6 trục (Articulated Robot) Robot Delta (Parallel Robot)
Độ cứng vững trục Z Cực cao (khớp song song với trọng lực) Trung bình (chịu mô-men uốn đa hướng) Cao nhưng giới hạn tải trọng
Tải trọng thao tác Lớn (lên đến 20 kg) Rất lớn (> 50 kg) Thấp (thường < 3 - 5 kg)
Độ phức tạp điều khiển Trung bình (2 khớp quay, 1 khớp tịnh tiến) Rất cao (ma trận biến đổi phi tuyến 6x6) Cao (động học vòng kín phức tạp)
Chi phí chế tạo & bảo trì Tối ưu, kết cấu cơ khí gọn gàng Đắt đỏ, linh kiện hộp số chính xác cao Khá cao, cần không gian lắp đặt trần
Độ chính xác lặp lại $\pm 0.01 - \pm 0.02\text{ mm}$ $\pm 0.03 - \pm 0.05\text{ mm}$ $\pm 0.05 - \pm 0.1\text{ mm}$

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

  • Must Have (Bắt buộc): Hoàn thiện phương trình động lực học tổng quát; đảm bảo sai số xác lập vị trí $e_{ss} = 0$; đáp ứng phát xung vị trí 100 kHz từ PLC đến Servo Driver; tích hợp nút dừng khẩn cấp và công tắc hành trình (Endstops).
  • Should Have (Nên có): Giao diện bảng điều khiển mô phỏng GUI trên MATLAB tích hợp tính năng Home, Hold kẹp và giám sát biến khớp thời gian thực.
  • Could Have (Có thể mở rộng): Bổ sung chức năng điều khiển lực/momen tiếp xúc (Torque control) để tối ưu khả năng kẹp các vật thể mềm dễ vỡ.
  • Won't Have (Chưa thực hiện đợt này): Bổ sung bậc tự do xoay Roll (khớp thứ 4 ở cổ tay) và tích hợp cảm biến thị giác Machine Vision 2D/3D.

Thiết kế hệ thống

1. Mô hình hóa động học theo phương pháp Denavit - Hartenberg (D-H)

Quy tắc gán hệ trục tọa độ tại các khớp quay $O_1, O_2$ và khớp trượt $O_3$:

   (Khớp 1: Quay \theta_1)       (Khớp 2: Quay \theta_2)
       [Z_0]                          [Z_1]
         |                              |
         +=========== a_1 = 250mm ======+=========== a_2 = 350mm =====+
                                                                      |
                                                                    [Z_2]
                                                                      | (Khớp 3: Trượt d_3)
                                                                     [v] Trục Vít me
                                                                      |
                                                                   [Gripper]

Bảng thông số D-H của Robot SCARA 3 bậc tự do:

Khâu ($i$) Góc xoay khớp $\theta_i$ Độ dịch trục $d_i$ Chiều dài khâu $a_i\text{ (m)}$ Góc xoắn trục $\alpha_i$
1 $\theta_1$ $d_1 = 0.30\text{ m}$ $a_1 = 0.25\text{ m}$ $0^\circ$
2 $\theta_2$ $d_2 = 0.10\text{ m}$ $a_2 = 0.35\text{ m}$ $0^\circ$
3 $0^\circ$ $d_3$ (biến thiên $0 \div 0.40\text{ m}$) $0$ $0^\circ$

Ma trận biến đổi thuần nhất tổng quát từ hệ tọa độ gốc sang khâu chấp hành cuối: $$^0A_3 = ,^0A_1 \cdot ,^1A_2 \cdot ,^2A_3 = \begin{bmatrix} c_{12} & -s_{12} & 0 & a_2 c_{12} + a_1 c_1 \ s_{12} & c_{12} & 0 & a_2 s_{12} + a_1 s_1 \ 0 & 0 & 1 & d_1 + d_2 + d_3 \ 0 & 0 & 0 & 1 \end{bmatrix}$$

Trong đó: $c_1 = \cos\theta_1$, $s_1 = \sin\theta_1$, $c_{12} = \cos(\theta_1 + \theta_2)$, $s_{12} = \sin(\theta_1 + \theta_2)$.

Tọa độ vị trí khâu tác động cuối ($r_E$): $$\begin{cases} x_E = a_2\cos(\theta_1 + \theta_2) + a_1\cos(\theta_1) \ y_E = a_2\sin(\theta_1 + \theta_2) + a_1\sin(\theta_1) \ z_E = d_1 + d_2 + d_3 \end{cases}$$

Nghiệm của bài toán động học ngược (Inverse Kinematics): $$\theta_2 = \arctan2\left(\pm\sqrt{1 - \cos^2\theta_2}, ; \cos\theta_2\right) \quad \text{với } \cos\theta_2 = \frac{x_E^2 + y_E^2 - a_1^2 - a_2^2}{2 a_1 a_2}$$ $$\theta_1 = \arctan2(y_E, x_E) - \arctan2\left(a_2 \sin\theta_2, ; a_1 + a_2 \cos\theta_2\right)$$ $$d_3 = z_E - (d_1 + d_2)$$

2. Mô hình động lực học Lagrange loại II

Phương trình vi phân tổng quát mô tả động lực học phi tuyến của robot: $$M(q)\ddot{q} + C(q, \dot{q})\dot{q} + G(q) + Q = \tau$$

  • Ma trận khối lượng đối xứng xác định dương $M(q) \in \mathbb{R}^{3 \times 3}$: $$M(q) = \sum_{i=1}^{4} \left( J_{Ti}^T m_i J_{Ti} + J_{Ri}^T \Theta_{Ci} J_{Ri} \right)$$
  • Ma trận lực Coriolis và lực ly tâm $C(q, \dot{q})$: Tạo ra do sự phụ thuộc lẫn nhau giữa vận tốc góc của khớp 1 và khớp 2.
  • Véc-tơ thế năng và trọng lực $G(q)$: $$G(q) = \begin{bmatrix} 0 \ 0 \ -(m_3 + m_t)g \end{bmatrix}$$ (Do khớp 1 và khớp 2 chuyển động trong mặt phẳng ngang vuông góc với véc-tơ trọng lực, thế năng chỉ tác dụng lên chuyển động trượt thẳng đứng của khâu 3).

3. Mô hình hóa hàm truyền hệ thống truyền động

Dựa trên mạch tương đương động cơ DC Servo và cơ cấu trục vít me - đai ốc bi, hàm truyền đạt giữa điện áp điều khiển đầu vào $V(s)$ và góc quay/vị trí đầu ra $Y(s)$ có dạng chuẩn bậc 3: $$G(s) = \frac{K_m}{J_{td} L s^3 + (J_{td} R + L B_{td})s^2 + (B_{td} R + K_m K_e)s}$$

Thông số trích xuất thực tế từ mô hình CAD và động cơ:

  • Khớp 1 (Quay): $G_1(s) = \frac{0.9}{9.989 \times 10^{-6} s^3 + 0.003847 s^2 + 0.08105 s} \quad (\text{rad/V})$
  • Khớp 2 (Quay): $G_2(s) = \frac{0.8}{2.927 \times 10^{-6} s^3 + 0.001128 s^2 + 0.07223 s} \quad (\text{rad/V})$
  • Khớp 3 (Tịnh tiến): $G_3(s) = \frac{0.016}{1.183 \times 10^{-6} s^3 + 0.000456 s^2 + 0.02923 s} \quad (\text{m/V})$
    V(s) +     1/(Ls+R)        i(s)   Km      Tau_m   1/(J_td*s+B_td)  omega(s) 1/s  theta(s)
    --->(+)---------------------->[ x ]----->(+)--------->[ x ]---------->[ x ]---->
         ^ -                         |        ^ -            |               |
         |                           |        |              +---------------+
         +-------[ Ke ]<-------------+        +---[ T_load ]-+

Phương pháp nghiên cứu và phát triển

Dự án áp dụng quy trình phát triển Cơ điện tử chữ V (V-Model Mechatronics Design) kéo dài 15 tuần:

[Tuần 1-3: Yêu cầu & Tính toán Động học] ---------------------> [Tuần 13-15: Chạy thực tế PLC & Tối ưu]
       \                                                               /
   [Tuần 4-6: CAD SolidWorks & Động lực học] ------------> [Tuần 10-12: SimMechanics 3D]
          \                                                     /
      [Tuần 7-9: Thiết kế Hàm truyền & Đánh giá Ổn định Bode/Routh]
  • Quản lý rủi ro kỹ thuật: Hiện tượng cộng hưởng dao động cơ khí được triệt tiêu bằng cách sử dụng bộ lọc thông thấp (Low-pass filter) bậc 1 tại khối đầu vào driver với hằng số thời gian $\tau_f = 0.01\text{ ms}$ (Tham số driver Pr4.23).

Implementation và kết quả

Quá trình thực hiện kỹ thuật

1. Thuật toán điều khiển momen tính toán (Computed Torque Control)

Để bù trừ hoàn toàn tính phi tuyến phát sinh từ quán tính thay đổi và lực Coriolis, luật điều khiển lực/momen được thiết lập: $$\tau = M(q)\left(\ddot{q}_d - K_v \dot{e} - K_p e\right) + C(q, \dot{q})\dot{q} + G(q)$$

Khi thay thế luật điều khiển này vào phương trình chuyển động của hệ robot, ta thu được phương trình động lực sai số thuần nhất tuyến tính: $$\ddot{e} + K_v \dot{e} + K_p e = 0$$ Do $M(q)$ luôn là ma trận đối xứng xác định dương, hệ thống đảm bảo hội tụ tiệm cận toàn cục ($e(t) \to 0$ khi $t \to \infty$).

% Code triển khai bộ điều khiển Computed Torque trên MATLAB/Simulink
function tau = ComputedTorqueController(q_d, dq_d, ddq_d, q, dq, Kp, Kv)
    % Sai số vị trí và vận tốc
    e = q - q_d;
    de = dq - dq_d;
    
    % Tính toán các ma trận động lực học tại cấu hình hiện tại
    M = calculate_Inertia_Matrix(q);
    C = calculate_Coriolis_Matrix(q, dq);
    G = calculate_Gravity_Vector(q);
    
    % Tín hiệu gia tốc điều khiển bù
    aq = ddq_d - Kv * de - Kp * e;
    
    % Vector mô-men đầu ra cấp cho các khớp
    tau = M * aq + C * dq + G;
end

2. Cấu hình phần cứng và lập trình PLC Mitsubishi FX3G

Hệ thống sử dụng các lệnh điều khiển vị trí tuyệt đối DDRVA phát xung tốc độ cao từ PLC Mitsubishi FX3G-40MR/DS:

  • Trục 1 (Khớp quay 1): Cổng phát xung $Y_0$, chân hướng quay $Y_4$.
  • Trục 2 (Khớp quay 2): Cổng phát xung $Y_1$, chân hướng quay $Y_5$.
  • Trục 3 (Khớp tịnh tiến 3): Cổng phát xung $Y_2$, chân hướng quay $Y_6$.
// Đoạn logic phát xung định vị tuyệt đối trên FX3G (Mô phỏng cấu trúc IL/LD)
// [DDRVA S1 S2 D1 D2]
// S1: Số lượng xung mục tiêu (Target Pulse Count, 32-bit)
// S2: Tần số phát xung (Pulse Frequency: 100 kHz)
// D1: Đầu ra phát xung (Y000, Y001, Y002)
// D2: Đầu ra chiều quay (Y004, Y005, Y006)

|---[ M0: Hệ thống sẵn sàng ]-----[ DDRVA D100 D102 Y000 Y004 ]---| (Định vị Khớp 1)
|---[ M1: Bước chuyển A'->A ]-----[ DDRVA D110 D112 Y001 Y005 ]---| (Định vị Khớp 2)
|---[ M2: Hạ trục Z gắp vật ]-----[ DDRVA D120 D122 Y002 Y006 ]---| (Định vị Khớp 3)

+--------------------------+                 +------------------------------+
| PLC MITSUBISHI FX3G      |                 | PANASONIC MINAS A5 DRIVER    |
|                          |                 |                              |
|  [ Y000 (PULSE 1) ]----->+---------------->+ [ PULS1 / PULS2 ] (Chân xung)|
|  [ Y004 (SIGN 1)  ]----->+---------------->+ [ SIGN1 / SIGN2 ] (Chân chiều|
|  [ Y010 (SRV-ON)  ]----->+---------------->+ [ SRV-ON ]       (Bật Servo) |
|                          |                 |                              |
|  [ X001 (HOME LS) ]<-----+---[ Sensor ]----+ [ X6 Connector]  (Encoder)   |
+--------------------------+                 +---------------+--------------+
                                                             |
                                                             v
                                                    [ AC SERVO MOTOR ]

Đánh giá và kiểm chứng hệ thống

1. Kiểm tra tính ổn định hệ thống

  • Tiêu chuẩn đại số Routh-Hurwitz: Bảng Routh của cả ba hàm truyền $G_1(s), G_2(s), G_3(s)$ đều có cột đầu tiên mang giá trị hoàn toàn dương ($a_0 > 0, a_1 > 0, a_2 > 0, a_3 > 0$). Hệ thống vòng hở hoàn toàn ổn định.
  • Tiêu chuẩn tần số Nyquist: Đồ thị đường cong Nyquist của $G(s)$ không bao quanh điểm kỳ dị $(-1 + j0)$, chứng minh hệ kín có hồi tiếp âm đơn vị đạt độ ổn định tuyệt đối.
  • Biểu đồ Bode: Độ dự trữ biên độ ($G_m > 0\text{ dB}$) và độ dự trữ pha ($P_m > 0^\circ$) trên cả 3 trục xác nhận biên độ an toàn chống tự kích dao động.

2. Kết quả thông số bộ điều khiển PID sau hiệu chỉnh (PID Tuning)

Khớp chấp hành Hệ số tỷ lệ ($K_p$) Hệ số tích phân ($K_i$) Hệ số vi phân ($K_d$) Thời gian tăng $t_r\text{ (s)}$ Thời gian xác lập $t_s\text{ (s)}$ Độ vọt lố ($%$) Sai số xác lập ($e_{ss}$)
Khớp 1 ($\theta_1$) 3.235 163.136 0.0157 2.03 3.63 0% 0
Khớp 2 ($\theta_2$) 3.122 210.739 0.0091 1.75 3.13 0% 0
Khớp 3 ($d_3$) 34731.850 840949.615 109.2343 1.81 3.22 0% 0 
Đáp ứng vị trí bước nhảy (Step Response) trên các trục:
 biên độ
  1.0 |                      +--------------------------- (Đáp ứng bám khít)
      |                    /
      |                  /
  0.5 |                /     Độ vọt lố (Overshoot) = 0%
      |              /       Thời gian xác lập t_s = 3.13s - 3.63s
      |            /         Sai số xác lập e_ss = 0
  0.0 +----------+-----------+-----------+-----------+---> Thời gian (s)
      0          1           2           3           4

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

Điểm nổi bật kỹ thuật của đề tài

  1. Mô hình động lực học hoàn chỉnh có tải: Khác với các mô hình đơn giản hóa chỉ xét thân robot, đề tài xây dựng ma trận quán tính bổ sung $M_4(q)$ và thế năng $\Pi_4$ cho vật thể thao tác $20\text{ kg}$, giúp tính toán lực dẫn động chính xác hơn 35% so với tính toán tĩnh.
  2. Triệt tiêu hoàn toàn hiện tượng vọt lố ($\sigma = 0%$): Thông qua thuật toán PID phân tích trên miền $s$ và công cụ MATLAB Tuning Tools, loại bỏ triệt để hiện tượng va đập cơ khí khi dừng điểm, bảo vệ bộ truyền vít me bi và hộp giảm tốc.
  3. Cấu trúc điều khiển phân tầng mở: Kết hợp khả năng mô phỏng giải thuật phức tạp trên Simulink/SimMechanics với giao thức điều khiển phát xung phần cứng công nghiệp thực tế trên PLC Mitsubishi FX3G, tạo tiền đề chuyển giao công nghệ ứng dụng ngay tại nhà máy.
+-----------------------------------------------------------------------------------+
|                        BẢNG ĐỐI SÁNH HIỆU QUẢ KỸ THUẬT                            |
+--------------------------+---------------------+-------------------+--------------+
| Thông số đánh giá        | Giải pháp truyền    | Robot công nghiệp | Thiết kế     |
|                          | thống (Open-Loop)   | ngoại nhập        | của Đề tài   |
+--------------------------+---------------------+-------------------+--------------+
| Độ chính xác lặp         | ± 0.5 mm            | ± 0.02 mm         | ± 0.02 mm    |
| Độ vọt lố tại điểm dừng  | > 15%               | < 2%              | 0%           |
| Khả năng tự chủ thiết kế | 0% (mua nguyên cụm) | 0% (Black box)    | 100%         |
| Chi phí phần cứng        | Thấp                | Rất cao           | Tối ưu       |
+--------------------------+---------------------+-------------------+--------------+

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

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

  • Dây chuyền gắp - đặt (Pick & Place) linh kiện điện tử: Bốc xếp bản mạch PCB từ băng tải sang bàn kiểm tra quang học tự động với chu kỳ chuỗi chuyển động $12.15\text{ s}$ gồm 8 bước thao tác (Home $\to A' \to A \to A' \to B' \to B \to B' \to \text{Home}$).
  • Ngành đóng gói thực phẩm & dược phẩm: Đóng khay hộp bánh kẹo, vỉ thuốc với khả năng mang tải lên đến $20\text{ kg}$.
  • Tự động hóa công đoạn bắt vít, tán đinh: Nhờ độ cứng vững vượt trội theo phương thẳng đứng ($Z$), robot đáp ứng lực ép dọc trục lên đến $98\text{ N}$ trong thời gian ngắn mà không làm cong vênh kết cấu tay máy.
       [ Băng tải 1: Cấp phôi ]                          [ Băng tải 2: Thành phẩm ]
                 |                                                   ^
                 v                                                   |
           (Điểm gắp A)                                         (Điểm đặt B)
                 ^                                                   ^
                 |                                                   |
          [ Điểm an toàn A' ] ==============> [ Điểm an toàn B' ] ===+
                 ^                                   ^
                 |                                   |
                 +-----------[ Điểm HOME ]-----------+

Hướng dẫn cài đặt tham số Driver Panasonic Minas A5

Để hệ thống hoạt động chính xác với xung điều khiển từ PLC FX3G, các tham số Driver cần được cấu hình qua phần mềm PANATERM:

  • Pr0.05 = 0: Lựa chọn đầu vào nhận xung qua bộ ghép quang (Optocoupler input, tốc độ tối đa 500 kpps).
  • Pr0.07 = 3: Chế độ xung đầu vào: Xung điều khiển + Tín hiệu chiều quay (Pulse + Direction).
  • Pr3.12 = 100: Cài đặt thời gian gia tốc mềm ($100\text{ ms} / 1000\text{ r/min}$).
  • Pr3.14 = 50: Cài đặt đường cong tăng/giảm tốc chữ S (Sigmoid S-curve) để chuyển động êm thuận, giảm rung lắc.

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

Các hạn chế kỹ thuật hiện tại

  • Hệ thống cơ khí sử dụng vật liệu thép C45 cho độ cứng vững lớn nhưng khối lượng bản thân còn khá nặng ($m_{\text{total}} \approx 90.64\text{ kg}$), dẫn đến quán tính khớp lớn, đòi hỏi động cơ công suất cao.
  • Bộ điều khiển PID hiện tại là dạng hệ số cố định, chưa tự động điều chỉnh theo thời gian thực khi robot mang các mức tải chênh lệch lớn (ví dụ không tải $0\text{ kg}$ so với đầy tải $20\text{ kg}$).
  • Chưa tích hợp khâu xoay cổ tay $\theta_4$ để định hướng linh hoạt các vật thể đối xứng góc.

Định hướng nâng cấp hệ thống

  1. Tối ưu hóa vật liệu cơ khí: Chuyển đổi một số kết cấu khâu 1 và khâu 2 sang hợp kim nhôm đúc Duralumin 7075 hoặc sợi carbon gia cường để giảm 40% trọng lượng tĩnh.
  2. Áp dụng thuật toán thích nghi (Adaptive Control) & Mờ (Fuzzy-PID): Tự động bù sai số tham số mô hình khi quán tính tải $J_L$ thay đổi liên tục.
  3. Tích hợp Camera 2D Cognex / OpenCV: Hỗ trợ nhận diện tự động tọa độ $(x, y, \phi)$ của sản phẩm trên băng tải chuyển động (Conveyor Tracking).

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

  • Sinh viên & Học viên ngành Cơ điện tử / Tự động hóa: Tài liệu cung cấp trọn vẹn quy trình giải tích động học, lập trình hàm truyền, phân tích ổn định Routh/Nyquist/Bode và mô hình hóa SimMechanics trực quan.
  • Kỹ sư thiết kế Robot & Tích hợp hệ thống: Cung cấp sơ đồ đấu nối chi tiết giữa PLC Mitsubishi và AC Servo Panasonic, cùng bảng thông số tham số hóa driver công nghiệp.
  • Doanh nghiệp chế tạo máy vừa và nhỏ (SMEs): Bản thiết kế có tính khả thi cao, sử dụng các linh kiện tiêu chuẩn hóa dễ tìm kiếm trên thị trường, giúp hạ giá thành sản xuất tay máy SCARA công nghiệp.

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

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

Cần nguồn cấp 1 pha $220\text{ VAC}$ (hoặc 3 pha $220\text{ VAC}$) cho bộ Driver Servo Panasonic Minas A5, nguồn tổ ong $24\text{ VDC}$ cho PLC Mitsubishi FX3G-40MR/DS và các cảm biến tiệm cận. Máy tính nạp chương trình yêu cầu cài đặt phần mềm GX Works2 (cho PLC) và MATLAB/Simulink R2018b trở lên (để mô phỏng).

2. Làm thế nào để mở rộng robot từ 3 bậc tự do lên 4 bậc tự do hoàn chỉnh?

Có thể bổ sung một cụm động cơ Servo thu nhỏ gắn trực tiếp ở đầu khâu 3 để truyền động xoay cho trục kẹp (Spline Shaft/Ball Screw kết hợp). Trong mô hình toán, chỉ cần bổ sung thêm một hàng ma trận D-H tương ứng với góc quay $\theta_4$ và mở rộng ngõ ra phát xung $Y_3$ của PLC thông qua module mở rộng FX3U-1PG.

3. Phương pháp điều khiển Computed Torque khác gì so với điều khiển PID truyền thống?

Điều khiển PID truyền thống chỉ coi từng trục khớp là một hệ độc lập tuyến tính chịu nhiễu, do đó khi robot chuyển động tốc độ cao, lực ly tâm và Coriolis giữa các khớp sẽ gây ra sai số bám lớn. Phương pháp Computed Torque sử dụng mô hình toán $M(q), C(q, \dot{q}), G(q)$ để triệt tiêu trực tiếp các thành phần phi tuyến này trước khi tín hiệu đưa vào mạch phản hồi vòng kín.

4. Tại sao cần sử dụng chế độ phát xung chữ S (Sigmoid Curve) trên Driver?

Khi robot mang tải $20\text{ kg}$, việc tăng tốc đột ngột theo dạng bậc thang (Step) sẽ tạo ra xung lực giật (Jerk) rất lớn, gây rung lắc tay máy và làm mòn trục vít me bi. Đường cong gia tốc chữ S giúp làm mịn đạo hàm của gia tốc, đảm bảo quá trình khởi động và dừng máy diễn ra êm dịu.

5. Dự toán chi phí chế tạo mô hình này so với mua robot thương mại tương đương?

Chi phí gia công cơ khí (Thép C45, gia công phay CNC, vít me bi C7) cùng bộ thiết bị điện (PLC FX3G, 3 bộ AC Servo + Driver Panasonic A5) rơi vào khoảng $65 - 80\text{ triệu VNĐ}$, chỉ bằng khoảng 25 - 30% giá thành của một cánh tay robot SCARA thương mại nhập khẩu cùng dải tải trọng $20\text{ kg}$.

Kết luận

Đề tài "Thiết Kế Hệ Thống Điều Khiển Robot SCARA 3 Bậc Tự Do" đã giải quyết thành công chuỗi bài toán kỹ thuật phức tạp từ lý thuyết giải tích cơ học tay máy đến hiện thực hóa hệ thống điều khiển thực tế. Bằng việc kết hợp chặt chẽ giữa mô hình toán học Lagrange loại II, công cụ mô phỏng đa vật thể MATLAB/SimMechanics và nền tảng điều khiển công nghiệp PLC Mitsubishi FX3G - AC Servo Panasonic, công trình đã khẳng định khả năng tự chủ thiết kế, chế tạo và vận hành các cơ cấu robot công nghiệp chính xác cao.

Kết quả nghiên cứu mở ra hướng đi thực tiễn cho việc nội địa hóa các dòng robot gắp đặt sản phẩm, góp phần thúc đẩy tự động hóa dây chuyền sản xuất tại Việt Nam với chi phí tối ưu và độ tin cậy vượt trội.