Giới thiệu dự án

Trong kỷ nguyên tự động hóa công nghiệp và Công nghiệp 4.0, các hệ thống tay máy robot đóng vai trò nòng cốt trong việc tối ưu hóa năng suất, nâng cao độ chính xác gia công và loại bỏ rủi ro lao động trong môi trường độc hại. Theo thống kê của Liên đoàn Robot Quốc tế (IFR), dòng robot SCARA (Selective Compliance Articulated Robot Arm) chiếm hơn 30% thị phần robot lắp ráp và đóng gói nhờ ưu thế vượt trội về độ cứng vững theo phương thẳng đứng kết hợp tính linh hoạt cao trong mặt phẳng nằm ngang.

Tuy nhiên, tại Việt Nam, phần lớn các doanh nghiệp sản xuất vừa và nhỏ (SMEs) gặp rào cản lớn khi tiếp cận các dòng robot SCARA thương mại nhập khẩu (như Epson, Yamaha, Denso, Kuka) do chi phí đầu tư ban đầu quá cao (dao động từ 15.000 – 40.000 USD/hệ thống) và sự phụ thuộc hoàn toàn vào hệ điều khiển đóng của nhà sản xuất. Ngược lại, các nghiên cứu trong nước trước đây chủ yếu dừng lại ở mức mô phỏng lý thuyết trên MATLAB/CAD hoặc chế tạo mô hình sử dụng động cơ bước (stepper motor) vòng hở có tốc độ phản hồi chậm, độ chính xác suy giảm nghiêm trọng khi vận hành tải liên tục.

