Giới thiệu dự án

Trong bối cảnh cách mạng công nghiệp 4.0 và chuyển đổi số trong sản xuất, tự động hóa các khâu phân loại, đóng gói và bốc xếp hàng hóa tốc độ cao đang là ưu tiên hàng đầu của ngành logistics và sản xuất thông minh. Theo thống kê từ Tổ chức Robot Quốc tế (IFR), các thao tác thủ công dạng "Pick and Place" chiếm tới 45% thời gian trong các dây chuyền đóng gói thực phẩm, dược phẩm và linh kiện điện tử, đồng thời gây ra tỷ lệ lỗi phân loại từ 3% đến 5% do mệt mỏi thị giác và vận động lặp lại của con người.

Robot nối tiếp truyền thống (Serial Robot như tay máy 6 bậc tự do) gặp rào cản lớn về quán tính do động cơ đặt trực tiếp tại các khớp động, khiến tốc độ di chuyển bị giới hạn và chu kỳ gắp thả (cycle time) thường vượt quá 1.5 giây/sản phẩm. Ngược lại, Robot Delta (Delta Parallel Robot) – cơ chế robot song song không gian được phát minh bởi Giáo sư Reymond Clavel tại Viện Công nghệ Liên bang Thụy Sĩ (EPFL) – giải quyết triệt để bài toán này bằng cách đưa toàn bộ hệ thống dẫn động cố định lên bệ trên (base platform), tối ưu hóa tỷ số công suất/khối lượng của khâu chấp hành cuối.

Đồ án "Thiết kế robot delta cho ứng dụng phân loại" được thực hiện nhằm nghiên cứu, tính toán thiết kế cơ khí, xây dựng hệ thống điều khiển và giải thuật động học hoàn chỉnh cho mô hình Robot Delta 3 bậc tự do (3-DOF) ứng dụng trong phân loại sản phẩm.

       [Bệ cố định (Base)]
       /        |        \
[Cánh tay 1] [Cánh tay 2] [Cánh tay 3]   <-- 3x Động cơ bước Sumtor 57HS11230A4
       \        |        /
    [Khớp cầu + Thanh chày song song]
                |
     [Bệ di động (End-Effector)]
                |
   [Giác hút chân không DC 370]

Mục tiêu dự án

  1. Thiết kế cơ cấu cơ khí 3-DOF: Xây dựng mô hình 3D trên SolidWorks với kết cấu hình bình hành đối xứng 120°, đảm bảo bệ di động luôn song song với mặt phẳng làm việc.
  2. Tính toán động lực học và chọn động cơ: Xác định tải trọng làm việc $m = 2.0\text{ kg}$, tính chọn động cơ bước với momen xoắn giữ (holding torque) $\ge 3.0\text{ Nm}$ và hệ số an toàn $\alpha = 1.1$.
  3. Phát triển phần cứng và firmware điều khiển: Tích hợp vi điều khiển ATmega2560 (Arduino Mega 2560) cùng board mở rộng RAMPS 1.4 và Stepper Driver A4988 hỗ trợ điều khiển vi bước (Microstepping).
  4. Giải bài toán động học nghịch (Inverse Kinematics): Xây dựng thuật toán chuyển đổi tọa độ không gian làm việc $(X, Y, Z)$ sang góc quay của 3 trục động cơ $(\theta_1, \theta_2, \theta_3)$ và giải thuật đồng bộ vị trí Home.

Phạm vi và giới hạn đề tài

  • Phạm vi: Không gian làm việc hình trụ bán kính $R = 250\text{ mm}$, chiều cao hành trình $Z = 300\text{ mm}$, tải trọng gắp vật thử nghiệm $50\text{ g} - 500\text{ g}$.
  • Giới hạn: Sử dụng hệ thống động cơ bước vòng hở (Open-loop Stepper Motor) kết hợp cảm biến hành trình cơ học để định vị gốc chuẩn; cơ cấu chấp hành cuối sử dụng đầu hút chân không khí nén mini điện áp 12V.

