Giới thiệu dự án
Trong bối cảnh công nghiệp 4.0 và chuyển đổi số sản xuất, cánh tay robot công nghiệp 6 bậc tự do (6-DOF Articulated Robot) đóng vai trò xương sống tại các dây chuyền gia công, hàn, sơn, đóng gói và lắp ráp linh kiện tự động. Theo các báo cáo thị trường tự động hóa công nghiệp toàn cầu, nhu cầu triển khai robot đa trục tăng trưởng trung bình hơn 12% mỗi năm. Tuy nhiên, tại thị trường Việt Nam, trên 85% hệ thống cánh tay robot công nghiệp đang vận hành đều nhập khẩu nguyên chiếc từ các thương hiệu như ABB, KUKA, Yaskawa hoặc Fanuc. Thực trạng này tạo ra rào cản tài chính lớn đối với các doanh nghiệp vừa và nhỏ (SMEs), đồng thời gây phụ thuộc hoàn toàn vào chuyên gia và phụ tùng ngoại nhập khi phát sinh bảo trì, nâng cấp.
Đồ án tốt nghiệp "Thiết kế và điều khiển robot công nghiệp sử dụng PLC" (thực hiện bởi nhóm sinh viên Kỹ thuật Cơ điện tử, chuyên ngành Hệ thống Sản xuất Tự động - Đại học Bách khoa Hà Nội) tập trung giải quyết bài toán làm chủ hoàn toàn từ phần cứng cơ khí, tủ điện điều khiển công nghiệp đến thuật toán động học và phần mềm giao diện điều hành. Đề tài phát triển hệ thống điều khiển lai (Hybrid Architecture) kết hợp giữa bộ điều khiển logic khả trình PLC Mitsubishi FX3U và máy tính điều khiển PC thông qua phần mềm trung gian giao tiếp chuyên dụng.
+-------------------------------------------------------------+
| MÁY TÍNH ĐIỀU KHIỂN TRUNG TÂM (PC / C# GUI) |
| - Tính toán Động học thuận (FK) / Động học ngược (IK) |
| - Quy hoạch quỹ đạo PTP & Liên tục (Trajectory Planning) |
| - Giao diện vận hành, giám sát thông số thời gian thực |
+-------------------------------------------------------------+
|
[MX Component v4.16L]
(Giao thức Serial RS-232 / RS-422)
|
v
+-------------------------------------------------------------+
| TỦ ĐIỀU KHIỂN CÔNG NGHIỆP PLC FX3U |
| +---------------------------+ RS-485 +----------------+ |
| | Master: FX3U-64MT/ES-A |<=========>| Slave: | |
| | (Phát xung Trục 1, 2, 3) | | FX3U-32MT/ES-A | |
| +---------------------------+ | (Phát xung | |
| | | Trục 4, 5, 6) | |
| | +----------------+ |
+----------------|----------------------------------|---------+
| Xung/Chiều (Pulse/Dir) |
v v
+-------------------------------------------------------------+
| HỆ THỐNG TRUYỀN ĐỘNG (6x TB6600 Driver + Stepper) |
| Trục 1: NEMA 17 (1:10) | Trục 4: NEMA 11 (1:14) |
| Trục 2: NEMA 23 (1:100) | Trục 5: Vít me bi (1:1) |
| Trục 3: NEMA 17 (1:50) | Trục 6: NEMA 14 (1:19) |
+-------------------------------------------------------------+
|
v
+-------------------------------------------------------------+
| CƠ CẤU CHẤP HÀNH 6-DOF (Cánh tay Robot Nhôm 6061) |
| Tải trọng: 500g | Tầm với: 600mm | Khối lượng: 10kg |
+-------------------------------------------------------------+
Mục tiêu đề tài
- Thiết kế và gia công cơ khí: Cải tiến cấu trúc cơ khí mẫu cánh tay robot 6 bậc tự do AR3 với vật liệu Hợp kim Nhôm 6061, tích hợp bộ truyền vít me - đai ốc bi và đai răng giảm tải.
- Tính toán động học và động lực học: Xây dựng hệ ma trận Denavit-Hartenberg (D-H), giải phương trình động học thuận (Forward Kinematics), động học ngược (Inverse Kinematics) và tính toán mô-men tĩnh theo phương trình Lagrange loại II.
- Phát triển tủ điện công nghiệp: Xây dựng giải pháp điều khiển đồng bộ 6 trục chuyển động bằng mạng Master - Slave kết nối 2 PLC Mitsubishi FX3U qua module truyền thông RS-485.
- Phần mềm giao diện và liên kết dữ liệu: Viết ứng dụng C# (.NET Framework) giám sát, nạp quỹ đạo và đồng bộ thanh ghi PLC qua thư viện MELSOFT MX Component.
Giới hạn và phạm vi nghiên cứu
- Tải trọng định mức tác động cuối: $500\text{ g}$ (tối đa $1.000\text{ g}$ ở tốc độ thấp).
- Bán kính làm việc tối đa: $600\text{ mm}$.
- Chế độ điều khiển: Hệ thống điều khiển vòng hở (Open-loop control) sử dụng động cơ bước kết hợp hộp giảm tốc vi sai và vi bước Driver TB6600.
Phân tích và thiết kế giải pháp
Phân tích hiện trạng
| Tiêu chí |
Robot nhập khẩu nguyên chiếc (ABB/KUKA) |
Bộ kit Robot mã nguồn mở (Arduino/ROS) |
Giải pháp Đề tài (PC C# + PLC FX3U) |
| Độ tin cậy công nghiệp |
Rất cao (Chuẩn IP54/IP67) |
Kém (Dễ nhiễu tín hiệu logic) |
Cao (PLC chống nhiễu EMC tiêu chuẩn) |
| Khả năng tùy biến |
Thấp (Kiến trúc đóng, phụ thuộc hãng) |
Rất cao (Mã nguồn mở) |
Cao (Làm chủ phần mềm C# và PLC) |
| Chi phí đầu tư |
$15.000 - $40.000 USD |
$300 - $800 USD |
$1.200 - $2.000 USD |
| Tính toán động học |
Tích hợp sẵn Controller |
Xử lý trên PC / Linux ROS |
Xử lý trên PC (C#), PLC phát xung |
| Khả năng bảo trì |
Phức tạp, chi phí linh kiện đắt |
Dễ thay thế nhưng độ bền thấp |
Linh kiện phổ biến, giá thành tối ưu |
Phân tích MoSCoW xác định các yêu cầu kỹ thuật:
- Must have: Hoàn thiện động học thuận/ngược 6 trục; phát xung đồng bộ 6 động cơ bước; nút dừng khẩn cấp (E-Stop) ngắt nguồn phần cứng; giao diện Jogging và Point-to-Point (PTP).
- Should have: Tính toán mô-men động lực học để lựa chọn dòng tải động cơ; truyền thông dữ liệu ổn định không trễ chu kỳ quét ($<100\text{ ms}$).
- Could have: Chế độ vẽ đường liên tục (Continuous Path); lưu và xuất lịch sử tọa độ điểm gắp.
- Won't have (lần này): Vòng phản hồi kín sử dụng Absolute Encoder từng khớp; xử lý ảnh Machine Vision nhận diện vật thể.
Thiết kế hệ thống
Hệ thống điều khiển được phân tầng cấu trúc rõ ràng nhằm tách biệt giữa tầng tính toán giải tích phức tạp và tầng điều khiển thời gian thực (Hard Real-time pulse generation):
+-----------------------------------------------------------------------------------+
| [TẦNG ĐIỀU HÀNH & TÍNH TOÁN] |
| Giao diện C# Visual Studio 2022 |
| - Ma trận chuyển đổi D-H 4x4 |
| - Tọa độ Tool Center Point (TCP) (X, Y, Z, Roll, Pitch, Yaw) |
| - Giải thuật giải tích & hình học tách 3 khớp đầu / 3 khớp sau |
+-----------------------------------------------------------------------------------+
│
Giao thức ActUtlType / MX Component v4.16L
│
▼
+-----------------------------------------------------------------------------------+
| [TẦNG ĐIỀU KHIỂN THỜI GIAN THỰC] |
| 1. PLC Master: Mitsubishi FX3U-64MT/ES-A (Transistor Output) |
| - Điều khiển trục 1 (Base), Trục 2 (Shoulder), Trục 3 (Elbow) |
| - Lệnh phát xung: PLSR, DRVA, DRVI (Tần số max 100 kHz) |
| - Module giao tiếp: FX3U-485-BD |
| |
| 2. PLC Slave: Mitsubishi FX3U-32MT/ES-A |
| - Nhận dữ liệu góc q4, q5, q6 qua mạng N:N Network / Modbus RTU |
| - Điều khiển Trục 4 (Wrist Pitch), Trục 5 (Wrist Yaw), Trục 6 (Wrist Roll) |
+-----------------------------------------------------------------------------------+
│
Tín hiệu Pulse / Direction
│
▼
+-----------------------------------------------------------------------------------+
| [TẦNG CÔNG SUẤT VÀ CHẤP HÀNH] |
| - Nguồn tổ ong Meanwell/Industrial 24VDC - 15A |
| - 6x Microstep Driver TB6600 (Thiết lập 1600 - 6400 Pulse/Rev) |
| - 6x Động cơ bước Hybrid Step Motor kèm Hộp giảm tốc hành tinh |
+-----------------------------------------------------------------------------------+
Công nghệ và phiên bản sử dụng
- Phần mềm lập trình PLC: MELSOFT GX Works2 Version 1.595Z.
- Thư viện kết nối dữ liệu: MELSOFT MX Component Version 4.16L (giao tiếp COM/OLE Automation qua đối tượng
ActUtlType).
- Môi trường phát triển giao diện: Microsoft Visual Studio 2022 (.NET Framework 4.7.2, Windows Forms C#).
- Phần mềm mô phỏng và CAD: SolidWorks 2020 (thiết kế 3D, tính toán trọng tâm/khối lượng), MATLAB R2021a (kiểm chứng không gian làm việc và quỹ đạo).
Thiết kế thanh ghi dữ liệu PLC
Hệ thống sử dụng các vùng nhớ chuyên dụng của PLC Mitsubishi FX3U để trao đổi dữ liệu vị trí:
D100 - D101: Vị trí xung đích trục 1 (32-bit signed integer).D102 - D103: Vị trí xung đích trục 2 (32-bit signed integer).D104 - D105: Vị trí xung đích trục 3 (32-bit signed integer).D200 - D205: Tốc độ phát xung các trục ($100\text{ Hz} - 100.000\text{ Hz}$).M0 - M10: Các bit cờ điều khiển (M0: Cho phép chạy Auto, M1: Chạy Jogging, M2: Reset vị trí, M10: Báo trạng thái phát xung hoàn thành).
Phương pháp nghiên cứu và tính toán động lực học
Để đảm bảo chọn đúng công suất động cơ và kiểm tra bền cơ cấu, mô-men tải tại các khớp được xác định thông qua phương trình Lagrange loại II:
$$\frac{d}{dt}\left(\frac{\partial T}{\partial \dot{q}_j}\right) - \frac{\partial T}{\partial q_j} + \frac{\partial \Pi}{\partial q_j} = Q_j^*$$
Trong đó:
- $T = \frac{1}{2} \dot{\mathbf{q}}^T \mathbf{M}(\mathbf{q}) \dot{\mathbf{q}}$ là động năng toàn phần của robot 6 trục.
- $\Pi(\mathbf{q})$ là thế năng của hệ thống trong trường trọng lực.
- $\mathbf{M}(\mathbf{q}) = \sum_{i=1}^6 \left( m_i \mathbf{J}{Ti}^T \mathbf{J}{Ti} + \mathbf{J}_{Ri}^T \mathbf{R}i \mathbf{I}{ci} \mathbf{R}i^T \mathbf{J}{Ri} \right)$ là ma trận khối lượng suy rộng.
Dựa trên khối lượng đo đạc từ mô hình 3D Solidworks (vật liệu Nhôm 6061: $m_1 = 3\text{ kg}$, $m_2 = 2.5\text{ kg}$, $m_3 = 1\text{ kg}$, $m_4 = 2\text{ kg}$, $m_5 = 0.5\text{ kg}$), các kết quả mô-men tĩnh lớn nhất tại các khớp được xác định:
- Khớp 1: $M_{dc1} \approx 0\text{ Nm}$ (trục quay thẳng đứng chịu tải uốn).
- Khớp 2: $M_{dc2} = 40.0\text{ Nm}$ (khớp vai chịu tải uốn và trọng trường lớn nhất).
- Khớp 3: $M_{dc3} = 39.0\text{ Nm}$ (khớp khuỷu).
- Khớp 4, 5, 6: $M_{dc4,5,6} \le 5.0\text{ Nm}$.
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ố động học Denavit - Hartenberg (D-H)
| Khâu ($i$) |
$\theta_i$ (Góc khớp) |
$\alpha_i$ (Góc xoắn) |
$d_i$ (Độ lệch trục - mm) |
$a_i$ (Chiều dài khâu - mm) |
| 1 |
$\theta_1^*$ |
$-90^\circ$ |
$d_1 = 169.25$ |
$a_1 = 64.2$ |
| 2 |
$\theta_2^*$ |
$0^\circ$ |
$0$ |
$a_2 = 305.0$ |
| 3 |
$\theta_3^*$ |
$90^\circ$ |
$0$ |
$a_3 = 0$ |
| 4 |
$\theta_4^*$ |
$-90^\circ$ |
$d_4 = 222.63$ |
$0$ |
| 5 |
$\theta_5^*$ |
$90^\circ$ |
$0$ |
$0$ |
| 6 |
$\theta_6^*$ |
$0^\circ$ |
$d_6 = 36.25$ |
$0$ |
Ma trận biến đổi tọa độ thuần nhất giữa 2 khâu liên tiếp:
$$^{i-1}\mathbf{T}_i = \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 & -\sin\theta_i\cos\alpha_i & a_i\sin\theta_i \ 0 & \sin\alpha_i & \cos\alpha_i & d_i \ 0 & 0 & 0 & 1 \end{bmatrix}$$
2. Thuật toán Động học ngược (Inverse Kinematics)
Do cấu trúc robot 6 trục cổ tay cầu, bài toán được tách thành 2 bài toán con độc lập:
-
Giải 3 khớp vị trí ($q_1, q_2, q_3$) bằng hình học không gian:
Góc quay đế:
$$\theta_1 = \text{atan2}(P_y, P_x)$$
Áp dụng định lý hàm cos trong tam giác cấu tạo bởi khâu 2, khâu 3 và điểm tâm cổ tay ($P_{wrist}$):
$$\theta_3 = \arccos\left(\frac{(P_x - a_1)^2 + (P_z - d_1)^2 - a_2^2 - d_4^2}{2 a_2 d_4}\right)$$
$$\theta_2 = \arctan\left(\frac{P_z - d_1}{P_x - a_1}\right) \pm \arccos\left(\frac{a_2^2 + (P_x - a_1)^2 + (P_z - d_1)^2 - d_4^2}{2 a_2 \sqrt{(P_x - a_1)^2 + (P_z - d_1)^2}}\right)$$
-
Giải 3 khớp định hướng ($q_4, q_5, q_6$) bằng phương pháp đại số ma trận:
Ma trận định hướng cổ tay:
$$^3\mathbf{R}6 = (^0\mathbf{R}3)^T \cdot ^0\mathbf{R}6 = \begin{bmatrix} b{11} & b{12} & b{13} \ b_{21} & b_{22} & b_{23} \ b_{31} & b_{32} & b_{33} \end{bmatrix}$$
Nghiệm góc hướng:
$$\theta_4 = \text{atan2}(b_{23}, b_{13}), \quad \theta_5 = \text{atan2}\left(\sqrt{1 - b_{33}^2}, b_{33}\right), \quad \theta_6 = \text{atan2}(b_{32}, -b_{31})$$
// Trích xuất từ Module tính toán Động học ngược trên C# Visual Studio
public static double[] CalculateInverseKinematics(double Px, double Py, double Pz, double[,] R06)
{
double[] q = new double[6];
double d1 = 169.25, a1 = 64.2, a2 = 305.0, d4 = 222.63, d6 = 36.25;
// 1. Tính toán góc khớp 1
q[0] = Math.Atan2(Py, Px);
// 2. Tính toán vị trí tâm cổ tay (Wrist Center Position)
double Pwx = Px - d6 * R06[0, 2];
double Pwy = Py - d6 * R06[1, 2];
double Pwz = Pz - d6 * R06[2, 2];
// 3. Tính toán góc khớp 2 và khớp 3 (Định lý hàm Cos)
double r = Math.Sqrt(Math.Pow(Pwx - a1 * Math.Cos(q[0]), 2) + Math.Pow(Pwy - a1 * Math.Sin(q[0]), 2));
double s = Pwz - d1;
double D = (r * r + s * s - a2 * a2 - d4 * d4) / (2 * a2 * d4);
if (Math.Abs(D) > 1.0) throw new Exception("Tọa độ nằm ngoài không gian làm việc của Robot!");
q[2] = Math.Atan2(-Math.Sqrt(1 - D * D), D); // Cấu hình khuỷu tay
double beta = Math.Atan2(s, r);
double gamma = Math.Atan2(d4 * Math.Sin(q[2]), a2 + d4 * Math.Cos(q[2]));
q[1] = beta - gamma;
// 4. Giải ma trận quay R3_6 để trích xuất q4, q5, q6
// [Triển khai nhân ma trận và bóc tách nghiệm Euler Z-Y-Z]
return q;
}
3. Điều khiển phát xung thời gian thực trên PLC Mitsubishi FX3U
Chương trình Ladder trên GX Works2 sử dụng lệnh phát xung tuyệt đối DDRVA (Double-word Absolute Drive) với tần số tăng giảm tốc tự động:
|---[ M0 ]-----------------[ DDRVA D100 D200 Y000 Y004 ]---|
| (Start Auto) (Pos_J1, Spd_J1, Pulse_Out, Dir_Out) |
| |
|---[ M0 ]-----------------[ DDRVA D102 D202 Y001 Y005 ]---|
| (Pos_J2, Spd_J2, Pulse_Out, Dir_Out) |
| |
|---[ M0 ]-----------------[ DDRVA D104 D204 Y002 Y006 ]---|
| (Pos_J3, Spd_J3, Pulse_Out, Dir_Out) |
Thử nghiệm và đánh giá kết quả
Hệ thống được vận hành thử nghiệm kiểm tra sai số định vị tại 5 điểm chuẩn trong không gian làm việc.
| Điểm thử nghiệm |
Tọa độ đặt $(X, Y, Z)$ [mm] |
Góc khớp tính toán $(q_1, q_2, q_3)$ [$^\circ$] |
Tọa độ thực tế đo $(X_r, Y_r, Z_r)$ [mm] |
Sai số vị trí $\Delta r$ [mm] |
| P1 |
$(350.0, 0.0, 200.0)$ |
$(0.0, 28.4, 45.2)$ |
$(348.8, 0.4, 199.1)$ |
$1.56$ |
| P2 |
$(250.0, 150.0, 300.0)$ |
$(30.9, 15.6, 62.1)$ |
$(248.9, 150.8, 298.9)$ |
$1.71$ |
| P3 |
$(0.0, 300.0, 150.0)$ |
$(90.0, 42.1, 35.8)$ |
$(-0.8, 298.7, 148.9)$ |
$1.90$ |
| P4 |
$(200.0, -200.0, 250.0)$ |
$(-45.0, 22.8, 55.4)$ |
$(198.6, -199.1, 248.8)$ |
$2.02$ |
| P5 |
$(400.0, 0.0, 100.0)$ |
$(0.0, 55.2, 18.3)$ |
$(398.2, 0.2, 98.9)$ |
$2.11$ |
BIỂU ĐỒ PHÂN BỐ SAI SỐ VỊ TRÍ (POSITION ERROR DISTRIBUTION)
Sai số (mm)
3.0 ┤
2.5 ┤
2.0 ┤ * (P4: 2.02mm) * (P5: 2.11mm)
1.5 ┤ * (P1: 1.56mm) * (P2: 1.71mm) * (P3: 1.90mm)
1.0 ┤
0.5 ┤
0.0 ┴─────────┴───────────────┴───────────────┴───────────────┴────────
P1 P2 P3 P4 P5
Kết quả đạt được
- Cơ khí: Chế tạo thành công cánh tay robot 6 trục từ hợp kim nhôm 6061, hệ thống truyền động vít me bi trục 5 và đai răng giảm chấn hoạt động êm ái, khử độ rơ cơ khí.
- Phần cứng điều khiển: Tủ điện chuẩn công nghiệp tích hợp 2 PLC Mitsubishi FX3U (64MT + 32MT), đồng bộ 6 ngõ ra phát xung tốc độ cao $100\text{ kHz}$ qua mạng RS-485.
- Phần mềm điều khiển: Xây dựng hoàn chỉnh giao diện C# điều khiển 2 chế độ: Thủ công (Manual Jogging) và Tự động theo điểm (PTP Teaching), thời gian phản hồi giao tiếp qua MX Component đạt mức $<45\text{ ms}$.
Đổi mới và đóng góp
- Kiến trúc điều khiển phân tầng mở (Open Hybrid Control Architecture): Tách rời bộ tính toán giải tích động học nặng sang môi trường PC (C# .NET) và giao toàn bộ nhiệm vụ phát xung thời gian thực cho PLC công nghiệp. Giải pháp này giúp tránh quá tải cho vi xử lý nhúng mà vẫn duy trì độ tin cậy vận hành của PLC tiêu chuẩn nhà máy.
- Kỹ thuật mở rộng trục phát xung đa PLC qua RS-485: Dòng PLC Mitsubishi FX3U tiêu chuẩn chỉ hỗ trợ tối đa 3 ngõ ra phát xung tốc độ cao ($Y0, Y1, Y2$). Đề tài đã làm chủ phương thức đồng bộ Master-Slave giữa FX3U-64MT và FX3U-32MT qua đường truyền RS-485, mở rộng điều khiển đồng thời 6 bậc tự do với chi phí chỉ bằng 25% so với việc trang bị các Module điều khiển vị trí chuyên dụng (như FX3U-20SSC-H hay QD77MS).
- Tiết kiệm chi phí đầu tư: Tổng chi phí chế tạo phần cứng và tủ điện đạt dưới 35 triệu VNĐ, giảm hơn 80% so với các cánh tay robot giáo dục - công nghiệp nhập khẩu có cấu hình tương đương.
Ứng dụng thực tế và triển khai
Kịch bản ứng dụng
- Dây chuyền phân loại và đóng gói sản phẩm (Pick and Place): Gắp linh kiện điện tử, đóng hộp dược phẩm hoặc phân loại nông sản với chu kỳ $3.5\text{ s/chu trình}$.
- Hệ thống cấp phôi tự động cho máy CNC: Nạp và dỡ phôi tự động trong các xưởng cơ khí chính xác, thay thế thao tác lặp đi lặp lại của công nhân trong môi trường dầu mỡ.
- Mô hình nghiên cứu và đào tạo tại các trường Đại học/Cao đẳng: Phục vụ giảng dạy chuyên ngành Kỹ thuật Cơ điện tử, Tự động hóa và Robot công nghiệp.
QUY TRÌNH TRIỂN KHAI HỆ THỐNG TRONG DÂY CHUYỀN SẢN XUẤT (ROADMAP)
[Tuần 1 - 2] Khảo sát layout nhà xưởng & Gá đặt cơ khí cánh tay robot
│
▼
[Tuần 3 - 4] Đấu nối tủ điện PLC, Driver TB6600 & Tích hợp cảm biến an toàn
│
▼
[Tuần 5 - 6] Cài đặt phần mềm điều khiển C#, cấu hình trạm MX Component
│
▼
[Tuần 7 - 8] Hiệu chuẩn không gian làm việc, dạy điểm (Teaching) & Chạy thử tải
Phân tích hiệu quả kinh tế (ROI)
- Chi phí đầu tư hệ thống: ~35.000.000 VNĐ.
- Chi phí nhân công vận hành thủ công (1 vị trí gắp phôi): ~8.000.000 VNĐ/tháng.
- Thời gian hoàn vốn dự kiến (Payback Period): Khoảng 4.5 đến 6 tháng.
Hạn chế và hướng phát triển
Hạn chế kỹ thuật hiện tại
- Hệ thống điều khiển vòng hở (Open-loop): Sử dụng động cơ bước không có Encoder phản hồi vị trí thực tế tại từng khớp, dẫn đến hiện tượng trượt bước khi mang tải quá $500\text{ g}$ ở gia tốc cao, gây tích lũy sai số theo thời gian vận hành.
- Tốc độ truyền thông qua chuẩn nối tiếp: Sử dụng giao tiếp qua cổng COM/RS-232 thông qua MX Component tạo độ trễ khoảng $30 - 50\text{ ms}$, chưa đáp ứng yêu cầu bám quỹ đạo liên tục ở tốc độ cao (Continuous Path Tracing).
Định hướng nâng cấp
- Thay thế động cơ bước bằng hệ thống Closed-loop Hybrid Stepper hoặc AC Servo Mitsubishi MR-J4 có tích hợp Encoder 22-bit để khép kín vòng điều khiển vị trí.
- Nâng cấp bộ điều khiển lên dòng PLC Mitsubishi FX5U hoặc iQ-R Series tích hợp mạng truyền thông thời gian thực CC-Link IE Field TSN / EtherCAT, giảm chu kỳ truyền dữ liệu xuống dưới $1\text{ ms}$.
- Tích hợp Module xử lý ảnh công nghiệp (Industrial Camera + OpenCV) để nhận diện tọa độ 3D và phân loại vật thể động trên băng chuyền.
Đối tượng hưởng lợi
- Sinh viên ngành Kỹ thuật Cơ điện tử, Tự động hóa: Tài liệu tham khảo hoàn chỉnh từ thiết kế 3D CAD, giải tích động học D-H, tính toán động lực học Lagrange II đến lập trình Ladder trên GX Works2 và kết nối C# qua MX Component.
- Kỹ sư tích hợp hệ thống (System Integrators): Nắm vững kiến trúc phần cứng Master-Slave đa PLC để điều khiển nhiều trục phát xung tốc độ cao với chi phí tối ưu.
- Doanh nghiệp vừa và nhỏ (SMEs): Cơ sở khả thi để tự chế tạo hoặc nội địa hóa cánh tay robot phục vụ tự động hóa các công đoạn gắp đặt, giảm phụ thuộc vào thiết bị nhập ngoại đắt đỏ.
Câu hỏi thường gặp
1. Yêu cầu cấu hình máy tính và phần cứng tối thiểu để vận hành hệ thống là gì?
Máy tính điều khiển cần chạy hệ điều hành Windows 10/11 64-bit, vi xử lý tối thiểu Intel Core i3 (thế hệ 8 trở lên), RAM 4GB, có cổng giao tiếp USB hoặc RS-232. Tủ điều khiển yêu cầu nguồn cấp lưới $220\text{VAC}$, công suất danh định $500\text{W}$, cùng 2 PLC Mitsubishi dòng FX3U ngõ ra Transistor (MT).
2. Làm thế nào để khắc phục giới hạn 3 trục phát xung trên một PLC FX3U đơn lẻ?
Giải pháp của đề tài là kết nối 2 PLC FX3U (FX3U-64MT làm Master và FX3U-32MT làm Slave) thông qua bo mạch mở rộng truyền thông FX3U-485-BD. PLC Master phát xung cho trục 1, 2, 3 và truyền dữ liệu góc quay của trục 4, 5, 6 sang PLC Slave qua vùng nhớ liên kết truyền thông mạng N:N để phát xung đồng thời.
3. Phần mềm C# giao tiếp với PLC Mitsubishi qua cơ chế nào?
Phần mềm C# sử dụng thư viện ActUtlType nằm trong bộ công cụ MELSOFT MX Component. Thư viện này tạo kênh OLE/COM Automation kết nối trực tiếp đến cổng lập trình hoặc cổng mạng của PLC, cho phép đọc/ghi giá trị các thanh ghi D (Data Register) và bit cờ M (Relay) theo thời gian thực mà không cần viết giao thức truyền nhận thô (Raw Serial).
4. Tại sao hệ thống gặp sai số vị trí từ 1.5mm đến 2.1mm và cách xử lý?
Sai số vị trí phát sinh từ dung sai gia công cơ khí các khâu nhôm, độ dơ bánh răng của hộp giảm tốc cơ khí, và việc hệ thống hoạt động ở chế độ vòng hở (không có cảm biến góc tại khớp). Để giảm sai số xuống $<0.5\text{ mm}$, cần gắn thêm bộ mã hóa xung (Encoder) vòng ngoài tại từng trục khớp và bổ sung thuật toán bù khe hở cơ khí (Backlash Compensation) trong phần mềm C#.
5. Chi phí dự toán và thời gian chế tạo hoàn thiện mô hình là bao lâu?
Tổng chi phí linh kiện phần cứng (Nhôm 6061, gia công CNC, 6 động cơ bước kèm hộp giảm tốc, 2 PLC FX3U, 6 Driver TB6600, nguồn tổ ong, khí cụ đóng cắt tủ điện) khoảng 25 - 35 triệu VNĐ. Thời gian thiết kế, gia công, lắp ráp và lập trình hoàn thiện đồ án mất khoảng 5 tháng (từ tháng 10/2022 đến tháng 03/2023).
Kết luận
Đồ án tốt nghiệp "Thiết kế và điều khiển robot công nghiệp sử dụng PLC" đã hoàn thành toàn diện các mục tiêu đặt ra: từ việc nghiên cứu cơ sở lý thuyết động học/động lực học, thiết kế cơ khí 3D trên Solidworks, gia công lắp ráp hoàn thiện cánh tay robot 6 bậc tự do, đến việc xây dựng tủ điện công nghiệp Master-Slave bằng 2 PLC Mitsubishi FX3U và lập trình phần mềm giao diện điều khiển C#.
Giải pháp điều khiển kết hợp giữa năng lực tính toán giải tích của máy tính PC và độ tin cậy phát xung của PLC mở ra hướng đi thực tế, chi phí thấp cho việc nội địa hóa thiết bị tự động hóa công nghiệp. Hệ thống là nền tảng vững chắc để tiếp tục phát triển các tính năng cao cấp như điều khiển vòng kín Servo, điều khiển bám quỹ đạo liên tục và tích hợp thị giác máy tính công nghiệp trong tương lai.