Đồ án tốt nghiệp "Nghiên cứu phương án điều khiển Robot SCARA" (thực hiện tại Khoa Cơ khí Chế tạo máy – Bộ môn Cơ điện tử, Trường Đại học Sư phạm Kỹ thuật TP.HCM) giải quyết trực tiếp bài toán thiết kế, tích hợp cơ điện tử và phát triển hệ thống điều khiển vị trí tốc độ cao cho robot SCARA 4 bậc tự do (4-DOF). Đề tài tập trung hoàn thiện cơ cấu cơ khí khớp xoay thứ 4, tích hợp hệ thống kẹp hút chân không khí nén và xây dựng giải thuật điều khiển hồi tiếp vị trí vòng kín (Closed-loop PID Control) trên nền tảng vi điều khiển chuyên dụng.

                  +-----------------------------------+
                  |   PC Host GUI (C# / WinForms)    |
                  +-----------------+-----------------+
                                    | (RS232/USART)
                                    v
                  +-----------------------------------+
                  |  Main Microcontroller Board (ARM) |
                  +--------+-----------------+--------+
                           |                 |
         +-----------------+                 +------------------+
         | (UART/PWM)                                           | (SPI/QEI)
         v                                                      v
+------------------+  +------------------+             +------------------+
| DC Servo Drivers |  | Pneumatic Driver |             |  Encoder Reader  |
| (Joints 1,2,3,4) |  | (Solenoid Valve) |             |  Feedback Board  |
+--------+---------+  +--------+---------+             +--------+---------+
         |                     |                                ^
         v                     v                                |
+------------------+  +------------------+                      |
| DC Servo Motors  |  | Vacuum Ejector & |                      |
| + Harmonic Gear  |  |  Suction Cup     |                      |
| + Timing Belt    |  +--------+---------+                      |
+--------+---------+           |                                |
         |                     v                                |
         |             +-----------------+                      |
         +------------>| SCARA Mechanism +----------------------+
                       | & Workpiece (10 | (Optical Encoders:
                       |   Steel Balls)  |  200-400 ppr)
                       +-----------------+

Mục tiêu nghiên cứu cụ thể

  1. Thiết lập mô hình toán học động học: Xây dựng bảng thông số Denavit-Hartenberg (D-H), giải phương trình động học thuận (Forward Kinematics), động học nghịch (Inverse Kinematics) và ma trận Jacobian vận tốc cho Robot SCARA 4-DOF.
  2. Thiết kế và hoàn thiện cơ khí khớp thứ 4: Tính toán, lựa chọn và chế tạo bộ truyền đai răng (Timing Belt Drive) loại 160XL kết hợp động cơ DC Servo NF5475E để điều khiển định hướng trục quay công tác.
  3. Phát triển hệ thống gắp sản phẩm khí nén: Tích hợp cụm van điện từ 3/2 MPS-322S, van hút chân không tạo áp suất âm VRI 09 (5 bar) và phễu hút cao su ISV-1/8 chuyên dụng để gắp thả bi thép $\varnothing 20\text{ mm}$.
  4. Thiết kế mạch điều khiển và driver công suất: Chế tạo mạch DC Servo Driver sử dụng cầu H điều chế độ rộng xung (PWM) kết hợp vi điều khiển ARM và mạch thu thập tín hiệu encoder quadrature (QEI).
  5. Xây dựng giải thuật điều khiển vị trí thời gian thực: Lập trình thuật toán PID số vòng kín, chia điểm quỹ đạo và giao tiếp máy tính qua chuẩn USART nhằm điều khiển di chuyển điểm-điểm (PTP) và chu trình tự động tốc độ cao.

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

  • Cấu hình động học: Chuỗi động học hở 4 bậc tự do R-R-P-R (Khớp 1: xoay $[-140^\circ, 140^\circ]$; Khớp 2: xoay $[-150^\circ, 150^\circ]$; Khớp 3: tịnh tiến $d_3 \le 350\text{ mm}$; Khớp 4: xoay quanh trục thẳng đứng).
  • Tải trọng thao tác: Tải hữu ích định mức 0.5 kg (chuyên dụng gắp 10 viên bi thép công nghiệp từ khuôn nạp sang khuôn nhận với độ chính xác lặp lại $\pm 0.2\text{ mm}$).
  • Phương pháp điều khiển: Tập trung vào điều khiển vị trí vòng kín từng khớp độc lập kết hợp phối hợp nội suy điểm, chưa áp dụng bộ bù động lực học phi tuyến hoàn chỉnh (Computed Torque Control).

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 SCARA Công nghiệp Nhập khẩu (Denso/Epson) Mô hình SCARA Mã nguồn mở (Dùng Động cơ bước) Giải pháp SCARA Đề tài (Closed-Loop DC Servo)
Hệ thống dẫn động AC Servo + Bộ truyền Harmonic/Cycloid cao cấp Động cơ bước (Stepper Motor) truyền động trực tiếp DC Servo Motor + Harmonic Gear (Khớp 1, 2) + Đai răng (Khớp 4)
Hệ thống phản hồi Encoder tuyệt đối (Absolute Optical/Magnetic) > 17-bit Không có phản hồi (Vòng hở, dễ trượt bước khi quá tải) Encoder gia tăng (Incremental Quadrature Optical) 200 - 400 ppr
Độ chính xác lặp $\pm 0.01 - \pm 0.02\text{ mm}$ $\pm 0.5 - \pm 1.0\text{ mm}$ $\pm 0.15 - \pm 0.25\text{ mm}$
Tốc độ làm việc Cực cao (Thời gian chu kỳ < 0.4s) Thấp đến trung bình (Dễ rung lắc khi tăng tốc) Tốc độ cao (Tối ưu hóa chia điểm quỹ đạo, chu kỳ ~1.2s)
Tính mở của hệ thống Hệ thống đóng (Black-box firmware, chi phí license cao) Mã nguồn mở (GRBL/Marlin), hạn chế mở rộng động học phức tạp Hoàn toàn làm chủ mã nguồn firmware C/C++, GUI tùy biến
Chi phí đầu tư Rất cao (400 - 800 triệu VNĐ) Thấp (10 - 25 triệu VNĐ) Tối ưu (20 - 35 triệu VNĐ)

Phân tích yêu cầu hệ thống theo mô hình MoSCoW

  • Must Have (Bắt buộc phải có):
    • Khớp 1 và Khớp 2 dẫn động bằng động cơ DC Servo R506B-072E (24V, 50W) qua hộp số Harmonic giảm thiểu khe hở góc (backlash $\approx 0$).
    • Khớp 3 sử dụng cơ cấu vít me bi (Ball Screw $D = 20\text{ mm}$, bước vít $p = 20\text{ mm}$) dẫn động bởi động cơ FC9MB40E (12V, 30W).
    • Khớp 4 hoàn thiện bằng cụm truyền động đai răng 160XL với tỉ số truyền $i = 1.62$.
    • Mạch đọc phản hồi Encoder đa kênh thời gian thực chống nhiễu.
  • Should Have (Nên có):
    • Giao diện điều khiển giám sát trực quan trên máy tính (PC GUI) hiển thị tọa độ thực thời gian thực và vẽ đồ thị đáp ứng vị trí.
    • Cụm giác hút chân không tạo áp suất âm bằng nguyên lý Venturi đạt -0.8 bar trong thời gian $< 50\text{ ms}$.
  • Could Have (Có thể mở rộng):
    • Tích hợp cảm biến quang học kiểm tra sự hiện diện của phôi trong khuôn chứa.
    • Chức năng tự động về gốc (Auto-Homing) sử dụng cảm biến tiệm cận quang.
  • Won't Have (Chưa thực hiện trong phạm vi đồ án):
    • Hệ thống thị giác máy tính (Visual Servoing) nhận diện phôi ngẫu nhiên trên băng tải.

Thiết kế hệ thống

Hệ thống điều khiển SCARA được thiết kế theo cấu trúc phân tầng phân tán (Hierarchical Distributed Control Architecture):

  1. Tầng giám sát và hoạch định quỹ đạo (Host Level):
    • Phần mềm giao diện phát triển trên nền tảng .NET/C# WinForms giao tiếp với bộ điều khiển trung tâm qua cổng nối tiếp USART tốc độ baud 115200 bps.
    • Nhiệm vụ: Nhận tọa độ đích $(X, Y, Z, Roll)$, tính toán giải thuật động học nghịch, chia các điểm nội suy trung gian và truyền gói dữ liệu lệnh xuống phần cứng.
  2. Tầng điều khiển trung tâm & Phản hồi (Master Controller & Feedback Level):
    • Vi điều khiển ARM Cortex-M thực hiện thu nhận chuỗi dữ liệu, kiểm tra mã lỗi (Checksum), phát tín hiệu điều khiển vị trí đến từng module driver.
    • Module xử lý encoder chuyên dụng giao tiếp ngoại vi QEI (Quadrature Encoder Interface) 4 kênh độc lập, liên tục cập nhật giá trị góc khớp thực tế $\theta_1, \theta_2, d_3, \theta_4$.
  3. Tầng chấp hành công suất (Actuation & Driver Level):
    • 04 mạch DC Servo Driver tích hợp cầu H công suất sử dụng MOSFET N-Channel, cách ly quang học bằng Optocoupler tốc độ cao 6N137, tần số băm xung PWM 20 kHz tránh tiếng ồn âm tần.
    • Cụm van khí nén điều khiển đóng mở nguồn cấp khí nén 5 - 8 bar vào van tạo chân không.

Bảng thông số kỹ thuật động cơ và thiết bị khí nén

Cụm chức năng Tên thiết bị / Mã hiệu Thông số điện áp Công suất / Áp suất Độ phân giải Encoder / Tỉ số truyền
Khớp 1 (Base Joint) DC Servo R506B-072E 24 VDC 50 W (3000 rpm) 400 xung/vòng (Quadrature: 1600 ppr) + Harmonic Gear
Khớp 2 (Elbow Joint) DC Servo R506B-072E 24 VDC 50 W (3000 rpm) 400 xung/vòng (Quadrature: 1600 ppr) + Harmonic Gear
Khớp 3 (Z Prismatic) DC Servo FC9MB40E 12 VDC 30 W (2200 rpm) 400 xung/vòng + Vít me bi $p = 20\text{ mm}$
Khớp 4 (Wrist Roll) DC Servo NF5475E 24 VDC 32.5 W (4948 rpm) 200 xung/vòng + Bộ truyền đai răng $i = 1.62$
Van cấp khí nén Solenoid Valve MPS-322S 24 VDC Áp suất 5 - 8 bar Van đảo chiều 3 cửa 2 vị trí (3/2)
Tạo chân không Vacuum Ejector VRI 09 Khí nén cơ bản Áp suất cấp 5 bar Độ chân không tối đa -85 kPa
Cơ cấu gắp hút Suction Cup 33969 ISV-1/8 Khí nén hút Lực hút danh định 15 N Đầu hút đàn hồi cao su chịu dầu

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

Quy trình nghiên cứu áp dụng mô hình phát triển chữ V kết hợp thử nghiệm mô phỏng số (Hardware-In-The-Loop Simulation):

Phân tích yêu cầu & Động học Robot (D-H, Jacobian)
       \                                      /  Đánh giá thực nghiệm & Tối ưu hóa PID
        \                                    /
   Thiết kế 3D CAD Khớp 4 & Bộ truyền đai  Kiểm thử tích hợp chu trình Pick & Place
          \                                /
           \                              /
      Thiết kế mạch Driver & MCU ARM --- Thi công lắp ráp cơ điện & Lập trình Firmware
  • Quản lý rủi ro & Biện pháp khắc phục:
    • Rủi ro trượt bước/sai số truyền động khớp 4: Lựa chọn đai răng cao su sợi cốt thép 160XL (răng thang), tính toán góc ôm $\alpha_1 = 170.1^\circ > 120^\circ$, loại trừ hoàn toàn hiện tượng trượt trơn.
    • Rủi ro nhiễu tín hiệu xung Encoder khi motor đóng cắt PWM: Bố trí đường mạch riêng biệt cho mass động lực (Power GND) và mass tín hiệu (Digital GND), kết hợp lọc phần cứng RC tại chân ngắt vi điều khiển.
    • Rủi ro va chạm cơ khí cuối hành trình: Cài đặt giới hạn mềm (Software Limits) trong firmware và gắn công tắc hành trình cơ học cắt nguồn khẩn cấp.

Implementation và kết quả

Quá trình phát triển kỹ thuật

1. Mô hình toán học động học và Jacobian

Áp dụng quy tắc Denavit-Hartenberg (D-H), hệ trục tọa độ được gắn lên các khâu của robot SCARA 4-DOF:

Bảng tham số D-H của Robot SCARA
Khớp $i$ $\theta_i$ (Biến khớp) $\alpha_i$ (Góc xoắn) $a_i$ (Chiều dài khâu) $d_i$ (Độ lệch trục)
1 $\theta_1^*$ $0^\circ$ $l_1$ $d_1$
2 $\theta_2^*$ $180^\circ$ $l_2$ $0$
3 $0^\circ$ $0^\circ$ $0$ $d_3^*$
4 $\theta_4^*$ $0^\circ$ $0$ $d_4$

Ma trận biến đổi thuần nhất từ khâu $i$ về khâu $i-1$: $$^{i-1}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}$$

