Giới thiệu dự án

Trong lĩnh vực kỹ thuật điều khiển tự động hiện đại, các hệ thống cơ điện tử thiếu cơ cấu chấp hành (underactuated systems) và phi tuyến bậc cao luôn là bài toán thách thức chuẩn mực đối với các kỹ sư và nhà nghiên cứu. Theo thống kê từ các hiệp hội tự động hóa quốc tế (IEEE Control Systems Society), hơn 70% các bài toán điều khiển chuyển động thực tế trong công nghiệp hàng hải, robot tự hành (AGV) và kỹ thuật hàng không (hạ cánh máy bay trong luồng khí đối lưu) đều quy về dạng bài toán điều khiển đối tượng có số ngõ vào điều khiển ít hơn số bậc tự do ngõ ra (Single-Input Multiple-Output - SIMO).

Hệ thống Bóng và Thanh trục giữa (Ball and Beam with Middle Axis System - B&B) là một mô hình kinh điển đại diện cho lớp đối tượng phi tuyến phức tạp này. Bài toán đặt ra là điều khiển vị trí của quả bóng ($p$) lăn tự do trên thanh ngang dài $0.34\text{ m}$ thông qua góc nghiêng của thanh ($\theta$), được dẫn động bởi một động cơ DC servo thông qua cơ cấu trục quay ở chính giữa thanh beam.

                [ Quả bóng mB = 0.045 kg, R = 0.011 m ]
                   o ---> p(t) (Vị trí bóng)
     ===========================================  (Thanh beam: Lb = 0.34 m, mb = 0.35 kg)
                         |
                       ( O )  Trọng tâm / Trục quay giữa
                         |
                 [ Động cơ DC Servo ] <--- Điện áp điều khiển e(t) (0 - 24V)
                 [ Encoder góc theta ]

Điểm nghẽn kỹ thuật (Problem Statement & Pain Points)

  • Tính phi tuyến và ghép kênh mạnh mẽ: Động lực học của bóng bị ảnh hưởng trực tiếp bởi gia tốc góc của thanh beam và lực quán tính phi tuyến; khi bóng càng rời xa tâm, mômen quán tính toàn hệ thống thay đổi liên tục theo $J(p) = m_B p^2 + J_b$.
  • Hạn chế của điều khiển tuyến tính cổ điển: Bộ điều khiển PID hay LQR truyền thống chỉ tuyến tính hóa quanh điểm cân bằng ($p=0, \theta=0$). Khi bóng di chuyển ra xa điểm cân bằng hoặc khi phải bám các quỹ đạo động phức tạp (sóng sine, xung vuông), mô hình tuyến tính bị sai lệch nghiêm trọng, dẫn đến sai số xác lập lớn, độ trễ pha kéo dài và mất ổn định hệ thống.
  • Hiện tượng trượt và phi tuyến ma sát thực tế: Trong điều kiện thực nghiệm, ma sát tĩnh, khe hở cơ khí và độ nhiễu tín hiệu ADC từ cảm biến vị trí quấn dây điện trở gây suy giảm nghiêm trọng độ chính xác định vị.

Mục tiêu của đồ án

  1. Xây dựng chính xác mô hình toán học giải tích phi tuyến của hệ B&B thông qua phương trình vi phân Euler-Lagrange và mô hình động cơ DC Servo.
  2. Thiết kế và tối ưu hóa bộ điều khiển tuyến tính tối ưu LQR (Linear Quadratic Regulator) dựa trên phương trình đại số Riccati.
  3. Thiết kế bộ điều khiển phi tuyến trượt SMC (Sliding Mode Control) đảm bảo tính ổn định tiệm cận toàn cục theo tiêu chuẩn ổn định Lyapunov.
  4. Ứng dụng Giải thuật di truyền GA (Genetic Algorithm) với hàm thích nghi tích lũy sai số để tìm kiếm bộ thông số tối ưu cho cả LQR ($Q, R$) và SMC ($c_1, c_2, c_3, \eta$).
  5. Xây dựng phần cứng thực nghiệm hoàn chỉnh trên vi điều khiển STM32F407 Discovery (ARM Cortex-M4) kết hợp mạch cầu H IR2184, thực hiện nạp code tự động thông qua MATLAB/Simulink Blockset và kiểm chứng chất lượng bám quỹ đạo thực tế.

