Giới thiệu dự án
Trong bối cảnh cuộc Cách mạng Công nghiệp 4.0 đang diễn ra mạnh mẽ, tự động hóa đóng vai trò cốt lõi trong việc nâng cao năng suất, chuẩn hóa chất lượng sản phẩm và tối ưu hóa chi phí vận hành. Theo báo cáo của Liên đoàn Robot Quốc tế (IFR), mật độ robot trong các ngành công nghiệp sản xuất trên toàn cầu đã tăng trưởng hơn 14% mỗi năm, trong đó các ứng dụng gắp và phân loại sản phẩm (Pick and Place) chiếm tới hơn 35% tổng số tác vụ tự động hóa tại các dây chuyền lắp ráp linh kiện điện tử, đóng gói bao bì và chế biến thực phẩm.
Tuy nhiên, tại nhiều doanh nghiệp vừa và nhỏ (SMEs), quy trình bốc xếp và phân loại phôi vẫn phụ thuộc chủ yếu vào nhân công thủ công. Điều này dẫn đến các điểm nghẽn nghiêm trọng:
- Tốc độ thao tác không ổn định, năng suất suy giảm rõ rệt theo thời gian ca làm việc do mệt mỏi thể chất.
- Tỷ lệ sai số và rủi ro rơi vỡ sản phẩm cao trong môi trường làm việc đơn điệu, lặp đi lặp lại.
- Nguy cơ chấn thương lao động tích tụ (RSI - Repetitive Strain Injury) và chi phí đào tạo lại nhân sự cao do biến động lao động.
- Các giải pháp robot dạng DIY dùng vi điều khiển mã nguồn mở thường thiếu độ bền công nghiệp, dễ bị nhiễu điện từ (EMI) và không đáp ứng được yêu cầu về thời gian thực (Real-time).
Đồ án "Chế tạo cánh tay robot trong công nghiệp gắp và xếp vật" được nghiên cứu và hiện thực hóa nhằm giải quyết triệt để các vấn đề trên thông qua việc làm chủ công nghệ thiết kế cơ khí chính xác, tích hợp hệ thống điều khiển chuyển động công nghiệp cấp cao dựa trên nền tảng PLC Mitsubishi Q-Series và truyền thông quang học SSCNET III/H.
+-----------------------------------------------------------------------------+
| MỤC TIÊU DỰ ÁN |
+-----------------------------------------------------------------------------+
| 1. Thiết kế cơ khí cánh tay SCARA 4 bậc tự do (4-DOF) kết cấu nhôm 6061 |
| 2. Tích hợp hệ thống Motion PLC Mitsubishi Q06HCPU kết hợp Module QD75MH4 |
| 3. Xây dựng giải thuật Động học Thuận (FK) & Động học Nghịch (IK) chuẩn xác |
| 4. Điều khiển đồng bộ 4 trục AC Servo MR-J4 qua mạng cáp quang SSCNET III/H |
| 5. Thiết kế giao diện HMI cảm ứng Handy GOT và tay phát xung MPG linh hoạt |
+-----------------------------------------------------------------------------+
Phương pháp tiếp cận và kết quả kỳ vọng
Dự án áp dụng cấu trúc robot SCARA (Selective Compliance Assembly Robot Arm) 4 bậc tự do kết hợp hệ thống cấp phôi bằng băng tải và tay kẹp khí nén. Nền tảng điều khiển sử dụng kiến trúc xử lý đa lõi (Multi-Processor) với CPU PLC Q06H và bộ điều khiển vị trí QD75MH4, liên kết với hệ thống Driver Servo AC MELSERVO-J4 thông qua bus quang tốc độ cao 150 Mbps.
Chỉ số định lượng kỳ vọng (Measurable Metrics):
- Chu kỳ gắp - đặt (Cycle time): $\le 2.2\text{ s/chu trình}$.
- Độ lặp lại vị trí (Repeatability): $\pm 0.05\text{ mm}$.
- Tải trọng nâng danh định (Payload): $0.5 - 1.5\text{ kg}$.
- Độ khả dụng hệ thống (Uptime): Đạt $99.2%$ trong điều kiện hoạt động liên tục.
Phạm vi và giới hạn:
Hệ thống tập trung vào bài toán định vị và sắp xếp vật mẫu hình khối xác định từ băng tải tĩnh/băng tải dừng theo cảm biến quang Omron E3Z-D61 sang bàn chứa pallet định hình. Hệ thống chưa tích hợp xử lý ảnh nhận dạng đối tượng động (Visual Servoing) trong giai đoạn thử nghiệm đầu tiên.
Phân tích và thiết kế giải pháp
Phân tích hiện trạng
Trước khi tiến hành thiết kế chi tiết, nhóm nghiên cứu đã phân tích so sánh các giải pháp tự động hóa gắp/xếp hiện hữu trên thị trường:
| Tiêu chí kỹ thuật |
Hệ thống khí nén/Gantry tuyến tính |
Robot mã nguồn mở (Vi điều khiển/Step Motor) |
Cánh tay SCARA công nghiệp (Dự án nghiên cứu) |
Robot công nghiệp 6-DOF (UR/KUKA/ABB) |
| Độ linh hoạt tọa độ |
Cố định hành trình x, y, z |
Khá, phụ thuộc firmware |
Rất cao trong mặt phẳng làm việc |
Tối đa (toàn không gian 3D) |
| Độ chính xác lặp lại |
$\pm 0.5\text{ mm}$ |
$\pm 0.3 - 0.8\text{ mm}$ |
$\pm 0.05\text{ mm}$ (vòng kín Encoder) |
$\pm 0.02 - 0.03\text{ mm}$ |
| Khả năng chống nhiễu |
Rất tốt |
Rất kém trong môi trường nhà máy |
Chuẩn công nghiệp (SSCNET quang) |
Tiêu chuẩn công nghiệp cao cấp |
| Thời gian chu kỳ |
$3.5 - 5.0\text{ s}$ |
$4.0 - 6.0\text{ s}$ |
$1.8 - 2.2\text{ s}$ |
$1.5 - 2.0\text{ s}$ |
| Chi phí đầu tư |
Thấp |
Rất thấp |
Tối ưu hóa (Phù hợp SMEs) |
Rất cao ($> 25,000\text{ USD}$) |
PHÂN LOẠI YÊU CẦU THEO MÔ HÌNH MOSCOW
┌───────────────────────────────┬───────────────────────────────┐
│ MUST HAVE │ SHOULD HAVE │
│ • Định vị 4 trục chính xác │ • Điều khiển tay phát xung MPG│
│ • Giao tiếp SSCNET III/H │ • Giám sát I/O trực quan HMI │
│ • Dừng khẩn cấp cứng an toàn │ • Cảnh báo quá nhiệt/quá tải │
├───────────────────────────────┼───────────────────────────────┤
│ COULD HAVE │ WON'T HAVE │
│ • Băng tải đồng bộ tốc độ │ • Camera 3D AI kiểm tra ngoại │
│ • Bộ đếm sản lượng tự động │ quan sản phẩm thời gian thực│
└───────────────────────────────┴───────────────────────────────┘
Thách thức kỹ thuật chính:
- Nhiễu tín hiệu xung điều khiển: Khi sử dụng phương pháp phát xung thông thường (Pulse/Direction), đường dây dài dễ bị méo xung gây trôi tọa độ.
- Khớp động học phi tuyến: Chuyển đổi từ tọa độ làm việc Descartes $(X, Y, Z, \theta)$ sang góc quay các trục $(\theta_1, \theta_2, d_3, \theta_4)$ đòi hỏi tính toán lượng giác thời gian thực không gây trễ chu kỳ quét (Scan cycle).
Thiết kế hệ thống
Kiến trúc hệ thống được chuẩn hóa theo mô hình điều khiển phân tán gồm 3 tầng: Tầng Giám sát & Vận hành (HMI & Teach Pendant), Tầng Điều khiển Trung tâm (PLC Motion Q-Series), và Tầng Chấp hành & Cảm biến (Driver Servo, Động cơ, Cảm biến, Khí nén).
graph TD
subgraph Control_Panel ["TẦNG VẬN HÀNH & GIÁM SÁT"]
HMI["Handy GOT GT1155HS-QSBD"]
MPG["Tay phát xung Handy Pulser"]
end
subgraph Controller_Rack ["TẦNG ĐIỀU KHIỂN TRUNG TÂM (PLC Q-SERIES)"]
PS["Nguồn Q61P"] --- CPU["PLC CPU Q06H"]
CPU --- QD75["Motion Module QD75MH4"]
CPU --- QX42["Input Module QX42 (24VDC)"]
CPU --- QY42P["Output Module QY42P (Transistor)"]
CPU --- QJ71["Ethernet QJ71E71-100"]
end
subgraph Drive_Actuator ["TẦNG TRUYỀN ĐỘNG & CHẤP HÀNH"]
MR1["MR-J4-40B (Trục 1 - Base)"]
MR2["MR-J4-20B (Trục 2 - Arm)"]
MR3["MR-J4W2-22B (Trục 3 Z & Trục 4 Yaw)"]
M1["HG-KR43 (400W)"]
M2["HG-KR23 (200W)"]
M3["HG-KR23 + HG-KR13"]
end
subgraph Plant ["CƠ CẤU CHẤP HÀNH & NGOẠI VI"]
Arm["Cánh tay SCARA 4-DOF"]
Gripper["Tay gắp khí nén"]
Conv["Băng tải + Sensor Omron E3Z-D61"]
end
HMI -->|RS-422 / Cáp 37 chân| CPU
MPG -->|Xung A/B vi sai| QD75
QD75 -->|Cáp quang SSCNET III/H 150 Mbps| MR1
MR1 -->|SSCNET III/H Bus| MR2
MR2 -->|SSCNET III/H Bus| MR3
MR1 --> M1
MR2 --> M2
MR3 --> M3
M1 & M2 & M3 --> Arm
QY42P --> Gripper
Conv --> QX42
Bảng thông số công nghệ và thiết bị (Technology Stack)
| Thành phần |
Mã hiệu / Công nghệ |
Phiên bản / Thông số kỹ thuật |
Vai trò trong hệ thống |
| Bộ vi xử lý chính |
Mitsubishi Q06HCPU |
Scan speed: $34\text{ ns/LD}$, 60k steps |
Xử lý logic, tính toán động học và phối hợp chu trình |
| Module điều khiển vị trí |
Mitsubishi QD75MH4 |
4 trục, chu kỳ nội suy $0.888\text{ ms}$ |
Điều khiển quỹ đạo vị trí qua mạng cáp quang |
| Servo Driver |
MELSERVO MR-J4-B series |
MR-J4-40B, MR-J4-20B, MR-J4W2-22B |
Điều khiển dòng, tốc độ, vị trí vòng kín với hồi tiếp quang 22-bit |
| Động cơ AC Servo |
Mitsubishi HG-KR Series |
100W, 200W, 400W (Encoder $4,194,304\text{ pulses/rev}$) |
Chấp hành chuyển động các khớp xoay và tịnh tiến |
| Màn hình HMI |
Handy GOT GT1155HS-QSBD |
Màn hình cảm ứng $5.7\text{ inch}$, cáp truyền 37 chân |
Vận hành di động, cài đặt tọa độ điểm gắp/đặt |
| Môi trường lập trình |
GX Works2 / GT Designer3 |
v1.590U / v1.215Z |
Lập trình Ladder/SFC, cấu hình Motion và giao diện |
| Cảm biến đầu vào |
Omron E3Z-D61 |
Phản xạ khuếch tán, khoảng cách $5 - 100\text{ mm}$ |
Phát hiện phôi trên băng tải cấp liệu |
| Bảo vệ & Nguồn |
ELCB NV30-FA / CP 32FM |
$30\text{A}$, $30\text{mA}$ rò rỉ / Biến áp BSW-750ASE |
Chống dòng rò, bảo vệ ngắn mạch và chuyển đổi $220\text{VAC}\to 100\text{VAC}$ |
Phương pháp luận triển khai (Methodology)
Quy trình phát triển dự án được thực hiện theo mô hình V-Model cải tiến, chia làm 4 giai đoạn chính trong 16 tuần:
Tuần 01 - 04: [Khảo sát & Thiết kế cơ khí 3D trên SolidWorks]
Tuần 05 - 08: [Gia công cơ khí CNC, Lắp ráp khung nhôm & Đấu nối tủ điện]
Tuần 09 - 12: [Cấu hình Motion QD75MH4, Lập trình thuật toán Động học trên GX Works2]
Tuần 13 - 16: [Tích hợp HMI, Hiệu chuẩn vị trí, Kiểm thử chu trình lặp & Bàn giao]
Ma trận đánh giá rủi ro và giải pháp khắc phục
| Rủi ro kỹ thuật |
Mức độ |
Hậu quả |
Giải pháp xử lý cụ thể |
| Gãy hoặc suy hao cáp quang SSCNET |
Cao |
Mất tín hiệu điều khiển toàn bộ Servo |
Thiết kế rãnh đi dây uốn cong chuẩn R30mm; sử dụng đầu nối quang chuyên dụng có nắp bảo vệ. |
| Độ rơ cơ khí (Backlash) tại puly |
Trung bình |
Sai lệch góc quay khớp, giảm độ lặp lại |
Sử dụng bộ căng đai chủ động kết hợp puly răng nhôm định hình T5 có chốt khóa định vị trục. |
| Điểm kỳ dị động học (Singularity) |
Trung bình |
Tốc độ khớp tiến tới vô cùng, gây rung giật |
Giới hạn vùng không gian làm việc (Workspace Envelope) trên phần mềm; khóa góc $\theta_2 \in [5^\circ, 150^\circ]$. |
| Nhiễu điện áp hài từ biến tần/servo |
Cao |
PLC bị reset ngẫu nhiên hoặc sai xung |
Lắp bộ lọc nhiễu Noise Filter MC trước nguồn cấp AC 100V; nối đất độc lập PE chuẩn $< 10\ \Omega$. |
Triển khai thực nghiệm và kết quả
Quá trình phát triển và Thuật toán điều khiển
Thiết kế cơ học của cánh tay SCARA 4-DOF bao gồm:
- Khâu 1 ($L_1 = 325\text{ mm}$): Nối giữa đế xoay trục 1 và khớp khuỷu.
- Khâu 2 ($L_2 = 265\text{ mm}$): Nối giữa khớp khuỷu và cụm trục Z.
- Trục 3 ($d_3$): Khâu tịnh tiến lên/xuống sử dụng vít me bi bước ren $10\text{ mm/vòng}$, hành trình làm việc $510\text{ mm}$.
- Trục 4 ($\theta_4$): Khâu xoay định hướng cổ tay mang kẹp khí nén.
BẢNG THÔNG SỐ ĐỘNG HỌC DENAVIT-HARTENBERG (D-H PARAMETERS)
┌───────┬──────────────┬──────────────┬──────────────┬──────────────┐
│ Khâu │ $\theta_i$ │ $d_i$ (mm) │ $a_i$ (mm) │ $\alpha_i$ │
├───────┼──────────────┼──────────────┼──────────────┼──────────────┤
│ 1 │ $\theta_1^*$ │ 580 │ 325 │ 0 │
│ 2 │ $\theta_2^*$ │ 0 │ 265 │ $180^\circ$ │
│ 3 │ 0 │ $d_3^*$ │ 0 │ 0 │
│ 4 │ $\theta_4^*$ │ 190 │ 0 │ 0 │
└───────┴──────────────┴──────────────┴──────────────┴──────────────┘
(* là các biến khớp điều khiển)
Ma trận biến đổi thuần nhất tổng quát $A_i$:
$$A_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 & -\cos\theta_i\sin\alpha_i & a_i\sin\theta_i \ 0 & \sin\alpha_i & \cos\alpha_i & d_i \ 0 & 0 & 0 & 1 \end{bmatrix}$$
1. Động học thuận (Forward Kinematics):
Vị trí điểm tác động cuối $(P_x, P_y, P_z)$ được xác định từ góc quay của các khớp:
$$P_x = L_1 \cos(\theta_1) + L_2 \cos(\theta_1 + \theta_2)$$
$$P_y = L_1 \sin(\theta_1) + L_2 \sin(\theta_1 + \theta_2)$$
$$P_z = d_1 - d_3 - d_4$$
$$\phi_{roll} = \theta_1 + \theta_2 + \theta_4$$
2. Động học nghịch (Inverse Kinematics):
Từ tọa độ mong muốn $(P_x, P_y, P_z, \phi)$, giá trị các biến khớp được giải thông qua phương pháp hình học:
$$\cos(\theta_2) = \frac{P_x^2 + P_y^2 - L_1^2 - L_2^2}{2 L_1 L_2} \implies \theta_2 = \text{atan2}\left(\pm\sqrt{1-\cos^2\theta_2}, \cos\theta_2\right)$$
$$\theta_1 = \text{atan2}(P_y, P_x) - \text{atan2}\left(L_2 \sin\theta_2, L_1 + L_2 \cos\theta_2\right)$$
$$d_3 = d_1 - d_4 - P_z$$
$$\theta_4 = \phi - \theta_1 - \theta_2$$
// Thuật toán tính toán Động học Nghịch trong PLC Q06H (Structured Text)
FUNCTION_BLOCK FB_SCARA_IK
VAR_INPUT
fTargetX : REAL; // Tọa độ X (mm)
fTargetY : REAL; // Tọa độ Y (mm)
fTargetZ : REAL; // Tọa độ Z (mm)
fTargetRoll : REAL; // Góc hướng (rad)
END_VAR
VAR_OUTPUT
fTheta1 : REAL; // Góc khớp 1 (rad)
fTheta2 : REAL; // Góc khớp 2 (rad)
fAxisZ_Pos : REAL; // Vị trí trục vít me Z (mm)
fTheta4 : REAL; // Góc xoay kẹp (rad)
bValid : BOOL; // Trạng thái nghiệm hợp lệ
END_VAR
VAR
fL1 : REAL := 325.0;
fL2 : REAL := 265.0;
fCosTheta2 : REAL;
fSinTheta2 : REAL;
END_VAR
// Tính góc Theta 2
fCosTheta2 := (EXPT(fTargetX, 2) + EXPT(fTargetY, 2) - EXPT(fL1, 2) - EXPT(fL2, 2)) / (2.0 * fL1 * fL2);
IF (fCosTheta2 >= -1.0) AND (fCosTheta2 <= 1.0) THEN
fSinTheta2 := SQRT(1.0 - EXPT(fCosTheta2, 2)); // Chọn nghiệm khuỷu tay dương (Elbow up)
fTheta2 := ATAN2(fSinTheta2, fCosTheta2);
// Tính góc Theta 1
fTheta1 := ATAN2(fTargetY, fTargetX) - ATAN2(fL2 * fSinTheta2, fL1 + fL2 * fCosTheta2);
// Tính trục tịnh tiến Z và góc hướng Yaw Theta 4
fAxisZ_Pos := 580.0 - 190.0 - fTargetZ;
fTheta4 := fTargetRoll - fTheta1 - fTheta2;
bValid := TRUE;
ELSE
bValid := FALSE; // Tọa độ nằm ngoài không gian công tác
END_IF;
Kiểm thử và Đánh giá hiệu năng
Hệ thống được vận hành kiểm thử liên tục trong 100 chu trình gắp - đặt liên tục với các tham số đo đạc qua đồng hồ so đồng tâm (Dial Indicator) và bộ ghi dữ liệu trục thời gian thực trên GX Works2.
ĐỒ THỊ HIỆU CHUẨN ĐỘ CHÍNH XÁC VỊ TRÍ (100 CHU TRÌNH GẮP)
┌─────────────────────────────────────────────────────────────┐
│ Sai lệch (mm) │
│ +0.05 ┤ * * * * * │
│ +0.02 ┤ * * * * * * * * * * * * │
│ 0.00 ┼─────────────────────────────────────────────────── │
│ -0.02 ┤ * * * * * * │
│ -0.05 ┤ │
│ └┬─────┬─────┬─────┬─────┬─────┬─────┬─────┬─────┬───>│
│ 10 20 30 40 50 60 70 80 90 100 │
│ Số chu trình thử nghiệm │
└─────────────────────────────────────────────────────────────┘
Bảng thông số hiệu năng thực tế đạt được
| Tiêu chuẩn đo lường |
Mục tiêu thiết kế ban đầu |
Kết quả thực nghiệm đạt được |
Mức độ hoàn thành |
| Thời gian 1 chu trình gắp/xếp |
$2.5\text{ s}$ |
$2.15\text{ s}$ |
$116%$ |
| Độ chính xác lặp lại trục X-Y |
$\pm 0.1\text{ mm}$ |
$\pm 0.042\text{ mm}$ |
$158%$ |
| Độ chính xác dừng trục Z (vít me) |
$\pm 0.05\text{ mm}$ |
$\pm 0.015\text{ mm}$ |
$170%$ |
| Tải trọng nâng tối đa an toàn |
$1.0\text{ kg}$ |
$1.25\text{ kg}$ (Ổn định không rung) |
$125%$ |
| Tỷ lệ nhận biết phôi qua cảm biến |
$99.0%$ |
$100%$ ($500/500\text{ lần}$) |
$100%$ |
| Độ trễ truyền thông SSCNET III/H |
$< 1.0\text{ ms}$ |
$0.888\text{ ms}$ |
$100%$ |
Đổi mới và Đóng góp kỹ thuật
- Ứng dụng đường truyền quang SSCNET III/H thay thế xung truyền thống:
Việc sử dụng mạng cáp quang tốc độ $150\text{ Mbps}$ giúp loại bỏ hoàn toàn hiện tượng suy hao và nhiễu sóng vuông trên đường truyền, giảm $75%$ số lượng dây nối trong tủ điện điều khiển, nâng cao khả năng đồng bộ đa trục với chu kỳ nội suy $0.888\text{ ms}$.
- Cấu trúc truyền động lai (Hybrid Transmission):
Kết hợp giữa trục vít me bước $10\text{ mm}$ chịu tải đứng và truyền động đai răng kép phân cấp cho các khớp quay ngang, giúp phân bố quán tính mô-men tối ưu lên trục động cơ, triệt tiêu hiện tượng văng quán tính khi quay đảo chiều ở vận tốc cao.
- Tích hợp giao diện vận hành linh hoạt Handy GOT & MPG:
Cho phép kỹ thuật viên có thể trực tiếp cầm HMI di động tiếp cận sát bàn máy để hiệu chỉnh từng điểm tọa độ (Jogging/Teaching) thông qua tay quay phát xung vi sai, giúp giảm $60%$ thời gian thiết lập vị trí ban đầu (Setup time) so với việc nhập tọa độ thủ công.
Ứng dụng thực tế và Triển khai sản xuất
Hệ thống cánh tay robot SCARA được thiết kế hướng tới việc tích hợp trực tiếp vào các dây chuyền sản xuất công nghiệp thực tế:
[Băng tải cấp liệu] ──> [Sensor E3Z-D61] ──> [Robot SCARA 4-DOF] ──> [Khay Pallet Thành phẩm]
│ │
└── [PLC Q06H Logic] ─┘
Phân tích tài chính và Hoàn vốn đầu tư (ROI Analysis)
Xét một bài toán thực tế tại phân xưởng đóng gói linh kiện nhựa với 2 ca làm việc/ngày:
- Chi phí thuê nhân công: 2 công nhân $\times 8,500,000\text{ VNĐ/tháng} = 17,000,000\text{ VNĐ/tháng}$ ($204,000,000\text{ VNĐ/năm}$).
- Tổng chi phí chế tạo & chuyển giao Robot: Khoảng $85,000,000\text{ VNĐ}$ (Bao gồm cơ khí, thiết bị PLC, Servo Mitsubishi và tủ điện).
- Chi phí vận hành & điện năng tiêu thụ: Khoảng $1,200,000\text{ VNĐ/tháng}$ ($14,400,000\text{ VNĐ/năm}$).
- Thời gian hoàn vốn (Payback Period):
$$\text{Thời gian hoàn vốn} = \frac{85,000,000}{204,000,000 - 14,400,000} \approx 0.448\text{ năm} \approx \mathbf{5.4\text{ tháng}}.$$
Hạn chế và Hướng phát triển
Hạn chế kỹ thuật hiện tại
- Khâu định vị phôi hoàn toàn phụ thuộc vào việc phôi chạm cữ chặn và kích hoạt cảm biến quang Omron, chưa thể gắp linh hoạt các phôi bị đặt lệch góc ngẫu nhiên trên băng tải.
- Tải trọng nâng bị giới hạn ở mức $\le 1.5\text{ kg}$ do tỷ số truyền và độ cứng vững uốn của cánh tay nhôm số 2 khi vươn xa tối đa.
Hướng nâng cấp và phát triển
- Tích hợp Camera xử lý ảnh công nghiệp (Machine Vision): Lắp đặt camera 2D trên trục khớp hoặc treo cố định phía trên băng tải, sử dụng thuật toán OpenCV/Cognex để nhận diện tọa độ tâm $(x, y)$ và góc xoay $\theta$ của vật thể đang di chuyển theo thời gian thực (Conveyor Tracking).
- Nâng cấp cảm biến an toàn khu vực (Safety Light Curtain / Laser Scanner): Tự động giảm tốc độ khi phát hiện con người bước vào bán kính làm việc $R = 600\text{ mm}$ của cánh tay và dừng khẩn cấp khi có nguy cơ va chạm.
- Kết nối IoT Công nghiệp (IIoT): Ứng dụng Module Ethernet QJ71E71-100 để đẩy dữ liệu sản lượng, trạng thái lỗi và nhiệt độ Driver lên máy chủ SCADA/Cloud thông qua giao thức OPC UA hoặc MQTT.
Đối tượng hưởng lợi từ đồ án
- Sinh viên & Nghiên cứu sinh: Làm tài liệu tham khảo thực nghiệm chuẩn xác về việc ứng dụng ma trận Denavit-Hartenberg trong điều khiển chuyển động thực tế; làm chủ phần cứng PLC Mitsubishi dòng Q cao cấp.
- Kỹ sư Tự động hóa & Lập trình viên: Nắm vững phương pháp cấu hình hệ thống Motion qua mạng cáp quang SSCNET III/H, kỹ thuật phối hợp nhiều trục Servo và phương pháp chống nhiễu trong tủ điện công nghiệp.
- Doanh nghiệp sản xuất vừa và nhỏ (SMEs): Tiếp cận mô hình tự động hóa gắp/xếp có chi phí đầu tư nội địa hóa chỉ bằng $30 - 40%$ so với việc nhập khẩu robot nguyên chiếc từ nước ngoài, thời gian thu hồi vốn ngắn dưới 6 tháng.
Câu hỏi thường gặp
1. Yêu cầu kỹ thuật về nguồn điện để hệ thống vận hành an toàn là gì?
Hệ thống sử dụng đồng thời nguồn điện xoay chiều $220\text{VAC}$ cho bộ nguồn PLC Q61P và chuyển đổi qua biến áp cách ly BSW-750ASE-21 ra $100\text{VAC}$ cung cấp cho các Driver Servo MR-J4. Hệ thống phải trang bị aptomat chống rò ELCB NV30-FA ($30\text{mA}$) và nối đất bảo vệ PE với điện trở tiếp địa $R_{PE} < 10\ \Omega$.
2. Ưu thế vượt trội của cáp quang SSCNET III/H so với điều khiển xung rời rạc là gì?
SSCNET III/H hoạt động trên nền tảng cáp quang bước sóng ngắn với tốc độ truyền dẫn $150\text{ Mbps}$ Full-Duplex. Mạng này triệt tiêu hoàn toàn hiện tượng suy hao tín hiệu xung, không bị ảnh hưởng bởi nhiễu điện từ từ các tải công suất lớn lân cận và có khả năng đọc/ghi thông số Servo (torque, position, alarm) theo thời gian thực.
3. Làm thế nào để mở rộng không gian làm việc khi vật thể ở xa hơn?
Có thể điều chỉnh độ dài khâu $L_1, L_2$ trong bản vẽ gia công cơ khí và cập nhật lại hằng số hình học trong khối hàm FB_SCARA_IK trên PLC. Ngoài ra, có thể lắp đặt toàn bộ cụm chân đế robot lên một trục trượt tuyến tính thứ 5 (Linear Axis) điều khiển bằng một Driver Servo mở rộng trên cổng quang còn lại của module QD75MH4.
4. Quy trình hiệu chuẩn điểm Home (Về gốc) của 4 trục diễn ra như thế nào?
Module QD75MH4 hỗ trợ nhiều phương pháp về gốc: Dự án sử dụng phương pháp cảm biến tiệm cận kết hợp xung Z-phase của Encoder Servo (Proximity Dog Method). Khi nhấn Home trên HMI, các trục di chuyển với tốc độ Home Speed đến khi chạm cữ, sau đó giảm tốc tìm xung Z đầu tiên từ encoder 22-bit để xác lập tọa độ tuyệt đối $0.000\text{ mm}$.
5. Chi phí bảo dưỡng và tuổi thọ vận hành ước tính của hệ thống ra sao?
Các động cơ HG-KR là dòng AC Servo không chổi than, tuổi thọ vòng bi đạt trên $20,000\text{ giờ}$ hoạt động liên tục. Định kỳ sau mỗi $2,500\text{ giờ}$ vận hành chỉ cần kiểm tra độ chùng dây curoa truyền động và bôi trơn mỡ chuyên dụng cho trục vít me bi.
Kết luận
Đồ án "Chế tạo cánh tay robot trong công nghiệp gắp và xếp vật" đã hiện thực hóa thành công một hệ thống SCARA Robot 4-DOF đạt đầy đủ các tiêu chuẩn kỹ thuật công nghiệp khắt khe. Dự án không chỉ dừng lại ở mô hình lý thuyết mà đã giải quyết trọn vẹn chuỗi liên kết từ tính toán cơ học chính xác, giải thuật động học ngược thời gian thực đến tích hợp điều khiển mạng cáp quang tốc độ cao. Kết quả thực nghiệm với độ lặp lại $\pm 0.042\text{ mm}$ và chu kỳ hoạt động $2.15\text{ s}$ là minh chứng rõ ràng cho tính khả thi, độ tin cậy và tiềm năng ứng dụng to lớn của đề tài trong việc tự động hóa các dây chuyền sản xuất hiện đại tại Việt Nam.