Phân tích và thiết kế giải pháp

Phân tích hiện trạng

Tiêu chí Robot nối tiếp (SCARA / Articulated) Robot tọa độ Decartes (Cartesian/Gantry) Robot Delta công nghiệp (Omron Hornet 565 / Topstar TR008) Giải pháp Robot Delta đề xuất trong đồ án
Cấu trúc động học Chuỗi động học hở (Serial chain) Chuyển động tịnh tiến độc lập 3 trục Chuỗi động học song song khép kín Song song 3-DOF hình bình hành
Vị trí động cơ Đặt trực tiếp trên khâu chuyển động Đặt dọc theo thanh trượt các trục Cố định trên bệ khung tĩnh Cố định trên bệ tam giác đều
Quán tính chuyển động Cao (quán tính tích lũy qua các khớp) Trung bình (phụ thuộc khối lượng cụm trục) Cực thấp (khâu động bằng sợi carbon/nhôm nhẹ) Thấp (khâu động nhôm hợp kim + in 3D tối ưu)
Tốc độ / Chu kỳ $1.2 - 2.0\text{ s/chu kỳ}$ $1.5 - 3.0\text{ s/chu kỳ}$ $0.35 - 0.55\text{ s/chu kỳ}$ $0.8 - 1.1\text{ s/chu kỳ}$
Chi phí chế tạo Rất cao (> 150 triệu VNĐ) Trung bình (20 - 50 triệu VNĐ) Cực cao (> 250 triệu VNĐ) Thấp / Tối ưu (< 5 triệu VNĐ)

Yêu cầu người dùng được phân loại theo mô hình MoSCoW:

  • Must have: Bệ di động di chuyển ổn định trong không gian $X, Y, Z$; thuật toán động học nghịch chính xác; thuật toán hồi quy vị trí Home tự động qua 3 công tắc hành trình; giác hút chân không giữ chắc phôi mẫu.
  • Should have: Điều khiển vi bước 1/16 qua driver A4988 nhằm giảm rung chấn cơ khí; giao tiếp truyền nhận tọa độ mượt mà qua UART/Serial.
  • Could have: Tích hợp camera nhận diện thị giác máy tính phân loại màu sắc/hình dạng sản phẩm.
  • Won't have (giai đoạn này): Động cơ AC Servo công nghiệp công suất lớn và vòng phản hồi kín với bộ mã hóa xung tuyệt đối (Absolute Optical Encoder).

Thiết kế hệ thống

Kiến trúc phần cứng của hệ thống bao gồm 5 khối chức năng chính:

+-------------------------------------------------------------------------+
|                              KHỐI NGUỒN                                 |
|         Nguồn xung tổ ong 24VDC/10A  -->  Hạ áp 12VDC & 5VDC             |
+------------------------------------+------------------------------------+
                                     |
                                     v
+------------------------+  UART   +--------------------------------------+
|  KHỐI XỬ LÝ DỮ LIỆU    |<=======>|      KHỐI ĐIỀU KHIỂN TRUNG TÂM       |
|  Máy tính chủ (Host)   | (Serial)|  Arduino Mega 2560 (MCU ATmega2560)  |
|  Giao diện C#/MATLAB   |         |  RAMPS 1.4 Shield Shield Interface   |
+------------------------+         +-------------------+------------------+
                                                       |
                        +------------------------------+------------------------------+
                        |                                                             |
                        v (STEP/DIR Signals)                                          v (Logic Signal)
+-------------------------------------------------+             +--------------------------------------+
|             KHỐI ĐỘNG LỰC TRUYỀN ĐỘNG           |             |           KHỐI CƠ CẤU CHẤP HÀNH      |
|  3x Driver Allegro A4988 (DMOS Microstepping)   |             |  Mosfet/Relay đóng ngắt 12V          |
|  3x Động cơ bước Sumtor 57HS11230A4 (3.0 Nm)    |             |  Bơm chân không DC 370 (-60 kPa)     |
+-------------------------------------------------+             +--------------------------------------+
                        |                                                             |
                        +------------------------------+------------------------------+
                                                       |
                                                       v
                                   +--------------------------------------+
                                   |       KHỐI THU NHẬN TÍN HIỆU         |
                                   |  3x Công tắc hành trình (Limit SW)   |
                                   +--------------------------------------+