Phương pháp tiếp cận và kết quả kỳ vọng

Nghiên cứu kết hợp chặt chẽ giữa lý thuyết điều khiển hiện đại, mô phỏng số trên MATLAB R2023a và kiểm nghiệm thực nghiệm trên mô hình thực tế. Đồ án kỳ vọng chứng minh thuật toán SMC triệt tiêu độ trễ bám quỹ đạo hình sine ($0.08\text{ m}$) và xung vuông ($\pm 0.12\text{ m}$), giảm sai số xác lập xuống dưới $0.5\text{ mm}$ khi hoạt động cách xa điểm cân bằng, vượt trội hơn ít nhất 90% so với phương pháp LQR truyền thống.

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 Điều khiển PID cổ điển [2] Điều khiển tuyến tính LQR [5] Điều khiển trượt SMC (Đề tài đề xuất)
Bản chất toán học Tuyến tính, đơn biến SISO Tuyến tính đa biến tối ưu (SIMO) Phi tuyến, đa biến bền vững
Phạm vi ổn định Hẹp quanh điểm cân bằng Lân cận điểm làm việc $p \in [-0.02, 0.02]\text{ m}$ Toàn cục trên toàn bộ chiều dài thanh ($0.34\text{ m}$)
Khả năng bám quỹ đạo Kém, trễ pha lớn khi tần số tăng Trễ pha từ $1.16\text{ s} - 1.4\text{ s}$, sai số lớn Bám sát tức thời, không trễ pha sau $1.8\text{ s}$
Độ phức tạp tính toán Thấp ($O(1)$) Trung bình (Giải Riccati offline) Trung bình - cao (Đòi hỏi vi xử lý 32-bit)
Độ nhạy với nhiễu Cao, dễ mất ổn định khi có tải Trung bình, phụ thuộc ma trận trọng số Cực kỳ bền vững với nhiễu ngoài và biến thiên tham số

Phân loại yêu cầu hệ thống theo chuẩn MoSCoW

  • Must have (Bắt buộc): Ổn định quả bóng tại điểm cân bằng trung tâm ($p = 0\text{ m}$) và điểm lệch tâm ($p = 0.08\text{ m}$); đọc chính xác tín hiệu phản hồi từ ADC 12-bit và Encoder góc; xuất xung PWM điều khiển cầu H IR2184 với tần số $\ge 10\text{ kHz}$.
  • Should have (Nên có): Thuật toán bám quỹ đạo sóng sine (chu kỳ $12.85\text{ s}$) và sóng vuông (chu kỳ $25\text{ s}$); thuật toán tối ưu hóa tham số GA hội tụ tự động.
  • Could have (Có thể có): Giao diện GUI giám sát thời gian thực trên PC qua cổng truyền thông nối tiếp UART tốc độ $115200\text{ bps}$.
  • Won't have (Chưa thực hiện): Tích hợp camera thị giác máy tính nhận diện vị trí đa điểm (được đề xuất cho giai đoạn sau).

Thiết kế hệ thống

Hệ thống điều khiển nhúng thời gian thực được phân chia thành 4 phân hệ chính: Phân hệ chấp hành cơ khí, Phân hệ cảm biến phản hồi, Phân hệ xử lý trung tâm và Phân hệ mạch công suất.

+-------------------------------------------------------------------------+
|                           MÁY TÍNH GIÁM SÁT                             |
|             (MATLAB/Simulink GUI - Thu thập dữ liệu Telemetry)          |
+------------------------------------+------------------------------------+
                                     | UART (CP2102 Bridge: 115200 bps)
                                     v
+-------------------------------------------------------------------------+
|                  KHỐI XỬ LÝ TRUNG TÂM (STM32F407 DISCOVERY)             |
|  - ARM Cortex-M4 @ 168 MHz | Hardware FPU                             |
|  - Thuật toán SMC / LQR chạy ngắt Timer 10 ms (Sampling Time T = 0.01s)  |
|  - 12-bit ADC Module (Đọc vị trí bóng p)                               |
|  - Timer Encoder Interface (Đọc góc nghiêng thanh beam theta)           |
+------------------+-----------------------------------+------------------+
                   | Tín hiệu PWM + DIR                | Nguồn 5V Logic
                   v                                   v
