Giới thiệu dự án

Sự bùng nổ của cuộc Cách mạng Công nghiệp 4.0 đã thúc đẩy tự động hóa trở thành trụ cột sống còn trong dây chuyền sản xuất hiện đại. Theo thống kê từ Liên đoàn Robot Quốc tế (IFR), mật độ robot trong các nhà máy toàn cầu đã vượt mức 151 đơn vị trên 10.000 công nhân, giúp nâng cao năng suất từ 30% đến 45% và giảm thiểu tối đa tai nạn lao động trong các môi trường độc hại, nhiệt độ cao hoặc phóng xạ. Tuy nhiên, rào cản tài chính đối với các cánh tay robot công nghiệp 6 bậc tự do đắt đỏ (thường dao động từ 15.000 đến 50.000 USD) khiến các doanh nghiệp vừa và nhỏ (SMEs) khó tiếp cận giải pháp tự động hóa cục bộ.

Đồ án tốt nghiệp "Thiết kế và điều khiển cánh tay robot ba bậc tự do" (ngành Công nghệ Kỹ thuật Điều khiển và Tự động hóa, Trường Đại học Sư phạm Kỹ thuật TP.HCM) giải quyết bài toán cốt lõi: Phát triển một hệ thống cánh tay robot 3 bậc tự do (3-DOF RRR) với chi phí tối ưu, ứng dụng phương pháp Thiết kế Dựa trên Mô hình (Model-Based Design - MBD) để rút ngắn chu kỳ nghiên cứu và triển khai thực tế.

flowchart LR
    A[Môi trường MATLAB/Simulink] -->|Waijung Blockset C Code Gen| B[Kit STM32F4 Discovery ARM Cortex-M4]
    B -->|PWM + Direction Signals| C[Mạch công suất Cầu H]
    C -->|Dòng điện điều khiển| D[Động cơ DC Servo 3 Khớp]
    D -->|Phản hồi xung Encoder| B
    B -->|Giao tiếp UART 115200 bps| E[Giao diện Giám sát Real-time Host PC]

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

  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 ngược (Inverse Kinematics) và ma trận Jacobi vận tốc.
  2. Quy hoạch quỹ đạo thông minh: Ứng dụng giải thuật đường cong Bézier bậc hai (Quadratic Bézier Curve) trong không gian 3 chiều để tạo quỹ đạo di chuyển trơn tru và né tránh chướng ngại vật thông qua điểm điều khiển ảo (virtual control point).
  3. Phát triển hệ thống điều khiển nhúng thời gian thực: Thiết kế bộ điều khiển PID số (Digital PID Controller) trên nền tảng vi điều khiển STM32F4 Discovery (ARM Cortex-M4 168 MHz) sử dụng thư viện Waijung Blockset trong môi trường MATLAB/Simulink.
  4. Hiện thực hóa phần cứng và truyền thông: Thi công hoàn thiện cơ cấu cơ khí 3 khớp quay, mạch lái động cơ cầu H, đọc phản hồi vòng kín từ bộ mã hóa xung quang học (Incremental Optical Encoder) và truyền thông dữ liệu hai chiều tốc độ cao qua UART PL-2303.

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

  • Cấu hình động học: Cánh tay robot 3 bậc tự do dạng khớp quay nối tiếp (Revolute-Revolute-Revolute: RRR).
  • Tải trọng danh định: 300g – 500g tại khâu chấp hành cuối (End-Effector).
  • Không gian làm việc (Workspace): Bán kính hoạt động cực đại $R \approx 350\text{ mm}$.
  • Giao thức điều khiển: Điều khiển vị trí vòng kín từng khớp độc lập với chu kỳ trích mẫu $T_s = 1\text{ ms} - 10\text{ ms}$.

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 Giải pháp PLC Công nghiệp Giải pháp Vi điều khiển 8-bit (Arduino/AVR) Giải pháp STM32F4 + Waijung MBD (Dự án)
Khả năng tính toán số thực (FPU) Trung bình (phụ thuộc module) Không có (xử lý giả lập phần mềm rất chậm) Tích hợp Hardware FPU 32-bit (168 MHz, 210 DMIPS)
Quy hoạch quỹ đạo bậc cao Phức tạp, hạn chế thuật toán tự do Không khả thi với giải thuật Bézier 3D phức tạp Tính toán thời gian thực ma trận Jacobi & Bézier trơn tru
Thời gian phát triển phần mềm Dài (lập trình Ladder/Structured Text) Trung bình (mã nguồn C++ thuần dễ phân mảnh) Cực ngắn (Sinh mã tự động 100% từ Simulink)
Chi phí phần cứng Rất cao (> 1.000 USD) Rất thấp (< 30 USD) Tối ưu (~ 60 - 120 USD)
Khả năng mở rộng vòng kín Tốt thông qua module mở rộng đắt tiền Hạn chế số kênh Timer ngắt phần cứng đọc Encoder 4 bộ Timer 16/32-bit hỗ trợ chế độ Encoder Hardware

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

  • Must-Have (Bắt buộc): Mô hình động học D-H chính xác; bộ điều khiển PID số chống trôi vị trí; thuật toán nội suy Bézier không gian; đọc Encoder 4x Quadrature; bảo vệ ngắt khẩn cấp.
  • Should-Have (Nên có): Giao diện Host PC giám sát tọa độ thời gian thực qua UART với tốc độ 115200 baud; giải thuật bù sai lệch tĩnh.
  • Could-Have (Có thể có): Khả năng tự động tính toán điểm ảo để tạo đường cong mượt khi gặp vật cản bất kỳ trong không gian làm việc.
  • Won't-Have (Chưa thực hiện đợt này): Cảm biến lực/mô-men xoắn (Force/Torque Sensor) tại đầu gắp; hệ thống thị giác máy tính nhận diện vật thể tự động (Visual Servoing).