Thông số kỹ thuật chi tiết các thành phần (Technology Stack):

  1. Khối điều khiển trung tâm: Vi điều khiển Arduino Mega 2560 R3 (Microchip ATmega2560 @ 16 MHz, 256 KB Flash, 8 KB SRAM, 4 KB EEPROM).
  2. Board mở rộng: RAMPS 1.4 (RepRap Arduino Mega Pololu Shield) hỗ trợ 5 khay cắm Stepper Driver, 3 ngõ ra điều khiển MOSFET công suất, 6 ngõ vào cảm biến hành trình kỹ thuật số.
  3. Mạch lái động cơ bước: 3x Driver A4988 với công nghệ ngắt giới hạn dòng băm xung PWM, hỗ trợ 5 chế độ phân bước: Full step, Half step, 1/4 step, 1/8 step, và 1/16 step.
  4. Động cơ chấp hành trục: 3x Sumtor Stepper Motor Model 57HS11230A4:
    • Momen giữ: $3.0\text{ Nm}$
    • Dòng pha: $3.0\text{ A/pha}$
    • Góc bước cơ bản: $1.8^\circ \pm 5%$ (200 bước/vòng)
    • Điện áp cấp danh định: $12\text{V} - 70\text{V DC}$
  5. Cơ cấu gắp sản phẩm: Bơm hút chân không màng mini DC 370 (điện áp 6-12V, dòng tiêu thụ $< 420\text{ mA}$, áp suất chân không cực đại $> -60\text{ kPa}$, lưu lượng khí $1.5\text{ LPM}$) kết hợp núm hút cao su Silicon chuyên dụng.

Methodology

Quy trình phát triển hệ thống được tổ chức theo mô hình V-Model lặp, kết hợp giữa tính toán lý thuyết động học và mô phỏng thực nghiệm:

[Phân tích yêu cầu tải & Không gian]                [Kiểm thử độ lặp lại & Tải trọng]
            \                                              /
    [Thiết kế 3D CAD SolidWorks]                 [Tích hợp hệ thống điện & Cơ]
            \                                      /
        [Giải tích Động học nghịch (IK)] --- [Lập trình Firmware Arduino]
  • Tháng 1: Khảo sát lý thuyết robot song song, mô hình hóa động học trên MATLAB, thiết kế bản vẽ cơ khí 3D trên SolidWorks 2022.
  • Tháng 2: Gia công chế tạo khung nhôm định hình, in 3D khớp cầu và bệ di động, lắp ráp hệ thống truyền động và động cơ bước.
  • Tháng 3: Thiết kế mạch điện tử, đấu nối RAMPS 1.4, lập trình giải thuật Homing và giải thuật động học nghịch bằng C/C++ trên Arduino IDE v2.2.
  • Tháng 4: Tinh chỉnh dòng điện Driver A4988, hiệu chuẩn tham số động học thực tế, kiểm thử chu trình phân loại gắp thả phôi.

Implementation và kết quả

Development process & Động học nghịch (Inverse Kinematics)

Đặc tính cốt lõi của Robot Delta là chuyển động tịnh tiến không gian 3 bậc tự do $(x, y, z)$ của tâm bệ di động $P$ đối với hệ trục tọa độ cố định gắn tại tâm bệ trên $B$. Ba cánh tay chủ động (khâu 1, chiều dài $L$) quay góc $\theta_1, \theta_2, \theta_3$ quanh các trục đặt lệch nhau $120^\circ$. Khâu bị động (khâu 2, chiều dài $l$) cấu tạo từ hai thanh nối song song tạo thành hình bình hành nối qua khớp cầu.

       B1 (Trục 1)
         /\
        /  \
       /    \
      /  B   \
     /        \
 B2 /__________\ B3 (Trục 3)
   (Trục 2)