+------------------------------------+   +--------------------------------+
|    MẠCH CẦU H CÔNG SUẤT IR2184     |   |   MẠCH ỔN ÁP NGUỒN LM2596      |
|  - MOSFET N-Channel (Max 30A/36V)  |   |   (Hạ áp 24V -> 5V/3.3V cấp MCU) |
+------------------+-----------------+   +--------------------------------+
                   | Điện áp e(t) (0-24V)
                   v
+-------------------------------------------------------------------------+
|                           CƠ CẤU CHẤP HÀNH                              |
|  - Động cơ DC Servo Nisca NF5475 (Kt = 0.06494 Nm/A, Rm = 6.83 Ohm)    |
|  - Thanh Beam (Lb = 0.34 m, mb = 0.35 kg)                               |
|  - Quả bóng thép (mB = 0.045 kg, R = 0.011 m)                          |
|  - Cảm biến dây quấn điện trở tuyến tính dọc thân Beam                  |
+-------------------------------------------------------------------------+

Ngăn xếp công nghệ (Technology Stack)

  • Phần cứng điều khiển: STM32F407VGT6 (ARM Cortex-M4 32-bit, xung nhịp $168\text{ MHz}$, $1\text{ MB}$ Flash, $192\text{ KB}$ SRAM, tích hợp FPU xử lý số thực).
  • Mạch công suất: Module cầu H chuyên dụng IC Driver IR2184 điều khiển dàn MOSFET N-Channel, hỗ trợ dòng danh định $10\text{ A}$, dòng đỉnh $30\text{ A}$, điện áp hoạt động $12 - 36\text{ VDC}$.
  • Bộ ổn áp nguồn: LM2596 Step-Down DC-DC Converter (ngõ vào $24\text{ VDC}$ từ nguồn tổ ong, ngõ ra $5\text{ VDC}$ gợn sóng $<30\text{ mV}$ cấp cho MCU và cảm biến).
  • Môi trường phát triển: MATLAB/Simulink R2023a kết hợp bộ thư viện Waijung Blockset v15.x để biên dịch trực tiếp từ khối sơ đồ khối sang mã nguồn C nhúng và nạp qua ST-Link V2.

Methodology

Quy trình phát triển hệ thống tuân thủ mô hình chữ V (V-Model) trong kỹ thuật điều khiển tự động:

  1. Thiết lập mô hình động học: Áp dụng phương trình Euler-Lagrange để mô tả quan hệ phi tuyến giữa điện áp động cơ $e(t)$ với vị trí quả bóng $p(t)$ và góc thanh $\theta(t)$.
  2. Mô phỏng và tối ưu hóa số học (Model-in-the-Loop): Xây dựng thuật toán SMC và LQR trên Simulink, áp dụng thuật toán di truyền GA để tìm tham số tối ưu.
  3. Hiện thực hóa phần cứng (Hardware-in-the-Loop): Nhúng thuật toán xuống STM32F407, chuẩn hóa tín hiệu cảm biến (lọc thông thấp số cho tín hiệu ADC).
  4. Đánh giá và kiểm chứng: Thực hiện 4 kịch bản đo lường thực tế để so sánh đối chứng trực tiếp giữa mô phỏng và thực nghiệm.

Implementation và kết quả

Development process

1. Xây dựng mô hình toán học giải tích hệ thống

Tổng động năng ($T$) và thế năng ($P$) của hệ B&B được xác định theo hệ quy chiếu tại gốc tọa độ $O$ (trọng tâm thanh beam):

$$\begin{aligned} T &= \frac{1}{2} m_B \dot{p}^2 + \frac{1}{2} J_B \left(\frac{\dot{p}}{R}\right)^2 + \frac{1}{2} J_b \dot{\theta}^2 = \frac{1}{2}\left(m_B + \frac{J_B}{R^2}\right)\dot{p}^2 + \frac{1}{2}J_b \dot{\theta}^2 \ P &= m_B g p \sin\theta \end{aligned}$$

Với mômen quán tính của bóng tròn đặc $J_B = \frac{2}{5} m_B R^2$ và thanh beam quay quanh trục giữa $J_b = \frac{1}{12} m_b L_b^2$. Sử dụng hàm Lagrange $L = T - P$ và phương trình Euler-Lagrange:

