Giới thiệu dự án

Trong bối cảnh bùng nổ của Công nghiệp 4.0 và xu hướng tự động hóa linh hoạt (Flexible Automation), tay máy robot (Robot Manipulators) đóng vai trò xương sống tại các nhà máy sản xuất thông minh. Theo thống kê từ Liên đoàn Robot Quốc tế (IFR - International Federation of Robotics), mật độ robot công nghiệp toàn cầu đã đạt mức trung bình 151 robot/10.000 nhân công vào năm 2022 và tiếp tục tăng trưởng kép hàng năm (CAGR) trên 7%. Tuy nhiên, các dòng cánh tay robot công nghiệp tiêu chuẩn 6 bậc tự do (6-DOF) từ các hãng lớn (KUKA, ABB, Fanuc) thường có giá thành rất cao (từ 15.000 đến 45.000 USD), cấu trúc phần mềm đóng kín, gây rào cản lớn cho các doanh nghiệp vừa và nhỏ (SME) cũng như các cơ sở đào tạo, nghiên cứu cơ điện tử tại Việt Nam.

Đồ án tốt nghiệp "Thiết kế và điều khiển cánh tay Robot 6 bậc tự do" được thực hiện tại Bộ môn Cơ Điện tử, Viện Cơ khí – Trường Đại học Bách Khoa Hà Nội, dưới sự hướng dẫn của TS. Phạm Đức An. Đồ án giải quyết bài toán thiết kế hoàn chỉnh một hệ thống cánh tay robot đa bậc tự do có chi phí chế tạo thấp, cấu trúc module hóa cao, mô hình hóa động học/động lực học chính xác và tích hợp hệ thống điều khiển không dây thời gian thực.

[Khối Điều Khiển Di Động: App Inventor (Android)]
                     │ (Bluetooth 2.0 / HC-05 Serial)
                     ▼
[Bộ Vi Điều Khiển Trung Tâm: Arduino Mega 2560 + RAMPS 1.4]
                     │
       ┌─────────────┴─────────────┐
       ▼                           ▼
[5x Driver DRV8825]        [PWM Signal Pin]
       │                           │
       ▼                           ▼
[5x Động Cơ Bước Khâu 1-5]  [1x DC Servo MG995 - Tay Kẹp]

Mục tiêu dự án

  1. Thiết kế cơ khí chính xác: Xây dựng mô hình 3D hoàn chỉnh cánh tay robot 5 khớp quay nối tiếp kết hợp 1 cơ cấu tay kẹp (tổng cộng 6 bậc tự do thao tác), tối ưu hóa tỷ lệ trọng lượng và độ cứng vững bằng vật liệu Acrylonitrile Butadiene Styrene (ABS) in 3D.
  2. Mô hình hóa toán học chuyên sâu: Thiết lập hệ phương trình động học thuận (Forward Kinematics) theo quy tắc Denavit-Hartenberg (D-H), giải phương trình động học ngược (Inverse Kinematics) bằng phương pháp tách nhóm 3 (Pieper Decoupling), và xây dựng mô hình động lực học Euler-Lagrange kết hợp quy hoạch quỹ đạo hình thang (Trapezoidal Velocity Profile).
  3. Phát triển phần cứng và mạch điều khiển: Tích hợp bộ điều khiển trung tâm ATmega2560 trên nền bo mạch RAMPS 1.4, sử dụng 5 mạch lái DRV8825 điều khiển microstepping và module truyền thông Bluetooth HC-05.
  4. Phần mềm điều khiển trực quan: Thiết kế ứng dụng Android (App Inventor 2) với các chức năng điều khiển tọa độ khớp (Manual Joint Jogging), ghi nhớ điểm thao tác (Teach & Save Points), và chạy chu trình lặp tự động (Auto Run Cycle).