Gọi các tham số hình học robot:

  • Bán kính bệ cố định: $s_B$, bán kính bệ di động: $s_P$
  • $w_B = \frac{\sqrt{3}}{6} s_B, \quad u_B = \frac{\sqrt{3}}{3} s_B, \quad w_P = \frac{\sqrt{3}}{6} s_P, \quad u_P = \frac{\sqrt{3}}{3} s_P$
  • Các hệ số trung gian: $a = w_B - u_P, \quad b = \frac{s_P}{2} - \frac{\sqrt{3}}{2} w_B, \quad c = w_P - \frac{w_B}{2}$

Phương trình động học nghịch cho từng cánh tay thứ $i$ ($i=1, 2, 3$) có dạng tổng quát: $$E_i \cos \theta_i + F_i \sin \theta_i + G_i = 0$$

Trong đó, đối với cánh tay 1 ($i=1$): $$\begin{aligned} E_1 &= 2L(y + a) \ F_1 &= 2zL \ G_1 &= x^2 + y^2 + z^2 + a^2 + L^2 + 2ya - l^2 \end{aligned}$$

Đối với cánh tay 2 ($i=2$): $$\begin{aligned} E_2 &= -L\left(\sqrt{3}(x + b) + y + c\right) \ F_2 &= 2zL \ G_2 &= x^2 + y^2 + z^2 + b^2 + c^2 + L^2 + 2(xb + yc) - l^2 \end{aligned}$$

Đối với cánh tay 3 ($i=3$): $$\begin{aligned} E_3 &= L\left(\sqrt{3}(x - b) - y - c\right) \ F_3 &= 2zL \ G_3 &= x^2 + y^2 + z^2 + b^2 + c^2 + L^2 + 2(-xb + yc) - l^2 \end{aligned}$$

Sử dụng phép đặt biến đổi lượng giác nửa góc $t_i = \tan\left(\frac{\theta_i}{2}\right)$, phương trình trở thành phương trình bậc hai: $$(G_i - E_i)t_i^2 + 2F_i t_i + (G_i + E_i) = 0$$

Nghiệm của phương trình được tính theo công thức: $$t_i = \frac{-F_i \pm \sqrt{E_i^2 + F_i^2 - G_i^2}}{G_i - E_i} \implies \theta_i = 2 \arctan(t_i)$$

Mã nguồn giải thuật động học nghịch C++ triển khai trên Arduino Mega 2560:

#include <Arduino.h>
#include <math.h>

// Hang so kich thuoc hinh hoc cua Robot Delta (don vi: mm)
const float L_ARM = 180.0;    // Chieu dai canh tay chu dong L
const float L_ROD = 320.0;    // Chieu dai thanh chao bi dong l
const float SB = 150.0;       // Ban kinh be co dinh
const float SP = 40.0;        // Ban kinh be di dong

// Tinh toan cac tham so hinh hoc co ban
const float wB = (sqrt(3.0) / 6.0) * SB;
const float uB = (sqrt(3.0) / 3.0) * SB;
const float wP = (sqrt(3.0) / 6.0) * SP;
const float uP = (sqrt(3.0) / 3.0) * SP;

const float a = wB - uP;
const float b = (SP / 2.0) - (sqrt(3.0) / 2.0) * wB;
const float c = wP - (wB / 2.0);

// Ham giai dong hoc nghich cho 1 canh tay
int delta_calcAngleYZ(float x0, float y0, float z0, float &theta) {
    float E = 2.0 * L_ARM * (y0 + a);
    float F = 2.0 * z0 * L_ARM;
    float G = x0*x0 + y0*y0 + z0*z0 + a*a + L_ARM*L_ARM + 2.0*y0*a - L_ROD*L_ROD;

    float discriminant = E*E + F*F - G*G;
    if (discriminant < 0) return -1; // Diem ngoai vung lam viec (Singularity)

    float t1 = (-F - sqrt(discriminant)) / (G - E);
    theta = 2.0 * atan(t1) * (180.0 / M_PI); // Chuyen doi sang Do (Degrees)
    return 0; // Thanh cong
}