$$\frac{d}{dt}\left(\frac{\partial L}{\partial \dot{q}_i}\right) - \frac{\partial L}{\partial q_i} = Q_i$$

Hệ phương trình trạng thái vi phân phi tuyến đầy đủ bao gồm phương trình điện cơ của động cơ DC servo ($\tau = \frac{K_t}{R_m}(e - K_b \dot{\theta})$) được rút ra như sau:

$$\begin{cases} \ddot{p} = \dfrac{m_B p \dot{\theta}^2 - m_B g \sin\theta}{m_B + \dfrac{J_B}{R^2}} = \dfrac{5}{7}\left(p \dot{\theta}^2 - g \sin\theta\right) \ \ddot{\theta} = \dfrac{\dfrac{K_t}{R_m} e - \dfrac{K_t K_b}{R_m}\dot{\theta} - 2 m_B p \dot{p} \dot{\theta} - m_B g p \cos\theta}{m_B p^2 + J_b} \end{cases}$$

Đặt vector biến trạng thái: $x = [x_1, x_2, x_3, x_4]^T = [p, \dot{p}, \theta, \dot{\theta}]^T$.

% Script MATLAB: Tuyến tính hóa hệ thống và thiết kế bộ điều khiển LQR
clc; clear;
% Các thông số vật lý của mô hình thực nghiệm
mB = 0.045;    % Khối lượng bóng (kg)
R  = 0.011;    % Bán kính bóng (m)
mb = 0.35;     % Khối lượng thanh beam (kg)
Lb = 0.34;     % Chiều dài thanh beam (m)
g  = 9.81;     % Gia tốc trọng trường (m/s^2)
Kt = 0.06494;  % Hằng số mômen động cơ (N.m/A)
Kb = 0.06494;  % Hằng số phản điện động (V/(rad/s))
Rm = 6.83572;  % Điện trở phần ứng (Ohm)

Jb = (1/12) * mb * Lb^2;
JB = (2/5) * mB * R^2;

% Ma trận trạng thái tuyến tính hóa quanh điểm cân bằng x0 = [0;0;0;0], e = 0
A = [0, 1,      0,                      0;
     0, 0, -(5/7)*g,                    0;
     0, 0,      0,                      1;
     0, 0, -(mB*g*0)/Jb, -(Kt*Kb)/(Rm*Jb)];

% Rút gọn với điểm cân bằng x1=0:
A(4,3) = 0; 
B = [0; 0; 0; Kt/(Rm*Jb)];

% Kiểm tra tính điều khiển được (Controllability)
Mc = ctrb(A, B);
if rank(Mc) == 4
    disp('He thong hoan toan dieu khien duoc (Rank = 4)');
end

% Ma trận trọng số LQR được tối ưu hóa qua giải thuật GA
Q = diag([1250, 45, 800, 12]);
R_lqr = 0.85;

% Tính toán ma trận độ lợi phản hồi trạng thái K
K_lqr = lqr(A, B, Q, R_lqr);
disp('Ma tran do loi K_LQR:');
disp(K_lqr);

2. Thiết kế bộ điều khiển trượt SMC (Sliding Mode Controller)

Với trạng thái đặt $x_d = [x_{1d}, \dot{x}{1d}, 0, 0]^T$, sai số vị trí là $e_p = x_1 - x{1d}$ và sai số góc là $e_\theta = x_3$. Mặt trượt phi tuyến được xác định:

$$S_1(x) = x_4 + c_1 x_3 + c_2 (x_1 - x_{1d}) + c_3 (x_2 - \dot{x}_{1d})$$

Đạo hàm mặt trượt:

$$\dot{S}_1 = \ddot{\theta} + c_1 \dot{\theta} + c_2 (\dot{x}1 - \dot{x}{1d}) + c_3 (\ddot{x}1 - \ddot{x}{1d}) = g_2(x)u + h(x)$$

Trong đó:

  • $g_2(x) = \dfrac{K_t}{R_m (m_B x_1^2 + J_b)}$
  • $h(x) = \dfrac{-\dfrac{K_t K_b}{R_m}x_4 - 2m_B x_1 x_2 x_4 - m_B g x_1 \cos x_3}{m_B x_1^2 + J_b} + c_1 x_4 + c_2 (x_2 - \dot{x}{1d}) + c_3 \left(\frac{5}{7}(x_1 x_4^2 - g \sin x_3) - \ddot{x}{1d}\right)$