Nhân liên tiếp 4 ma trận chuyển đổi $^{0}T_4 = A_1 A_2 A_3 A_4$, ta thu được hệ phương trình động học thuận: $$\begin{cases} 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_3 - d_4 \end{cases}$$

Giải hệ phương trình lượng giác, nghiệm động học nghịch xác định như sau: $$\cos\theta_2 = \frac{P_x^2 + P_y^2 - l_1^2 - l_2^2}{2 l_1 l_2}, \quad \sin\theta_2 = \pm\sqrt{1 - \cos^2\theta_2} \implies \theta_2 = \text{atan2}(\sin\theta_2, \cos\theta_2)$$ $$\theta_1 = \text{atan2}(S_1, C_1) \quad \text{với} \quad \begin{cases} C_1 = \frac{(l_1 + l_2 C_2)P_x + (l_2 S_2)P_y}{P_x^2 + P_y^2} \ S_1 = \frac{(l_1 + l_2 C_2)P_y - (l_2 S_2)P_x}{P_x^2 + P_y^2} \end{cases}$$ $$d_3 = -P_z - d_4, \quad \theta_4 = \theta_1 + \theta_2 - \phi$$

Ma trận Jacobian hình học xác định mối quan hệ vận tốc đầu công tác $\dot{X} = J(\theta) \dot{q}$: $$J = \begin{bmatrix} -l_1 S_1 - l_2 S_{12} & -l_2 S_{12} & 0 & 0 \ l_1 C_1 + l_2 C_{12} & l_2 C_{12} & 0 & 0 \ 0 & 0 & -1 & 0 \ 0 & 0 & 0 & 0 \ 0 & 0 & 0 & 0 \ 1 & 1 & 0 & -1 \end{bmatrix}$$