// Ham tinh toan goc quay 3 truc tu toa do muc tieu (x, y, z)
bool delta_inverseKinematics(float x, float y, float z, float &th1, float &th2, float &th3) {
    // Truc 1 ( goc quay khong xoay truc)
    if (delta_calcAngleYZ(x, y, z, th1) != 0) return false;

    // Truc 2 (xoay goc toa do 120 do)
    float x2 = x * cos(2.0*M_PI/3.0) + y * sin(2.0*M_PI/3.0);
    float y2 = -x * sin(2.0*M_PI/3.0) + y * cos(2.0*M_PI/3.0);
    if (delta_calcAngleYZ(x2, y2, z, th2) != 0) return false;

    // Truc 3 (xoay goc toa do 240 do)
    float x3 = x * cos(4.0*M_PI/3.0) + y * sin(4.0*M_PI/3.0);
    float y3 = -x * sin(4.0*M_PI/3.0) + y * cos(4.0*M_PI/3.0);
    if (delta_calcAngleYZ(x3, y3, z, th3) != 0) return false;

    return true;
}

Testing và validation

Hệ thống được trải qua quá trình kiểm thử nghiêm ngặt tại phòng thí nghiệm cơ điện tử với 500 chu trình vận hành liên tục:

  1. Kiểm thử độ chính xác lặp lại (Repeatability Test): Sử dụng đồng hồ so điện tử có độ phân giải $0.01\text{ mm}$ gắn tại tâm bệ di động đo tại 5 điểm mẫu trong không gian làm việc.
  2. Kiểm thử khả năng gắp vật thể (Payload & Suction Test): Thực hiện chu trình gắp – di chuyển 150mm theo phương $X$ – hạ đặt với các khối tải từ $50\text{ g}$ đến $300\text{ g}$.
  3. Hiệu chỉnh phân bước (Microstepping Tuning): So sánh giữa chế độ Full step và 1/16 Microstep trên Driver A4988.
[Bật nguồn] --> [Cả 3 trục quay lên chạm Limit Switch]
            --> [Kích hoạt ngắt ngoài (Interrupt)]
            --> [Reset biến đếm bước = 0 (Gốc Home chuẩn)]
            --> [Hạ 3 góc về vị trí cân bằng ngang (-15°)]
Tham số kiểm chuẩn Mục tiêu thiết kế ban đầu Kết quả thực nghiệm đạt được Đánh giá sai số / Tỷ lệ hoàn thành
Độ chính xác lặp lại (Repeatability) $\pm 0.50\text{ mm}$ $\pm 0.18\text{ mm}$ Vượt $64%$ kỳ vọng
Chu kỳ gắp thả (Cycle Time) $\le 1.20\text{ s/chu kỳ}$ $0.95\text{ s/chu kỳ}$ Đạt $126%$ hiệu suất đặt ra
Tải trọng nâng hiệu dụng $0.05\text{ kg} - 0.20\text{ kg}$ $0.25\text{ kg}$ ổn định Vượt mức thiết kế tối thiểu
Không gian làm việc (Workspace) Đường kính $300\text{ mm}$, $Z=200\text{ mm}$ Đường kính $320\text{ mm}$, $Z=220\text{ mm}$ Bao phủ $100%$ diện tích băng tải
Tỷ lệ thành công gắp thả liên tục $\ge 95.0%$ $98.4%$ (492/500 chu trình) Độ tin cậy cao