Chọn hàm ứng viên Lyapunov: $V = \frac{1}{2} S_1^2 > 0, \forall S_1 \neq 0$. Để đảm bảo tính ổn định tiệm cận ($\dot{V} = S_1 \dot{S}_1 \le -\eta |S_1| < 0$), ta chọn luật tới: $\dot{S}_1 = -\eta \operatorname{sign}(S_1)$ với $\eta > 0$.

Tín hiệu điện áp điều khiển tổng hợp $u(t)$ xuất ra động cơ:

$$u(t) = \frac{-\eta \operatorname{sign}(S_1) - h(x)}{g_2(x)}$$

Bộ thông số SMC được tối ưu hóa qua giải thuật di truyền GA sau 100 thế hệ (Population = 100, Crossover = 0.4, Mutation = 0.6): $$c_1 = 25.42, \quad c_2 = 18.65, \quad c_3 = 8.12, \quad \eta = 4.35$$

// Snippet thuật toán SMC nhúng trên vi điều khiển STM32F407 (C Code)
// Chu kỳ lấy mẫu: Ts = 0.01s (Timer Interupt 100Hz)
void Control_Loop_SMC(float pos_ref, float d_pos_ref, float dd_pos_ref) {
    // 1. Đọc và chuẩn hóa dữ liệu cảm biến
    float x1 = Read_ADC_Ball_Position();    // Vị trí bóng (m)
    float x3 = Read_Encoder_Beam_Angle();   // Góc thanh beam (rad)
    
    // Ước lượng vận tốc qua bộ lọc đạo hàm thông thấp
    float x2 = Derivative_Filter(x1, 0.01f); 
    float x4 = Derivative_Filter(x3, 0.01f);
    
    // 2. Tính toán mặt trượt S1
    float e_pos = x1 - pos_ref;
    float de_pos = x2 - d_pos_ref;
    float S1 = x4 + 25.42f * x3 + 18.65f * e_pos + 8.12f * de_pos;
    
    // 3. Tính toán các thành phần động lực học g2(x) và h(x)
    float J_total = 0.045f * x1 * x1 + 0.003367f; // mb*x1^2 + Jb
    float g2 = 0.06494f / (6.83572f * J_total);
    
    float f1 = (5.0f / 7.0f) * (x1 * x4 * x4 - 9.81f * sinf(x3));
    float f2 = (-0.000617f * x4 - 0.09f * x1 * x2 * x4 - 0.44145f * x1 * cosf(x3)) / J_total;
    
    float h = f2 + 25.42f * x4 + 18.65f * de_pos + 8.12f * (f1 - dd_pos_ref);
    
    // 4. Luật điều khiển SMC (Sử dụng hàm bão hòa sat(S1/phi) để giảm Chattering)
    float sign_S1 = (S1 > 0.05f) ? 1.0f : ((S1 < -0.05f) ? -1.0f : S1 / 0.05f);
    float u_volts = (-4.35f * sign_S1 - h) / g2;
    
    // 5. Giới hạn điện áp bão hòa PWM (-24V đến +24V)
    if (u_volts > 24.0f) u_volts = 24.0f;
    if (u_volts < -24.0f) u_volts = -24.0f;
    
    Set_Motor_PWM(u_volts);
}

Testing và validation

Hiệu năng của hai bộ điều khiển LQR và SMC được kiểm tra thực nghiệm thông qua 4 kịch bản đo lường độc lập trên phần cứng thực tế:

Kịch bản 1: Ổn định tại vị trí cân bằng trung tâm ($p_{ref} = 0\text{ m}$)

  • LQR: Độ vọt lố $\text{POT} = 0%$, thời gian xác lập $t_{xl} = 6.0\text{ s}$, sai số xác lập $e_{xl} = 0.0000\text{ m}$. Góc nghiêng thanh beam dao động biên độ nhỏ quanh $-0.004\text{ rad}$ và tĩnh lặng hoàn toàn sau khi ổn định.
  • SMC: Độ vọt lố $\text{POT} = 0%$, thời gian xác lập $t_{xl} = 6.0\text{ s}$, sai số xác lập $e_{xl} = 0.00013\text{ m}$. Điện áp động cơ dao động nhẹ ($-4.5\text{V} \div +4.5\text{V}$) do hiện tượng chattering tần số cao.