2. Tính toán bộ truyền đai răng khớp thứ 4

  • Đường kính bánh đai chủ động: $d_1 = 34\text{ mm}$ ($z_1 = 28\text{ răng}$, tốc độ động cơ $n_1 = 4948\text{ rpm}$).
  • Đường kính bánh đai bị động: $d_2 = 55\text{ mm}$ ($z_2 = 35\text{ răng}$).
  • Tỉ số truyền: $i = \frac{z_2}{z_1} = \frac{d_2}{d_1} = 1.62 \implies n_2 = \frac{4948}{1.62} \approx 3054\text{ rpm}$.
  • Khoảng cách trục thiết kế: $a = 132\text{ mm}$.
  • Góc ôm trên bánh đai chủ động: $$\alpha_1 = 180^\circ - \frac{d_2 - d_1}{a} \times 57^\circ = 180^\circ - \frac{55 - 34}{132} \times 57^\circ = 170.1^\circ \ge 120^\circ \quad (\text{Đạt chuẩn chống trượt})$$
  • Chiều dài đai tiêu chuẩn: Lựa chọn đai răng 160XL (chiều dài danh định $L = 406.08\text{ mm}$, bước răng $p = 5.08\text{ mm}$, chiều cao răng $1.2\text{ mm}$).
/**
 * @brief  Thuat toan PID vi tri roi rac hoa cho Driver DC Servo
 * @param  target_pos: Vi tri xung dat tu bo hoach dinh quy dao
 * @param  current_pos: Vi tri xung thuc te doc tu bo dem QEI
 * @return int16_t: Gia tri PWM xuat ra cau H (-1000 den +1000)
 */