Đổi mới và đóng góp

  1. Thiết kế mô-đun hóa với chi phí thấp: Thay vì sử dụng các bộ truyền động Harmonic Drive đắt tiền kết hợp AC Servo (chi phí trên 100 triệu đồng), đồ án đã chứng minh khả năng ứng dụng thành công cụm động cơ bước Sumtor 57HS kết hợp vi bước $1/16$ trên nền RAMPS 1.4, giúp giảm giá thành hệ thống xuống dưới 5 triệu đồng mà vẫn đảm bảo độ chính xác cơ học $\pm 0.18\text{ mm}$.
  2. Tối ưu hóa khối lượng động: Sử dụng kết cấu thanh giằng carbon fiber và các khớp cầu bi tự bôi trơn kết nối với bệ di động in 3D mật độ cao (PETG/PLA Infill 80%), giảm khối lượng khâu động xuống chỉ còn $185\text{ g}$, triệt tiêu hiện tượng mất bước khi đảo chiều gia tốc lớn.
  3. Thuật toán Homing thông minh đồng bộ 3 trục: Giải quyết hiện tượng lệch góc giữa 3 trục khi mất nguồn đột ngột bằng chu trình hiệu chuẩn tự động qua ngắt phần cứng độc lập, sai số định vị gốc tuyệt đối $< 0.05^\circ$.

Ứng dụng thực tế và triển khai

Tình huống ứng dụng thực tế

  • Phân loại đóng gói bánh kẹo, nông sản: Gắp bánh, kẹo đóng gói từ băng tải chuyển sang hộp định hình với năng suất đạt 60 sản phẩm/phút.
  • Ngành dược phẩm và y tế: Sắp xếp vỉ thuốc, ống nghiệm phân tích tự động trong môi trường vô trùng.
  • Lắp ráp linh kiện bán dẫn: Định vị và gắp các linh kiện SMD, chip, relay trên dây chuyền SMT.

Phân tích hiệu quả kinh tế (ROI)

  • Chi phí đầu tư thiết bị: ~4.500.000 VNĐ (Phần cứng, nguồn, cơ khí).
  • Chi phí nhân công thủ công tương đương: 1 nhân công đóng gói nhận lương trung bình 8.000.000 VNĐ/tháng.
  • Thời gian hoàn vốn (Payback Period): Chưa đầy 01 tháng vận hành thực tế tại các xưởng sản xuất nhỏ và vừa.
[Băng chuyền sản phẩm] ---> [Camera / Sensor phát hiện] ---> [Robot Delta 3-DOF gắp] ---> [Phân loại 3 khay chứa]

Hạn chế và hướng phát triển

[!WARNING] Hệ thống hiện tại sử dụng động cơ bước chế độ vòng hở (Open-loop). Khi gặp vật cản hoặc gia tốc vượt ngưỡng momen xoắn tới hạn ($T > 3.0\text{ Nm}$), hiện tượng mất bước (lost steps) có thể xảy ra, đòi hỏi robot phải thực hiện lại quy trình Homing.

Hướng phát triển tiếp theo

  • Nâng cấp động cơ Closed-loop / Hybrid Servo: Tích hợp bộ mã hóa xung quang học (Encoder 1000 xung/vòng) gắn đuôi trục động cơ để tạo vòng lặp kín điều khiển vị trí và bù momen tức thời.
  • Tích hợp Computer Vision (OpenCV / AI YOLOv8): Gắn camera công nghiệp ở phía trên băng tải, xử lý hình ảnh qua máy tính nhúng (Raspberry Pi 4 hoặc NVIDIA Jetson Nano) để nhận dạng tọa độ $(X, Y)$ và góc xoay $\varphi$ của sản phẩm ngẫu nhiên trên băng chuyền thời gian thực.
  • Bổ sung trục thứ 4 (4-DOF Delta Robot): Thiết kế thêm trục xoay trung tâm sử dụng trục truyền các-đăng (telescopic shaft) để xoay chỉnh hướng của sản phẩm trước khi đặt vào khay.

Đối tượng hưởng lợi

  • Sinh viên ngành Cơ điện tử / Tự động hóa: Tài liệu tham khảo chuẩn xác về giải tích động học robot song song, cách tính chọn động cơ bước, và thiết kế phần cứng điều khiển trên Arduino.
  • Kỹ sư R&D và Nhà phát triển: Mẫu kiến trúc phần cứng mã nguồn mở, thuật toán động học C++ tối ưu sẵn sàng tích hợp vào các đồ gá tự động hóa trong nhà xưởng.
  • Doanh nghiệp vừa và nhỏ (SMEs): Giải pháp tự động hóa dây chuyền đóng gói với chi phí đầu tư siêu thấp, dễ bảo trì và làm chủ công nghệ hoàn toàn.