Thông số kỹ thuật mục tiêu (Expected Metrics)

  • Tầm với cực đại (Reach Radius): $R_{\max} = 535\text{ mm}$ (bán kính không gian làm việc hình cầu).
  • Chiều cao tổng thể: $H_{\text{total}} = 840\text{ mm}$ (bao gồm cơ cấu kẹp), $720\text{ mm}$ (khung cơ sở).
  • Độ mở cơ cấu tay kẹp (Gripper Stroke): $80\text{ mm}$, tải trọng gắp danh định $150\text{ g} - 300\text{ g}$.
  • Góc quay giới hạn các khớp: Khâu 1 ($\pm 110^\circ$), Khâu 2 ($\pm 100^\circ$), Khâu 3 ($\pm 120^\circ$), Khâu 4 ($\pm 180^\circ$), Khâu 5 ($\pm 90^\circ$).
  • Sai số vị trí lặp lại (Repeatability): $\le \pm 2.0\text{ mm}$; sai số góc quay $\le 2^\circ$.

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

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

Tiêu chí so sánh Cánh tay công nghiệp tiêu chuẩn (KUKA/ABB) Bộ kit Robot Arm Acrylic Hobby Giải pháp Đồ án BKHN (ABS + Stepper + RAMPS)
Bậc tự do (DOF) 6 DOF (Khớp quay) 4 - 6 DOF (Micro Servo SG90) 5 DOF Khớp quay + 1 DOF Tay kẹp Servo
Vật liệu cấu trúc Hợp kim nhôm đúc, Gang cầu Mica/Acrylic cắt laser, Nhôm mỏng Nhựa nhiệt dẻo ABS in 3D + Đế gỗ kỹ thuật
Hệ thống dẫn động AC Servo Motor + Hộp số Harmonic RC Servo Mini (bánh răng nhựa) Stepper NEMA 17/23 + Bộ truyền Puly - Đai răng
Độ chính xác $\pm 0.02\text{ mm} - \pm 0.05\text{ mm}$ $\pm 10\text{ mm} - \pm 20\text{ mm}$ (độ rơ lớn) $\pm 1.5\text{ mm} - \pm 2.0\text{ mm}$
Khả năng mở rộng Đóng (SDK chuyên dụng, phí cao) Giới hạn (Board nạp cơ bản) Mã nguồn mở hoàn toàn (Arduino, MATLAB)
Chi phí chế tạo > 350.000.000 VNĐ 1.000.000 - 2.500.000 VNĐ 5.500.000 - 7.500.000 VNĐ

Yêu cầu hệ thống theo mô hình MoSCoW

  • Must-have (Bắt buộc): Giải được bài toán động học ngược chính xác; điều khiển độc lập 5 trục động cơ bước và 1 servo; giao tiếp Bluetooth ổn định; cơ cấu kẹp đóng/mở chắc chắn.
  • Should-have (Nên có): Quy hoạch quỹ đạo nội suy mượt dạng hình thang, triệt tiêu hiện tượng giật động học (jerk); tính toán mô phỏng động lực học trên MATLAB/Simulink.
  • Could-have (Có thể mở rộng): Lưu trữ không giới hạn tọa độ điểm qua bộ nhớ EEPROM/App; tích hợp cảm biến hành trình Endstop cho chế độ Auto-Homing.
  • Won't-have (Tạm hoãn): Điều khiển vòng kín phản hồi hồi tiếp tuyệt đối (Closed-loop Absolute Encoder); xử lý ảnh phân loại sản phẩm qua camera AI.

Thiết kế hệ thống

Bảng thông số hình học Denavit-Hartenberg (D-H Parameters)

Hệ tọa độ gắn trên các khâu được xác định với các thông số liên kết: $h_1 = 234\text{ mm}$, $h_2 = 221\text{ mm}$, $h_3 = 128\text{ mm}$, $h_4 = 96\text{ mm}$ ($h_{34} = h_3 + h_4 = 224\text{ mm}$), $h_5 = 130\text{ mm}$.