Kiến trúc phần cứng và Stack công nghệ

graph TD
    subgraph Host_Computer [Trạm Giám Sát & Điều Khiển]
        Simulink_Env[MATLAB R2014a/R2015a & Simulink]
        Waijung_Lib[Waijung Blockset v14.11a]
        Host_Serial[Host Serial Rx/Tx Module]
    end

    subgraph Embedded_Controller [Bộ Điều Khiển Nhúng STM32F407VGT6]
        Target_Setup[Target Setup @ 168 MHz SysTick]
        Encoder_Read[Timer Hardware Encoder Mode]
        PID_Loop[Discrete PID Controller 1 kHz]
        PWM_Gen[TIM Advanced PWM Generator]
        UART_Core[USART2 / USART3 Peripheral]
    end

    subgraph Actuation_Mechanics [Phần Cứng & Cơ Cấu Chấp Hành]
        Bridge_H[Mạch Công Suất H-Bridge L298N/IR2104]
        DC_Motors[3x DC Geared Motors 12V/24V]
        Encoders[3x Incremental Encoders 334-500 PPR]
        Arm_Links[Khung Cơ Khí Hợp Kim Nhôm/Mica 3-DOF]
    end

    Simulink_Env -->|C Code Generation via RTW| Embedded_Controller
    Host_Serial <-->|UART PL-2303 115200 bps| UART_Core
    Encoder_Read <-- Encoders
    PID_Loop --> PWM_Gen
    PWM_Gen --> Bridge_H
    Bridge_H --> DC_Motors
    DC_Motors --> Arm_Links
    Arm_Links --> Encoders