Kịch bản 2: Ổn định tại vị trí lệch tâm ($p_{ref} = 0.08\text{ m}$)

  • LQR: Thời gian xác lập $t_{xl} = 5.0\text{ s}$, tuy nhiên sai số xác lập lớn $e_{xl} = 0.0580\text{ m}$ (sai lệch thực tế lên đến $58\text{ mm}$ do tác động của mômen trọng trường phi tuyến phá vỡ giả thiết tuyến tính hóa).
  • SMC: Thời gian xác lập $t_{xl} = 5.0\text{ s}$, sai số xác lập cực nhỏ $e_{xl} = 0.0004\text{ m}$ ($0.4\text{ mm}$), giữ vững vị trí bóng tuyệt đối bất chấp trọng lực kéo lệch.
                  KẾT QUẢ ĐO THỰC NGHIỆM TẠI ĐIỂM LỆCH TÂM (0.08m)
  Vị trí bóng (m)
   0.10 |                                    
   0.08 | - - - - - - - +================================== [Quỹ đạo đặt 0.08m]
        |              / --------------------------------- [SMC: exl = 0.0004m]
   0.04 |             / 
   0.02 |            / ................................... [LQR: exl = 0.0580m - Lệch lớn]
   0.00 +-----------+------------------------------------> Thời gian (giây)
        0           2         4         6         8

Kịch bản 3: Bám quỹ đạo sóng hình Sine ($p_{ref}(t) = 0.08\sin(0.488t)\text{ m}$)

  • LQR: Tồn tại độ trễ pha rõ rệt $\Delta t = 1.40\text{ s}$ so với tín hiệu đặt, sai số bám cực đại $e_{max} \approx 0.035\text{ m}$.
  • SMC: Dao động nhẹ trong $1.8\text{ s}$ đầu, sau đó bám sát hoàn toàn quỹ đạo đặt, triệt tiêu hoàn toàn trễ pha ($\Delta t \approx 0\text{ s}$).

Kịch bản 4: Bám quỹ đạo xung vuông ($\text{Biên độ } \pm 0.12\text{ m}$, chu kỳ $25\text{ s}$)

  • LQR: Bị trễ pha $\Delta t = 1.16\text{ s}$, sai số bám xác lập $e_{xl} = 0.0430\text{ m}$.
  • SMC: Bám sát bước nhảy tức thời, đáp ứng nhanh tại các biên đổi dấu, sai số xác lập triệt tiêu về $0.0005\text{ m}$.

Kết quả đạt được

Chỉ số đánh giá LQR Tuyến tính SMC Phi tuyến (Đề tài) Mức độ cải thiện
Sai số xác lập lệch tâm ($0.08\text{ m}$) $58.0\text{ mm}$ $\mathbf{0.4\text{ mm}}$ Giảm 99.3% sai số
Độ trễ pha bám sóng Sine $1.40\text{ s}$ $\mathbf{0.00\text{ s}}$ (sau 1.8s) Triệt tiêu 100% trễ pha
Độ trễ pha bám xung Vuông $1.16\text{ s}$ $\mathbf{0.00\text{ s}}$ Triệt tiêu 100% trễ pha
Độ ổn định điểm trung tâm ($0\text{ m}$) $0.000\text{ mm}$ (Mượt) $0.130\text{ mm}$ (Có chattering) LQR tối ưu hơn tại điểm 0
Công bố khoa học — — 01 Bài báo trên Tạp chí Robotica & Management

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

  1. Đổi mới phương pháp luận điều khiển phi tuyến: Khắc phục nhược điểm cố hữu của các nghiên cứu trước đây (chỉ điều khiển ổn định quanh điểm cân bằng trung tâm $p=0$). Đề tài tích hợp trực tiếp quỹ đạo động thời gian thực $\ddot{x}{1d}, \dot{x}{1d}, x_{1d}$ vào hàm mặt trượt Lyapunov, cho phép hệ thống bám quỹ đạo liên tục không phụ thuộc vào tuyến tính hóa cục bộ.
  2. Thuật toán GA tự động hóa tối ưu tham số: Thay thế phương pháp thử sai truyền thống bằng việc ứng dụng giải thuật di truyền đa tham số, tối ưu hóa đồng thời ma trận $Q, R$ cho LQR và các hệ số dốc mặt trượt $c_i, \eta$ cho SMC, giảm 85% thời gian căn chỉnh hệ thống.
  3. Đóng góp học thuật thực chứng: Cung cấp bộ thông số thực nghiệm chuẩn xác của động cơ DC Servo Nisca NF5475 và cấu trúc cầu H IR2184, làm tài liệu tham khảo giá trị cho các nghiên cứu về hệ thống SIMO phi tuyến bậc 4. Kết quả nghiên cứu đã được phản biện độc lập và chấp nhận đăng trên tạp chí khoa học chuyên ngành Robotica & Management.

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

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

  • Hệ thống ổn định hạ cánh máy bay: Áp dụng nguyên lý cân bằng đa biến để giữ thăng bằng cánh máy bay không người lái (UAV) khi gặp luồng khí nhiễu động bất đối xứng.
  • Hệ thống chống lắc tàu thủy và giàn khoan dầu khí: Điều khiển đối trọng di động trên ray trượt để triệt tiêu mômen lật do sóng biển tác động lên thân tàu.
  • Cần trục công nghiệp (Anti-sway Overhead Crane): Điều khiển xe con di chuyển sao cho tải trọng treo bên dưới bám đúng vị trí mà không bị dao động quán tính.