#define PWM_MAX 1000
#define PWM_MIN -1000
#define INTEGRAL_WINDUP_LIMIT 300

typedef struct {
    float Kp;
    float Ki;
    float Kd;
    int32_t prev_error;
    float integral;
} PID_Controller_t;

PID_Controller_t joint_pid = { .Kp = 2.45f, .Ki = 0.08f, .Kd = 0.65f, .prev_error = 0, .integral = 0.0f };

int16_t Compute_Joint_PID(PID_Controller_t *pid, int32_t target_pos, int32_t current_pos, float dt) {
    int32_t error = target_pos - current_pos;
    
    // Tinh thanh phan ti le (Proportional)
    float P_out = pid->Kp * (float)error;
    
    // Tinh thanh phan tich phan (Integral) kem Anti-windup
    pid->integral += (float)error * dt;
    if (pid->integral > INTEGRAL_WINDUP_LIMIT) pid->integral = INTEGRAL_WINDUP_LIMIT;
    else if (pid->integral < -INTEGRAL_WINDUP_LIMIT) pid->integral = -INTEGRAL_WINDUP_LIMIT;
    float I_out = pid->Ki * pid->integral;
    
    // Tinh thanh phan vi phan (Derivative)
    float derivative = ((float)error - (float)pid->prev_error) / dt;
    float D_out = pid->Kd * derivative;
    
    pid->prev_error = error;
    
    // Tong hop cong suat dieu khien
    float total_out = P_out + I_out + D_out;
    
    // Bao hoa dau ra PWM
    if (total_out > PWM_MAX) return PWM_MAX;
    if (total_out < PWM_MIN) return PWM_MIN;
    
    return (int16_t)total_out;
}

Kiểm thử và đánh giá thực nghiệm (Testing & Validation)

Hệ thống được kiểm thử thực nghiệm qua 3 giai đoạn:

  1. Kiểm thử đáp ứng độc lập từng khớp: Đưa tín hiệu đặt dạng bước (Step Response) để hiệu chỉnh các hệ số $K_p, K_i, K_d$.
  2. Kiểm thử nội suy phối hợp 4 trục: Di chuyển từ điểm $A(x_1, y_1, z_1)$ đến điểm $B(x_2, y_2, z_2)$ theo đường cong chia điểm.
  3. Kiểm thử chu trình gắp thả bi thực tế: Vận hành liên tục chu kỳ gắp 10 viên bi thép từ Khuôn 1 sang Khuôn 2 (kích thước khuôn $140 \times 140 \times 16\text{ mm}$).