Thông số kỹ thuật cấu kiện chính:

  • Vi điều khiển: STM32F407VGT6, lõi ARM Cortex-M4 32-bit RISC, bộ nhớ 1MB Flash, 192KB SRAM, tích hợp bộ xử lý số thực phần cứng (FPU).
  • Bộ chuyển đổi giao tiếp: USB-to-UART Bridge PL-2303 hỗ trợ truyền nhận mức tín hiệu TTL (0V - 5V / 3.3V).
  • Phần mềm phát triển: MATLAB R2014a/R2015a, Simulink, Waijung Blockset (Aimagin Co., Ltd), GNU ARM Embedded Toolchain / Keil MDK-ARM.
  • Cơ cấu truyền động: Động cơ DC giảm tốc tích hợp Encoder quang học gia số độ phân giải cao.

Implementation và kết quả

Cơ sở toán học và giải thuật điều khiển

1. Phương trình Động học thuận (Denavit - Hartenberg)

Thiết lập hệ trục tọa độ tham chiếu theo quy tắc bàn tay phải cho 3 khâu của cánh tay robot. Ma trận chuyển đổi thuần nhất tổng quát giữa hai hệ tọa độ liên tiếp $i-1$ và $i$:

$$T_{i}^{i-1} = \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}$$

Ma trận chuyển đổi toàn cục xác định vị trí điểm làm việc cuối của robot:

$$T_3^0 = T_1^0(\theta_1) \cdot T_2^1(\theta_2) \cdot T_3^2(\theta_3) = \begin{bmatrix} n_x & o_x & a_x & p_x \ n_y & o_y & a_y & p_y \ n_z & o_z & a_z & p_z \ 0 & 0 & 0 & 1 \end{bmatrix}$$

Vị trí khâu chấp hành cuối $[p_x, p_y, p_z]^T$ theo các biến khớp $\theta_1, \theta_2, \theta_3$ và chiều dài các khâu $l_1, l_2, l_3$:

$$\begin{cases} p_x = \cos(\theta_1) \cdot [l_2\cos(\theta_2) + l_3\cos(\theta_2 + \theta_3)] \ p_y = \sin(\theta_1) \cdot [l_2\cos(\theta_2) + l_3\cos(\theta_2 + \theta_3)] \ p_z = l_1 + l_2\sin(\theta_2) + l_3\sin(\theta_2 + \theta_3) \end{cases}$$

2. Phương trình Động học ngược (Inverse Kinematics)

Để đưa khâu chấp hành cuối đến điểm mục tiêu $(p_x, p_y, p_z)$, các biến khớp được tính toán bằng phương pháp đại số kết hợp lượng giác:

$$\theta_1 = \text{atan2}(p_y, p_x)$$

Đặt khoảng cách chiếu trên mặt phẳng Oxy là $r = \sqrt{p_x^2 + p_y^2}$ và $z' = p_z - l_1$. Áp dụng định lý hàm số cosin cho tam giác tạo bởi các khâu $l_2, l_3$:

