Giới thiệu dự án
Trong bối cảnh Cách mạng Công nghiệp 4.0 và quá trình phục hồi, tự động hóa sau đại dịch COVID-19, việc ứng dụng robot công nghiệp trong dây chuyền sản xuất đã trở thành yếu tố sống còn để nâng cao năng suất, đảm bảo an toàn lao động và giảm thiểu tỷ lệ lỗi do con người. Tại các nhà máy chế biến thực phẩm, dược phẩm và đóng gói linh kiện (tiêu biểu như dây chuyền đóng gói sữa Vinamilk), bài toán phân loại sản phẩm theo quy cách, màu sắc và kích thước đòi hỏi tốc độ xử lý chu kỳ (cycle time) cực nhanh cùng độ chính xác vị trí cao.
Phương pháp phân loại thủ công hoặc sử dụng cảm biến quang tĩnh kết hợp xilanh khí nén truyền thống bộc lộ nhiều điểm nghẽn nghiêm trọng:
- Tốc độ giới hạn: Nhân công thao tác thủ công chỉ đạt trung bình 20–30 sản phẩm/phút, dễ mệt mỏi và sai sót khi làm việc liên tục.
- Tính linh hoạt thấp: Cảm biến quang chỉ phát hiện sự hiện diện tại điểm cố định, không thể định vị không gian tọa độ thực $(X, Y, Z)$ khi sản phẩm nằm phân tán trên băng chuyền.
- Tổn hao cơ khí: Cánh tay robot nối tiếp (Articulated/SCARA) có quán tính tay đòn lớn, tốc độ pick-and-place bị giới hạn và chi phí bảo dưỡng cao.
Đồ án "Ứng dụng PLC điều khiển Robot Delta phân loại sản phẩm theo màu" được triển khai nhằm giải quyết triệt để các hạn chế trên bằng cách kết hợp cơ cấu song song Delta 3 bậc tự do (3-DOF), hệ thống thị giác máy tính (Machine Vision) và bộ điều khiển logic khả trình công nghiệp PLC Siemens S7-1200.
+-----------------------------------------------------------------------+
| MỤC TIÊU CỦA DỰ ÁN |
+-----------------------------------------------------------------------+
| 1. Thiết kế và chế tạo cơ khí robot song song Delta 3-DOF bằng in 3D. |
| 2. Xây dựng thuật toán xử lý ảnh trên nền C# .NET và EmguCV. |
| 3. Phát triển giải thuật động học thuận/nghịch cho cơ cấu Delta. |
| 4. Lập trình phát xung PTO điều khiển 3 động cơ bước qua S7-1200. |
| 5. Đồng bộ dữ liệu SCADA/HMI qua OPC KepServerEX và lưu trữ SQL. |
+-----------------------------------------------------------------------+
Giải pháp lựa chọn cấu trúc robot song song Delta vì toàn bộ 3 động cơ chấp hành được gắn cố định trên khung tĩnh (base plate), giúp giảm thiểu tối đa khối lượng chuyển động của cánh tay đòn, cho phép đạt gia tốc lớn và chu kỳ gắp thả dưới 1.8 giây/sản phẩm. Hệ thống camera kết hợp máy tính chủ (PC) đảm nhiệm xử lý ảnh nhận dạng màu sắc (Đỏ, Xanh lá, Xanh lam) và giải bài toán động học nghịch, sau đó truyền góc quay mục tiêu $(\theta_1, \theta_2, \theta_3)$ xuống PLC thông qua giao thức OPC để điều khiển phát xung PTO chính xác.
Phạm vi và giới hạn của đề tài:
- Phạm vi: Phân loại các khối sản phẩm hình học cơ bản có 3 màu sắc đặc trưng (Red, Green, Blue) di chuyển trên băng tải phẳng; điều khiển hút chân không gắp/nhả vào 3 khay phân loại riêng biệt.
- Giới hạn: Sử dụng Web Camera 5MP trong điều kiện ánh sáng môi trường kiểm soát; cơ cấu truyền động sử dụng động cơ bước vòng hở kết hợp vi bước; phạm vi không gian làm việc (workspace) dạng bán cầu đường kính $300\text{ mm}$, chiều cao $150\text{ mm}$.
Phân tích và thiết kế giải pháp
Phân tích hiện trạng
Để định hình giải pháp tối ưu, nhóm nghiên cứu đã khảo sát và so sánh các phương thức phân loại sản phẩm phổ biến trên thị trường:
| Tiêu chí |
Phân loại thủ công |
Cảm biến màu + Piston khí |
Robot nối tiếp (SCARA) |
Robot song song Delta + Vision |
| Tốc độ (Pick/min) |
20 – 30 |
40 – 50 |
50 – 70 |
80 – 120+ |
| Độ linh hoạt |
Rất thấp |
Kém (chỉ cố định 1 vị trí) |
Trung bình |
Rất cao (nhận diện 2D tự do) |
| Quán tính chuyển động |
N/A |
Không có |
Lớn (động cơ di chuyển) |
Cực nhỏ (động cơ tĩnh) |
| Độ tin cậy công nghiệp |
Thấp |
Khá |
Cao |
Rất cao |
| Chi phí đầu tư |
Chi phí nhân công định kỳ |
Thấp |
Rất cao (> 150 triệu VNĐ) |
Tối ưu (Mức đồ án: < 15 triệu) |
Phân tích yêu cầu hệ thống theo mô hình MoSCoW:
- Must Have (Bắt buộc): Giải thuật động học nghịch Delta; trích xuất tọa độ tâm và màu sắc vật thể bằng EmguCV; phát xung PTO điều khiển 3 trục qua PLC S7-1200; hệ thống dừng khẩn cấp và công tắc hành trình Homing.
- Should Have (Nên có): Giao diện WinForms giám sát thời gian thực chế độ Auto/Manual; kết nối cơ sở dữ liệu SQL Server ghi nhật ký; đo tốc độ băng tải qua Encoder và High-Speed Counter (HSC).
- Could Have (Có thể mở rộng): Tự động bám đuổi sản phẩm khi băng tải chuyển động liên tục (Conveyor Tracking); nhận diện đa dạng hình học (tam giác, tròn, vuông).
- Won't Have (Chưa thực hiện): Nhận diện 3D qua cảm biến chiều sâu (ToF/LiDAR); xoay hướng sản phẩm 4-DOF bằng trục xoay phụ.
Thiết kế hệ thống
Kiến trúc hệ thống được xây dựng theo mô hình phân tầng điều khiển kết hợp giữa tầng xử lý thuật toán cao cấp (PC Vision Engine) và tầng điều khiển thời gian thực công nghiệp (Industrial Real-Time Control):
graph TD
A[Web Camera 5MP] -->|USB Stream 30fps| B[PC Engine - C# .NET & EmguCV]
B -->|Tọa độ pixel X, Y| C[Khối Xử lý Ảnh & Trích xuất Màu HSV]
C -->|Tọa độ thực Robot Xr, Yr, Zr| D[Khối Động học nghịch Inverse Kinematics]
D -->|Góc quay Theta 1, Theta 2, Theta 3| E[OPC Server - KepServerEX v6]
E -->|Ethernet PROFINET| F[PLC Siemens S7-1200 CPU 1212C]
F -->|PTO Pulse / Direction| G[3x Driver TB6600 Microstep]
G -->|Pha A/B Stepper| H[3x Động cơ bước NEMA Robot Delta]
F -->|Digital Output Relay| I[Module mở rộng SM 1222 DQ 8xRelay]
I -->|24V Control| J[Bơm hút chân không & Van khí]
I -->|24V Control| K[Động cơ kéo Băng tải]
L[Encoder quang] -->|Xung Pha A/B| F
B <-->|ADO.NET Data Log| M[(Microsoft SQL Server)]
Technology Stack và Version Numbers:
- Phần cứng điều khiển: PLC Siemens S7-1200 CPU 1212C DC/DC/DC (Firmware v4.2, mã hiệu 6ES7 212-1AG40-0XB0); Module mở rộng Digital Output SM 1222 DQ 8xRelay/2A (6ES7222-1HF32-0XB0).
- Phần cứng truyền động: 03 Driver vi bước TB6600 (điện áp 9–42VDC, dòng tối đa 4.0A); 03 Động cơ bước lưỡng cực Step Motor; 03 Công tắc hành trình cơ khí KW11; Cảm biến Encoder quang 2 pha AB.
- Phần mềm lập trình PLC: Siemens TIA Portal V15 (SIMATIC STEP 7 Basic & WinCC Basic).
- Phần mềm xử lý ảnh & HMI: Microsoft Visual Studio 2019, .NET Framework 4.7.2, C# WinForms.
- Thư viện thị giác máy: EmguCV v4.1.1 (OpenCV .NET Wrapper).
- Truyền thông & Cơ sở dữ liệu: Kepware KEPServerEX v6.5 (OPC DA/UA Server), Microsoft SQL Server 2019 Express.
Thiết kế cơ sở dữ liệu (Database Schema):
Bảng ProductionLog lưu vết chu kỳ phân loại:
CREATE TABLE ProductionLog (
LogID INT IDENTITY(1,1) PRIMARY KEY,
Timestamp DATETIME DEFAULT GETDATE(),
ColorDetected NVARCHAR(20) NOT NULL,
Target_X REAL NOT NULL,
Target_Y REAL NOT NULL,
Target_Z REAL NOT NULL,
Theta1 REAL NOT NULL,
Theta2 REAL NOT NULL,
Theta3 REAL NOT NULL,
SortingBin INT NOT NULL,
CycleTime_ms INT NOT NULL,
Status NVARCHAR(50) DEFAULT 'SUCCESS'
);
Thiết kế địa chỉ truyền thông OPC Tags (KepServerEX -> S7-1200 DB1):
DB1.DBD0 (REAL): Target_Theta1 (Góc xoay cánh tay 1)DB1.DBD4 (REAL): Target_Theta2 (Góc xoay cánh tay 2)DB1.DBD8 (REAL): Target_Theta3 (Góc xoay cánh tay 3)DB1.DBX12.0 (BOOL): CMD_Start_Cycle (Lệnh bắt đầu chu kỳ gắp)DB1.DBX12.1 (BOOL): Vacuum_Trigger (Kích hoạt bơm hút chân không)DB1.DBX12.2 (BOOL): Robot_Busy (Phản hồi trạng thái bận từ PLC)DB1.DBX12.3 (BOOL): Cycle_Done (Phản hồi hoàn thành chu kỳ gắp)
Methodology
Dự án áp dụng phương pháp phát triển xoắn ốc (Spiral Model) kết hợp kiểm thử Hardware-in-the-Loop (HIL) theo 5 giai đoạn:
+-----------------------------------------------------------------------------------+
| LỘ TRÌNH TRIỂN KHAI DỰ ÁN |
+-----------------------------------------------------------------------------------+
| Giai đoạn 1 (Tuần 1 - 3): Toán học hóa & Mô phỏng Động học Robot Delta |
| Giai đoạn 2 (Tuần 4 - 7): Thiết kế CAD 3D Fusion 360 & Gia công in 3D cơ khí |
| Giai đoạn 3 (Tuần 8 - 11): Phát triển Module Vision EmguCV & Giao diện C# WinForms|
| Giai đoạn 4 (Tuần 12 - 14):Cấu hình TIA Portal V15, Motion Control PTO & OPC |
| Giai đoạn 5 (Tuần 15 - 17):Tích hợp toàn hệ thống, Cân chỉnh tọa độ & Đánh giá |
+-----------------------------------------------------------------------------------+
Ma trận rủi ro và giải pháp khắc phục:
| Rủi ro kỹ thuật |
Mức độ |
Biện pháp giảm thiểu |
| Trượt bước (Step loss) động cơ bước |
Cao |
Cấu hình tham số gia tốc/giảm tốc mềm (S-curve Jerk Limit) trong Technology Object TIA Portal. |
| Nhiễu sáng môi trường làm sai lệch HSV |
Trung bình |
Bổ sung hộp chụp sáng đẳng hướng, cố định dải ngưỡng nhị phân bằng hàm CvInvoke.InRange. |
| Độ trễ truyền thông OPC |
Trung bình |
Tối ưu hóa chu kỳ quét KepServerEX xuống mức $10\text{ ms}$; sử dụng Ethernet công nghiệp chuẩn 100Mbps. |
| Va đập cơ khí ngoài không gian làm việc |
Cao |
Giới hạn hành trình phần mềm (Software Limit Switches) và công tắc hành trình vật lý KW11. |
Implementation và kết quả
Development process
1. Cơ sở toán học Động học nghịch (Inverse Kinematics) Robot Delta
Mục tiêu là tìm các góc khớp $(\theta_1, \theta_2, \theta_3)$ khi biết trước tọa độ tâm bàn kẹp di động $E_0(x_0, y_0, z_0)$. Khớp đòn chủ động $F_i J_i$ có chiều dài $r_f$ chỉ quay trong mặt phẳng thẳng đứng, khâu bị động $J_i E_i$ hình bình hành có chiều dài $r_e$.
Xét nhánh thứ nhất ($i = 1$) nằm trong mặt phẳng $YZ$, tọa độ điểm $E'1$ (hình chiếu của khớp kẹp $E_1$ lên mặt phẳng $YZ$) và điểm gắn động cơ cố định $F_1$:
$$E'1 = \left(0, y_0 - \frac{e}{2\sqrt{3}}, z_0\right), \quad F_1 = \left(0, -\frac{f}{2\sqrt{3}}, 0\right)$$
Bán kính đường tròn giao tuyến $E'1 J_1$ được tính bằng định lý Pythagoras:
$$E'1 J_1 = \sqrt{r_e^2 - x_0^2}$$
Khớp $J_1(0, y{J1}, z{J1})$ là giao điểm của hai đường tròn tâm $F_1$ bán kính $r_f$ và tâm $E'1$ bán kính $E'1 J_1$:
$$\begin{cases} (y{J1} - y{F1})^2 + z{J1}^2 = r_f^2 \ (y{J1} - y_{E'1})^2 + (z_{J1} - z_{E'1})^2 = r_e^2 - x_0^2 \end{cases}$$
Góc quay cánh tay 1 được xác định trực tiếp qua hàm lượng giác:
$$\theta_1 = \arctan\left(\frac{z_{J1}}{y_{F1} - y_{J1}}\right)$$
Do cấu trúc đối xứng quay $120^\circ$, tọa độ cho góc $\theta_2$ và $\theta_3$ được suy ra bằng cách nhân vector tọa độ $(x_0, y_0)$ với ma trận xoay:
$$R(\alpha) = \begin{bmatrix} \cos\alpha & -\sin\alpha \ \sin\alpha & \cos\alpha \end{bmatrix}, \quad \text{với } \alpha = 120^\circ \text{ và } \alpha = 240^\circ$$
+------------------------------------------------------------------------------------+
| LƯU ĐỒ XỬ LÝ ẢNH TRÍCH XUẤT TỌA ĐỘ VÀ MÀU SẮC |
+------------------------------------------------------------------------------------+
| Web Camera Frame ---> BGR to HSV ---> CvInvoke.InRange (Tách dải màu R/G/B) |
| | |
| v |
| Tọa độ Robot (Xr, Yr) <--- Image Moments <--- FindContours <--- 2x Erosion/Dilation|
+------------------------------------------------------------------------------------+
2. Pipeline Xử lý ảnh với EmguCV (C#)
Chương trình đọc luồng video từ Web Camera 5MP, thực hiện phân tách kênh màu và tính toán trọng tâm vật thể theo thuật toán tối ưu:
using Emgu.CV;
using Emgu.CV.CvEnum;
using Emgu.CV.Structure;
using Emgu.CV.Util;
using System;
using System.Drawing;
public class DeltaVisionProcessor
{
// Ngưỡng màu HSV cho vật mẫu Đỏ, Xanh lá, Xanh lam
private readonly Hsv lowerRed = new Hsv(0, 120, 70);
private readonly Hsv upperRed = new Hsv(10, 255, 255);
public PointF ProcessFrame(Mat inputFrame, out string detectedColor)
{
detectedColor = "UNKNOWN";
PointF centerPoint = new PointF(0, 0);
// 1. Chuyển đổi không gian màu BGR sang HSV
Image<Hsv, byte> hsvImg = inputFrame.ToImage<Hsv, byte>();
// 2. Phân ngưỡng nhị phân theo dải màu (Ví dụ: Màu đỏ)
Image<Gray, byte> maskRed = hsvImg.InRange(lowerRed, upperRed);
// 3. Xử lý hình thái học: 2 lần Co (Erosion) và 2 lần Giãn (Dilation) với Kernel 8x8
Mat kernel = CvInvoke.GetStructuringElement(ElementShape.Rectangle, new Size(8, 8), new Point(-1, -1));
CvInvoke.Erode(maskRed, maskRed, kernel, new Point(-1, -1), 2, BorderType.Default, new MCvScalar());
CvInvoke.Dilate(maskRed, maskRed, kernel, new Point(-1, -1), 2, BorderType.Default, new MCvScalar());
// 4. Tìm Contours đường bao của vật thể
VectorOfVectorOfPoint contours = new VectorOfVectorOfPoint();
Mat hierarchy = new Mat();
CvInvoke.FindContours(maskRed, contours, hierarchy, RetrType.Ccomp, ChainApproxMethod.ChainApproxSimple);
double maxArea = 0;
int targetContourIndex = -1;
for (int i = 0; i < contours.Size; i++)
{
double area = CvInvoke.ContourArea(contours[i]);
if (area > 500 && area > maxArea) // Lọc diện tích hợp lệ
{
maxArea = area;
targetContourIndex = i;
}
}
// 5. Tính toán trọng tâm thông qua Image Moments
if (targetContourIndex != -1)
{
MCvMoments moments = CvInvoke.Moments(contours[targetContourIndex]);
if (moments.M00 != 0)
{
float cx = (float)(moments.M10 / moments.M00);
float cy = (float)(moments.M01 / moments.M00);
centerPoint = new PointF(cx, cy);
detectedColor = "RED";
}
}
return centerPoint;
}
}
3. Chuyển đổi tọa độ từ Camera sang Tọa độ Robot
Ma trận biến đổi Affine 2D hiệu chuẩn góc lệch và tỷ lệ giữa hệ tọa độ Pixel $(u, v)$ và hệ tọa độ thực Robot $(X_r, Y_r)$:
$$\begin{bmatrix} X_r \ Y_r \ 1 \end{bmatrix} = \begin{bmatrix} s_x \cos\phi & -s_y \sin\phi & T_x \ s_x \sin\phi & s_y \cos\phi & T_y \ 0 & 0 & 1 \end{bmatrix} \begin{bmatrix} u \ v \ 1 \end{bmatrix}$$
Trong đó $s_x = 0.42\text{ mm/pixel}$, $s_y = 0.42\text{ mm/pixel}$ là hệ số tỷ lệ kích thước thực nghiệm; $\phi$ là góc lệch trục tọa độ; $(T_x, T_y)$ là độ dời gốc tọa độ giữa tâm camera và tâm gốc robot.
4. Cấu hình Motion Control trên Siemens TIA Portal V15
Trên PLC S7-1200 1212C DC/DC/DC, 3 trục động cơ bước được định nghĩa dưới dạng Technology Objects (TO_Axis_1, TO_Axis_2, TO_Axis_3):
- Ngõ phát xung: PTO 1 gán chân $Q0.0$ (Pulse) và $Q0.1$ (Direction); PTO 2 gán chân $Q0.2$ (Pulse) và $Q0.3$ (Direction); PTO 3 gán chân $Q0.4$ (Pulse) và $Q0.5$ (Direction). Tần số phát xung tối đa cấu hình đạt $100\text{ kHz}$.
- Cấu hình Dynamics: Tốc độ tối đa $V_{\max} = 150^\circ/\text{s}$, gia tốc $a = 300^\circ/\text{s}^2$, thời gian giảm tốc $Ramp\text{-}down = 0.2\text{ s}$, kích hoạt chức năng Jerk Limit để làm mịn đồ thị hình thang chuyển động.
- Tập lệnh Motion Control tiêu chuẩn:
MC_Power: Kích hoạt trạng thái sẵn sàng cho trục.MC_Home: Thực hiện quy trình Active Homing đưa 3 cánh tay về chạm công tắc hành trình $KW11$ xác lập gốc $0.0^\circ$.MC_MoveAbsolute: Điều khiển trục quay chính xác đến góc $\theta_i$ nhận từ PC.MC_Halt / MC_Reset: Dừng và xử lý sự cố kẹt cơ khí hoặc quá hành trình.
Testing và validation
Hệ thống đã trải qua quá trình kiểm thử toàn diện với 500 chu kỳ phân loại sản phẩm liên tục tại phòng thí nghiệm:
+----------------------------------------------------------------------------------+
| KẾT QUẢ PHÂN PHỐI THỜI GIAN CHU KỲ GẮP THẢ (CYCLE TIME) |
+----------------------------------------------------------------------------------+
| Vision Processing & HSV Filtering: 22 ms [===] |
| Inverse Kinematics Calculation: 3 ms [=] |
| OPC Ethernet Data Transfer: 15 ms [==] |
| PLC Motion Trajectory Execution: 1420 ms [===================================]|
| Vacuum Suction / Release Time: 200 ms [=====] |
| TỔNG THỜI GIAN MỘT CHU KỲ GẮP THẢ: 1660 ms (~1.66 giây / sản phẩm) |
+----------------------------------------------------------------------------------+
Ma trận đánh giá độ chính xác phân loại theo màu (500 mẫu thử):
| Màu mẫu thử |
Số lượng thử nghiệm |
Nhận dạng đúng |
Gắp & thả đúng vị trí |
Tỷ lệ thành công (%) |
Nguyên nhân lỗi |
| Màu Đỏ (Red) |
180 |
179 |
177 |
98.33% |
02 lần bóng bề mặt do đèn chùm |
| Xanh Lam (Blue) |
160 |
158 |
155 |
96.88% |
03 lần trượt giác hút do bụi bám |
| Xanh Lá (Green) |
160 |
157 |
154 |
96.25% |
03 lần lệch tọa độ do mép phôi lồi |
| TỔNG CỘNG |
500 |
494 |
486 |
97.20% |
Sai số tọa độ trung bình: $\pm 0.8\text{ mm}$ |
Thống kê Bug tracking và phương án khắc phục:
- Hiện tượng rung lắc khi hạ giác hút: Xảy ra do gia tốc dừng đột ngột $\to$ Khắc phục bằng cách tăng
Ramp-down time từ $0.1\text{ s}$ lên $0.25\text{ s}$ trong Technology Object và tích hợp bộ lọc chuyển động mềm Jerk Limit.
- Xung đột bộ đệm truyền thông KepServerEX: Khi camera gửi tọa độ liên tục ở 30fps làm tràn bộ đệm PLC $\to$ Giải quyết bằng cơ chế bắt tay 2 chiều: PC chỉ gửi tọa độ mới khi cờ
Robot_Busy chuyển về mức logic FALSE và Cycle_Done bằng TRUE.
Kết quả đạt được
+---------------------------------------------------------------------------------+
| KẾT QUẢ SO VỚI CHỈ TIÊU BAN ĐẦU |
+---------------------------------------------------------------------------------+
| Chỉ tiêu thiết kế | Kế hoạch đề ra | Kết quả thực nghiệm |
|-----------------------------|-------------------------|------------------------|
| Tỷ lệ phân loại chính xác | >= 95.0% | 97.2% |
| Tốc độ chu kỳ gắp thả | <= 2.0 s/sản phẩm | 1.66 s/sản phẩm |
| Tần số phát xung PTO PLC | 50 kHz | 100 kHz (Max phần cứng)|
| Sai số cơ khí định vị | <= 1.5 mm | +-0.8 mm |
| Chế độ vận hành HMI | Auto & Manual | Đầy đủ + Database SQL |
+---------------------------------------------------------------------------------+
Đổi mới và đóng góp
- Kiến trúc phần mềm kết hợp linh hoạt: Đồ án đã giải quyết bài toán giao tiếp lai giữa môi trường tính toán đồ họa cao cấp (.NET Framework / EmguCV) và môi trường điều khiển công nghiệp khắc khe (Siemens PLC) thông qua OPC KepServerEX, loại bỏ nhu cầu trang bị camera thông minh (Smart Camera công nghiệp) đắt tiền như Cognex hay Keyence.
- Thuật toán hình thái học tối ưu: Ứng dụng chuỗi lọc 2 lần Co kết hợp 2 lần Giãn (Kernel $8\times 8$) giúp tách triệt để nền và các vùng phản xạ chói lóa, cho phép thuật toán tính Moment ảnh đạt độ ổn định tọa độ tâm cực cao ($\Delta < 1\text{ pixel}$).
- Cơ cấu cơ khí in 3D module hóa: Toàn bộ cụm khớp cầu, tay đòn hình bình hành và giá đỡ bàn di động được tối ưu trọng lượng bằng vật liệu in 3D PETG/PLA chịu lực, giảm quán tính khâu chuyển động xuống dưới $180\text{ gram}$.
- Nâng cao hiệu suất phân loại: So với giải pháp xilanh khí nén cổ điển, mô hình robot Delta tăng độ linh hoạt phân loại từ 1 bậc lên 3 bậc tự do không gian, cải thiện $45%$ tốc độ phân loại và giảm $60%$ chi phí đầu tư so với robot SCARA thương mại.
Ứng dụng thực tế và triển khai
Trường hợp ứng dụng thực tế (Use Cases)
- Công nghiệp Thực phẩm & Bánh kẹo: Đóng gói bánh quy, phân loại kẹo theo màu sắc vỏ bao bì, gắp sô-cô-la vào khay định hình.
- Công nghiệp Dược phẩm: Phân loại vỉ thuốc, kiểm tra màu sắc nắp lọ vaccine, loại bỏ phôi lỗi trước công đoạn đóng thùng.
- Lắp ráp Linh kiện Điện tử: Định vị và gắp các tụ điện, IC, nắp che linh kiện theo mã vạch hoặc dấu chấm màu định danh.
+-------------------------------------------------------------------------------+
| BẢNG TÍNH TOÁN HIỆU QUẢ KINH TẾ (ROI) |
+-------------------------------------------------------------------------------+
| Hạng mục đầu tư mô hình Delta Robot: |
| - PLC Siemens S7-1200 1212C + Module Relay SM 1222: 5.800.000 VNĐ |
| - Hệ thống 3 Động cơ bước + Driver TB6600 + Nguồn tổ ong: 2.400.000 VNĐ |
| - Cơ khí khung nhôm định hình, in 3D, Băng tải, Bơm chân không: 3.200.000 VNĐ |
| - Web Camera 5MP + Phụ kiện truyền thông: 1.100.000 VNĐ |
| TỔNG CHI PHÍ PHẦN CỨNG: 12.500.000 VNĐ |
| ----------------------------------------------------------------------------- |
| So sánh kinh tế: |
| - Chi phí 01 nhân công phân loại thủ công: 8.000.000 VNĐ / tháng |
| - Chi phí năng lượng & bảo trì hệ thống Robot Delta: ~ 400.000 VNĐ / tháng |
| -> THỜI GIAN HOÀN VỐN ĐẦU TƯ (PAYBACK PERIOD): ~ 1.6 THÁNG |
+-------------------------------------------------------------------------------+
Hạn chế và hướng phát triển
Hạn chế kỹ thuật
- Động cơ bước vòng hở: Khi vận hành ở tần số phát xung vượt quá $120\text{ kHz}$, động cơ có nguy cơ trượt bước nhẹ nếu đầu hút gặp tải nặng bất ngờ do không có phản hồi encoder tuyệt đối tại từng khớp.
- Độ nhạy sáng của Camera thông thường: Dải ngưỡng HSV cố định có thể bị ảnh hưởng nếu cường độ chiếu sáng của phân xưởng thay đổi đột ngột giữa ca ngày và ca đêm.
- Cơ cấu kẹp tĩnh: Chưa có trục thứ tư ($4\text{-DOF}$) để xoay điều chỉnh góc nghiêng của sản phẩm trước khi đặt vào khay.
Hướng phát triển trong tương lai
- Nâng cấp động cơ Servo/Closed-loop Stepper: Thay thế bằng động cơ bước có hồi tiếp encoder (Easy Servo) hoặc AC Servo Mitsubishi MR-J4 để tăng tốc độ chu kỳ lên dưới $0.8\text{ s/sản phẩm}$.
- Tích hợp Deep Learning (YOLOv8-tiny): Ứng dụng mô hình AI nhận diện đa dạng khuyết tật bề mặt, chữ in date và phân loại sản phẩm có hình dáng dị thể phức tạp.
- Bám đuổi băng tải động (Conveyor Tracking): Sử dụng hàm Motion Control chuyên sâu trên S7-1500 hoặc khối giải thuật mở rộng trên S7-1200 để robot gắp thả trực tiếp khi băng chuyền chạy liên tục không cần dừng.
Đối tượng hưởng lợi
- Sinh viên ngành Kỹ thuật Điều khiển & Tự động hóa, Điện tử: Nguồn tài liệu thực chứng toàn diện kết hợp giữa lý thuyết động học robot song song, xử lý ảnh thị giác máy tính và kỹ thuật lập trình PLC chuyển động cao cấp.
- Kỹ sư Tự động hóa & Lập trình viên SCADA: Mô hình tham chiếu chuẩn mực cho việc tích hợp OPC KepServerEX kết nối C# .NET với phần cứng Siemens S7-1200.
- Doanh nghiệp vừa và nhỏ (SMEs): Giải pháp tự động hóa dây chuyền đóng gói chi phí thấp, thời gian triển khai nhanh, nâng cao năng suất tức thì.
- Nhà nghiên cứu học thuật: Cung cấp bộ thông số thực nghiệm, ma trận biến đổi tọa độ và thuật toán động học nghịch đã được kiểm chứng thực tế.
Câu hỏi thường gặp
1. Yêu cầu cấu hình phần cứng tối thiểu để triển khai hệ thống là gì?
Hệ thống yêu cầu PC chạy Windows 10/11 64-bit, CPU Intel Core i3 thế hệ 8 trở lên, 8GB RAM, cổng mạng Ethernet RJ45 chuẩn 100Mbps. Về phía điều khiển: PLC Siemens S7-1200 CPU 1212C DC/DC/DC (bắt buộc phiên bản DC/DC/DC để có ngõ ra bán dẫn phát xung PTO tốc độ cao), 03 Driver TB6600 và nguồn cấp công nghiệp 24VDC/10A.
2. Làm thế nào để giải quyết hiện tượng mất bước của động cơ khi robot chuyển động nhanh?
Cần cấu hình thời gian tăng/giảm tốc (Ramp-up / Ramp-down) hợp lý trong mục Dynamics của Technology Object trên TIA Portal V15, đồng thời kích hoạt tính năng Jerk Limit (giới hạn độ giật). Ngoài ra, cài đặt dòng điện trên Driver TB6600 đạt mức $100%$ dòng danh định của động cơ và chọn chế độ vi bước $1/8$ hoặc $1/16$ để chuyển động êm ái.
3. Tại sao không nạp trực tiếp thuật toán xử lý ảnh vào PLC mà phải qua máy tính trung gian?
PLC S7-1200 là bộ điều khiển logic thời gian thực với dung lượng bộ nhớ làm việc (Work Memory) giới hạn (75KB - 100KB), không thiết kế để giải mã luồng video độ phân giải cao và tính toán ma trận ma trận điểm ảnh phức tạp. Việc phân chia PC đảm nhiệm xử lý ảnh / động học và PLC đảm nhiệm phát xung chấp hành là mô hình chuẩn công nghiệp, tối ưu hóa chi phí và hiệu năng.
4. Hệ thống xử lý thế nào khi có 2 hoặc nhiều vật thể cùng xuất hiện trên khung hình?
Thuật toán trên C# duyệt mảng Contours thông qua vòng lặp, tính diện tích từng vật thể và sắp xếp theo thứ tự tọa độ $Y$ (vật nào đến vùng bắt trước sẽ được gắp trước). Hệ thống áp dụng cơ chế hàng đợi (FIFO Queue) để xử lý tuần tự từng sản phẩm.
5. Chi phí bảo trì và độ bền của cơ cấu robot Delta in 3D ra sao?
Cơ cấu in 3D bằng nhựa kỹ thuật (PETG/ABS) có tuổi thọ vận hành thử nghiệm trên 1000 giờ liên tục. Chi phí thay thế một cụm khớp nối in 3D khi xảy ra mài mòn cơ khí chỉ dưới $50.000\text{ VNĐ}$ và thời gian in thay thế dưới 2 giờ, cực kỳ tiết kiệm cho môi trường phòng lab và sản xuất nhỏ.
Kết luận
Đồ án "Ứng dụng PLC điều khiển Robot Delta phân loại sản phẩm theo màu" đã hoàn thành xuất sắc toàn bộ các mục tiêu lý thuyết và thực nghiệm đề ra. Dự án chứng minh tính khả thi vượt trội của việc tích hợp bộ điều khiển PLC Siemens S7-1200, thị giác máy tính EmguCV và cơ cấu song song Delta trong bài toán tự động hóa phân loại tốc độ cao. Với tỷ lệ phân loại thành công đạt $97.2%$, thời gian chu kỳ chỉ $1.66\text{ giây/sản phẩm}$ và tổng chi phí gia công chế tạo tối ưu, hệ thống mở ra tiềm năng ứng dụng thực tiễn to lớn cho các dây chuyền đóng gói vừa và nhỏ tại Việt Nam.
LIÊN HỆ PHÁT TRIỂN & CHUYỂN GIAO CÔNG NGHỆ:
Quý độc giả, sinh viên và doanh nghiệp quan tâm đến toàn bộ mã nguồn chương trình C# WinForms, source code TIA Portal V15 và bản vẽ thiết kế cơ khí 3D có thể liên hệ trực tiếp nhóm nghiên cứu (Zalo: 0367583469) để được hỗ trợ kỹ thuật và hợp tác triển khai.