Toạ độ (mm)
  ^
  |               * * * * * * * * * * * (Target: 300 mm)
  |             *
  |           *   <--- Thoi gian dap ung qua do: Ts = 0.42s
  |         *          Do vot lo: Mp = 4.2%
  |       *            Sai so xac lap: Ess = +/- 0.12 mm
  |     *
  +----------------------------------------------------> Thoi gian (s)
  0    0.1   0.2   0.3   0.4   0.5   0.6   0.7

Bảng kết quả thực nghiệm tọa độ đầu công tác

Điểm kiểm tra Tọa độ đặt $(X, Y, Z)\text{ [mm]}$ Tọa độ thực nghiệm $(X, Y, Z)\text{ [mm]}$ Sai số tuyệt đối $(\Delta X, \Delta Y, \Delta Z)\text{ [mm]}$ Thời gian đáp ứng (s)
Điểm 1 (Gốc khuôn 1) $(220.0, 150.0, -120.0)$ $(220.15, 149.88, -120.05)$ $(+0.15, -0.12, -0.05)$ $0.38\text{ s}$
Điểm 2 (Nhấc phôi Z+) $(220.0, 150.0, -50.0)$ $(220.10, 149.92, -50.02)$ $(+0.10, -0.08, -0.02)$ $0.22\text{ s}$
Điểm 3 (Chuyển tiếp) $(0.0, 280.0, -50.0)$ $(0.18, 279.85, -50.04)$ $(+0.18, -0.15, -0.04)$ $0.55\text{ s}$
Điểm 4 (Vị trí thả K2) $(-180.0, 160.0, -120.0)$ $(-179.82, 160.14, -120.08)$ $(+0.18, +0.14, -0.08)$ $0.48\text{ s}$
  • Độ chính xác định vị trung bình: Đạt sai số mặt phẳng $e_{xy} \le 0.21\text{ mm}$, sai số trục đứng $e_z \le 0.08\text{ mm}$.
  • Độ ổn định chu trình gắp bi thép: Thao tác thành công $10/10$ viên bi thép, không xảy ra hiện tượng rơi phôi nhờ áp suất chân không duy trì ổn định ở mức $-75\text{ kPa}$.

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

  1. Làm chủ cấu trúc cơ điện tử truyền động khớp 4 tích hợp: Khắc phục nhược điểm cồng kềnh của các thiết kế cũ bằng việc tích hợp bộ truyền đai răng $160\text{XL}$ đồng trục với trục vít me rỗng, cho phép vừa truyền chuyển động tịnh tiến Z độc lập, vừa truyền chuyển động xoay $\theta_4$ với góc xoay không giới hạn.
  2. Kiến trúc điều khiển phân tán hiệu năng cao: Tách biệt khối xử lý toán học động học trên PC/ARM trung tâm và các module driver PID thời gian thực dưới mạch chấp hành, đảm bảo tần số lấy mẫu điều khiển vị trí đạt $1\text{ kHz}$ mà không bị trễ bus truyền thông.
  3. Hiệu quả kinh tế vượt trội: Giảm hơn 75% chi phí đầu tư so với việc nhập khẩu cánh tay robot SCARA tương đương, đồng thời mở ra khả năng tùy biến linh hoạt cho các bài toán phân loại sản phẩm quy mô vừa và nhỏ.

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

[Băng tải cấp phôi] ---> [Khuôn định vị 1] 
                               |
                               v (Robot SCARA 4-DOF: Hut chan khong)
                               |
                               +---> [Khuôn phân loại 2] ---> [Băng tải đóng gói]

Các kịch bản ứng dụng điển hình

  • Ngành lắp ráp linh kiện điện tử (SMT & PCB Assembly): Gắp IC, chip dán, tụ điện bề mặt hoặc sắp xếp đầu nối dây tự động với tần suất cao.
  • Ngành chế tạo cơ khí chính xác: Phân loại và gắp phôi bi thép, vòng bi, bu lông, ốc vít từ khay dập sang cụm kiểm tra dung sai tự động.
  • Ngành đóng gói thực phẩm & dược phẩm: Đóng vỉ thuốc, phân chia lọ vaccine hoặc xếp hộp bánh kẹo vào thùng carton với năng suất 45 - 55 sản phẩm/phút.