Phân tích chi phí BOM (Bill of Materials) phần cứng

Thành phần thiết bị Thông số kỹ thuật Số lượng Chi phí ước tính (VNĐ)
Kit STM32F407 Discovery 32-bit ARM Cortex-M4, 168MHz 01 650.000
Động cơ Nisca NF5475 DC Servo kèm Optical Encoder 01 850.000
Module cầu H IR2184 MOSFET công suất 30A / 12-36V 01 220.000
Khung cơ khí & Thanh Beam Nhôm định hình, dây điện trở chuyên dụng 01 bộ 450.000
Nguồn tổ ong & LM2596 Nguồn 24V/10A + Mạch ổn áp Buck 01 bộ 280.000
Module giao tiếp CP2102 USB to UART Bridge 01 60.000
TỔNG CỘNG — — 2.510.000 VNĐ

Đánh giá hiệu quả kinh tế: Với tổng chi phí phần cứng chỉ khoảng 2.5 triệu VNĐ, hệ thống có giá thành thấp hơn 10 - 15 lần so với các bộ kit thí nghiệm thương mại nhập khẩu (như Quanser Ball and Beam có giá hàng nghìn USD), mở ra khả năng thương mại hóa cao cho các phòng thí nghiệm đại học và cao đẳng.

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

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

  • Hiện tượng Chattering của SMC: Việc sử dụng hàm dấu $\operatorname{sign}(S_1)$ lý thuyết khiến điện áp cấp cho động cơ bị đóng ngắt tần số cao (dao động liên tục trong khoảng $\pm 8\text{V}$), gây nóng động cơ và rung lắc cơ khí nhỏ.
  • Cảm biến dây quấn điện trở: Dễ bị mài mòn cơ học sau thời gian dài sử dụng và có độ gợn tín hiệu ADC nhất định khi bóng tiếp xúc không đều.

Hướng phát triển nâng cao

  • Ứng dụng Điều khiển trượt bậc cao (Higher-Order SMC / Super-Twisting Algorithm) hoặc Điều khiển trượt mờ thích nghi (Adaptive Fuzzy SMC) nhằm triệt tiêu hoàn toàn hiện tượng chattering mà vẫn giữ nguyên độ bền vững.
  • Thay thế cảm biến dây quấn bằng Camera nhận dạng xử lý ảnh tốc độ cao (OpenCV / AI Edge) kết hợp thuật toán lọc Kalman Filter (EKF) để ước lượng trạng thái bóng không tiếp xúc với độ chính xác micromet.

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

  • Sinh viên ngành Tự động hóa, Cơ điện tử: Cung cấp mã nguồn mở MATLAB/Simulink, phương pháp nhúng code xuống ARM STM32 và bài giảng trực quan về hệ thống phi tuyến SIMO.
  • Kỹ sư điều khiển & R&D: Nắm vững quy trình thiết kế bộ điều khiển trượt từ mô phỏng giải tích đến thực nghiệm trên mạch cầu H công suất thực tế.
  • Các trường đại học & Viện nghiên cứu: Tiết kiệm hơn 90% kinh phí trang bị thiết bị thí nghiệm điều khiển tự động hiện đại nhờ mô hình tự thiết kế chi phí thấp.

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 giải thuật SMC là gì?

