Giới thiệu dự án

Trong bối cảnh cách mạng công nghiệp 4.0 và xu hướng tự động hóa dây chuyền sản xuất tăng trưởng với tốc độ CAGR hơn 9.5% giai đoạn 2020–2026, nhu cầu phân loại, đóng gói và gắp thả sản phẩm tốc độ cao trong các ngành công nghiệp thực phẩm, dược phẩm, dệt may và linh kiện điện tử trở nên vô cùng cấp thiết. Theo các báo cáo từ Liên đoàn Robot Quốc tế (IFR), các dòng cánh tay robot nối tiếp (Serial Manipulators) truyền thống thường bị giới hạn về gia tốc và chu kỳ gắp do quán tính lớn từ động cơ đặt trực tiếp tại các khớp động. Ngược lại, cơ cấu robot song song (Parallel Delta Robot) với các động cơ gắn cố định trên khung tĩnh cho phép giảm thiểu quán tính khâu tác động cuối (End-Effector), đạt gia tốc làm việc lên tới $10\text{G} - 12\text{G}$ trong môi trường công nghiệp.

Đồ án tốt nghiệp kỹ sư Cơ điện tử thực hiện nghiên cứu, thiết kế và chế tạo hoàn chỉnh hệ thống Robot Delta 3 bậc tự do (3-RUS / 3-RRR) kết hợp thị giác máy tính (Machine Vision) và cảm biến Encoder để gắp thả vật thể chuyển động trên băng chuyền tốc độ cao.