Yêu cầu triển khai kỹ thuật tại nhà máy

  • Nguồn cấp điện: 220 VAC $\pm 10%$, $50\text{ Hz}$ qua bộ nguồn công nghiệp chuyển đổi $24\text{ VDC} - 15\text{ A}$ và $12\text{ VDC} - 10\text{ A}$.
  • Nguồn khí nén: Áp suất tối thiểu $5.5\text{ bar}$, lưu lượng cấp $60\text{ lít/phút}$, trang bị bộ lọc tách nước và tra dầu bôi trơn khí nén.
  • Không gian lắp đặt: Bệ gá thép tấm phẳng dày $\ge 12\text{ mm}$, diện tích chân đế tối thiểu $500 \times 500\text{ mm}$ chống rung động quán tính.
  • Tính toán hoàn vốn (ROI): Thay thế 02 công nhân thao tác thủ công ở khâu gắp xếp bi thép, tiết kiệm khoảng $120.000.000\text{ VNĐ}$ chi phí nhân công mỗi năm, thời gian thu hồi vốn đầu tư chỉ từ 4 đến 6 tháng.

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

Hạn chế kỹ thuật hiện tại

  • Độ phân giải phản hồi: Sử dụng encoder quang học gia tăng 200 – 400 xung/vòng, chưa đạt độ mịn chuyển động ở các góc vi chỉnh cực nhỏ so với encoder tuyệt đối 17-bit công nghiệp.
  • Quy hoạch quỹ đạo: Đồ án mới áp dụng phương pháp chia điểm rời rạc hình thang, chưa tích hợp quy hoạch biên dạng chữ S (S-curve Jerk-limited profile) dẫn đến hiện tượng rung động nhẹ tại các điểm dừng đảo chiều vận tốc cao.

Hạn chế về tài nguyên & phần cứng

  • Khung thân cơ khí gia công chủ yếu trên máy công cụ truyền thống, chưa đạt độ đồng tâm tuyệt đối tại các gối đỡ trục khớp 3 và 4.

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

  • Tích hợp Camera AI & Machine Vision: Gắn camera công nghiệp trực tiếp trên đầu công tác (Eye-in-Hand) để nhận diện tự động tọa độ và góc xoay của vật thể ngẫu nhiên trên băng tải chuyển động.
  • Nâng cấp giao thức truyền thông công nghiệp: Chuyển đổi giao tiếp UART sang mạng bus thời gian thực CANopen hoặc EtherCAT để đồng bộ hóa tuyệt đối chu kỳ điều khiển $< 250,\mu\text{s}$.
  • Áp dụng giải thuật điều khiển thông minh: Triển khai bộ điều khiển trượt thích nghi (Adaptive Sliding Mode Control) và bù mô-men trọng trường để tăng độ mượt chuyển động khi thay đổi tải trọng hữu ích đột ngột.

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

  • Sinh viên & Học viên chuyên ngành Cơ điện tử / Tự động hóa: Cung cấp tài liệu tham khảo chi tiết từ lý thuyết D-H, Jacobian đến thiết kế mạch công suất cầu H và lập trình PID nhúng trên vi điều khiển.
  • Kỹ sư R&D & Nhà phát triển Robot: Nắm bắt phương pháp tính toán bộ truyền đai răng, thiết kế hệ thống khí nén chân không và xử lý tín hiệu Encoder chống nhiễu công nghiệp.
  • Doanh nghiệp vừa và nhỏ (SMEs): Tiếp cận giải pháp tự động hóa nội địa hóa với chi phí thấp, dễ bảo trì, thay thế linh kiện và làm chủ 100% công nghệ.
  • Các nhóm nghiên cứu học thuật: Nền tảng phần cứng ổn định để thử nghiệm các thuật toán điều khiển nâng cao (Mạng nơ-ron, Điều khiển thích nghi mờ, Robot học tăng cường).

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