$$\cos(\theta_3) = \frac{r^2 + (z')^2 - l_2^2 - l_3^2}{2 l_2 l_3} \implies \theta_3 = \text{atan2}\left(\pm\sqrt{1 - \cos^2(\theta_3)}, \cos(\theta_3)\right)$$

Góc khớp thứ hai $\theta_2$ thu được thông qua phép khử lượng giác:

$$\theta_2 = \text{atan2}(z', r) - \text{atan2}(l_3\sin(\theta_3), l_2 + l_3\cos(\theta_3))$$

% Thuat toan Dong hoc nguoc cho Robot 3-DOF
function [theta1, theta2, theta3] = inverse_kinematics_3dof(px, py, pz, l1, l2, l3)
    % Tinh goc quay de robot
    theta1 = atan2(py, px);
    
    % Khoang cach hinh chieu tren mat phang Oxy va truc Oz
    r = sqrt(px^2 + py^2);
    z_prime = pz - l1;
    
    % Tinh toan bien khop theta3 (cau hinh elbow-up)
    D = (r^2 + z_prime^2 - l2^2 - l3^2) / (2 * l2 * l3);
    if abs(D) > 1
        error('Toa do nam ngoai vung khong gian lam viec (Workspace)!');
    end
    theta3 = atan2(-sqrt(1 - D^2), D);
    
    % Tinh toan bien khop theta2
    theta2 = atan2(z_prime, r) - atan2(l3 * sin(theta3), l2 + l3 * cos(theta3));
end

3. Quy hoạch quỹ đạo né vật cản bằng Đường cong Bézier bậc hai

Quỹ đạo di chuyển của cánh tay robot từ điểm đầu $P_0(x_0, y_0, z_0)$ đến điểm đích $P_2(x_2, y_2, z_2)$ qua điểm ảo điều khiển hướng $P_1(x_1, y_1, z_1)$ được biểu diễn theo tham số hóa $t \in [0, 1]$:

$$P(t) = (1-t)^2 P_0 + 2t(1-t) P_1 + t^2 P_2$$

Đạo hàm bậc nhất xác định vector vận tốc tiếp tuyến giúp tối ưu hóa gia tốc và triệt tiêu rung động cơ khí:

$$\mathbf{v}(t) = \frac{dP(t)}{dt} = 2(1-t)(P_1 - P_0) + 2t(P_2 - P_1)$$

% Ham tinh toan quy dao Bezier bac hai tranh vat can
function trajectory = generate_bezier_trajectory(P0, P1, P2, num_steps)
    t = linspace(0, 1, num_steps);
    trajectory = zeros(num_steps, 3);
    for i = 1:num_steps
        trajectory(i, :) = (1 - t(i))^2 * P0 + ...
                           2 * t(i) * (1 - t(i)) * P1 + ...
                           t(i)^2 * P2;
    end
end

4. Thuật toán Điều khiển PID số (Discrete PID)

Ứng dụng phương pháp vi phân lùi (Backward Difference Approximation) và tích phân hình thang để rời rạc hóa phương trình điều khiển trên STM32F4:

$$u[k] = u[k-1] + q_0 e[k] + q_1 e[k-1] + q_2 e[k-2]$$

Trong đó các hệ số số học được tối ưu hóa theo chu kỳ lấy mẫu $T_s$:

$$q_0 = K_p + K_i T_s + \frac{K_d}{T_s}, \quad q_1 = -K_p - \frac{2K_d}{T_s}, \quad q_2 = \frac{K_d}{T_s}$$

// Implementation bo dieu khien PID so thoi gian thuc tren STM32F4
typedef struct {
    float Kp, Ki, Kd;
    float Ts;
    float prev_error;
    float prev_prev_error;
    float prev_output;
    float out_max, out_min;
} DiscretePID;

float PID_Compute(DiscretePID *pid, float setpoint, float feedback) {
    float error = setpoint - feedback;
    
    // Tinh toan cac he so sai lech
    float q0 = pid->Kp + (pid->Ki * pid->Ts) + (pid->Kd / pid->Ts);
    float q1 = -pid->Kp - (2.0f * pid->Kd / pid->Ts);
    float q2 = pid->Kd / pid->Ts;
    
    // Tinh toan tin hieu ngo ra dieu khien
    float output = pid->prev_output + (q0 * error) + (q1 * pid->prev_error) + (q2 * pid->prev_prev_error);
    
    // Bao hoa ngo ra (Anti-windup / Saturation)
    if (output > pid->out_max) output = pid->out_max;
    else if (output < pid->out_min) output = pid->out_min;
    
    // Cap nhat trang thai cho chu ky tiep theo
    pid->prev_prev_error = pid->prev_error;
    pid->prev_error = error;
    pid->prev_output = output;
    
    return output;
}

Kết quả thử nghiệm và Đánh giá hiệu năng

Hệ thống đã trải qua các bài kiểm tra thực nghiệm với 5 kịch bản quy hoạch quỹ đạo né vật cản trong không gian với điểm đích $P_2 = [150, 150, 100]\text{ mm}$ từ điểm xuất phát ban đầu, kết hợp thay đổi linh hoạt các tọa độ điểm ảo $P_1$:

Kịch bản thử nghiệm Điểm ảo $P_1(x, y, z)$ [mm] Thời gian đáp ứng $t_s$ (s) Độ vọt lố $\sigma%$ Sai số xác lập $e_{ss}$ Đánh giá trạng thái quỹ đạo
Kịch bản 1 $[150, 150, 0]$ 0.82 s 4.2% $< 0.5\text{ mm}$ Tránh vật cản tầm thấp chính xác
Kịch bản 2 $[150, 0, 150]$ 0.88 s 4.8% $< 0.6\text{ mm}$ Chuyển hướng mượt theo trục Y
Kịch bản 3 $[0, 150, 150]$ 0.85 s 4.5% $< 0.5\text{ mm}$ Uốn cong biên độ rộng theo trục X
Kịch bản 4 $[150, 0, 0]$ 0.79 s 3.9% $< 0.4\text{ mm}$ Quỹ đạo hạ thấp trọng tâm an toàn
Kịch bản 5 $[0, 150, 0]$ 0.81 s 4.1% $< 0.5\text{ mm}$ Phối hợp 3 khớp đạt độ ổn định cao 
Chi tiết thông số PID tối ưu hóa thực nghiệm cho 3 trục:
- Khớp 1 (Khớp quay đế):     Kp = 12.5,  Ki = 0.08,  Kd = 0.45  (Sample Time Ts = 1ms)
- Khớp 2 (Khớp vai nâng):    Kp = 18.2,  Ki = 0.12,  Kd = 0.68  (Sample Time Ts = 1ms)
- Khớp 3 (Khớp khuỷu vươn):  Kp = 15.4,  Ki = 0.10,  Kd = 0.52  (Sample Time Ts = 1ms)

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

  1. Ứng dụng triệt để quy trình Model-Based Design (MBD): Loại bỏ hoàn toàn việc viết mã C thuần truyền thống dễ phát sinh lỗi cấp phát bộ nhớ. Toàn bộ thuật toán từ khối ma trận toán học, bộ đọc Encoder phần cứng (Timer Encoder Mode), khối điều xung Basic PWM đến khối truyền thông Host Serial Rx/Tx đều được cấu hình đồ họa trong Simulink và tự động dịch sang mã máy thông qua Waijung Blockset.
  2. Quy hoạch quỹ đạo Bézier tham số hóa thời gian thực: Thay vì sử dụng nội suy đường thẳng (Linear Interpolation) gây gia tốc giật (Jerk) tại các điểm gãy làm giảm tuổi thọ hộp số, việc ứng dụng đường cong Bézier bậc hai giúp liên tục hóa đạo hàm vận tốc, giảm rung lắc cơ học tới 38% khi bắt đầu và kết thúc chu trình chuyển động.
  3. Giám sát trực quan Hardware-in-the-Loop (HIL): Thiết lập kênh truyền thông song công (Full-duplex) qua module UART PL-2303 ở tốc độ 115200 bps, cho phép truyền dữ liệu góc quay thực tế từ STM32F4 ngược về máy tính để vẽ đồ thị đáp ứng thời gian thực với độ trễ trích mẫu dưới 10 ms.

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

Các tình huống ứng dụng công nghiệp

  • Dây chuyền phân loại sản phẩm (Pick and Place): Kết hợp với hệ thống băng tải để gắp và phân loại sản phẩm dựa trên kích thước hoặc vị trí với chu kỳ 1.5 giây/sản phẩm.
  • Hệ thống cấp phôi tự động cho máy CNC: Đưa phôi cơ khí vào đồ gá với sai số lặp lại nhỏ hơn $0.8\text{ mm}$.
  • Môi trường phòng thí nghiệm và giáo dục đào tạo: Đóng vai trò là mô hình chuẩn mực phục vụ giảng dạy lý thuyết điều khiển tự động, kỹ thuật robot và hệ thống nhúng thời gian thực tại các trường đại học khối kỹ thuật.

Phân tích chi phí và hiệu quả đầu tư (ROI)

Hạng mục cấu thành Chi phí tự triển khai (Mô hình đề tài) Chi phí giải pháp thương mại nhập khẩu
Bộ xử lý & Mạch điều khiển 25 USD (STM32F4 Discovery) 450 USD (Module PLC + Motion Card)
Cơ cấu truyền động & Encoder 40 USD (DC Servo Geared Motors) 600 USD (AC Industrial Servo + Drive)
Khung cơ khí & Gia công 35 USD (Nhôm tấm định hình) 500 USD (Khung đúc công nghiệp)
Mạch công suất & Phụ kiện 20 USD (Driver H-Bridge + Nguồn) 250 USD (Industrial Power Supply)
TỔNG CHI PHÍ ~ 120 USD ~ 1.800 USD

[!TIP] Thời gian hoàn vốn (ROI): Việc ứng dụng mô hình cánh tay robot 3-DOF tự chế tạo trong các dây chuyền phân loại bán tự động giúp giảm chi phí đầu tư ban đầu tới 93.3%, mang lại thời gian thu hồi vốn ước tính chỉ từ 2.5 đến 4 tháng đối với các xưởng sản xuất quy mô nhỏ.

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

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

  • Cơ cấu bánh răng trong hộp số động cơ DC còn tồn tại khe hở cơ khí (backlash), dẫn đến hiện tượng trôi nhẹ khi đảo chiều đột ngột.
  • Chưa tích hợp thuật toán bù trọng trường động học (Lagrange - Euler) cho khớp nâng vai khi cánh tay vươn dài ở tầm với cực đại.
  • Cấu trúc 3 bậc tự do chưa thể tùy biến hướng nghiêng của khâu chấp hành cuối (End-Effector Orientation) trong không gian 6D.

Hướng nâng cấp mở rộng:

  • Tích hợp thị giác máy tính (Computer Vision): Kết hợp camera công nghiệp và thư viện OpenCV để nhận dạng và định vị tọa độ vật thể động trên băng tải.
  • Nâng cấp phần cứng truyền động: Thay thế động cơ DC chổi than bằng động cơ bước vòng kín (Closed-loop Stepper) hoặc Động cơ không chổi than (BLDC) kết hợp hộp số sóng Harmonic Drive nhằm triệt tiêu hoàn toàn khe hở cơ khí.
  • Mở rộng bậc tự do: Nâng cấp lên cấu hình 5 hoặc 6 bậc tự do (6-DOF) và tích hợp hệ điều hành Robot chuyên dụng ROS/ROS 2 (Robot Operating System) giao tiếp qua bus CAN.

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

  • Sinh viên khối ngành Kỹ thuật (Tự động hóa, Cơ điện tử, Nhúng): Tài liệu tham khảo toàn diện từ giải tích toán học D-H, phương pháp điều khiển PID số đến kỹ năng thực hành vi điều khiển ARM Cortex-M4.
  • Kỹ sư R&D và Lập trình viên nhúng: Tiếp cận quy trình Model-Based Design hiện đại với MATLAB/Simulink và Waijung Blockset giúp rút ngắn 70% thời gian tạo mẫu (prototyping).
  • Doanh nghiệp vừa và nhỏ (SMEs): Cơ sở thiết kế khả thi để tự chế tạo các cánh tay robot chuyên dụng giá rẻ cho các công đoạn gắp/đặt đơn giản.
  • Nhà nghiên cứu học thuật: Nền tảng thực nghiệm mở để thử nghiệm các giải pháp điều khiển nâng cao như Điều khiển Trượt (Sliding Mode Control), Điều khiển Thích nghi (Adaptive Control) và Mạng nơ-ron mờ (ANFIS).

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

1. Yêu cầu cấu hình phần cứng và phần mềm tối thiểu để vận hành hệ thống là gì?

Máy tính trạm cần cài đặt hệ điều hành Windows 7/10/11 64-bit, phần mềm MATLAB/Simulink phiên bản R2014a trở lên cùng gói thư viện Waijung Blockset. Phần cứng nhúng bao gồm kit phát triển STM32F4 Discovery, cáp Mini-USB nạp chương trình ST-LINK/V2, module chuyển đổi USB-UART PL-2303 và nguồn tổ ong 12V-5A cấp tải động lực.

2. Làm thế nào để giải quyết hiện tượng trôi vị trí do quán tính của cánh tay robot?

Hệ thống sử dụng bộ điều khiển PID số có bổ sung khâu tích phân hình thang để triệt tiêu triệt để sai số xác lập $e_{ss} \to 0$. Đồng thời, mạch cầu H được kích hoạt chế độ hãm động năng (Dynamic Braking) bằng cách điều khiển ngắn mạch hai cực động cơ thông qua tín hiệu logic khi sai lệch góc nằm trong dải dung sai cho phép ($\pm 0.2^\circ$).

3. Tại sao giải thuật Bézier lại ưu việt hơn phương pháp nội suy bậc ba (Cubic Spline) trong đề tài này?

Đường cong Bézier cho phép người vận hành dễ dàng điều khiển quỹ đạo tránh vật cản trực quan chỉ bằng cách thay đổi tọa độ của một điểm ảo duy nhất ($P_1$). Giải thuật này đòi hỏi ít tài nguyên bộ nhớ và khối lượng phép tính thấp hơn đáng kể so với việc giải hệ phương trình ma trận dải của Cubic Spline, giúp STM32F4 tính toán tức thời mà không gây trễ chu kỳ ngắt.

4. Hệ thống truyền thông UART có bị nghẽn dữ liệu khi gửi nhận liên tục không?

Tốc độ baudrate được thiết lập ở mức chuẩn 115200 bps, tương đương khả năng truyền tải khoảng 11.520 byte/giây. Gói tin định dạng nhị phân tối ưu giữa Host PC và STM32F4 chỉ có kích thước 16 byte/chu kỳ. Với tần số gửi dữ liệu giám sát 100 Hz (10 ms/lần), băng thông chiếm dụng chỉ đạt khoảng 13.8% công suất đường truyền, đảm bảo không xảy ra hiện tượng tràn bộ đệm (Buffer Overflow).

5. Chi phí bảo dưỡng và độ bền cơ học của hệ thống như thế nào?

Nhờ thuật toán Bézier giúp triệt tiêu rung giật đột ngột, áp lực cơ học lên các khớp nối hợp kim và nhông giảm tốc được giảm thiểu đáng kể. Hệ thống chỉ yêu cầu kiểm tra bôi trơn định kỳ ổ bi và hộp giảm tốc sau mỗi 500 giờ vận hành thực tế với chi phí bảo dưỡng gần như bằng không.

Kết luận

Đồ án tốt nghiệp "Thiết kế và điều khiển cánh tay robot ba bậc tự do" đã hoàn thành xuất sắc toàn bộ các mục tiêu đặt ra: từ việc xây dựng cơ sở lý thuyết động học vững chắc, mô hình hóa giải thuật Bézier tránh vật cản, đến việc hiện thực hóa bộ điều khiển PID số trên phần cứng thực tế STM32F4 Discovery thông qua công cụ hiện đại Waijung Blockset.

Sự kết hợp hoàn hảo giữa phương pháp Thiết kế Dựa trên Mô hình (Model-Based Design) và nền tảng vi điều khiển 32-bit hiệu năng cao đã chứng minh tính khả thi vượt trội trong việc hạ giá thành chế tạo cánh tay robot mà vẫn đảm bảo độ chính xác và tính linh hoạt công nghiệp. Đây là bước đệm kỹ thuật quan trọng, mở ra tiềm năng ứng dụng rộng rãi cho các dây chuyền tự động hóa vừa và nhỏ cũng như các phòng thí nghiệm nghiên cứu chuyên sâu.