Giới thiệu dự án
Trong kỷ nguyên Công nghiệp 4.0 và chuyển đổi số sản xuất (Smart Manufacturing), các dây chuyền phân loại, đóng gói và lưu kho tự động đòi hỏi tính linh hoạt cao, khả năng truy xuất nguồn gốc theo thời gian thực và vận hành với độ tin cậy nghiêm ngặt. Theo báo cáo từ International Federation of Robotics (IFR), mật độ ứng dụng robot công nghiệp trong khâu logistics và đóng gói tăng trưởng trung bình 12-15% mỗi năm. Tuy nhiên, tại các doanh nghiệp vừa và nhỏ (SMEs), quy trình phân loại sản phẩm vẫn phụ thuộc lớn vào thao tác thủ công hoặc các cơ cấu chấp hành cố định (fixed automation), dẫn đến độ trễ chu kỳ, tỷ lệ sai sót định danh từ 3-5% và thiếu khả năng thích ứng khi đổi quy cách đóng gói.
Vấn đề thực tiễn và thách thức kỹ thuật (Problem Statement)
Các hệ thống phân loại truyền thống đối mặt với 3 điểm nghẽn cốt lõi:
- Hạn chế bậc tự do và không gian làm việc: Các cơ cấu phân loại dạng thanh gạt khí nén hay robot tọa độ Descartes (Cartesian) thiếu độ linh hoạt trong không gian 3 chiều, không thể thực hiện các thao tác gắp-thả phức tạp tại các khay kệ nhiều tầng.
- Chi phí điều khiển chuyển động đa trục cao: Việc sử dụng PLC cao cấp tích hợp module điều khiển chuyển động (Motion Control) chuyên dụng cho robot 6 trục (6-DOF) làm tăng chi phí phần cứng lên mức không khả thi đối với các dự án quy mô vừa và nhỏ.
- Bất đồng bộ truyền thông công nghiệp: Thiếu chuẩn giao tiếp mở giữa lớp điều khiển giám sát (SCADA/PLC) và lớp điều khiển cánh tay robot cục bộ, gây nghẽn cổ chai dữ liệu và suy giảm tính thời gian thực (Real-time determinism).
[Băng tải cấp phôi & Cảm biến màu Keyence / Barcode]
│
▼
[Trạm cố định sản phẩm (SMC Cylinder)]
│
▼
[Cánh tay Robot 6-DOF (ESP32-Xtensa LX6 + Fastech Ezi-Servo)]
│
▼ (Modbus TCP/IP over Ethernet)
[Trạm phân loại & Kệ 2 tầng (Siemens S7-1200)]
Mục tiêu đề tài
- Thiết kế và gia công cơ khí hoàn chỉnh cánh tay Robot 6-DOF: Kết cấu khung nhôm hợp kim 6061 gia công CNC, tích hợp hộp số giảm tốc độ chính xác cao (Harmonic Drive, Harmonic M504, SPG, SEJINIGB) với tải trọng hữu ích (Payload) định mức 1.5 kg.
- Xây dựng kiến trúc điều khiển phân tán (Distributed Architecture): Offload toàn bộ thuật toán động học thuận (Forward Kinematics) và động học nghịch (Inverse Kinematics) sang vi điều khiển 32-bit ESP32-WROOM-32U, giải phóng chu kỳ quét (Scan cycle) cho PLC điều khiển chính.
- Triển khai giao thức truyền thông công nghiệp Modbus TCP/IP & Modbus RTU RS-485: Kết nối đồng bộ giữa Siemens S7-1200 (Modbus Client) và ESP32 Controller (Modbus Server qua Ethernet W5500), đồng thời điều khiển mạng 6 driver servo khép vòng qua RS-485.
- Tích hợp trạm phân loại đa tiêu chí: Nhận diện màu sắc phôi thông qua cảm biến quang điện Keyence CZ-V21 và giải mã mã ma trận QR để phân tầng lưu kho tự động trên kệ hàng 2 tầng.
- Phát triển giao diện điều khiển và giám sát (Teach Pendant HMI & SCADA): Thiết kế giao diện HMI Nextion 7-inch cảm ứng điện dung với 33 trang chức năng (hỗ trợ chế độ Jogging Encoder, Base coordinate, Teaching Position Table 1000 điểm) và SCADA WinCC trên PC.
Phương pháp tiếp cận và kết quả kỳ vọng
- Phương pháp tiếp cận: Kết hợp phương pháp mô hình hóa hình học Denavit-Hartenberg (D-H), giải thuật phân tách hình học cổ tay cầu (Spherical Wrist Decoupling) để giải động học nghịch thời gian thực, cùng kiến trúc bus truyền thông lai (Hybrid Modbus Industrial Bus).
- Kết quả đo lường được:
- Sai số lặp vị trí đầu công tác (Repeatability): $\le \pm 0.1\text{ mm}$.
- Thời gian tính toán động học nghịch trên MCU ESP32: $< 1.2\text{ ms/điểm}$.
- Thời gian chu kỳ phân loại hoàn chỉnh (Cycle time): $20 - 25\text{ s/sản phẩm}$.
- Tỷ lệ nhận diện và phân loại chính xác: $\ge 99.2%$.
Phạm vi và giới hạn
- Hệ thống áp dụng cho các sản phẩm dạng khối hình học xác định, khối lượng dưới 1.5 kg.
- Mã QR được in bề mặt tiêu chuẩn (kích thước tối thiểu $15 \times 15\text{ mm}$).
- Môi trường vận hành công nghiệp tiêu chuẩn, dải nhiệt độ $0 - 55^\circ\text{C}$, không chống cháy nổ.
Phân tích và thiết kế giải pháp
Phân tích hiện trạng
| Tiêu chí kỹ thuật |
Giải pháp Robot Tọa độ Descartes / SCARA |
Giải pháp Robot 6-DOF dùng PLC Motion Control |
Giải pháp Đề tài: Hybrid MCU-PLC 6-DOF Robot |
| Bậc tự do (DOF) |
3 - 4 DOF (Không gian làm việc phẳng/hộp) |
6 DOF (Không gian cầu linh hoạt) |
6 DOF (Không gian làm việc cầu bán kính 650 mm) |
| Khả năng tiếp cận vị trí |
Kém tại các góc nghiêng hoặc kệ hẹp |
Rất cao, linh hoạt mọi hướng |
Rất cao nhờ cấu trúc Spherical Wrist |
| Chi phí phần cứng |
Thấp ($1,500 - $2,500) |
Rất cao ($10,000 - $25,000) |
Tối ưu ($2,000 - $3,500) |
| Tải tính toán PLC |
Thấp |
Rất cao (yêu cầu PLC S7-1500T Technology) |
Tối ưu hóa tuyệt đối (PLC S7-1200 cơ bản) |
| Giao thức điều khiển |
Xung/Hướng (Pulse/Dir) phân tán |
Profinet IRT / EtherCAT đắt đỏ |
Modbus TCP/IP (Ethernet) + Modbus RTU RS-485 |
| Độ mở rộng và tùy biến |
Trung bình |
Thấp (Phụ thuộc License hãng) |
Rất cao (Firmware C++ mã nguồn mở, UI Nextion) |
Phân loại yêu cầu hệ thống (Ma trận MoSCoW)
- Must-have (Bắt buộc): Giải thuật động học nghịch 6 bậc tự do không điểm kỳ dị (Singularity handling); Giao tiếp Modbus TCP/IP ổn định giữa S7-1200 và ESP32; Khóa an toàn phanh từ (Electromagnetic Brake) tại Khớp 2 và Khớp 3 khi mất nguồn.
- Should-have (Cần có): Tính năng dạy điểm trực quan bằng Encoder tay quay (Handwheel MPG Jogging); Bảng lưu trữ 1000 tọa độ điểm công tác trên Flash/EEPROM; Cảm biến định vị gốc tuyệt đối (Homing sensors) trên 6 trục.
- Could-have (Có thể có): Giao diện SCADA trên WinCC giám sát dòng điện tải động cơ thời gian thực; Chế độ điều khiển tịnh tiến thuần theo hệ tọa độ Base (Base Coordinate Jogging).
- Won't-have (Chưa thực hiện): Nhận diện 3D Point Cloud và thuật toán tránh vật cản động thời gian thực (Dynamic Obstacle Avoidance).
Thiết kế hệ thống
+-------------------------------------------------------------------------+
| SIEMENS PLC S7-1200 |
| (Master Modbus TCP/IP) |
+----+-------------------------+--------------------+------------------+--+
| | | |
(Modbus TCP) (Digital I/O) (Digital I/O) (Digital I/O)
| | | |
v v v v
+--------------+ +------------------+ +------------------+ +-------------+
| ESP32 | | Keyence CZ-V21 | | Omron E3Z-LS61 | | Khí nén SMC |
| 6-DOF MCU | | (Color Sensor) | | (Photoelectric) | | Solenoids |
+---+------+---+ +------------------+ +------------------+ +-------------+
| |
(RS485) (UART)
| |
| +--> Nextion 7" HMI Teach Pendant
|
+---------> [Driver FASTECH Ezi-Servo Plus-R x6]
|
+--> [Servomotors J1 - J6 with Harmonic/Planetary Gears]
1. Cơ sở toán học Động học Robot (Kinematics Modeling)
Hệ thống sử dụng quy ước Denavit-Hartenberg (D-H standard). Cấu hình hình học cánh tay có các thông số kích thước:
$L_1 = 55\text{ mm}$, $L_2 = 330\text{ mm}$, $L_3 = 62\text{ mm}$, $D_0 = 228\text{ mm}$, $D_1 = 330\text{ mm}$, $D_2 = 201\text{ mm}$.
Bảng thông số D-H cánh tay robot 6-DOF:
| Khâu ($i$) |
$\alpha_{i-1}$ |
$a_{i-1}$ |
$d_i$ |
$\theta_i$ |
Giới hạn góc quay ($\theta$) |
| 1 |
$0^\circ$ |
$0$ |
$D_0 = 228\text{ mm}$ |
$\theta_1$ |
$-170^\circ \sim +170^\circ$ |
| 2 |
$90^\circ$ |
$L_1 = 55\text{ mm}$ |
$0$ |
$\theta_2$ |
$-60^\circ \sim +120^\circ$ |
| 3 |
$0^\circ$ |
$L_2 = 330\text{ mm}$ |
$0$ |
$\theta_3$ |
$-150^\circ \sim +90^\circ$ |
| 4 |
$90^\circ$ |
$L_3 = 62\text{ mm}$ |
$D_1 = 330\text{ mm}$ |
$\theta_4$ |
$-180^\circ \sim +180^\circ$ |
| 5 |
$-90^\circ$ |
$0$ |
$0$ |
$\theta_5$ |
$-120^\circ \sim +120^\circ$ |
| 6 |
$90^\circ$ |
$0$ |
$D_2 = 201\text{ mm}$ |
$\theta_6$ |
$-360^\circ \sim +360^\circ$ |
Ma trận biến đổi tổng quát từ hệ quy chiếu gốc đến khâu chấp hành cuối (End-Effector):
$$^{0}{6}T = , ^{0}{1}T(\theta_1) \cdot , ^{1}{2}T(\theta_2) \cdot , ^{2}{3}T(\theta_3) \cdot , ^{3}{4}T(\theta_4) \cdot , ^{4}{5}T(\theta_5) \cdot , ^{5}{6}T(\theta_6) = \begin{bmatrix} r{11} & r_{12} & r_{13} & P_x \ r_{21} & r_{22} & r_{23} & P_y \ r_{31} & r_{32} & r_{33} & P_z \ 0 & 0 & 0 & 1 \end{bmatrix}$$
Giải bài toán Động học nghịch (Inverse Kinematics) bằng phương pháp tách cổ tay cầu (Spherical Wrist Center $W = [W_x, W_y, W_z]^T$):
$$W = P_{EE} - D_2 \cdot R_{0_6} \cdot \begin{bmatrix} 0 \ 0 \ 1 \end{bmatrix}$$
Góc quay khớp 1:
$$\theta_1 = \text{atan2}(W_y, W_x)$$
Góc khớp 2 và 3 được suy ra dựa trên định lý hàm cosin trong mặt phẳng cánh tay:
$$\theta_3 = \text{atan2}(\pm\sqrt{1-\cos^2\beta}, \cos\beta) + \text{atan2}(D_1, L_3)$$
$$\theta_2 = \text{atan2}\left(W_z - D_0, \sqrt{W_x^2 + W_y^2} - L_1\right) - \text{atan2}(\pm\sqrt{1-\cos^2\gamma}, \cos\gamma)$$
Góc cổ tay $(\theta_4, \theta_5, \theta_6)$ được trích xuất trực tiếp từ ma trận định hướng phần dư:
$$^{3}{6}R = (^{0}{3}R)^T \cdot , ^{0}{6}R$$
$$\theta_4 = \text{atan2}(r{23}, r_{13}); \quad \theta_5 = \text{atan2}(\pm\sqrt{1-r_{33}^2}, r_{33}); \quad \theta_6 = \text{atan2}(r_{32}, -r_{31})$$
2. Cấu hình phần cứng và Danh mục thiết bị (Technology Stack)
- Lớp điều khiển tính toán (Computation Core): Vi điều khiển ESP32-WROOM-32U (Xtensa Dual-Core 32-bit LX6, 240 MHz, 520 KB SRAM).
- Lớp điều khiển logic & cảm biến (Master Controller): Siemens SIMATIC S7-1200 CPU 1214C DC/DC/DC (Firmware v4.4, bộ nhớ làm việc 100 KB, chu kỳ xử lý Boolean $0.08,\mu\text{s/lệnh}$).
- Hệ thống truyền động Servo:
- 4 bộ FASTECH EZI-Servo Plus-R 60L (Mô-men xoắn giữ $1.68\text{ Nm}$, Driver EzS-NDR-60L-A-D).
- 2 bộ FASTECH EZI-Servo Plus-R 60M (Mô-men xoắn giữ $1.26\text{ Nm}$, Driver EzS-NDR-60M-A-D).
- Phanh điện từ MIKI PULLEY BXW-02-10-52 (Mô-men phanh $0.70\text{ Nm}$, điện áp kích 24VDC).
- Hệ thống hộp số giảm tốc:
- Trục 1: SPG SHA130SV050 ($i = 50$).
- Trục 2: SEJINIGB PH004-C2 ($i = 44$) kết hợp Pulley-Đai răng tỉ số 2:1 (Tổng $i = 88$).
- Trục 3: SEJINIGB PQ-C2 ($i = 47.2$).
- Trục 4: Harmonic Drive CSF-14-100-GH-F0BCD ($i = 100$, độ rơ Backlash $< 1\text{ arcmin}$).
- Trục 5: Harmonic Drive HPG-14A-50-F0 ($i = 45$) kết hợp Pulley-Đai răng 2:1 (Tổng $i = 90$).
- Trục 6: Harmonic M504 ($i = 100$).
- Hệ thống cảm biến và cơ cấu chấp hành khí nén:
- Cảm biến màu kỹ thuật số Keyence CZ-V21 (Nguồn sáng 3 dải LED RGB, thời gian đáp ứng $200,\mu\text{s}$).
- Cảm biến quang tán xạ Omron E3Z-LS61 (Khoảng cách phát hiện $20 - 200\text{ mm}$).
- Xi lanh xoay góc SMC MRHQ10D-90S và xi lanh trượt chống xoay 2 ty SMC MXS6-30.
- Tay kẹp khí nén song song SMC MHZJ2-20D, cụm van điện từ TPC DV1120.
3. Bản đồ vùng nhớ Modbus TCP/IP (Data Blocks Architecture)
Truyền thông giữa S7-1200 và ESP32 thực hiện qua cổng RJ45 Ethernet chuẩn IEEE 802.3, địa chỉ IP cố định lớp C (ESP32: 192.168.1.10, S7-1200: 192.168.1.20, Port: 502).
| Holding Register Address |
PLC Data Block Tag |
Kiểu dữ liệu |
Mô tả chức năng |
| 40001 |
ROBOT_CMD_REG |
UINT |
Mã lệnh điều khiển (1: Home, 2: Run Job, 3: Jog, 4: Emergency Stop) |
| 40002 |
ROBOT_TARGET_ID |
UINT |
Chỉ số bảng vị trí mục tiêu (Job Table ID từ 1 - 10) |
| 40003 - 40004 |
ROBOT_POS_X |
REAL (32-bit) |
Tọa độ mục tiêu trục X ($P_x$ tính theo mm) |
| 40005 - 40006 |
ROBOT_POS_Y |
REAL (32-bit) |
Tọa độ mục tiêu trục Y ($P_y$ tính theo mm) |
| 40007 - 40008 |
ROBOT_POS_Z |
REAL (32-bit) |
Tọa độ mục tiêu trục Z ($P_z$ tính theo mm) |
| 40009 |
ROBOT_STATUS |
WORD |
Bit 0: Busy, Bit 1: Done, Bit 2: Error, Bit 3: Home Completed |
| 40010 |
QR_DATA_REG |
UINT |
Mã phân loại sản phẩm giải mã từ QR Code (1: Loại A, 2: Loại B) |
Methodology
Dự án triển khai theo quy trình kỹ thuật chữ V (V-Model System Engineering), tích hợp các vòng lặp kiểm thử mô phỏng trước khi triển khai phần cứng:
[Phân tích Yêu cầu] ──────────────────────────────> [Kiểm thử Chấp nhận UAT]
│ ▲
▼ │
[Thiết kế Động học & 3D] ───────────────> [Kiểm thử Tích hợp Chuỗi Động học]
│ ▲
▼ │
[Lập trình Firmware & SCL] ─────────────> [Kiểm thử Đơn vị & Bus Truyền thông]
│ ▲
└─────────────> [Gia công & Đấu nối] ─────────────┘
Ma trận đánh giá rủi ro và giải pháp khắc phục (FMEA Matrix)
| Hạng mục rủi ro |
Xác suất |
Mức độ nghiêm trọng |
Giải pháp phòng ngừa & Giảm thiểu |
| Va chạm cơ khí do điểm kỳ dị (Singularity) |
Vừa |
Nghiêm trọng |
Thuật toán IK tích hợp bộ lọc kiểm tra định thức ma trận Jacobian $\det(J) \to 0$, tự động khóa vận tốc góc. |
| Nhiễu điện từ (EMI) trên bus RS-485 |
Cao |
Vừa |
Sử dụng cáp xoắn đôi có vỏ bọc chống nhiễu (STP 24 AWG), bổ sung điện trở đầu cuối $120,\Omega$, cách ly quang optocoupler. |
| Trôi vị trí/Rơi tự do khi ngắt nguồn |
Thấp |
Rất nghiêm trọng |
Thiết kế mạch Relay liên động tự động ngắt điện cấp và đóng phanh từ MIKI PULLEY trong $< 20\text{ ms}$ khi mất nguồn. |
| Mất gói tin truyền thông Modbus TCP |
Vừa |
Vừa |
Thiết lập cơ chế Heartbeat 500ms; sau 3 chu kỳ không phản hồi, PLC tự động kích hoạt trạng thái dừng an toàn (Safe-Stop). |
Implementation và kết quả
Development process
Quá trình lập trình trên ESP32 sử dụng framework Arduino-ESP32 trên nền tảng Visual Studio Code & PlatformIO. Cấu trúc thư viện phân tách thành các module độc lập: MATH (tính toán ma trận), FORWARD_KINEMATIC, SERVO (giao tiếp giao thức riêng của FASTECH qua RS-485), và MODBUS_TCP.
Trích đoạn mã nguồn: Thuật toán giải Động học nghịch và phân bổ vận tốc Servo
#include "Convert_Function.h"
#include "Multiple_SPI.h"
#include <ModbusIP_ESP8266.h>
// Struct chứa các biến góc quay khớp sau khi giải nghịch
struct JointAngles {
float theta1, theta2, theta3, theta4, theta5, theta6;
bool is_valid;
};
JointAngles Solve_Inverse_Kinematics(float EE_x, float EE_y, float EE_z, float roll, float pitch, float yaw) {
JointAngles result;
// 1. Tính toán ma trận định hướng R_0_6 từ góc Euler (Roll-Pitch-Yaw)
MatrixSize<3, 3> R_0_6 = Compute_Euler_Rotation(roll, pitch, yaw);
// 2. Tính toán tọa độ tâm cổ tay Spherical Wrist (Wx, Wy, Wz)
float Wx = EE_x - D2_CONST * R_0_6(0, 2);
float Wy = EE_y - D2_CONST * R_0_6(1, 2);
float Wz = EE_z - D2_CONST * R_0_6(2, 2);
// 3. Tính góc Khớp 1
result.theta1 = atan2(Wy, Wx) * RAD_TO_DEG;
// 4. Giải tam giác hình học phẳng cho Khớp 2 và Khớp 3
float r_plane = sqrt(Wx * Wx + Wy * Wy) - L1_CONST;
float s_height = Wz - D0_CONST;
float D_diag_sq = r_plane * r_plane + s_height * s_height;
float cos_beta = (L2_CONST * L2_CONST + (L3_CONST * L3_CONST + D1_CONST * D1_CONST) - D_diag_sq)
/ (2.0f * L2_CONST * sqrt(L3_CONST * L3_CONST + D1_CONST * D1_CONST));
if (cos_beta < -1.0f || cos_beta > 1.0f) {
result.is_valid = false; // Ngoài không gian làm việc (Out of workspace)
return result;
}
float beta = acos(cos_beta);
float alpha_offset = atan2(D1_CONST, L3_CONST);
result.theta3 = (PI - beta + alpha_offset) * RAD_TO_DEG;
float cos_gamma = (L2_CONST * L2_CONST + D_diag_sq - (L3_CONST * L3_CONST + D1_CONST * D1_CONST))
/ (2.0f * L2_CONST * sqrt(D_diag_sq));
float gamma = acos(cos_gamma);
float phi = atan2(s_height, r_plane);
result.theta2 = (phi - gamma) * RAD_TO_DEG;
// 5. Tính toán ma trận định hướng phần dư R_3_6 để suy ra Theta 4, 5, 6
MatrixSize<3, 3> R_0_3 = Compute_R03(result.theta1, result.theta2, result.theta3);
MatrixSize<3, 3> R_3_6 = R_0_3.Transpose() * R_0_6;
result.theta4 = atan2(R_3_6(1, 2), R_3_6(0, 2)) * RAD_TO_DEG;
result.theta5 = atan2(sqrt(1.0f - R_3_6(2, 2) * R_3_6(2, 2)), R_3_6(2, 2)) * RAD_TO_DEG;
result.theta6 = atan2(R_3_6(2, 1), -R_3_6(2, 0)) * RAD_TO_DEG;
result.is_valid = true;
return result;
}
// Chuyển đổi góc quay (Degree) sang số lượng xung điều khiển Fastech Ezi-Servo (10000 ppr)
long Convert_Deg_To_Pulses(int joint_id, float deg_target, float gear_ratio) {
double pulses = (deg_target / 360.0f) * 10000.0f * gear_ratio;
return static_cast<long>(round(pulses));
}
Testing và validation
1. Đánh giá độ chính xác động học và thời gian thực thi
SAI SỐ VỊ TRÍ ĐẦU CÔNG TÁC (POSITION ERROR)
0.15 ┼─────────────────────────────────────────────────────────────
│ *
0.10 ┼──────────────*───────────────────────***──────*──────────────
(mm) │ * *** * ***** *** *
0.05 ┼───***──────*****───────***─────────*******──*****───────***──
│ ***** ******* ***** ********* ******* *****
0.00 ┴───P1─────────P2─────────P3───────────P4────────P5────────P6───
(Gốc Home) (Băng tải) (Quét mã) (Kẹp phôi) (Kệ T1) (Kệ T2)
- Độ lặp lại vị trí (Repeatability): Đo kiểm qua 100 chu trình liên tục tại 6 điểm mốc quan trọng bằng đồng hồ so Mitutoyo $\pm 0.001\text{ mm}$. Sai số trung bình đạt $\pm 0.08\text{ mm}$ (cực đại không quá $0.11\text{ mm}$).
- Thời gian xử lý vòng lặp (Execution Benchmark):
- Thuật toán giải nghịch IK trên ESP32: $0.84\text{ ms}$.
- Giao tiếp RS-485 truyền lệnh đồng thời 6 driver servo: $4.2\text{ ms}$.
- Độ trễ phản hồi Modbus TCP qua Ethernet W5500: $2.1\text{ ms}$.
2. Phân tích chu kỳ thời gian phân loại (Cycle Time Analysis)
| Giai đoạn vận hành |
Thời gian dự kiến (Kế hoạch) |
Thời gian thực tế (Đo kiểm) |
Tình trạng |
| Cấp phôi & Nhận diện màu sắc (Keyence) |
$3.0\text{ s}$ |
$2.4\text{ s}$ |
Đạt ($+20%$ nhanh hơn) |
| Chặn phôi, định vị & Quét QR Code |
$4.0\text{ s}$ |
$3.5\text{ s}$ |
Đạt |
| Robot di chuyển, gắp sản phẩm |
$6.0\text{ s}$ |
$5.2\text{ s}$ |
Đạt |
| Robot đưa phôi vào kệ (Tầng 1 / Tầng 2) |
$7.0\text{ s}$ |
$6.8\text{ s}$ |
Đạt |
| Thả phôi & Quay về vị trí chờ (Home) |
$4.0\text{ s}$ |
$3.5\text{ s}$ |
Đạt |
| Tổng thời gian chu kỳ hoàn chỉnh |
$24.0\text{ s}$ |
$21.4\text{ s}$ |
Vượt mục tiêu ($< 25\text{ s}$) |
Kết quả đạt được
Hệ thống đã hoàn thiện thi công phần cứng và thử nghiệm thực tế với độ hoàn thiện cao:
- Chế tạo thành công cánh tay robot 6-DOF kết cấu nhôm CNC độ cứng vững cao, phối hợp 6 hộp số công nghiệp không xảy ra hiện tượng rơ lắc.
- Hệ thống tủ điện công nghiệp gọn gàng, cách ly hoàn toàn giữa nguồn điều khiển 24VDC, nguồn vi điều khiển 5VDC/3.3VDC và mạch công suất động cơ.
- Giao diện Nextion 7-inch Teach Pendant cung cấp đầy đủ 33 trang giao diện chuyên sâu, cho phép người vận hành nạp điểm, dạy điểm, chuyển đổi hệ tọa độ Joint/Base và giám sát mã lỗi trực tiếp mà không cần kết nối máy tính.
Đổi mới và đóng góp
- Kiến trúc điều khiển phân tán chi phí thấp (Offloaded Kinematics Architecture): Giải quyết triệt để rào cản tài chính khi ứng dụng robot 6 trục. Thay vì đầu tư PLC Motion Controller chuyên dụng đắt tiền, hệ thống sử dụng vi điều khiển kép ESP32 chạy giải thuật D-H tối ưu hóa đa luồng (FreeRTOS Dual Core), đưa chi phí điều khiển xuống dưới 30% so với giải pháp truyền thống.
- Mô hình truyền thông Bus lai (Hybrid Industrial Networking): Tích hợp liền mạch Modbus TCP/IP ở tầng giám sát và Modbus RTU RS-485 tốc độ cao ở tầng trường. Điều này giúp hệ thống kết nối dễ dàng vào các hạ tầng SCADA/MES tiêu chuẩn công nghiệp hiện hữu.
- Cơ cấu dẫn động kết hợp Harmonic Drive và Phanh từ an toàn: Đảm bảo tỉ số truyền lớn trong không gian nhỏ hẹp, duy trì khả năng tự giữ vị trí ngay cả khi mất điện đột ngột, nâng cao tuổi thọ driver và động cơ.
Ứng dụng thực tế và triển khai
[Nhà kho Thông minh / Smart Warehouse] ──► [Nhập phôi tự động từ AGV/Băng chuyền]
│
▼
[Module Nhận diện Đa phương thức] ──► [Kiểm tra Màu + Đọc QR Code định danh]
│
▼
[Phân tầng & Lưu kho Tự động] ──► [Robot 6-DOF xếp chính xác lên khay kệ]
Các bước triển khai công nghiệp (Deployment Procedure)
- Khảo sát cơ khí & Gá đặt: Cố định đế robot trên bàn thao tác vững chắc; cấp nguồn 3 pha/1 pha 220VAC qua biến áp cách ly sang bộ nguồn Meanwell 24VDC-20A.
- Đấu nối mạng truyền thông: Cắm cáp mạng RJ45 từ Switch công nghiệp đến CPU S7-1200 và cổng Ethernet W5500 của Robot; kết nối đường khí nén áp suất $4 - 6\text{ bar}$.
- Cấu hình địa chỉ mạng & Data Block: Khai báo cấu hình Hardware Configuration trên TIA Portal v16/v17; nạp các khối hàm
MB_CLIENT và MB_SERVER.
- Hiệu chuẩn gốc (Zero Calibration): Sử dụng chế độ Calibration trên HMI Teach Pendant để đưa 6 khớp về vị trí vật lý chuẩn (Home Sensors triggered), lưu giá trị bù (Offset) vào bộ nhớ không bay màu (NVS/EEPROM).
- Vận hành tự động: Chuyển công tắc sang vị trí Auto; hệ thống tự động nhận diện phôi và phân phối chu trình.
Phân tích hiệu quả kinh tế (Cost-Benefit Analysis & ROI)
- Chi phí đầu tư hệ thống (CAPEX): Ước tính khoảng 65 - 75 triệu VNĐ (bao gồm cơ khí CNC, động cơ Servo, PLC, linh kiện khí nén và HMI).
- Chi phí nhân công tiết kiệm (OPEX): Thay thế trực tiếp 02 công nhân đóng gói/phân loại theo ca ($2 \times 9.000.000\text{ VNĐ/tháng} = 18.000.000\text{ VNĐ/tháng}$).
- Thời gian hoàn vốn (Payback Period):
$$\text{ROI Time} = \frac{70.000.000\text{ VNĐ}}{18.000.000 - 1.500.000\text{ (bảo trì/điện)}}\approx 4.24\text{ tháng}$$
Hạn chế và hướng phát triển
Hạn chế kỹ thuật
- Tải trọng hữu ích hiện tại giới hạn ở mức $1.5\text{ kg}$ do giới hạn công suất của động cơ size 60 và kết cấu đai truyền động trục 2.
- Thuật toán giải mã QR hiện tại phụ thuộc vào vị trí cố định của phôi trên băng chuyền thông qua xi lanh kẹp; chưa hỗ trợ quét mã động khi phôi đang di chuyển tốc độ cao (Dynamic Barcode Tracking).
- Quá trình chuyển động giữa các điểm nạp trong Position Table là nội suy điểm-điểm (PTP - Point-to-Point), chưa hỗ trợ nội suy đường thẳng (Linear Interpolation) và nội suy cung tròn (Circular Interpolation) trơn mượt trên không gian Descartes.
Hướng phát triển tương lai
- Tích hợp Camera AI/Machine Vision: Ứng dụng mô hình YOLOv8 trên vi xử lý nhúng (Nvidia Jetson Nano/Raspberry Pi 4) để thực hiện nhận diện 3D Pose Estimation và phân loại trực tiếp trên băng tải không cần cơ cấu chặn.
- Nâng cấp thuật toán quỹ đạo chuyển động: Áp dụng phương pháp quy hoạch quỹ đạo đa thức bậc 5 hoặc S-Curve Jerk-limited Trajectory để giảm rung lắc cơ khí ở các điểm đổi hướng.
- Mở rộng tính di động: Tích hợp cánh tay robot lên khung xe tự hành AMR/AGV điều hướng SLAM LIDAR, tận dụng nguồn DC 24V sẵn có của hệ thống Servo.
Đối tượng hưởng lợi
- Sinh viên & Học viên chuyên ngành Tự động hóa/Cơ điện tử: Nguồn học liệu tham khảo hoàn chỉnh từ thiết kế cơ khí 3D (SolidWorks), tính toán động học robot nâng cao (D-H parameters, ma trận đồng nhất) đến lập trình nhúng nhúng C++ và PLC công nghiệp.
- Kỹ sư Tích hợp hệ thống (System Integrators): Cung cấp mô hình tham chiếu về giải pháp điều khiển phân tán hybrid, giúp cắt giảm chi phí bản quyền và phần cứng đắt đỏ khi triển khai các dự án tự động hóa vừa và nhỏ.
- Nhà máy sản xuất & Doanh nghiệp đóng gói: Mô hình thực nghiệm rõ ràng về phân loại thông minh kết hợp truy xuất dữ liệu mã QR theo thời gian thực, sẵn sàng mở rộng kết nối lên hệ thống quản trị sản xuất MES/ERP.
- Nhà nghiên cứu học thuật: Khung nền tảng mở (Open hardware/software architecture) để thử nghiệm các giải pháp điều khiển thông minh mới như Adaptive Control, Fuzzy-PID hoặc Reinforcement Learning trên robot thực.
Câu hỏi thường gặp
1. Yêu cầu kỹ thuật tối thiểu để triển khai và vận hành hệ thống là gì?
Hệ thống yêu cầu nguồn điện 1 pha $220\text{VAC}\pm10%$, $50\text{Hz}$ (công suất nguồn cấp $\ge 1.0\text{ kW}$); nguồn khí nén khô sạch $4 - 6\text{ bar}$; cáp mạng Ethernet Cat5e/Cat6 chuẩn RJ45 kết nối mạng LAN nội bộ.
2. Giới hạn mở rộng số lượng điểm dạy (Teaching Points) của robot là bao nhiêu?
Hệ thống cho phép lưu trữ tối đa 10 bảng vị trí (Tables), mỗi bảng chứa 100 điểm tọa độ (tổng cộng 1000 điểm làm việc). Dữ liệu được lưu trong thẻ nhớ SD Card và bộ nhớ Flash của MCU, không bị mất khi ngắt nguồn.
3. Hệ thống xử lý thế nào khi xảy ra mất kết nối Modbus TCP giữa PLC và Robot?
Module ESP32 và S7-1200 duy trì cờ giám sát tín hiệu nhịp tim (Heartbeat pulse). Nếu quá $1500\text{ ms}$ không nhận được bản tin xác thực, robot sẽ tự động giảm tốc mềm về trạng thái dừng an toàn (Safe Pause) và kích hoạt cảnh báo Alarm còi hú trên tủ điện.
4. Chi phí bảo trì định kỳ và độ bền của hệ thống servo/hộp số ra sao?
Các dòng động cơ FASTECH Ezi-Servo và hộp số Harmonic Drive là dòng công nghiệp kín bụi, không cần bảo dưỡng chổi than. Định kỳ kiểm tra độ căng dây đai răng và tra mỡ bôi trơn chuyên dụng cho hộp số sau mỗi $5000\text{ giờ}$ vận hành liên tục.
5. Có thể thay thế đầu đọc QR và cảm biến màu bằng Camera công nghiệp không?
Hoàn toàn có thể. ESP32 và S7-1200 đều hỗ trợ nhận lệnh qua Modbus TCP hoặc ngõ vào số (Digital Trigger). Khi tích hợp Smart Camera (như Cognex, Basler hay Omron Microscan), dữ liệu phân loại có thể ghi trực tiếp vào thanh ghi Modbus Holding Register 40010 để robot thực thi phân loại.
Kết luận
Đề tài "Nghiên cứu, Thiết kế và Thi công Cánh tay Robot 6 Bậc Tự do Ứng dụng cho Mô hình Phân loại, Sắp xếp Sản phẩm Theo Màu sắc và Mã QR Truyền thông qua Modbus TCP/IP" đã giải quyết thành công bài toán tự động hóa phân loại sản phẩm đa tiêu chí với độ chính xác cao và chi phí tối ưu. Dự án chứng minh tính khả thi vượt trội của kiến trúc điều khiển lai giữa vi điều khiển nhúng hiệu năng cao và PLC công nghiệp, mang lại giải pháp công nghệ làm chủ toàn diện từ cơ khí, thuật toán động học đến mạng truyền thông phân tán. Đây là tiền đề kỹ thuật vững chắc để nâng cấp thành các hệ thống Robot cánh tay di động (Mobile Manipulator) phục vụ các dây chuyền sản xuất thông minh trong tương lai.