Khâu ($i$) Biến khớp ($q_i$) Khoảng cách $d_i$ (mm) Chiều dài khâu $a_i$ (mm) Góc xoắn $\alpha_i$ (deg)
1 $q_1^*$ $h_1 = 234$ 0 $90^\circ$
2 $q_2^*$ 0 $h_2 = 221$ $0^\circ$
3 $q_3^* + 90^\circ$ 0 0 $90^\circ$
4 $q_4^*$ $h_{34} = 224$ 0 $90^\circ$
5 $q_5^*$ 0 $h_5 = 130$ $0^\circ$ 
                       [Cơ cấu Kẹp E (End-Effector)]
                                    │ (h5 = 130mm)
                             [Khớp 5 (q5)]
                                    │ (Khớp nối mềm / Trục)
                             [Khớp 4 (q4)]
                                    │ (h34 = 224mm)
                             [Khớp 3 (q3)]
                                    │ (h2 = 221mm)
                             [Khớp 2 (q2)] ◄── 2x Stepper 57HS112 (Song song)
                                    │ (h1 = 234mm)
                             [Khớp 1 (q1)] ◄── Stepper 17HS24 + Puly 1:7
                                    │
                             [Khâu Đế Gỗ & Vỏ ABS]

Technology Stack & Component Versions

  • CAD/CAE Modeling: SolidWorks 2020 SP5 (thiết kế chi tiết 3D, phân tích va chạm, xuất khối lượng và ma trận quán tính $I_i$).
  • Mô phỏng toán học: MATLAB R2020b / Simulink (Simscape Multibody, Symbolic Math Toolbox).
  • Embedded Firmware: Arduino IDE v1.8.13, C/C++ Bare-metal tối ưu hóa thanh ghi timer.
  • Mobile Application: MIT App Inventor 2 (BuildServer v186a), giao thức Bluetooth SPP (Serial Port Profile).
  • Mạch công suất & Lái: RAMPS 1.4 Shield kết hợp 5 module DRV8825 cấu hình 1/16 microstepping, động cơ servo kim loại MG995 (Momen xoắn $10\text{ kg}\cdot\text{cm}$ tại 4.8V).

Implementation và kết quả

Development process

1. Động học thuận và Ma trận biến đổi thuần nhất

Ma trận chuyển đổi tổng quát giữa hai khâu liên tiếp theo quy tắc D-H:

$$A_i = \begin{bmatrix} \cos q_i & -\sin q_i \cos \alpha_i & \sin q_i \sin \alpha_i & a_i \cos q_i \ \sin q_i & \cos q_i \cos \alpha_i & -\cos q_i \sin \alpha_i & a_i \sin q_i \ 0 & \sin \alpha_i & \cos \alpha_i & d_i \ 0 & 0 & 0 & 1 \end{bmatrix}$$

Ma trận vị trí và hướng của khâu công tác cuối $T_5^0$ so với hệ tọa độ cơ sở:

$$T_5^0 = A_1 A_2 A_3 A_4 A_5 = \begin{bmatrix} r_{11} & r_{12} & r_{13} & x_E \ r_{21} & r_{22} & r_{23} & y_E \ r_{31} & r_{32} & r_{33} & z_E \ 0 & 0 & 0 & 1 \end{bmatrix}$$

