Giới thiệu dự án
Trong bối cảnh cuộc Cách mạng Công nghiệp 4.0 đang thúc đẩy mạnh mẽ quá trình tự động hóa sản xuất, các dây chuyền lắp ráp linh kiện điện tử, vi mạch bán dẫn và đóng gói thực phẩm đòi hỏi năng suất ngày càng cao cùng độ chính xác tuyệt đối. Theo thống kê từ Hiệp hội Robot Quốc tế (IFR - International Federation of Robotics), robot cấu trúc SCARA (Selective Compliance Articulated Robot Arm) chiếm hơn 30% tổng số robot công nghiệp được triển khai trong ngành công nghiệp điện tử nhờ khả năng vận hành linh hoạt trong mặt phẳng ngang và độ cứng vững cao theo phương thẳng đứng.
Tuy nhiên, các doanh nghiệp vừa và nhỏ (SMEs) tại Việt Nam gặp nhiều rào cản khi tiếp cận các dòng robot SCARA nhập khẩu từ Nhật Bản hoặc châu Âu do chi phí đầu tư ban đầu quá lớn, khó khăn trong việc tùy biến phần mềm điều khiển và bảo trì hệ thống. Đồ án môn học Thiết kế Hệ thống Cơ điện tử (Mã học phần: ME5512, Khoa 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: Nghiên cứu, tính toán thiết kế động học, động lực học và xây dựng hệ thống điều khiển vị trí vòng kín cho Robot SCARA 4 bậc tự do (4-DOF) nhằm tối ưu hóa chi phí sản xuất mà vẫn đảm bảo các chỉ tiêu kỹ thuật công nghiệp khắt khe.
[Khớp 1: Quay (q1)] ---> [Khớp 2: Quay (q2)]
| |
(Trục Z cố định) (Cánh tay 2)
|
[Khớp 3: Tịnh tiến (q3, Trục vít me bi)]
|
[Khớp 4: Quay (q4, Cụm xoay end-effector)]
Mục tiêu dự án
- Thiết kế cấu trúc cơ học 4-DOF: Xây dựng kết cấu 3 khớp xoay và 1 khớp tịnh tiến với tầm với danh định $R = 500\text{ mm}$ (gồm khâu 1 $L_1 = 225\text{ mm}$, khâu 2 $L_2 = 275\text{ mm}$).
- Mô hình hóa toán học hoàn chỉnh: Thiết lập bảng thông số Denavit-Hartenberg (D-H), giải bài toán động học thuận/nghịch, tính toán ma trận Jacobi và thiết lập phương trình vi phân động lực học phi tuyến bằng phương pháp Lagrange loại 2.
- Quy hoạch quỹ đạo chuyển động mượt mà: Thiết kế quỹ đạo gắp - thả (Pick-and-Place) trong không gian thao tác theo đa thức bậc 3 để triệt tiêu hiện tượng giật động học (jerk) và rung lắc cơ khí.
- Mô hình hóa và tổng hợp bộ điều khiển: Xác định hàm truyền đạt động cơ DC Servo tích hợp khâu truyền động (hộp giảm tốc, vít me bi), đánh giá tính ổn định hệ thống qua biểu đồ Nyquist, và thiết kế bộ điều khiển PID tối ưu hóa thời gian xác lập.
- Thiết kế phần cứng và phần mềm nhúng: Lập trình giao diện điều khiển, cấu hình xuất xung điều khiển vị trí trên vi điều khiển STM32F407 Discovery kết hợp driver Yaskawa SGDV-5R5A và động cơ AC Servo Yaskawa SGMAV.
Thông số kỹ thuật và phạm vi thiết kế
| Thông số kỹ thuật |
Giá trị danh định |
Đơn vị |
Ghi chú |
| Số bậc tự do (DOF) |
4 |
Bậc |
3 khớp quay ($q_1, q_2, q_4$), 1 khớp tịnh tiến ($q_3$) |
| Tải trọng nâng tối đa ($m_{tai}$) |
6.0 |
kg |
Đã tính cơ cấu kẹp và phôi thao tác |
| Tầm với làm việc lớn nhất |
500 |
mm |
$a_1 + a_2 = 225\text{ mm} + 275\text{ mm}$ |
| Hành trình trục thẳng đứng (Z) |
200 |
mm |
Sử dụng bộ truyền trục vít me - đai ốc bi bước $p=25\text{ mm}$ |
| Độ lặp lại vị trí (X, Y) |
$\pm 0.02$ |
mm |
Đáp ứng chuẩn gắp lắp linh kiện PCB/SMD |
| Độ lặp lại vị trí (Z) |
$\pm 0.01$ |
mm |
Độ chính xác trục dịch chuyển thẳng đứng |
| Phạm vi góc quay khớp 1 ($q_1$) |
$\pm 132$ |
độ ($^\circ$) |
Tốc độ góc tối đa $420^\circ/\text{s}$ |
| Phạm vi góc quay khớp 2 ($q_2$) |
$\pm 145$ |
độ ($^\circ$) |
Tốc độ góc tối đa $720^\circ/\text{s}$ |
| Vận tốc tuyến tính trục Z ($q_3$) |
1100 |
mm/s |
Dẫn động bởi động cơ Servo 550W |
| Vận tốc góc khớp quay 4 ($q_4$) |
2000 |
độ/s ($^\circ/\text{s}$) |
Xoay định hướng phôi thao tác |
| Thời gian chu kỳ gắp-thả (Standard Cycle) |
0.36 |
s |
Với tải trọng thử nghiệm 1.0 kg |
Phân tích và thiết kế giải pháp
Phân tích hiện trạng
Trong phân khúc thao tác tự động tốc độ cao, các nhà tích hợp hệ thống thường lựa chọn giữa Robot Tọa độ Descartes (Cartesian/Gantry), Robot Chuỗi hở 6 bậc tự do (6-DOF Articulated) và Robot SCARA 4 bậc tự do:
| Tiêu chí so sánh |
Robot Cartesian (Gantry) |
Robot 6-DOF Articulated |
Robot SCARA 4-DOF (Đồ án đề xuất) |
| Độ linh hoạt không gian |
Thấp (chuyển động 3 trục độc lập X-Y-Z) |
Rất cao (thao tác mọi hướng trong không gian 3D) |
Tối ưu cho mặt phẳng ngang X-Y và tịnh tiến Z |
| Tốc độ chu kỳ (Cycle Time) |
Chậm ($> 1.2\text{ s}$) |
Trung bình ($0.6 - 1.0\text{ s}$) |
Rất nhanh ($0.36 - 0.5\text{ s}$) |
| Độ cứng vững theo phương Z |
Trung bình (phụ thuộc dầm trượt) |
Thấp hơn do cánh tay nối tiếp dài |
Rất cao (kết cấu trục thẳng đứng chuyên biệt) |
| Chi phí chế tạo & bảo trì |
Thấp đến trung bình |
Rất cao ($> 25,000\text{ USD}$) |
Trung bình ($5,000 - 8,000\text{ USD}$), tối ưu chi phí |
| Độ phức tạp điều khiển |
Đơn giản (không cần động học ngược) |
Rất phức tạp (6 nghiệm phi tuyến) |
Phù hợp, tính toán giải tích trực tiếp theo D-H |
Phân loại yêu cầu hệ thống theo mô hình MoSCoW:
- Must have (Bắt buộc): Hoạt động ổn định với tải 6kg; độ chính xác lặp $\le \pm 0.02\text{ mm}$; thuật toán động học ngược giải tích chạy thời gian thực; hệ thống điều khiển vị trí vòng kín (Closed-loop PID) không vọt lố.
- Should have (Nên có): Giao diện giám sát GUI trên MATLAB cho phép nhập tọa độ đích $X-Y-Z-\varphi$; mô hình CAD 3D đồng bộ với không gian mô phỏng Simscape.
- Could have (Có thể mở rộng): Tích hợp thông dịch mã lệnh G-code công nghiệp; nội suy cung tròn tự động.
- Won't have (Chưa thực hiện trong giai đoạn này): Cảm biến lực 6 trục đầu cuối và hệ thống thị giác máy tính AI 3D Vision.
Thiết kế hệ thống
Kiến trúc tổng thể của hệ thống robot SCARA 4-DOF bao gồm 4 tầng chức năng:
[Tầng Giám sát HMI (MATLAB GUI / PC)]
| (Giao tiếp RS-232 / UART qua FT232RL)
[Tầng Điều khiển Trung tâm: STM32F407VGT6 ARM Cortex-M4 @ 168MHz]
| (Tín hiệu xuất xung: PULSE / DIRECTION + ENABLE)
[Tầng Lực & Điều khiển Động cơ: 4x Yaskawa SGDV-5R5A Servo Driver]
| (Nguồn 3-Phase 200V + Encoder phản hồi 20-bit)
[Tầng Chấp hành Cơ khí: Động cơ Yaskawa SGMAV + Hộp số + Vít me bi]
- Phần mềm tính toán & mô phỏng: MATLAB R2023b, Simulink, Control System Toolbox, Simscape Multibody.
- Phần cứng vi xử lý: Kit phát triển STM32F407 Discovery (Chip STM32F407VGT6, vi kiến trúc ARM Cortex-M4, xung nhịp 168 MHz, tích hợp bộ tính toán dấu phẩy động FPU phần cứng).
- Bộ điều khiển động cơ & Chấp hành:
- Khâu 1 & Khâu 2 (Khớp xoay vai và khửu): Động cơ AC Servo Yaskawa SGMAV (Công suất 400W/550W, hằng số mô-men xoắn $K_m = 0.467\text{ Nm/A}$, quán tính rotor $J_m = 0.258 \times 10^{-4}\text{ kg}\cdot\text{m}^2$).
- Khâu 3 (Khớp tịnh tiến Z): Động cơ Servo 550W truyền động qua trục vít me đai ốc bi ($p = 25\text{ mm}$, $d_1 = 16.7\text{ mm}$, khối lượng vít me $0.84\text{ kg}$).
- Khâu 4 (Khớp xoay trục công tác): Động cơ Servo 200W kết nối đai răng.
- Hệ thống phản hồi: Cảm biến mã hóa vòng quay tương đối/tuyệt đối (Encoder) tích hợp trên trục động cơ với độ phân giải cao kết hợp cảm biến hành trình quang giới hạn vị trí biên.
Methodology
Dự án triển khai theo quy trình V-Model nghiêm ngặt trong 15 tuần:
Tuần 1-3: Nghiên cứu lý thuyết & Xác lập thông số D-H
Tuần 4-6: Giải tích động học, động lực học Lagrange & Quy hoạch quỹ đạo
Tuần 7-9: Mô hình hóa hàm truyền & Khảo sát ổn định (Nyquist/Bode)
Tuần 10-12: Thiết kế bộ điều khiển PID (PID Tuner) & Mô phỏng Simulink
Tuần 13-14: Thiết kế mạch nguyên lý, lựa chọn linh kiện & Lập trình STM32
Tuần 15: Kiểm thử liên động toàn hệ thống, đánh giá sai số & Báo cáo
Implementation và kết quả
Development process & Core Algorithms
1. Động học thuận và Thiết lập hệ quy chiếu D-H
Đặt các hệ tọa độ ${O_i}$ theo quy tắc Denavit-Hartenberg tiêu chuẩn tại các tâm khớp quay và khớp trượt:
| Khâu ($i$) |
Biến khớp ($\theta_i$) |
Khoảng cách dịch chuyển ($d_i$) |
Chiều dài khâu ($a_i$) |
Góc xoắn ($\alpha_i$) |
| 1 |
$q_1^*$ |
$d_1 = 156\text{ mm}$ |
$a_1 = 225\text{ mm}$ |
$0$ |
| 2 |
$q_2^*$ |
$d_2 = 95\text{ mm}$ |
$a_2 = 275\text{ mm}$ |
$\pi$ |
| 3 |
$0$ |
$q_3^*$ |
$0$ |
$0$ |
| 4 |
$q_4^*$ |
$d_4 = 51\text{ mm}$ |
$0$ |
$0$ |
Ma trận biến đổi tọa độ tổng quát giữa hệ $i-1$ và hệ $i$:
$$T_i^{i-1} = \begin{bmatrix} \cos q_i & -\sin q_i \cos \alpha_i & \sin q_i \sin \alpha_i & a_i \cos q_i \ \sin q_i & \cos q_i \cos \alpha_i & -\sin q_i \sin \alpha_i & a_i \sin q_i \ 0 & \sin \alpha_i & \cos \alpha_i & d_i \ 0 & 0 & 0 & 1 \end{bmatrix}$$
Nhân liên tiếp các ma trận chuyển đổi từ gốc tọa độ $O_0$ tới khâu thao tác $O_4$, ta nhận được phương trình động học thuận:
$$T_4^0 = T_1^0 \cdot T_2^1 \cdot T_3^2 \cdot T_4^3 = \begin{bmatrix} \cos \varphi & \sin \varphi & 0 & x_K \ \sin \varphi & -\cos \varphi & 0 & y_K \ 0 & 0 & -1 & z_K \ 0 & 0 & 0 & 1 \end{bmatrix}$$
Trong đó, tọa độ điểm đầu cuối $K(x_K, y_K, z_K)$ và hướng $\varphi$:
$$\begin{cases} x_K = a_1 \cos q_1 + a_2 \cos(q_1 + q_2) \ y_K = a_1 \sin q_1 + a_2 \sin(q_1 + q_2) \ z_K = d_1 + d_2 - q_3 - d_4 \ \varphi = q_1 + q_2 - q_4 \end{cases}$$
2. Thuật toán giải Động học ngược (Inverse Kinematics)
Khi biết trước vị trí mong muốn $(x_K, y_K, z_K, \varphi)$, hệ phương trình lượng giác phi tuyến được giải theo phương pháp giải tích:
$$x_K^2 + y_K^2 = a_1^2 + a_2^2 + 2a_1 a_2 \cos q_2 \implies \cos q_2 = \frac{x_K^2 + y_K^2 - a_1^2 - a_2^2}{2a_1 a_2}$$
$$\implies q_2 = \pm \arccos\left(\frac{x_K^2 + y_K^2 - a_1^2 - a_2^2}{2a_1 a_2}\right)$$
Từ $q_2$, khai triển giải hệ phương trình Cramer tìm $q_1$:
$$\Delta = (a_2 \cos q_2 + a_1)^2 + (a_2 \sin q_2)^2$$
$$\Delta_1 = x_K(a_2 \cos q_2 + a_1) + y_K a_2 \sin q_2$$
$$\Delta_2 = y_K(a_2 \cos q_2 + a_1) - x_K a_2 \sin q_2$$
$$q_1 = \text{atan2}(\Delta_2, \Delta_1)$$
$$q_3 = d_1 + d_2 - d_4 - z_K$$
$$q_4 = q_1 + q_2 - \varphi$$
% Đoạn mã MATLAB giải động học ngược robot SCARA 4-DOF
function [q1, q2, q3, q4] = inverse_kinematics(xK, yK, zK, phi, a1, a2, d1, d2, d4)
% Tính biến khớp q2
cos_q2 = (xK^2 + yK^2 - a1^2 - a2^2) / (2 * a1 * a2);
if abs(cos_q2) > 1
error('Điểm tọa độ nằm ngoài không gian làm việc của Robot!');
end
q2 = acos(cos_q2); % Chọn cấu hình khuỷu tay dương (elbow-down)
% Giải hệ phương trình tìm q1
delta = (a2 * cos(q2) + a1)^2 + (a2 * sin(q2))^2;
delta1 = xK * (a2 * cos(q2) + a1) + yK * a2 * sin(q2);
delta2 = yK * (a2 * cos(q2) + a1) - xK * a2 * sin(q2);
q1 = atan2(delta2, delta1);
% Biến khớp tịnh tiến và biến khớp xoay đầu công tác
q3 = d1 + d2 - d4 - zK;
q4 = q1 + q2 - phi;
end
3. Phương trình Động lực học Lagrange loại 2
Phương trình tổng quát:
$$\frac{d}{dt}\left(\frac{\partial T}{\partial \dot{q}_k}\right) - \frac{\partial T}{\partial q_k} + \frac{\partial \Pi}{\partial q_k} = \tau_k$$
Hệ phương trình vi phân chuyển động phi tuyến thu được:
$$M(q)\ddot{q} + C(q,\dot{q})\dot{q} + g(q) = \tau$$
Trong đó $M(q)$ là ma trận quán tính đối xứng $4 \times 4$, $C(q,\dot{q})$ là ma trận lực hướng tâm và Coriolis biểu diễn qua các hệ số Christoffel $c_{ijk} = \frac{1}{2}\left(\frac{\partial m_{ij}}{\partial q_k} + \frac{\partial m_{ik}}{\partial q_j} - \frac{\partial m_{jk}}{\partial q_i}\right)$, và $g(q) = [0, 0, -9.81(m_3 + m_4), 0]^T$ là vector trọng trường.
4. Quy hoạch quỹ đạo gắp-thả theo đa thức bậc 3
Để tránh hiện tượng nhảy bậc gia tốc làm cháy motor hoặc biến dạng cơ khí, quy hoạch vị trí trục $x(t)$ theo thời gian $t \in [0, t_e]$ với điều kiện biên vận tốc triệt tiêu $\dot{x}(0) = 0, \dot{x}(t_e) = 0$:
$$x(t) = a_0 + a_1 t + a_2 t^2 + a_3 t^3 \implies \begin{cases} a_0 = x_0 \ a_1 = 0 \ a_2 = \frac{3(x_e - x_0)}{t_e^2} \ a_3 = \frac{-2(x_e - x_0)}{t_e^3} \end{cases}$$
Vị trí x(t) : x0 ---------------------------> xe (Đường cong S-curve mượt)
Vận tốc dx/dt : 0 ---------[ Cực đại ]---------> 0 (Đảm bảo tính liên tục C1)
5. Mô hình hóa hàm truyền đạt động cơ DC
Phương trình cân bằng điện - cơ chuyển sang miền Laplace với điều kiện ban đầu bằng 0:
$$U(s) = (Ls + R)I(s) + K_e \omega(s)$$
$$M(s) = K_m I(s)$$
$$M(s) = (J_{td} s + B_{td})\omega(s) + M_t(s)$$
Với góc quay động cơ $\theta_m(s) = \frac{\omega(s)}{s}$, hàm truyền đạt vòng hở từ điện áp đặt $U(s)$ đến góc quay $\theta_m(s)$ là:
$$G_{dc}(s) = \frac{\theta_m(s)}{U(s)} = \frac{K_m}{s\left[ L J_{td} s^2 + (L B_{td} + R J_{td})s + (K_m K_e + R B_{td}) \right]} = \frac{K_{td}}{s(T_1 s^2 + T_2 s + 1)}$$
Đối với khâu 3 tịnh tiến qua trục vít me bi (bước $p = 25\text{ mm}$), hệ số truyền đổi là $K = \frac{p}{2\pi}$:
$$G_{khau3}(s) = \frac{n_3 K_{td} K}{s(T_1 s^2 + T_2 s + 1)}$$
Testing và validation
Khảo sát hệ hở và hệ kín phản hồi đơn vị trước khi có bộ điều khiển cho thấy một bài toán vật lý nghiêm trọng: Hệ thống ổn định (biểu đồ Nyquist không bao điểm $-1 + 0j$) nhưng tốc độ đáp ứng quá chậm, hoàn toàn không thể ứng dụng trong công nghiệp.
% Script MATLAB tính toán hàm truyền và khảo sát đặc tính quá độ
Ke = 56/60; Km = 0.496; Jm = 0.258e-3; Bm = 2.58e-4;
R = 1.2; L = 0.0035; n = 1/50; Jload = 0.012; Bload = 0.001;
Jtd = Jm + n^2 * Jload;
Btd = Bm + n^2 * Bload;
num = [Km * n];
den = [L*Jtd, (L*Btd + R*Jtd), (Km*Ke + R*Btd), 0];
Gs = tf(num, den);
step(feedback(Gs, 1)); % Đánh giá đáp ứng bước nhảy
Đánh giá định lượng trước và sau khi tối ưu hóa bộ điều khiển PID (Sử dụng MATLAB PID Tuner)
| Khâu truyền động |
Thời gian tăng $t_r$ (Gốc) |
Thời gian xác lập $t_s$ (Gốc) |
Bộ thông số PID tối ưu ($K_p, K_i, K_d$) |
Thời gian xác lập $t_s$ (Sau tối ưu) |
Độ vọt lố (POT) |
Sai lệch tĩnh ($e_{ss}$) |
| Khớp 1 ($q_1$) |
$105.0\text{ s}$ |
$472.0\text{ s}$ |
$K_p = 125.4, K_i = 18.2, K_d = 8.6$ |
$0.28\text{ s}$ |
$2.1%$ |
$0.000\text{ rad}$ |
| Khớp 2 ($q_2$) |
$94.0\text{ s}$ |
$380.0\text{ s}$ |
$K_p = 98.7, K_i = 14.5, K_d = 6.2$ |
$0.22\text{ s}$ |
$1.8%$ |
$0.000\text{ rad}$ |
| Khớp 3 ($q_3$) |
$220.0\text{ s}$ |
$956.0\text{ s}$ |
$K_p = 340.0, K_i = 45.0, K_d = 24.8$ |
$0.34\text{ s}$ |
$0.0%$ |
$0.000\text{ mm}$ |
| Khớp 4 ($q_4$) |
$64.0\text{ s}$ |
$287.0\text{ s}$ |
$K_p = 45.2, K_i = 8.1, K_d = 2.4$ |
$0.15\text{ s}$ |
$3.4%$ |
$0.000\text{ rad}$ |
Kết quả đạt được
- Giảm thời gian đáp ứng hơn 99.9%: Thời gian xác lập từ mức hàng trăm giây giảm xuống dưới $0.35\text{ s}$, đáp ứng trọn vẹn chu kỳ làm việc tiêu chuẩn $0.36\text{ s}$.
- Khả năng bám quỹ đạo hoàn hảo: Kiểm nghiệm mô phỏng chuyển động theo quỹ đạo đường thẳng và đường tròn trong không gian 3D cho thấy sai số bám biên dạng (contour error) đạt dưới $\pm 0.015\text{ mm}$.
- Hoàn thiện thiết kế phần cứng: Thiết kế thành công sơ đồ nguyên lý mạch điều khiển khổ A0 tích hợp vi điều khiển STM32F407, mạch cách ly quang tốc độ cao (Optocoupler 6N137) chống nhiễu công nghiệp cho tín hiệu xung/hướng và khối cấp nguồn đa kênh cách ly.
Đổi mới và đóng góp
- Quy trình mô hình hóa giải tích khép kín: Khác với các nghiên cứu đơn giản hóa bỏ qua thành phần động lực học phi tuyến, đồ án đã giải quyết tường minh ma trận Coriolis và ma trận quán tính phụ thuộc cấu hình khớp $M(q)$, làm tiền đề cho việc bù mô-men quán tính biến thiên.
- Tối ưu hóa đa tầng: Kết hợp đồng thời tối ưu hóa quỹ đạo chuyển động bằng đa thức bậc 3 (giảm rung động cơ học đầu cuối) với tinh chỉnh tự động bộ điều khiển PID bằng công cụ PID Tuner trên nền tảng hàm truyền đạt thực của động cơ AC Servo Yaskawa.
- Tính khả thi thực tiễn cao: Đề xuất cấu hình mạch ghép nối trực tiếp giữa kit vi điều khiển 32-bit hiệu năng cao STM32F407 với dòng driver công nghiệp Yaskawa SGDV-5R5A, mở ra khả năng thương mại hóa chế tạo robot nội địa với chi phí chỉ bằng $30-40%$ so với thiết bị nhập ngoại.
Ứng dụng thực tế và triển khai
Tình huống ứng dụng thực tế
- Dây chuyền cắm linh kiện tự động (SMT / Through-Hole): Gắp chip IC, điện trở, tụ điện từ khay nạp và đặt chính xác lên bo mạch in PCB với tốc độ 120 sản phẩm/phút.
- Ngành công nghiệp dược phẩm & Đóng gói: Đóng nắp chai lọ y tế, dán nhãn tự động, phân loại vỉ thuốc theo mã vạch tốc độ cao.
- Gia công vi cơ khí & Khắc Laser: Dẫn đường đầu khắc laser CO2/Fiber trên mặt phẳng 2D với độ mịn đường cong biên dạng cực cao nhờ nội suy đa thức liên tục.
[Băng chuyền cấp phôi] ---> [Cảm biến quang phát hiện]
|
[Robot SCARA gắp phôi (Chu kỳ 0.36s)]
|
[Băng chuyền đóng gói đầu ra]
Yêu cầu triển khai hạ tầng & Đánh giá hiệu quả kinh tế (ROI)
- Nguồn điện vận hành: 1-Phase 220VAC $\pm 10%$ (cấp nguồn điều khiển) và 3-Phase 200VAC (cấp nguồn động lực Servo).
- Môi trường hoạt động: Nhiệt độ $0 - 45^\circ\text{C}$, độ ẩm $< 85%$ không ngưng tụ, cách ly bụi kim loại dẫn điện.
- Ước tính chi phí & ROI:
- Chi phí gia công cơ khí chính xác & Bộ truyền vít me bi: 35,000,000 VNĐ.
- Hệ thống 4 bộ động cơ & Driver Yaskawa Servo (Second-hand/New OEM): 45,000,000 VNĐ.
- Bo mạch điều khiển STM32, nguồn công nghiệp & Phụ kiện: 10,000,000 VNĐ.
- Tổng chi phí chế tạo mẫu thử: ~90,000,000 VNĐ (so với mức 250,000,000 - 400,000,000 VNĐ của robot nhập khẩu mới cùng phân khúc tải trọng 6kg). Thời gian hoàn vốn dự kiến cho doanh nghiệp sản xuất linh kiện đạt từ 6 đến 9 tháng.
Hạn chế và hướng phát triển
Hạn chế kỹ thuật hiện tại
- Bộ điều khiển PID hiện tại được thiết kế độc lập cho từng khớp (Decoupled Single-Axis Control), chưa có khâu bù tương tác ghép kênh chéo (Dynamic Cross-Coupling) khi cả 4 trục đồng thời chuyển động ở vận tốc tối đa $720^\circ/\text{s}$.
- Hệ thống hoạt động theo tọa độ định sẵn (Blind pick-and-place), chưa có khả năng tự nhận diện vị trí và góc xoay của phôi thay đổi ngẫu nhiên trên băng chuyền.
Hướng phát triển tiếp theo
- Ứng dụng điều khiển hiện đại: Nghiên cứu triển khai thuật toán Điều khiển Mô-men tính toán (Computed Torque Control - CTC) hoặc Điều khiển Trượt thích nghi (Adaptive Sliding Mode Control) để bù trừ phi tuyến theo thời gian thực.
- Tích hợp Camera 2D/3D Machine Vision: Kết nối hệ thống xử lý ảnh công nghiệp OpenCV / Python thông qua giao thức truyền thông Ethernet/IP hoặc Modbus TCP để định vị tọa độ phôi động trên băng tải.
Đối tượng hưởng lợi
- Sinh viên ngành Cơ điện tử, Tự động hóa & Robot: Nắm vững phương pháp luận chuẩn mực từ thiết lập bảng D-H, thiết lập ma trận Jacobi, giải tích động lực học Lagrange đến mô phỏng hệ thống điều khiển vị trí trên MATLAB/Simulink.
- Kỹ sư R&D và Lập trình viên nhúng: Tiếp cận giải pháp điều khiển động cơ AC Servo công nghiệp qua vi điều khiển STM32F407 với chuẩn giao tiếp xung/hướng tốc độ cao và sơ đồ mạch ghép nối cách ly quang.
- Doanh nghiệp tích hợp hệ thống tự động hóa: Cơ sở kỹ thuật vững chắc để nội địa hóa cánh tay robot SCARA công nghiệp, giảm phụ thuộc vào nhà cung cấp nước ngoài và tiết kiệm chi phí đầu tư.
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 điều khiển robot SCARA là gì?
Hệ thống cần tối thiểu 01 vi điều khiển 32-bit có hỗ trợ tính toán số thực FPU (như STM32F407 hoặc tương đương) với ít nhất 4 kênh Timer xuất xung PWM tần số cao ($> 200\text{ kHz}$) và 4 kênh Timer đọc Encoder chế độ Quadrature; 04 bộ Driver Servo hỗ trợ chế độ Position Mode (Xung/Hướng); bộ nguồn công nghiệp 24VDC cách ly và hệ thống nút dừng khẩn cấp E-Stop cắt nguồn cứng.
2. Giới hạn tải trọng của robot có thể mở rộng vượt quá 6kg không?
Có thể mở rộng lên 10 - 20kg bằng cách: (1) Thay đổi tỷ số truyền hộp giảm tốc Harmonic/Bánh răng hành tinh ở khớp 1 và 2 từ $1:50$ lên $1:80$ hoặc $1:100$; (2) Tăng công suất động cơ Servo khâu 1 và 2 lên $750\text{W} - 1.0\text{kW}$; (3) Nâng cấp đường kính trục vít me bi khâu 3 từ $16.7\text{ mm}$ lên $25\text{ mm}$ và tăng tiết diện dầm hợp kim nhôm cánh tay.
3. Phương thức tích hợp robot với hệ thống PLC công nghiệp hiện hữu như thế nào?
Vi điều khiển STM32F407 có thể giao tiếp với PLC (Siemens S7-1200, Mitsubishi FX5U) thông qua các chân I/O số cách ly 24V (để nhận tín hiệu Start, Stop, Ready, Error) hoặc qua chuẩn truyền thông công nghiệp RS485 Modbus RTU / CANopen để truyền nhận tọa độ điểm thao tác linh hoạt.
4. Quy trình bảo trì và hiệu chuẩn định kỳ hệ thống cơ điện tử gồm những gì?
Cần thực hiện tra mỡ bôi trơn chuyên dụng định kỳ mỗi 500 giờ làm việc cho trục vít me bi và các vòng bi đỡ; kiểm tra độ căng dây đai răng truyền động khâu 4; hiệu chuẩn điểm Zero (Homing Calibration) bằng cảm biến tiệm cận quang học có độ lặp lại cao sau mỗi lần ngắt nguồn hệ thống.
5. Chi phí bảo dưỡng và tuổi thọ vận hành ước tính của robot?
Nhờ sử dụng động cơ AC Servo không chổi than (Brushless) và bộ truyền vít me bi cấp chính xác C5/C7, tuổi thọ cơ khí danh định đạt trên 20,000 giờ làm việc liên tục. Chi phí bảo trì định kỳ hàng năm ước tính dưới $5%$ tổng giá trị chế tạo thiết bị.
Kết luận
Đồ án môn học "Thiết kế robot SCARA 4 bậc tự do" (Mã HP: ME5512, Khoa Cơ điện tử – Trường Cơ khí, Trường Đại học Bách khoa Hà Nội) do sinh viên Hoàng Xuân Tùng thực hiện dưới sự hướng dẫn của ThS. Hoàng Văn Bạo đã hoàn thành xuất sắc toàn bộ khối lượng nghiên cứu đặt ra. Đề tài đã chuẩn hóa quy trình thiết kế cơ điện tử khép kín: từ giải tích động học D-H, động lực học Lagrange, mô hình hóa hàm truyền đạt hệ thống truyền động đến tổng hợp bộ điều khiển PID tối ưu trên MATLAB/Simulink và thiết kế mạch điều khiển nhúng STM32F407.
Kết quả mô phỏng khẳng định robot đáp ứng hoàn hảo các tiêu chuẩn kỹ thuật công nghiệp với tải trọng $6\text{ kg}$, tầm với $500\text{ mm}$, thời gian xác lập cực nhanh dưới $0.35\text{ s}$ và triệt tiêu hoàn toàn sai lệch tĩnh. Đây là tài liệu tham khảo có giá trị học thuật và ứng dụng thực tiễn cao cho sinh viên, kỹ sư và các doanh nghiệp đang theo đuổi mục tiêu tự chủ công nghệ chế tạo robot tại Việt Nam.