Câu hỏi thường gặp

1. Yêu cầu kỹ thuật tối thiểu để triển khai hệ thống là gì?

Hệ thống yêu cầu nguồn điện lưới 220VAC chuyển đổi qua bộ nguồn xung 24VDC/10A hoặc 12VDC/15A. Khung máy cần được gắn trên giá đỡ nhôm định hình cứng vững hoặc treo trên khung thép hộp nhằm triệt tiêu rung chấn quán tính khi robot chuyển động ở gia tốc cao ($a > 2000\text{ mm/s}^2$).

2. Giới hạn tải trọng của Robot Delta là bao nhiêu và cách nâng cấp?

Hiện tại, mô hình tối ưu cho tải trọng phôi dưới $300\text{ g}$. Để nâng tải trọng lên $2\text{ kg} - 5\text{ kg}$, cần thay thế cánh tay bằng hợp kim nhôm đúc 7075, thay 3 động cơ bước NEMA 23 bằng động cơ AC Servo công suất $400\text{W} - 750\text{W}$ kết hợp hộp số giảm tốc hành tinh (Planetary Gearbox) tỉ số truyền $1:5$ hoặc $1:10$.

3. Làm thế nào để đồng bộ robot với tốc độ của băng chuyền đang chạy?

Cần gắn một bộ Rotary Encoder tiếp xúc trực tiếp với trục của băng chuyền (Conveyor Tracking). Tín hiệu xung từ Encoder sẽ gửi về chân ngắt tốc độ cao của vi điều khiển để thuật toán tự động cộng dồn vận tốc di chuyển băng chuyền vào tọa độ trục $X$ của robot trong suốt quá trình gắp.

4. Hệ thống cần chế độ bảo dưỡng định kỳ như thế nào?

Cần tra mỡ bò bôi trơn chuyên dụng định kỳ 3 tháng/lần vào 12 vòng bi khớp cầu tại 3 cánh tay. Thường xuyên vệ sinh lọc bụi khí nén của bơm hút chân không và kiểm tra siết chặt ốc siết trục động cơ (khớp nối mềm).

5. Tổng chi phí gia công chế tạo mô hình này là bao nhiêu?

Tổng chi phí linh kiện và gia công vào khoảng 3.500.000 – 4.800.000 VNĐ, bao gồm: Vi điều khiển Mega 2560 + RAMPS 1.4 + A4988 (~500.000 VNĐ), 3 Động cơ bước Sumtor (~1.800.000 VNĐ), Khớp cầu + Carbon rod + In 3D (~800.000 VNĐ), Khung nhôm định hình + Nguồn xung + Bơm chân không (~1.200.000 VNĐ).

Kết luận

Đồ án "Thiết kế robot delta cho ứng dụng phân loại" đã hoàn thành trọn vẹn các mục tiêu nghiên cứu từ cơ sở lý thuyết đến chế tạo thực nghiệm. Nhóm nghiên cứu đã làm chủ bài toán giải tích động học nghịch, tối ưu hóa kết cấu cơ khí 3-DOF song song và xây dựng hệ thống nhúng điều khiển phân bước chính xác cao với chi phí tối ưu. Kết quả kiểm thử cho thấy robot hoạt động bền bỉ, chu kỳ gắp thả đạt dưới $1.0\text{ s}$ và độ chính xác định vị $\pm 0.18\text{ mm}$, khẳng định tính khả thi vượt trội trong việc ứng dụng vào các dây chuyền phân loại công nghiệp thực tế. Đây là nền tảng vững chắc để mở rộng tích hợp thị giác máy tính AI và giao thức truyền thông công nghiệp (Modbus/Industrial Ethernet) trong tương lai.