1. Yêu cầu kỹ thuật tối thiểu về phần cứng và phần mềm để vận hành cánh tay robot SCARA này là gì?

Hệ thống yêu cầu nguồn cấp công nghiệp $24\text{ VDC} - 15\text{ A}$ cho mạch công suất khớp 1, 2, 4 và $12\text{ VDC} - 10\text{ A}$ cho khớp 3; nguồn cấp khí nén ổn định từ $5 - 8\text{ bar}$. Phía máy tính yêu cầu hệ điều hành Windows 7/10/11, cài đặt .NET Framework 4.5 trở lên và có cổng USB/COM hỗ trợ tốc độ truyền 115200 bps.

2. Giải pháp khắc phục hiện tượng trễ hoặc mất xung khi đọc đồng thời 4 kênh Encoder ở tốc độ cao?

Hệ thống sử dụng module xử lý vi điều khiển trung gian tích hợp bộ ngoại vi đếm xung phần cứng QEI chuyên dụng (Hardware Quadrature Encoder Interface). Bộ đếm phần cứng giải mã trực tiếp 4 trạng thái cạnh xung (x4 Mode) mà không dùng ngắt ngoài phần mềm (GPIO Interrupt), giúp triệt tiêu hoàn toàn hiện tượng trễ ngắt và ngăn ngừa mất xung ngay cả khi motor quay ở tốc độ cực đại 4948 rpm.

3. Hệ thống có thể tích hợp vào dây chuyền sản xuất PLC sẵn có trong nhà máy không?

Hoàn toàn có thể. Bộ điều khiển trung tâm được thiết kế sẵn các chân I/O cách ly quang nhận tín hiệu Start/Stop/Ready chuẩn công nghiệp 24V từ PLC (Siemens S7-1200, Mitsubishi FX Series), hoặc giao tiếp qua chuẩn truyền thông Modbus RTU (RS485) để nhận lệnh điều khiển tọa độ trực tiếp từ PLC chủ.

4. Tại sao lại chọn bộ truyền đai răng 160XL cho khớp thứ 4 thay vì truyền động bánh răng trực tiếp?

Bộ truyền đai răng mang lại ưu thế: vận hành cực kỳ êm ái, giảm chấn và triệt tiêu dao động mô-men xoắn đột ngột lên trục động cơ, không cần bôi trơn liên tục như bánh răng hở, đồng thời cho phép bố trí động cơ song song lệch tâm với trục quay công tác, giúp cụm đầu tay máy đạt kích thước gọn gàng nhất.

5. 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) thế nào?

Tổng chi phí vật tư cơ khí, động cơ servo, gia công chi tiết, mạch điện tử và cụm khí nén chân không rơi vào khoảng 25 - 32 triệu VNĐ. So với chi phí thuê nhân công bốc dỡ/gắp sản phẩm, hệ thống giúp tiết kiệm khoảng 10 triệu VNĐ/tháng, mang lại thời gian thu hồi vốn đầu tư thực tế trong vòng 3 – 4 tháng vận hành liên tục.

Kết luận

Đề tài "Nghiên cứu phương án điều khiển Robot SCARA" đã giải quyết toàn diện bài toán từ xây dựng mô hình toán học giải tích, thiết kế thi công cơ khí bổ sung khớp thứ 4, tích hợp hệ thống kẹp hút khí nén chân không, cho đến làm chủ thiết kế phần cứng điện tử và thuật toán điều khiển PID vòng kín thời gian thực. Kết quả thử nghiệm gắp thả 10 viên bi thép liên tục giữa hai khuôn định vị với độ chính xác đạt $\pm 0.2\text{ mm}$ và thời gian đáp ứng quá độ $< 0.45\text{ s}$ là minh chứng vững chắc cho tính khả thi và độ tin cậy của mô hình.

Công trình không chỉ đóng góp một giải pháp phần cứng mở, chi phí tối ưu phục vụ công tác giảng dạy và nghiên cứu chuyên sâu tại các trường đại học kỹ thuật, mà còn tạo tiền đề vững chắc cho việc ứng dụng robot SCARA nội địa hóa vào các dây chuyền đóng gói, lắp ráp linh kiện tự động tại các nhà máy sản xuất ở Việt Nam.