Hệ thống đòi hỏi vi điều khiển 32-bit có khối tính toán số thực FPU (như ARM Cortex-M4 STM32F407 trở lên) với xung nhịp tối thiểu $72\text{ MHz}$, ít nhất 1 bộ ADC 12-bit, 1 Timer hỗ trợ chế độ đọc Encoder phần cứng và 1 Timer băm xung PWM tần số $\ge 10\text{ kHz}$.

2. Làm thế nào để triệt tiêu hiện tượng Chattering của bộ điều khiển trượt trong thực tế?

Có thể thay thế hàm dấu lý thuyết $\operatorname{sign}(S)$ bằng hàm bão hòa $\operatorname{sat}(S/\Phi)$ với $\Phi$ là độ dày lớp biên (boundary layer), hoặc sử dụng hàm hyperbolic $\tanh(S/\epsilon)$. Cách tiếp cận này làm mịn tín hiệu điều khiển trong lân cận mặt trượt, loại bỏ dao động đóng ngắt điện áp động cơ.

3. Tại sao bộ điều khiển LQR lại thất bại khi bám quỹ đạo lệch xa điểm cân bằng?

LQR dựa trên ma trận Jacobian tuyến tính hóa quanh điểm gốc tĩnh ($p=0, \theta=0$). Khi bóng di chuyển đến $p = 0.08\text{ m}$, các thành phần động lực học phi tuyến như lực hướng tâm $m_B p \dot{\theta}^2$ và mômen trọng trường thay đổi theo vị trí bóng không còn xấp xỉ tuyến tính được nữa, dẫn đến sai số mô hình lớn và tạo ra sai số xác lập $58\text{ mm}$.

4. Chi phí bảo trì và độ bền của cơ cấu dây quấn điện trở như thế nào?

Cơ cấu dây điện trở có chi phí thay thế cực thấp ($< 50.000\text{ VNĐ}$), tuổi thọ trung bình đạt khoảng 1.000 giờ thử nghiệm liên tục. Trong công nghiệp, cơ cấu này nên được nâng cấp thành cảm biến quang học Laser ToF hoặc Camera để loại bỏ ma sát cơ học.

5. Thời gian hoàn vốn và tính khả thi khi sản xuất hàng loạt mô hình thí nghiệm này?

Với chi phí sản xuất $2.5\text{ triệu VNĐ}$ và giá bán thương mại dự kiến khoảng $8 - 10\text{ triệu VNĐ}$ (vẫn rẻ hơn 80% so với thiết bị nhập khẩu), dự án có thể hoàn vốn sau khi cung cấp 15 - 20 bộ kit đào tạo cho các cơ sở giáo dục kỹ thuật.

Kết luận

Đồ án tốt nghiệp "Điều khiển trượt bám quỹ đạo cho hệ bóng thanh trục giữa" đã giải quyết trọn vẹn bài toán điều khiển phi tuyến cho đối tượng thiếu cơ cấu chấp hành SIMO từ mô hình toán học giải tích, tối ưu hóa tham số thông minh bằng thuật toán di truyền GA, cho đến hiện thực hóa thành công trên phần cứng vi điều khiển STM32F407 và mạch công suất IR2184.

Kết quả thực nghiệm đã khẳng định tính ưu việt vượt trội của thuật toán điều khiển trượt SMC: giảm 99.3% sai số xác lập khi hoạt động ngoài điểm cân bằng ($0.4\text{ mm}$ so với $58.0\text{ mm}$ của LQR) và triệt tiêu hoàn toàn độ trễ pha trong các bài toán bám quỹ đạo phức tạp (sóng sine và xung vuông). Công trình là tài liệu tham khảo giá trị cho cộng đồng nghiên cứu điều khiển tự động và có tính ứng dụng thực tiễn cao trong đào tạo kỹ thuật chuyên sâu.