2. Giải thuật Động học ngược bằng phương pháp tách nhóm 3 (Pieper's Decoupling)

Xác định tọa độ điểm tâm cổ tay trung gian $C \equiv O_4$ tách biệt với định hướng khâu cuối:

$$\mathbf{p}C = \mathbf{p}E - R_E^0 \cdot \begin{bmatrix} h_5 \ 0 \ 0 \end{bmatrix} \implies \begin{cases} x_C = x_E - h_5 r{11} \ y_C = y_E - h_5 r{21} \ z_C = z_E - h_5 r_{31} \end{cases}$$

Từ tọa độ điểm $C$, tính toán nghiệm giải tích tường minh cho 3 góc khớp gốc:

  • Khớp 1: $q_1 = \text{atan2}(y_C, x_C)$
  • Khớp 2 và 3: Thiết lập hệ phương trình hình học chiếu lên mặt phẳng quay, giải nghiệm tam giác chứa cạnh $h_2$ và $h_{34}$.
  • Khớp 4 và 5: Xác định thông qua ma trận định hướng còn lại $R_5^3 = (R_3^0)^{-1} R_5^0$.
% MATLAB Inverse Kinematics Function Snippet (Decoupling Approach)
function [q1, q2, q3, q4, q5] = inverse_kinematics(xE, yE, zE, R)
    h1 = 0.234; h2 = 0.221; h34 = 0.224; h5 = 0.130;
    % Wrist center position C
    xC = xE - h5 * R(1,1);
    yC = yE - h5 * R(2,1);
    zC = zE - h5 * R(3,1);
    
    % Joint 1
    q1 = atan2(yC, xC);
    
    % Geometry in arm plane
    r_proj = sqrt(xC^2 + yC^2);
    s = zC - h1;
    D = (r_proj^2 + s^2 - h2^2 - h34^2) / (2 * h2 * h34);
    D = max(min(D, 1.0), -1.0); % Clamp domain
    
    % Joint 3 & Joint 2
    q3 = atan2(sqrt(1 - D^2), D);
    q2 = atan2(s, r_proj) - atan2(h34*sin(q3), h2 + h34*cos(q3));
    
    % Orientation joints 4 and 5
    % Calculated using Euler angles extraction from relative rotation matrix
    % ...
end

3. Mô hình Động lực học Euler-Lagrange

Phương trình vi phân chuyển động phi tuyến của cánh tay robot:

$$M(\mathbf{q})\ddot{\mathbf{q}} + C(\mathbf{q}, \dot{\mathbf{q}})\dot{\mathbf{q}} + \mathbf{g}(\mathbf{q}) = \mathbf{\tau}$$

Trong đó:

  • $M(\mathbf{q}) = \sum_{i=1}^5 \left( J_{Ti}^T m_i J_{Ti} + J_{Ri}^T R_i^0 I_i (R_i^0)^T J_{Ri} \right)$ là ma trận khối lượng đối xứng xác định dương ($5 \times 5$).
  • $C(\mathbf{q}, \dot{\mathbf{q}})$ là ma trận lực hướng tâm và Coriolis, tính qua hệ số Christoffel: $c_{ij} = \sum_{k=1}^5 \frac{1}{2} \left( \frac{\partial m_{ij}}{\partial q_k} + \frac{\partial m_{ik}}{\partial q_j} - \frac{\partial m_{jk}}{\partial q_i} \right) \dot{q}_k$.
  • $\mathbf{g}(\mathbf{q})$ là vector mô-men thế năng trọng trường: $g_i(\mathbf{q}) = \frac{\partial P}{\partial q_i}$.

4. Quy hoạch quỹ đạo vận tốc hình thang (Trapezoidal Velocity Profile)

Chia hành trình chuyển động giữa hai điểm cấu hình $q_A$ và $q_B$ trong khoảng thời gian $t_f = 4.0\text{ s}$ thành 3 pha rõ rệt (thời gian tăng tốc $t_a = 1.0\text{ s}$):

$$\ddot{q}(t) = \begin{cases} a_{\max} = \frac{v_{\max}}{t_a}, & 0 \le t \le t_a \ 0, & t_a < t \le t_f - t_a \ -a_{\max}, & t_f - t_a < t \le t_f \end{cases}$$

  • Khâu 2 ($\Delta q_2 = \frac{\pi}{2}\text{ rad}$): $v_{2\max} = 0.5236\text{ rad/s}$, $a_{2\max} = 0.5236\text{ rad/s}^2$.
  • Khâu 3 ($\Delta q_3 = \frac{\pi}{3}\text{ rad}$): $v_{3\max} = 0.3491\text{ rad/s}$, $a_{3\max} = 0.3491\text{ rad/s}^2$.
  • Khâu 4 ($\Delta q_4 = \frac{2\pi}{3}\text{ rad}$): $v_{4\max} = 0.6981\text{ rad/s}$, $a_{4\max} = 0.6981\text{ rad/s}^2$.
// Arduino Mega 2560 - Multi-axis Step Generation
#define STEP_PIN_J1 54
#define DIR_PIN_J1  55
#define ENABLE_PIN  38

void executeTrapezoidalMove(long targetSteps[5], float maxSpeed, float accel) {
    digitalWrite(ENABLE_PIN, LOW); // Active Low DRV8825
    // Set Directions based on sign of targetSteps
    for(int i = 0; i < 5; i++) {
        setDirection(i, targetSteps[i] >= 0);
    }
    // Bresenham Multi-axis synchronized pulse loop
    // Computes pulse delays according to trapezoidal acceleration curve
    // Real-time step generation using Timer Interrupts (Timer1/Timer3)
}

Kết quả đo kiểm và Thực nghiệm

Phân bố mô-men xoắn và Lựa chọn động cơ dẫn động

Khớp Mã động cơ đã chọn Mô-men giữ danh định Tỷ số truyền Puly / Khớp Mô-men tải yêu cầu ($M_{d}$) Tỷ lệ an toàn ($S_f$)
Khâu 1 Stepper 17HS24-1206S $0.65\text{ Nm}$ Đai răng $14:98$ ($1/7$) $0.61\text{ Nm}$ $1.49$
Khâu 2 2x Stepper 57HS112-3004A08 $2 \times 3.0\text{ Nm} = 6.0\text{ Nm}$ Đai răng $14:70$ ($1/5$) $5.51\text{ Nm}$ $1.36$
Khâu 3 Stepper 17HS13-0404S-PG5 $0.22\text{ Nm}$ (Hộp số $1:5$) Đai răng $14:56$ ($1/4$) $1.08\text{ Nm}$ $1.42$
Khâu 4 Stepper 17HS13-0404S1 $0.26\text{ Nm}$ Khớp mềm + Đai $14:42$ ($1/3$) $0.21\text{ Nm}$ $1.64$
Khâu 5 Stepper 14HS13-0804S $0.18\text{ Nm}$ Dẫn động trực tiếp trục $0.15\text{ Nm}$ $1.20$
Tay kẹp DC Servo TowerPro MG995 $1.0\text{ Nm}$ ($10\text{ kg}\cdot\text{cm}$) Cơ cấu thanh răng song phẳng $0.35\text{ Nm}$ $2.85$

Kết quả đánh giá sai số vị trí thực nghiệm

Điểm thử nghiệm Tọa độ đặt $(X, Y, Z)$ [mm] Tọa độ thực tế $(X, Y, Z)$ [mm] Sai số tuyệt đối $(\Delta r)$ [mm] Sai số góc trung bình
Điểm $P_1$ $(445.0, 65.0, 347.0)$ $(443.8, 64.2, 348.1)$ $1.82\text{ mm}$ $0.85^\circ$
Điểm $P_2$ $(138.0, 65.0, 665.0)$ $(139.1, 65.8, 663.7)$ $1.98\text{ mm}$ $1.12^\circ$
Điểm $P_3$ $(300.0, 0.0, 250.0)$ $(298.9, 0.5, 251.2)$ $1.69\text{ mm}$ $0.64^\circ$
Điểm $P_4$ $(0.0, 350.0, 400.0)$ $(0.8, 348.4, 401.1)$ $2.14\text{ mm}$ $1.35^\circ$

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

  1. Cấu trúc truyền động kép khâu gốc (Dual-stepper Actuation Khâu 2): Khâu 2 là vị trí chịu mô-men uốn tĩnh và động lớn nhất ($5.51\text{ Nm}$). Nhóm đã thiết kế cụm truyền động song song 2 động cơ bước NEMA 23 (57HS112) kết hợp puly đai răng cốt thép HTD-5M, loại bỏ hiện tượng vặn xoắn thân cánh tay và triệt tiêu tải trọng lệch tâm.
  2. Module hóa 100% bằng công nghệ in 3D FDM: Toàn bộ vỏ khớp, bệ đỡ vòng bi và khung tay kẹp được thiết kế tối ưu hóa mật độ điền đầy (Infill Density 65-80% mô hình tổ ong Honeycomb), giúp trọng lượng chuyển động của cánh tay giảm 58% so với gia công nhôm khối nhưng vẫn đảm bảo độ bền uốn theo tiêu chuẩn vật liệu ABS ($E = 2.1\text{ GPa}$, $\sigma_y = 41\text{ MPa}$).
  3. Thuật toán điều khiển giải tích gọn nhẹ trên vi xử lý 8-bit: Bằng việc áp dụng phương pháp Pieper tách nhóm 3, khối lượng tính toán ma trận lượng giác ngược giảm 70% so với phương pháp nghịch đảo ma trận Jacobi lặp số, cho phép hệ thống nạp lệnh quỹ đạo nội suy mượt trực tiếp trên bo mạch Arduino Mega 2560 mà không bị tràn bộ nhớ SRAM (8KB).
  4. Hệ thống điều khiển không dây dạng Teach & Repeat trực quan: Ứng dụng Android độc quyền kết nối qua giao thức UART-Bluetooth HC-05 cho phép người vận hành di chuyển từng khớp đến vị trí mong muốn, lưu điểm vào mảng nhớ flash và tự động chạy lại quỹ đạo tuần hoàn với tần số đáp ứng lệnh trễ dưới $25\text{ ms}$.

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

[Dây Chuyền Cấp Phôi Tự Động] ──► [Robot 6-DOF BKHN] ──► [Bàn Kiểm Tra Sản Phẩm]
                                        ▲
                                        │ (Tín hiệu Ready/Busy)
                                 [Cảm Biến Tiệm Cận]

Các kịch bản ứng dụng thực tế

  • Phân loại và gắp đặt sản phẩm (Pick and Place): Triển khai tại các xưởng lắp ráp linh kiện điện tử hoặc đóng gói dược phẩm với tần suất gắp 12-15 sản phẩm/phút, tải trọng vật gắp dưới $200\text{ g}$.
  • Trang thiết bị đào tạo Robotic tại các trường Đại học/Cao đẳng: Làm mô hình trực quan phục vụ giảng dạy các môn học Cơ điện tử, Lý thuyết điều khiển tự động, Robot công nghiệp và Lập trình nhúng.
  • Thao tác trong môi trường độc hại: Gắp mẫu thí nghiệm hóa học, vật phẩm trong tủ cấy vô trùng hoặc khu vực cách ly y tế thông qua điều khiển từ xa qua kết nối Bluetooth/RF.

Hướng dẫn triển khai hệ thống (Deployment Guide)

  1. Yêu cầu nguồn cấp: Bộ nguồn tổ ong DC chuyển mạch $12\text{V} - 20\text{A}$ (đảm bảo dòng tải đỉnh khi 5 động cơ bước và servo hoạt động đồng thời).
  2. Cài đặt phần mềm:
    • Nạp firmware điều khiển Robot_Arm_Controller.ino lên Arduino Mega 2560 thông qua cổng USB Type-B.
    • Cài đặt tệp tin RobotController.apk trên thiết bị Android (hệ điều hành Android 7.0 trở lên).
  3. Quy trình kết nối và vận hành:
    • Cấp nguồn 12V cho RAMPS 1.4; kiểm tra đèn LED báo nguồn trên driver DRV8825.
    • Bật Bluetooth trên điện thoại, quét và kết nối với module HC-05 (mã PIN mặc định: 1234).
    • Mở ứng dụng, nhấn nút "Connect Bluetooth", chọn thiết bị HC-05.
    • Sử dụng các thanh trượt (Sliders) để điều khiển thủ công các khớp $J_1 \div J_5$ và nút đóng/mở kẹp.
    • Nhấn "Save Point" để lưu các mốc vị trí $A, B, C...$; nhấn "Auto Run" để kích hoạt chu trình tự động.

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

Hạn chế kỹ thuật

  • Vận hành vòng hở (Open-loop System): Do sử dụng động cơ bước không gắn encoder hồi tiếp góc quay thực, hệ thống có nguy cơ bị trượt bước (loss of steps) nếu chịu tải va đập đột ngột vượt quá mô-men giữ.
  • Biến dạng đàn hồi cơ khí: Vật liệu nhựa in 3D ABS có hệ số giãn nở nhiệt và độ võng nhất định khi cánh tay vươn dài tối đa ($535\text{ mm}$), dẫn đến sai số vị trí tăng lên ở vùng biên không gian làm việc.
  • Băng thông truyền thông: Kết nối Bluetooth HC-05 (bước truyền UART 9600 bps) có độ trễ truyền gói tin, chưa phù hợp cho các tác vụ bám quỹ đạo liên tục ở tốc độ cao (Continuous Path Tracking).

Hướng phát triển trong tương lai

  • Nâng cấp điều khiển vòng kín (Closed-Loop Stepper): Tích hợp cảm biến góc quay từ tính tuyệt đối 14-bit (AS5600 hoặc AS5048A) tại mỗi trục khớp để bù sai số động thời gian thực.
  • Cải tiến kết cấu cơ khí: Chuyển đổi các khâu chịu lực chính (Khâu 1, Khâu 2) sang vật liệu hợp kim nhôm 6061 gia công CNC hoặc Carbon Fiber; thay thế khớp nối mềm bằng khớp nối cardan hoặc hộp số sóng Harmonic siêu nhẹ.
  • Tích hợp Thị giác máy tính (Machine Vision): Lắp đặt camera RGB-D (Intel RealSense D435) ở đầu công tác (Eye-in-Hand) kết hợp thuật toán YOLOv8 / OpenCV để nhận dạng và gắp vật thể ngẫu nhiên trên băng tải.

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

                    ┌───────────────────────────────┐
                    │     ĐỒ ÁN ROBOT 6-DOF BKHN    │
                    └──────────────┬────────────────┘
         ┌─────────────────┬───────┴─────────┬─────────────────┐
         ▼                 ▼                 ▼                 ▼
   [Sinh Viên]       [Kỹ Sư R&D]        [Doanh Nghiệp]    [Nhà Nghiên Cứu]
 - Thực hành D-H   - Mã nguồn mở     - Giải pháp SME   - Nền tảng phát triển
 - Tiếp cận RAMPS  - Tối ưu động học - Chi phí < 8tr   - Mô phỏng Simulink
  • Sinh viên ngành Cơ điện tử / Tự động hóa: Nguồn tài liệu thực nghiệm hoàn chỉnh từ khâu giải tích toán học D-H, tính toán động lực học đến thiết kế mạch điện RAMPS 1.4 và lập trình điều khiển.
  • Kỹ sư và Nhà sáng chế (Makers/Developers): Bộ khung thiết kế mã nguồn mở có thể tùy biến kích thước, dễ dàng phát triển các thuật toán điều khiển phi tuyến nâng cao (Sliding Mode Control, Backstepping, Adaptive PID).
  • Doanh nghiệp vừa và nhỏ (SMEs): Bản thiết kế mẫu cánh tay phân loại hàng hóa chi phí siêu thấp (dưới 8 triệu VNĐ), có thể tự chế tạo và bảo trì tại chỗ mà không phụ thuộc nhà cung cấp ngoại.
  • Cộng đồng nghiên cứu Robot học: Bộ thông số D-H và ma trận khối lượng/quán tính đã được kiểm chứng thực nghiệm, sẵn sàng tích hợp vào hệ điều hành Robot ROS/ROS2 thông qua package URDF (Unified Robot Description Format).

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

1. Yêu cầu kỹ thuật tối thiểu để triển khai và nạp code cho hệ thống robot?

Hệ thống yêu cầu nguồn cấp DC $12\text{V} - 20\text{A}$, máy tính cài đặt Arduino IDE v1.8 trở lên có nạp sẵn thư viện AccelStepper hoặc FlexyStepper, cáp USB nạp cho board ATmega2560 và điện thoại Android (Android 7.0+) cài đặt file APK điều khiển.

2. Giới hạn tải trọng nâng và tầm với của cánh tay robot là bao nhiêu?

Cánh tay có bán kính không gian làm việc tối đa là $535\text{ mm}$, chiều cao hoạt động $840\text{ mm}$. Tải trọng gắp danh định tối ưu là $150\text{ g} - 300\text{ g}$ ở đầu tay kẹp để đảm bảo động cơ bước khâu 2 và khâu 3 không bị trượt bước trong suốt hành trình gia tốc.

3. Làm thế nào để tích hợp robot vào hệ thống PLC công nghiệp hoặc ROS?

Bo mạch Arduino Mega 2560 có thể giao tiếp với PLC công nghiệp thông qua các chân Digital I/O cách ly quang (Optocoupler) để truyền nhận tín hiệu cờ (Handshaking signals: Start, Busy, Done, Error), hoặc kết nối với máy tính nhúng Raspberry Pi/Jetson Nano qua cổng USB Serial để chạy các node điều khiển MoveIt! trong ROS2.

4. Quy trình bảo trì cơ khí và hiệu chuẩn điện tử cần thực hiện như thế nào?

Cần định kỳ kiểm tra độ căng của 4 bộ truyền đai răng HTD-5M sau mỗi 50 giờ hoạt động để tránh trượt răng; bôi trơn các vòng bi đỡ trục; kiểm tra và căn chỉnh điện áp tham chiếu $V_{\text{ref}}$ trên biến trở của 5 mạch driver DRV8825 ($V_{\text{ref}} = I_{\text{max}} \times 8 \times R_s \approx 0.6\text{V} - 1.2\text{V}$) để tránh hiện tượng quá nhiệt động cơ.

5. Tổng chi phí chế tạo toàn bộ hệ thống là bao nhiêu và thời gian thu hồi vốn (ROI)?

Toàn bộ chi phí phần cứng (nhựa in 3D ABS, động cơ bước NEMA 17/23, servo MG995, mạch RAMPS 1.4, Arduino Mega 2560, nguồn 12V, puly, đai răng, ốc vít) dao động từ 5.500.000 đến 7.500.000 VNĐ. Đối với các cơ sở đào tạo hoặc xưởng lắp ráp nhỏ, thời gian thu hồi vốn ước tính chỉ từ 2 đến 4 tháng so với việc đầu tư cánh tay thương mại nhập khẩu.

Kết luận

Đồ án tốt nghiệp "Thiết kế và điều khiển cánh tay Robot 6 bậc tự do" của nhóm sinh viên Nguyễn Năng Nam Hải và Vũ Văn Hiệp (Đại học Bách Khoa Hà Nội) đã 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 không chỉ giải quyết trọn vẹn bài toán học thuật về động học thuận - ngược D-H, phương trình động lực học Euler-Lagrange và quy hoạch quỹ đạo vận tốc hình thang 3 pha mượt mà, mà còn cung cấp một sản phẩm phần cứng thực nghiệm hoạt động ổn định, độ chính xác lặp lại đạt xấp xỉ $\pm 1.8\text{ mm}$.

Với chi phí chế tạo cạnh tranh, kiến trúc mở và giao diện điều khiển di động tiện lợi, mô hình cánh tay robot 6-DOF này khẳng định tiềm năng ứng dụng to lớn trong giáo dục kỹ thuật cao và dây chuyền tự động hóa SME. Đây là nền tảng vững chắc để tiếp tục tích hợp các công nghệ thông minh như điều khiển vòng kín với encoder từ tính và thị giác máy tính AI trong giai đoạn phát triển tiếp theo.