graph TD
    A[Camera quan sát] -->|Khung hình ảnh| B[Máy tính CPU / Giao diện C#]
    C[Rotary Encoder] -->|Xung vận tốc & quãng đường| B
    B -->|Xử lý ảnh HSV & Biên dịch G-code| B
    B -->|Tọa độ đón bắt / G-code qua UART| D[Bộ điều khiển Arduino Mega 2560]
    E[Bộ điều khiển cầm tay Pendant] <-->|Giao tiếp song song| D
    D -->|Timer ISR Step/Dir| F[Shield RAMPS 1.4 + Driver A4988]
    F -->|Dẫn động tỉ số 1:3 GT2| G[3x Động cơ bước NEMA 17]
    G --> H[Cơ cấu tay quay - Khớp cầu - Bàn di động]
    D -->|Kích Relay quang ly| I[Bơm hút chân không & Van xả khí nén]
    I --> J[Giác hút cao su End-Effector]

Mục tiêu kỹ thuật của dự án:

  1. Thiết kế cơ khí và mô hình hóa: Tính toán bậc tự do theo tiêu chuẩn Kutzbach ($M = 3$), thiết kế khung nhôm định hình tam giác đều, hệ thống 3 cánh tay chủ động dẫn động qua bộ truyền đai răng GT2 tỉ số 1:3, liên kết 6 thanh truyền carbon và 12 khớp cầu (Ball-joints).
  2. Xây dựng giải thuật Động học: Giải quyết chính xác bài toán động học thuận (Forward Kinematics) bằng phương pháp giao điểm 3 mặt cầu và bài toán động học ngược (Inverse Kinematics) bằng phương pháp hình học không gian khép kín để ánh xạ tọa độ Descartes $(X, Y, Z)$ sang góc quay khớp $(\theta_1, \theta_2, \theta_3)$.
  3. Phát triển Firmware nhúng điều khiển thời gian thực: Xây dựng phần mềm nhúng trên vi điều khiển ATmega2560 (16 MHz) sử dụng ngắt Timer (Timer Interrupt Service Routine) điều khiển đồng bộ 3 động cơ bước (NEMA 17) nội suy đường thẳng, hỗ trợ tập lệnh G-code chuẩn công nghiệp.
  4. Xây dựng phần mềm giám sát và Xử lý ảnh (PC Vision): Lập trình ứng dụng trên nền tảng .NET/C# tích hợp thư viện xử lý ảnh chuyển đổi không gian màu HSV, trích xuất tọa độ trọng tâm $(x_c, y_c)$ của vật thể, đồng bộ tốc độ băng chuyền qua Encoder để tính toán điểm đón bắt động (Dynamic Tracking Pick-and-Place).
  5. Thiết kế thiết bị dạy học / Bàn điều khiển cầm tay (Teach Pendant): Chế tạo Controller độc lập với màn hình LCD 2004, phím điều hướng và biến trở số để vận hành chế độ Manual Jogging và Home trực tiếp.

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

  • Tải trọng thao tác (Payload): 50g – 200g (phù hợp với bao bì bánh kẹo, linh kiện điện tử nhỏ, nắp chai).
  • Vùng làm việc (Workspace): Hình trụ đường kính $D = 250\text{ mm}$, chiều cao $H = 150\text{ mm}$.
  • Cơ cấu gắp: Đầu hút chân không cao su (Vacuum Suction Cup) tích hợp van xả khí nhanh bằng relay quang cách ly (Optocoupler).

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 Robot cánh tay nối tiếp (Articulated 6-DOF) Robot SCARA (4-DOF) Robot Delta 3-RUS (Giải pháp đề tài)
Vị trí động cơ Đặt tại từng khớp (quán tính lớn) Khớp 1-2 trên đế, trục Z di động 100% đặt trên đế tĩnh (quán tính khâu động cực nhỏ)
Tốc độ gắp thả 30 - 50 chu kỳ/phút 60 - 90 chu kỳ/phút 100 - 150 chu kỳ/phút
Độ cứng vững Giảm dần theo tầm với cánh tay Khá cao trên mặt phẳng ngang Oxy Rất cao do kết cấu vòng kín hình bình hành
Chi phí chế tạo Rất cao (> 80 - 150 triệu VNĐ) Trung bình (> 40 - 70 triệu VNĐ) Thấp (< 10 triệu VNĐ với linh kiện mô-đun hóa)
Bảo trì & Thay thế Phức tạp, phụ thuộc nhà sản xuất Trung bình Cực kỳ dễ dàng (In 3D, nhôm định hình, Arduino)

Ưu tiên 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 ngược giải nhanh dưới 2ms; điều khiển đồng thì 3 trục bằng Timer; giao thức kết nối USB Serial handshake IsDelta $\to$ YesDelta; xử lý ảnh nhận diện vật thể màu sắc qua HSV.
  • Should-have (Cần có): Bộ biên dịch G-code mở rộng (hỗ trợ lệnh điều kiện IF, vòng lặp GOTO, biến nhớ #100); van xả khí đảo chiều để triệt tiêu chân không tức thì; Teach Pendant điều khiển bằng tay.
  • Could-have (Nên có): Dự đoán vận tốc băng tải phi tuyến; mô phỏng 3D quỹ đạo thời gian thực trên GUI.
  • Won't-have (Chưa triển khai): Trục xoay thứ 4 ($W$ axis) định hướng góc xoay vật thể; tích hợp mạng truyền thông công nghiệp CANopen/EtherCAT.

Thiết kế hệ thống

classDiagram
    class GcodeProgramManager {
        +List~GcodeProgram~ items
        +CreateNewFile(string fileName)
        +DeleteFile(string fileName)
        +LoadToEditor(string path)
    }
    class GcodeCompiler {
        +Compile(string rawGcode) string
        +EvaluateExpression(string exp) double
        +ProcessBranching(string condition) bool
    }
    class VisionProcessor {
        +Mat sourceFrame
        +ApplyHSVFilter(Scalar min, Scalar max) Mat
        +ExtractContours() List~Point2f~
        +TransformToRobotCoord(Point2f cameraPoint, double beltSpeed) Point3f
    }
    class SerialCommunication {
        +PortName string
        +BaudRate 115200
        +AutoScanPorts() string
        +SendCommand(string gcodeLine) bool
        +WaitResponseOk() bool
    }
    class FirmwareMotionControl {
        +double theta1, theta2, theta3
        +InverseKinematics(double x, double y, double z)
        +SetupTimerInterrupt()
        +ExecuteStepISR()
    }
    GcodeProgramManager --> GcodeCompiler
    VisionProcessor --> GcodeCompiler
    GcodeCompiler --> SerialCommunication
    SerialCommunication ..> FirmwareMotionControl : UART String

Danh mục công nghệ và phiên bản phần cứng/phần mềm:

  • Ngôn ngữ & Nền tảng: C# / .NET Framework 4.7.2, C++11 nhúng (Embedded C++).
  • Môi trường phát triển: Microsoft Visual Studio 2019, Arduino IDE 1.8.19.
  • Thư viện thị giác: OpenCV 4.x wrapper (.NET EmguCV) / Custom Bitmap Fast Processing.
  • Phần cứng điều khiển: Vi điều khiển ATmega2560 (16MHz, 256KB Flash, 8KB SRAM), RAMPS 1.4 CNC Shield, 3x Stepper Driver A4988 (1/16 Microstepping).
  • Hệ thống dẫn động & Cơ khí: 3x Stepper NEMA 17 (1.8°/step, 0.44 Nm), Bộ truyền đai GT2-6mm (Pully 16 răng : 48 răng $\to$ Tỉ số truyền 1:3), Nhôm định hình 2020 V-Slot, Khớp cầu ren M4 mạ niken.

Phương pháp nghiên cứu và phát triển (Methodology)

Dự án áp dụng mô hình phát triển V-Model cải tiến (Agile-Hardware Development) kết hợp tạo mẫu nhanh (Rapid Prototyping) với công nghệ in 3D FDM (nhựa PLA/PETG) để kiểm tra dung sai khớp trước khi hoàn thiện kết cấu.

Tuần 1-2: Mô hình toán học & Động học Robot (Matlab/Simulink)
Tuần 3-4: Thiết kế 3D SolidWorks 2018 & In 3D chế tạo gá lắp
Tuần 5-6: Thi công mạch điện, Shield RAMPS 1.4 & Lập trình Firmware C++
Tuần 7-8: Lập trình C# WinForms, Giao tiếp UART, Xử lý ảnh OpenCV
Tuần 9-10: Tích hợp Encoder băng tải, Hiệu chuẩn tọa độ, Thử nghiệm gắp động

Ma trận đánh giá rủi ro và giải pháp khắc phục:

  1. Hiện tượng trượt bước (Step Loss) ở tốc độ cao: Khắc phục bằng cách sử dụng bộ truyền giảm tốc đai răng GT2 1:3 giúp tăng mô-men giữ gấp 3 lần, đồng thời tối ưu hóa profile gia tốc hình thang (Trapezoidal Acceleration Profile).
  2. Độ trễ truyền nhận tín hiệu điều khiển: Thiết lập Buffer vòng (Ring Buffer) 32 bytes trên vi điều khiển kết hợp thuật toán bắt tay (Handshake) 2 chiều Ok phản hồi tức thời.
  3. Biến dạng quang học từ Camera: Triển khai ma trận chiếu phối cảnh (Perspective Transform) và lọc ngưỡng động thích nghi theo độ sáng môi trường.

Implementation và kết quả

Quá trình phát triển và thuật toán cốt lõi

1. Tính toán Động học ngược (Inverse Kinematics Algorithm)

Mục tiêu là tính toán 3 góc quay $\theta_i$ ($i = 1, 2, 3$) từ tọa độ điểm tác động cuối $E(x_0, y_0, z_0)$. Đặt bán kính tam giác đế cố định là $f$, bán kính bàn di động là $e$, chiều dài cánh tay chủ động là $r_f$, chiều dài thanh truyền là $r_e$.

Phương trình vector vòng kín của mỗi nhánh robot trong mặt phẳng tương ứng: $$(y_j - y_{Fj})^2 + (z_j - z_{Fj})^2 = r_e^2 - (x_j - x_{Fj})^2$$

Đoạn mã giải thuật động học ngược trong Firmware C++ (trích xuất từ hệ thống thực tế):

int delta_calcForward(double theta1, double theta2, double theta3, double &x0, double &y0, double &z0) {
    double t = (f - e) * tan30 / 2.0;
    double dtr = pi / 180.0;
    theta1 *= dtr; theta2 *= dtr; theta3 *= dtr;

    double y1 = -(t + rf * cos(theta1));
    double z1 = -rf * sin(theta1);
    double y2 = (t + rf * cos(theta2)) * sin30;
    double x2 = y2 * tan60;
    double z2 = -rf * sin(theta2);
    double y3 = (t + rf * cos(theta3)) * sin30;
    double x3 = -y3 * tan60;
    double z3 = -rf * sin(theta3);

    double dnm = (y2 - y1) * x3 - (y3 - y1) * x2;
    double w1 = y1 * y1 + z1 * z1;
    double w2 = x2 * x2 + y2 * y2 + z2 * z2;
    double w3 = x3 * x3 + y3 * y3 + z3 * z3;

    // Tính toán ma trận định thức và tìm giao điểm mặt cầu
    double a1 = (z2 - z1) * (y3 - y1) - (z3 - z1) * (y2 - y1);
    double b1 = -((w2 - w1) * (y3 - y1) - (w3 - w1) * (y2 - y1)) / 2.0;
    double a2 = -(z2 - z1) * x3 + (z3 - z1) * x2;
    double b2 = ((w2 - w1) * x3 - (w3 - w1) * x2) / 2.0;

    double a = a1 * a1 + a2 * a2 + dnm * dnm;
    double b = 2.0 * (a1 * b1 + a2 * (b2 - y1 * dnm) - z1 * dnm * dnm);
    double c = (b2 - y1 * dnm) * (b2 - y1 * dnm) + b1 * b1 + dnm * dnm * (z1 * z1 - re * re);

    double d = b * b - 4.0 * a * c;
    if (d < 0) return -1; // Vô nghiệm (vượt không gian làm việc)

    z0 = -0.5 * (b + sqrt(d)) / a;
    x0 = (a1 * z0 + b1) / dnm;
    y0 = (a2 * z0 + b2) / dnm;
    return 0;
}

2. Cấu hình Timer Interrupt đồng bộ hóa phát xung Step

Để đảm bảo chuyển động tuyến tính nội suy chính xác của cả 3 trục mà không làm trễ quá trình nhận G-code, hệ thống sử dụng ngắt Timer 1 trên vi điều khiển ATmega2560:

void setupTimer1() {
    cli(); // Tắt toàn bộ ngắt toàn cục
    TCCR1A = 0; // Xóa thanh ghi điều khiển TCCR1A
    TCCR1B = 0; // Xóa thanh ghi TCCR1B
    TCNT1  = 0; // Đặt lại giá trị đếm bộ Timer
    
    // Cài đặt tần số ngắt 10kHz (OCR1A = 16MHz / (8 * 10kHz) - 1 = 199)
    OCR1A = 199;
    TCCR1B |= (1 << WGM12); // Chế độ CTC (Clear Timer on Compare Match)
    TCCR1B |= (1 << CS11);  // Prescaler = 8
    TIMSK1 |= (1 << OCIE1A);// Bật ngắt so sánh Timer1 Channel A
    sei(); // Bật lại ngắt toàn cục
}

ISR(TIMER1_COMPA_vect) {
    // Thuật toán phát xung điều khiển bước trục 1, 2, 3 theo tỉ lệ vận tốc
    if (stepCounter1 > 0) {
        digitalWrite(STEP_PIN_1, HIGH);
        digitalWrite(STEP_PIN_1, LOW);
        stepCounter1--;
    }
    // Tương tự cho STEP_PIN_2 và STEP_PIN_3
}

3. Thuật toán Xử lý ảnh phân ngưỡng HSV và Bám đối tượng (C#)

Xử lý ảnh thực hiện phân đoạn màu của sản phẩm đang di chuyển:

  • Chuyển không gian màu RGB sang HSV ($H \in [0, 180]$, $S \in [0, 255]$, $V \in [0, 255]$).
  • Lọc nhiễu bằng thuật toán Gaussian Blur ($5 \times 5$) và hình thái học Morphology Close/Open.
  • Tìm đường bao findContours và tính tâm hình học (Centroid Moment):

$$x_c = \frac{M_{10}}{M_{00}}, \quad y_c = \frac{M_{01}}{M_{00}}$$

  • Tọa độ mục tiêu đón bắt:

$$X_{pick} = x_c \cdot k_x + X_0, \quad Y_{pick} = (y_c + v_{belt} \cdot \Delta t) \cdot k_y + Y_0$$

Thử nghiệm và Đánh giá hiệu năng

Biểu đồ thực nghiệm phân bố chu kỳ gắp thả (Pick-and-Place Cycle):
[Nhận diện Camera]   ==> 22ms
[Gửi lệnh G-code]   ==> 4ms
[Di chuyển đón vật] ==> 140ms
[Hút chân không]    ==> 50ms
[Nâng & Thả vật]    ==> 160ms
[Xả áp khí nén]     ==> 20ms
-----------------------------------------
Tổng chu kỳ trung bình: 396ms / sản phẩm (~151 sản phẩm/phút)

Kết quả thử nghiệm chi tiết:

  • Tốc độ băng chuyền tối đa kiểm tra: $v = 180\text{ mm/s}$.
  • Độ chính xác lặp lại vị trí (Repeatability): $\pm 0.35\text{ mm}$.
  • Tỷ lệ nhận diện chính xác vật thể (Vision Accuracy): $98.6%$ trong điều kiện ánh sáng ổn định ($350 - 500\text{ Lux}$).
  • Tỷ lệ gắp thành công (Pick Success Rate): $96.2%$ trên tổng số 500 lần thử nghiệm liên tục.

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

  1. Bộ biên dịch G-code tùy biến tích hợp cấu trúc lập trình cao cấp: Khác biệt với các bộ điều khiển CNC thông thường chỉ đọc lệnh đơn, phần mềm C# tự phát triển cho phép người vận hành viết các biểu thức điều kiện IF [CONDITION] THEN [STATEMENT], câu lệnh nhảy GOTO Nxx, gán biến động #100 = #101 + 5, tạo điều kiện lập trình chu trình gắp thả linh hoạt không cần nạp lại Firmware.
  2. Cơ chế tự động dò tìm và Handshake cổng giao tiếp: Triển khai giao thức tự động quét toàn bộ COM port khả dụng, gửi chuỗi IsDelta và chỉ nhận diện thiết bị phản hồi YesDelta, loại bỏ hoàn toàn hiện tượng xung đột kết nối hoặc người dùng phải cấu hình cổng thủ công.
  3. Hệ thống van xả khí nén tích hợp: Giải quyết dứt điểm nhược điểm giữ áp suất âm lâu của đầu hút cao su truyền thống, tăng tốc độ nhả vật thể từ $120\text{ms}$ xuống còn $20\text{ms}$ (cải thiện $83.3%$ thời gian đáp ứng nhả vật).
graph LR
    A[Mã nguồn G-code mở rộng] --> B{Bộ tiền xử lý C#}
    B -->|Phát hiện IF / GOTO / Biến| C[Trình biên dịch Macro]
    C --> D[Chuyển đổi thành G01/G00/G41/M03 thuần]
    D --> E[Bộ đệm tuần tự Ring Buffer]
    E -->|Gửi từng dòng| F[Robot Hardware]
    F -->|Phản hồi Ok| E

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

Tình huống ứng dụng thực tế (Use Cases):

  • Phân loại nông sản, thực phẩm: Đóng hộp bánh kẹo, phân loại trái cây theo kích thước và độ chín màu sắc.
  • Dây chuyền lắp ráp điện tử: Nhặt các linh kiện IC, tụ điện từ băng tải cấp phôi và đặt chính xác lên khay chứa.
  • Đóng gói dược phẩm: Đếm và gắp vỉ thuốc, chai lọ nhỏ vào hộp carton với tốc độ cao.
Lộ trình triển khai hệ thống (Implementation Roadmap):
[Giai đoạn 1] Chuẩn hóa kích thước khung và khâu di động (CAD/CAM tiêu chuẩn) -> 1 tháng
[Giai đoạn 2] Nâng cấp động cơ từ Stepper lên AC Servo 400W & Bus EtherCAT     -> 2 tháng
[Giai đoạn 3] Tích hợp mạng nơ-ron tích chập (YOLOv8-Nano) nhận diện vật phức tạp -> 1.5 tháng
[Giai đoạn 4] Thử nghiệm thực địa tại nhà máy sản xuất bánh kẹo               -> 1.5 tháng

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

  • Chi phí đầu tư hệ thống: Khoảng $8.500.000\text{ VNĐ}$ (Mô hình chế tạo thực tế) so với robot Delta công nghiệp nhập khẩu từ $120.000.000 - 250.000.000\text{ VNĐ}$.
  • Năng suất lao động: 1 cụm Robot Delta 3-RUS hoạt động thay thế cho 2 công nhân đóng gói thủ công, giảm thiểu $75%$ tỉ lệ lỗi đóng gói do mỏi mắt và nâng cao năng suất tổng thể lên $140%$. Thời gian hoàn vốn (Payback Period) ước tính chỉ từ 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:

  • Động cơ bước NEMA 17 hoạt động ở chế độ vòng hở (Open Loop), dễ sinh nhiệt khi chạy liên tục trên 3 giờ và có nguy cơ trượt bước nếu tăng tốc đột ngột trên $2500\text{ mm/s}^2$.
  • Khung gá và khớp động in 3D bằng nhựa PLA/PETG có hiện tượng rơ dơ sau khoảng 100 giờ hoạt động liên tục.
  • Hệ thống thị giác máy tính sử dụng webcam 2D góc nhìn thẳng đứng, chưa có khả năng ước lượng chiều cao vật thể theo trục Z nếu vật thể xếp chồng lên nhau.

Hướng nâng cấp trong tương lai:

  • Nâng cấp lên động cơ Hybrid Servo (Closed-loop Stepper) hoặc AC Servo tích hợp Encoder tuyệt đối 17-bit.
  • Gia công toàn bộ cánh tay và bệ di động bằng hợp kim nhôm 6061 hoặc sợi carbon composite đúc khuôn.
  • Bổ sung Camera 3D Depth Sensor (Intel RealSense D435) để xử lý các bài toán gắp vật ngẫu nhiên trong thùng chứa (Bin-picking).

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

  • Sinh viên Cơ điện tử / Tự động hóa: Là tài liệu tham khảo chi tiết từ lý thuyết tính toán động học, mô phỏng hình học đến kỹ thuật lập trình Timer vi điều khiển và xử lý ảnh OpenCV.
  • Kỹ sư R&D và Lập trình viên nhúng: Nắm bắt mô hình kiến trúc điều khiển Robot qua G-code, kỹ thuật phân luồng giao tiếp Serial không chặn (Non-blocking UART) và mô hình hóa hình học Delta 3-RUS.
  • Doanh nghiệp vừa và nhỏ (SMEs): Cơ sở khả thi để tự chủ chế tạo các giải pháp tự động hóa phân loại tốc độ cao với giá thành nội địa hóa tối ưu.
  • Nhà nghiên cứu: Nền tảng mở để phát triển các thuật toán điều khiển thích nghi, điều khiển trượt (Sliding Mode Control) hay tích hợp trí tuệ nhân tạo Deep Learning cho robot song song.

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ì?

Máy tính trạm điều khiển cần trang bị tối thiểu CPU Intel Core i3 (thế hệ 6 trở lên) hoặc tương đương, RAM 4GB, 2 cổng USB 2.0/3.0, chạy hệ điều hành Windows 10/11 (hỗ trợ .NET Framework 4.7.2). Khối robot yêu cầu nguồn tổ ong 12V-15A DC cho động cơ và nguồn khí nén $0.4 - 0.6\text{ MPa}$ cho đầu hút.

2. Làm thế nào để mở rộng thêm trục xoay định hướng (4-DOF Delta)?

Để tích hợp trục xoay $W$ cho khâu chấp hành cuối, cần lắp đặt thêm một trục truyền động telescoping (thanh then hoa đồng trục) nối từ động cơ thứ tư gắn trên đế tĩnh xuống bàn di động, truyền qua một khớp các-đăng (Universal Joint). Đồng thời mở rộng thêm trục $A$ trong Firmware và bộ phân giải G-code.

3. Hệ thống xử lý thế nào khi có nhiều vật thể xuất hiện cùng lúc trên băng tải?

Phần mềm C# tích hợp thuật toán phân loại ưu tiên: Trích xuất danh sách tọa độ tất cả các contour tìm được, sắp xếp mảng vật thể theo thứ tự tọa độ $Y$ giảm dần (vật nào ở gần cuối hành lang gắp của robot nhất sẽ được gắp trước) để tối ưu hóa quãng đường di chuyển và đảm bảo không bỏ sót sản phẩm.

4. Chi phí bảo dưỡng và khả năng thay thế linh kiện định kỳ ra sao?

Do sử dụng linh kiện chuẩn hóa quốc tế (nhôm định hình V-slot, dây đai GT2, vòng bi khớp cầu M4, driver A4988), chi phí thay thế định kỳ rất thấp (dưới $300.000\text{ VNĐ}$ cho toàn bộ dây đai và bạc đạn sau mỗi 6 tháng vận hành liên tục).

5. Tại sao không giải động học ngược bằng phương pháp giải tích đại số mà dùng phương pháp hình học?

Phương pháp hình học không gian (Geometric approach) tận dụng tính đối xứng $120^\circ$ của robot Delta, quy bài toán về việc tìm giao điểm giữa đường tròn quỹ đạo của cánh tay chủ động với mặt cầu bán kính $r_e$ của thanh truyền. Cách tiếp cận này giảm thiểu phép tính lượng giác phức tạp, giúp vi điều khiển 8-bit/16MHz tính toán nghiệm trong thời gian cực ngắn (< 1.5ms).

Kết luận

Đồ án tốt nghiệp "Chế tạo Robot Delta gắp thả vật trên băng chuyền tốc độ cao" đã hoàn thành xuất sắc toàn bộ các mục tiêu đặt ra: từ xây dựng nền tảng lý thuyết động học, thiết kế cơ khí chính xác, đến lập trình hệ thống Firmware nhúng thời gian thực và phần mềm thị giác máy tính chuyên dụng. Kết quả thực nghiệm đã chứng minh tính đúng đắn của mô hình toán học và tính ổn định cao của cơ cấu cơ điện tử với tốc độ đạt xấp xỉ 150 lần gắp/phút. Đề tài không chỉ mang giá trị học thuật sâu sắc trong đào tạo kỹ sư chất lượng cao mà còn là tiền đề vững chắc cho việc ứng dụng, nội địa hóa và thương mại hóa các dòng robot song song tốc độ cao phục vụ nền sản xuất thông minh tại Việt Nam.