Giới thiệu dự án

Trong lĩnh vực điều khiển tự động và robot học, các hệ thống cơ điện phi tuyến, thiếu cơ cấu chấp hành (underactuated systems) luôn là bài toán kinh điển đặt ra nhiều thách thức nghiên cứu. Theo các khảo sát kỹ thuật trong tự động hóa công nghiệp, hơn 70% các hệ thống cân bằng động trong thực tế—từ robot tự cân bằng hai bánh, hệ thống giảm chấn con lắc chủ động cho tòa nhà cao tầng (Tuned Mass Damper - TMD), đến cơ cấu giữ ổn định góc nghiêng cho tàu ngầm và thiết bị hàng không vũ trụ—đều đòi hỏi thuật toán điều khiển tối ưu hóa đa biến với độ trễ thấp và khả năng bù nhiễu cao.

Mô hình Bóng trên Bánh Xe (Ball on Wheel) là một đối tượng nghiên cứu phi tuyến bậc cao với một đầu vào điều khiển (điện áp cấp cho động cơ quay bánh xe) và nhiều đầu ra (vị trí góc của quả bóng và góc quay của bánh xe). Vấn đề cốt lõi của bài toán là duy trì quả bóng cân bằng tại điểm cực đại không ổn định của bánh xe trong điều kiện có ma sát lăn không trượt và các tác động bất định từ môi trường bên ngoài.

                  ( Quả bóng: m_b, r_b )  --> Góc lệch theta_1
                         ( O_b )
                           |
                     [ Tiếp điểm C ]
                           |
                  (( Bánh xe: I_w, r_w )) --> Góc quay theta_2
                         ( O_w )
                           |
                   [ Động cơ NISCA 24V ] === [ Bộ điều khiển STM32F4 ]

Mục tiêu dự án

  1. Xây dựng mô hình toán học giải tích: Thiết lập hệ phương trình vi phân phi tuyến mô tả động học và động lực học của hệ Ball on Wheel bằng phương pháp Euler-Lagrange.
  2. Tuyến tính hóa và phân tích tính điều khiển được: Xấp xỉ hóa hệ thống quanh điểm cân bằng thẳng đứng, xây dựng không gian trạng thái $x = [\theta_1, \dot{\theta}_1, \theta_2, \dot{\theta}_2]^T$ và chứng minh tính điều khiển được thông qua ma trận Kalman ($\text{rank}(M_c) = 4$).
  3. Thiết kế bộ điều khiển Linear Quadratic Regulator (LQR): Tối ưu hóa hàm mục tiêu toàn phương, xác định ma trận phản hồi trạng thái $K$ thông qua giải phương trình vi phân Riccati đại số liên tục.
  4. Phát triển phần cứng và nhúng thời gian thực: Gia công mô hình cơ khí chính xác trên SolidWorks, tích hợp vi điều khiển STM32F4 (ARM Cortex-M4), cảm biến khoảng cách hồng ngoại SHARP GP2Y0A21YK0F, mạch công suất cầu H HI216 và động cơ DC NISCA 24VDC có gắn bộ giải mã vòng quay (Optical Encoder).
  5. Xây dựng phần mềm giám sát (GUI) và cơ sở dữ liệu: Thiết kế giao diện Visual Studio C# kết nối truyền thông nối tiếp với STM32 và đồng bộ dữ liệu người dùng qua Microsoft SQL Server.

Phương pháp tiếp cận và phạm vi nghiên cứu

  • Phương pháp tiếp cận: Sử dụng điều khiển phản hồi trạng thái toàn phần tối ưu LQR (SIMO - Single Input Multiple Output) để giải quyết bài toán bù góc lệch quả bóng $\theta_1$ kết hợp khống chế vận tốc và vị trí góc bánh xe $\theta_2$.
  • Chỉ số đo lường kỳ vọng (KPIs): Thời gian đáp ứng xác lập (settling time) $t_s < 2.5\text{ s}$, độ vọt lố (overshoot) góc nghiêng bóng $< 15%$, sai số xác lập góc bóng tiệm cận $0^\circ$.
  • Giới hạn đề tài: Khảo sát trong miền cân bằng lân cận trục thẳng đứng $\theta_1 \in [-10^\circ, +10^\circ]$, giả định quả bóng lăn không trượt và bảo đảm lực tiếp xúc pháp tuyến luôn dương ($N > 0$).

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

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

Các mô hình chuẩn mực trong phòng thí nghiệm điều khiển thường bao gồm: Con lắc ngược (Inverted Pendulum), Bóng trên thanh (Ball and Beam), và Bóng trên bánh xe (Ball on Wheel).

Tiêu chí kỹ thuật Con lắc ngược (Inverted Pendulum) Bóng trên thanh (Ball and Beam) Bóng trên bánh xe (Ball on Wheel)
Bậc tự do (DOF) 2 DOF (Vị trí xe, Góc lắc) 2 DOF (Góc thanh, Vị trí bóng) 2 DOF ($\theta_1$ góc bóng, $\theta_2$ góc bánh)
Mối quan hệ động học Khớp quay cố định hoặc tịnh tiến Quả bóng lăn trên rãnh phẳng Tiếp xúc cong - cong (Lăn trên cung tròn)
Độ phi tuyến Trung bình ($\sin\theta, \cos\theta$) Thấp (Tuyến tính hóa cục bộ dễ) Rất cao (Lực quán tính ly tâm, vi sai tiếp điểm)
Đặc tính cơ cấu Cơ cấu dẫn động trực tiếp Dẫn động qua servo/đòn bẩy Khớp nối phi tiếp xúc trực tiếp (Lực bám ma sát)
Độ phức tạp điều khiển SIMO bậc 4 SISO/SIMO bậc 4 SIMO bậc 4 với ràng buộc tiếp tuyến

Phân loại yêu cầu hệ thống theo mô hình MoSCoW

  • Must have: Hệ thống cơ khí chịu lực vững chắc; Giải thuật LQR tính toán tín hiệu điều khiển $u(t) = -Kx$; Đọc phản hồi từ cảm biến hồng ngoại và encoder; Mạch bảo vệ quá dòng/ngắn mạch cho động cơ.
  • Should have: Giao diện GUI C# giám sát đồ thị thời gian thực; Bộ lọc thông thấp khử nhiễu tín hiệu ADC từ cảm biến khoảng cách.
  • Could have: Đăng nhập phân quyền và lưu trữ nhật ký vận hành qua Microsoft SQL Server.
  • Won't have (lần này): Thuật toán thích nghi trực tuyến (Adaptive LQR) khi khối lượng bóng thay đổi bất định.

Thiết kế hệ thống

+--------------------------------------------------------------------------------+
|                             KIẾN TRÚC HỆ THỐNG                                 |
+--------------------------------------------------------------------------------+
 [ Cảm biến SHARP GP2Y0A21 ] ---> [ ADC 12-bit ] --+
                                                    |---> [ STM32F4 Cortex-M4 ]
 [ NISCA Optical Encoder ]   ---> [ TIM2 Encoder ] -+      | (Thuật toán LQR)
                                                           |
 [ GUI Visual Studio C# ]    <--- [ UART / USB ] --+      | (PWM Duty Cycle)
           |                                               v
 [ MS SQL Server DB ]                             [ Driver HI216 H-Bridge ]
                                                           |
                                                           v
                                                  [ Động cơ DC NISCA 24V ]

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

  • Bộ vi xử lý nhúng: STM32F407VGT6 (ARM Cortex-M4, xung nhịp 168 MHz, 1 MB Flash, 192 KB SRAM, FPU phần cứng).
  • Môi trường phát triển firmware: Keil uVision v5.38 / STM32CubeIDE v1.14, thư viện STM32Cube HAL.
  • Phần mềm tính toán và mô phỏng: MATLAB R2023b, Simulink, Control System Toolbox.
  • Thiết kế cơ khí CAD: SolidWorks 2023 SP3.0.
  • Giao diện giám sát: Microsoft Visual Studio 2022 (.NET Framework 4.8, C# WinForms).
  • Hệ quản trị cơ sở dữ liệu: Microsoft SQL Server 2022 Express.

Thông số vật lý của mô hình

  • Khối lượng quả bóng tennis ($m_b$): $0.0569\text{ kg}$
  • Bán kính quả bóng ($r_b$): $0.033285\text{ m}$ ($33.285\text{ mm}$)
  • Bán kính bánh xe ($r_w$): $0.11\text{ m}$ ($110\text{ mm}$)
  • Momen quán tính bánh xe ($I_w$): $1.427 \times 10^{-3}\text{ kg}\cdot\text{m}^2$
  • Điện trở phần ứng động cơ ($R_a$): $2.2826\ \Omega$
  • Hằng số mô-men động cơ ($K_m$): $0.0926\text{ N}\cdot\text{m/A}$
  • Gia tốc trọng trường ($g$): $9.81\text{ m/s}^2$

Phương pháp luận (Methodology)

Dự án được triển khai theo quy trình kỹ thuật chữ V (V-Model) trong thời gian 17 tuần:

  • Tuần 1 - 5: Khảo sát lý thuyết, nghiên cứu giải thuật LQR, thiết lập phương trình Euler-Lagrange.
  • Tuần 6 - 8: Thiết kế mô hình 3D trên SolidWorks, xuất bản vẽ 2D chế tạo giá đỡ nhôm định hình, mặt đế và bánh đà.
  • Tuần 9 - 11: Gia công lắp ráp phần cứng, đấu nối mạch cầu H HI216, cảm biến hồng ngoại SHARP và vi điều khiển STM32F4.
  • Tuần 12 - 14: Xây dựng mô hình Simulink, giải phương trình Riccati tìm ma trận $K$, lập trình C nhúng trên STM32 và viết GUI Visual Studio kết nối SQL Server.
  • Tuần 15 - 17: Vận hành thực nghiệm, tinh chỉnh ma trận trọng số $Q$ và $R$, đánh giá sai số, viết báo cáo tổng kết.

Implementation và kết quả

Quy trình phát triển và mô hình toán học

1. Phương trình Lagrange của hệ thống

Hàm Lagrange $L = T - V$, trong đó tổng động năng $T$ và thế năng $V$ của hệ thống được xác định: $$T = \frac{1}{2}I_w \dot{\theta}_2^2 + \frac{1}{2}m_b (r_w + r_b)^2 \dot{\theta}_1^2 + \frac{1}{2}\left(\frac{2}{5}m_b r_b^2\right)\dot{\theta}_3^2$$ $$V = m_b g (r_w + r_b) \cos\theta_1$$

Điều kiện lăn không trượt giữa bóng và bánh xe liên kết vận tốc góc: $$r_w \dot{\theta}_2 - (r_w + r_b)\dot{\theta}_1 = r_b \dot{\theta}_3$$

Mô-men xoắn điện từ sinh ra từ động cơ điện một chiều kích từ vĩnh cửu: $$\tau = \frac{K_m u}{R_a} - \frac{K_m^2 \dot{\theta}_2}{R_a}$$

2. Không gian trạng thái tuyến tính hóa

Xác định vector trạng thái $x = [x_1, x_2, x_3, x_4]^T = [\theta_1, \dot{\theta}_1, \theta_2, \dot{\theta}_2]^T$, hệ phương trình vi phân trạng thái có dạng: $$\dot{x} = A x + B u$$

Trong đó ma trận trạng thái $A$ và ma trận đầu vào $B$ quanh điểm cân bằng $x_0 = [0, 0, 0, 0]^T$ được tính toán giải tích: $$A = \begin{bmatrix} 0 & 1 & 0 & 0 \ b & 0 & 0 & a \ 0 & 0 & 0 & 1 \ j & 0 & 0 & i \end{bmatrix}, \quad B = \begin{bmatrix} 0 \ c \ 0 \ k \end{bmatrix}$$

Với các hệ số phụ thuộc vào tham số cơ điện của hệ: $$a = \frac{-2 K_m^2 r_w}{R_a (r_b + r_w)(2 m_b r_w^2 + 7 I_w)}, \quad b = \frac{2 g m_b r_w^2 + 5 I_w g}{(r_b + r_w)(2 m_b r_w^2 + 7 I_w)}, \quad c = \frac{2 K_m r_w}{R_a (r_b + r_w)(2 m_b r_w^2 + 7 I_w)}$$ $$i = \frac{-7 K_m^2}{R_a (2 m_b r_w^2 + 7 I_w)}, \quad j = \frac{2 g m_b r_w}{2 m_b r_w^2 + 7 I_w}, \quad k = \frac{7 K_m}{R_a (2 m_b r_w^2 + 7 I_w)}$$

3. Kiểm tra tính điều khiển được (Controllability)

Ma trận điều khiển được Kalman: $$M_c = \begin{bmatrix} B & AB & A^2 B & A^3 B \end{bmatrix}$$

Mã nguồn MATLAB kiểm tra tính điều khiển được và tính nghiệm ma trận $K$:

% Dinh nghia cac thong so he thong
rw = 0.11; rb = 0.033285; mb = 0.0569; Iw = 1.427e-3;
Ra = 2.2826; Km = 0.0926; g = 9.81;

% Tinh toan he so ma tran A va B
denom1 = (rb + rw) * (2 * mb * rw^2 + 7 * Iw);
denom2 = (2 * mb * rw^2 + 7 * Iw);

a = (-2 * Km^2 * rw) / (Ra * denom1);
b = (2 * g * mb * rw^2 + 5 * Iw * g) / denom1;
c = (2 * Km * rw) / (Ra * denom1);
i = (-7 * Km^2) / (Ra * denom2);
j = (2 * g * mb * rw) / denom2;
k = (7 * Km) / (Ra * denom2);

A = [0 1 0 0; b 0 0 a; 0 0 0 1; j 0 0 i];
B = [0; c; 0; k];

% Kiem tra hang cua ma tran dieu khien duoc
Mc = [B, A*B, A^2*B, A^3*B];
rank_Mc = rank(Mc); % Ket qua: rank_Mc = 4 (He thong Fully Controllable)

% Tinh toan ma tran phan hoi trang thai LQR
Q = diag([100000, 1, 1000, 1]);
R = 1;
K = lqr(A, B, Q, R);

4. Mã nguồn nhúng điều khiển thời gian thực trên STM32F4

Thuật toán tính toán điện áp điều khiển $u(t) = -Kx$ được nhúng trực tiếp vào vòng lặp ngắt định thời của STM32:

#include "stm32f4xx_hal.h"
#include <math.h>

#define PI 3.14159265359f

extern TIM_HandleTypeDef htim1; // PWM Motor Timer
extern TIM_HandleTypeDef htim2; // Encoder Timer
extern ADC_HandleTypeDef hadc1; // IR Sensor ADC

// Cac he so phan hoi LQR da duoc tinh toan
const float K1 = -312.45f, K2 = -45.12f, K3 = -31.62f, K4 = -12.85f;
const float setpoint_dist = 25.0f; // Khoang cach can bang (cm)

void Control_Loop_ISR(void) {
    uint32_t raw_adc = HAL_ADC_GetValue(&hadc1);
    int16_t encoder_count = (int16_t)__HAL_TIM_GET_COUNTER(&htim2);
    
    // Tinh toan khoang cach tu dien ap analog SHARP GP2Y0A21
    float voltage = (float)raw_adc * (3.3f / 4095.0f);
    float distance = 27.86f * powf(voltage, -1.15f); // Dac tuyen thuc nghiem
    
    // Tinh toan goc lech qua bong x1 (rad)
    float delta_d = distance - setpoint_dist;
    float x1 = atan2f(delta_d, (11.0f + 3.3285f)); 
    
    // Tinh toan vi tri goc banh xe x3 (rad) tu Encoder NISCA (500 xung/vong)
    float x3 = (float)encoder_count * (2.0f * PI / 2000.0f);
    
    // Xap xi van toc trang thai x2 va x4 qua bo loc dao ham so
    static float prev_x1 = 0.0f, prev_x3 = 0.0f;
    float dt = 0.01f; // Chu ky lay mau 10ms (100Hz)
    float x2 = (x1 - prev_x1) / dt;
    float x4 = (x3 - prev_x3) / dt;
    prev_x1 = x1;
    prev_x3 = x3;
    
    // Tin hieu dieu khien toi uu LQR
    float Ut = -(K1 * x1 + K2 * x2 + K3 * x3 + K4 * x4);
    
    // Bao hoa dien ap [-24V, +24V] va xuat PWM dieu khien cau H HI216
    if (Ut > 24.0f) Ut = 24.0f;
    if (Ut < -24.0f) Ut = -24.0f;
    
    uint16_t duty_cycle = (uint16_t)(fabsf(Ut) / 24.0f * 1000.0f);
    if (Ut >= 0.0f) {
        __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_1, duty_cycle);
        __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_2, 0);
    } else {
        __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_1, 0);
        __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_2, duty_cycle);
    }
}

Kiểm thử và đánh giá hiệu năng

Khảo sát sự thay đổi của ma trận trọng số $Q$ và $R$

  1. Khảo sát trọng số $Q_1$ (Góc lệch quả bóng $\theta_1$): Khi tăng $Q_1$ từ $10^4$ lên $10^7$ và $10^9$ với $R = 1$, hệ thống tập trung dập tắt sai lệch góc bóng nhanh hơn, thời gian quá độ giảm từ $3.8\text{ s}$ xuống $1.8\text{ s}$, tuy nhiên điện áp đỉnh điều khiển $u(t)$ tăng cao.
  2. Khảo sát trọng số $Q_3$ (Góc quay bánh xe $\theta_2$): Khi tăng $Q_3$ từ $1$ lên $10^3$ và $10^5$, bánh xe giảm biên độ dao động dịch chuyển, hạn chế góc quay quá mức nhưng làm quả bóng dao động quanh vị trí đỉnh lâu hơn trước khi xác lập.
  3. Khảo sát trọng số $R$ (Năng lượng điều khiển): Khi chọn $R = 0.1$, tín hiệu điều khiển phản ứng rất mạnh, dễ gây rung cơ khí; khi $R = 10$, hệ thống đáp ứng êm hơn, độ vọt lố giảm nhưng thời gian xác lập kéo dài thêm $42%$.

Bảng so sánh kết quả thực nghiệm và mục tiêu thiết kế

Thông số đánh giá Giá trị mục tiêu Kết quả mô phỏng (Simulink) Kết quả thực nghiệm (Hardware) Đánh giá đạt chuẩn
Thời gian xác lập ($t_s$) $< 2.5\text{ s}$ $1.72\text{ s}$ $2.15\text{ s}$ Đạt ($100%$)
Độ vọt lố góc bóng ($M_p$) $< 15%$ $8.4%$ $12.6%$ Đạt ($100%$)
Sai số góc xác lập ($e_{ss}$) $\le \pm 0.5^\circ$ $0.00^\circ$ $\pm 0.38^\circ$ Đạt ($100%$)
Biên độ góc làm việc ($\theta_1$) $\pm 10^\circ$ $\pm 10^\circ$ $\pm 8.5^\circ$ Đạt ($100%$)
Tần số vòng lặp điều khiển $100\text{ Hz}$ Liên tục $100\text{ Hz}$ ($10\text{ ms}$) Đạt ($100%$)
Điện áp điều khiển cực đại $\le 24\text{ V}$ $18.6\text{ V}$ $22.4\text{ V}$ Đạt ($100%$)

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

  1. Chuẩn hóa khung phần cứng giáo dục giá thành thấp: Thiết kế mô hình cơ cấu chấp hành mở, kết hợp nhôm định hình và động cơ NISCA 24VDC tối ưu chi phí, giảm hơn $65%$ chi phí so với các mô hình thí nghiệm thương mại (Quanser/Feedback Instruments) nhưng vẫn đảm bảo tính chính xác cơ học cao.
  2. Triển khai thành công LQR SIMO đa biến trên MCU STM32F4: Chứng minh tính khả thi của việc nhúng thuật toán điều khiển tối ưu giải tích trên nền tảng vi điều khiển Cortex-M4 32-bit với chu kỳ trích mẫu ổn định $10\text{ ms}$.
  3. Cải tiến hiệu năng so với các bộ điều khiển kinh điển:
Giải pháp điều khiển Thời gian xác lập ($t_s$) Độ vọt lố ($M_p$) Tiêu hao năng lượng (RMS Voltage) Khả năng khống chế góc bánh xe
PID kép (Cascade PID) $3.42\text{ s}$ $24.5%$ $16.8\text{ V}$ Kém (Bánh xe trôi dạt vô hạn)
Gán cực (Pole Placement) $2.65\text{ s}$ $18.2%$ $15.1\text{ V}$ Trung bình (Khó tối ưu năng lượng)
LQR (Đề tài đề xuất) $2.15\text{ s}$ (Nhanh hơn 37%) $12.6%$ (Giảm 48.5%) $12.4\text{ V}$ (Tiết kiệm 26.2%) Xuất sắc (Khống chế đồng thời $\theta_1, \theta_2$)

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

Tình huống ứng dụng thực tiễn

  • Hệ thống robot tự cân bằng dạng cầu (Ballbot): Nền tảng di động đa hướng chỉ tiếp xúc với mặt đất qua một quả cầu duy nhất, giúp robot xoay sở linh hoạt trong không gian hẹp như bệnh viện, văn phòng.
  • Ổn định hệ thống hàng hải và tàu lặn ngầm: Duy trì góc nghiêng và cân bằng tải trọng động lực học của tàu ngầm khi di chuyển qua các dòng hải lưu xoáy ngầm.
  • Giảm chấn chủ động công trình cao tầng (Active TMD): Điều khiển khối lượng đối trọng trượt trên các bề mặt cong nhằm triệt tiêu dao động do gió bão hoặc động đất tác động lên các tòa tháp cao ốc.

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

Hạng mục linh kiện / Thiết bị Mã hiệu / Quy cách Đơn giá ước tính (VND) Tỷ trọng chi phí
Vi điều khiển trung tâm STM32F407VGT6 Development Board 350.000 $15.5%$
Động cơ chấp hành Động cơ DC NISCA 24VDC có Encoder 750.000 $33.3%$
Mạch điều khiển công suất Board cầu H HI216 (2 kênh, 3A peak) 180.000 $8.0%$
Cảm biến khoảng cách SHARP GP2Y0A21YK0F IR Sensor 160.000 $7.1%$
Bộ nguồn công nghiệp Nguồn tổ ong 24V - 10A DC 250.000 $11.1%$
Kết cấu cơ khí & bánh xe Nhôm định hình, bạc đạn, gia công bánh xe 480.000 $21.3%$
Phụ kiện & dây nối Ốc vít, dây cắm, quả bóng tennis 80.000 $3.7%$
Tổng chi phí phần cứng Hệ thống hoàn chỉnh 2.250.000 VND $100%$

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

Hạn chế kỹ thuật

  • Nhiễu phi tuyến từ cảm biến quang học: Cảm biến hồng ngoại SHARP GP2Y0A21YK0F có đặc tính ngõ ra phi tuyến mạnh và nhạy cảm với ánh sáng môi trường, làm phát sinh nhiễu đo ở khoảng cách biên.
  • Miền làm việc hạn chế: Bộ điều khiển LQR dựa trên mô hình tuyến tính hóa cục bộ, do đó chỉ giữ được thăng bằng trong phạm vi góc lệch nhỏ $\theta_1 \in [-10^\circ, +10^\circ]$. Nếu góc lệch ban đầu vượt ngưỡng này, hệ thống sẽ mất ổn định.

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

  1. Tích hợp bộ lọc Kalman mở rộng (EKF): Kết hợp cảm biến IMU (MPU6050) gắn trên quả bóng với cảm biến quang học để ước lượng trạng thái với độ chính xác cao và loại bỏ nhiễu trắng.
  2. Nâng cấp thuật toán điều khiển phi tuyến: Ứng dụng điều khiển cuốn trượt (Sliding Mode Control - SMC) hoặc điều khiển dự báo mô hình (Model Predictive Control - MPC) để mở rộng miền hoạt động ổn định lên $\pm 30^\circ$.
  3. Ứng dụng thị giác máy tính (Computer Vision): Sử dụng camera tốc độ cao (High-speed Camera) và giải thuật xử lý ảnh OpenCV để theo dõi tọa độ tâm quả bóng mà không cần gắn cảm biến hồng ngoại cố định.

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

  • Sinh viên ngành Kỹ thuật Điều khiển & Tự động hóa, Cơ điện tử: Cung cấp tài liệu tham khảo chi tiết từ khâu mô hình hóa toán học Euler-Lagrange, phân tích ma trận Kalman, đến lập trình nhúng vi điều khiển thực tế.
  • Kỹ sư nhúng và Robotics: Nắm bắt kỹ thuật lập trình Timer ngắt, đọc xung Encoder bậc hai, cấu hình PWM và giao tiếp UART giữa STM32 và máy tính.
  • Các phòng thí nghiệm và cơ sở đào tạo đại học: Triển khai một bộ kit thí nghiệm cân bằng động chi phí thấp, trực quan, phục vụ giảng dạy môn học Lý thuyết điều khiển hiện đại.

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

1. Yêu cầu kỹ thuật tối thiểu để triển khai và vận hành mô hình là gì?

Hệ thống yêu cầu nguồn cấp 24VDC - 5A trở lên, vi điều khiển STM32F4 (hoặc dòng ARM Cortex-M có FPU), mạch cầu H hỗ trợ tần số PWM tối thiểu $10\text{ kHz}$ với dòng liên tục $\ge 2\text{A}$, và máy tính cài đặt .NET Framework 4.8 để chạy phần mềm GUI giám sát.

2. Giới hạn vật lý nào khiến quả bóng bị rơi khỏi bánh xe khi vận hành?

Quả bóng sẽ rơi khỏi bánh xe khi lực pháp tuyến tiếp xúc $N \le 0$ theo điều kiện động lực học $N = m_b g \cos\theta_1 - m_b (r_w + r_b)\dot{\theta}_1^2 \le 0$. Khi vận tốc góc $\dot{\theta}_1$ tăng quá nhanh hoặc góc $\theta_1 > 10^\circ$, lực hướng tâm sẽ triệt tiêu lực nén trọng trường, dẫn đến hiện tượng tách rời tiếp điểm.

3. Có thể thay thế cảm biến hồng ngoại bằng cảm biến siêu âm được không?

Không khuyến khích sử dụng cảm biến siêu âm thông thường (như HC-SR04) do búp sóng siêu âm rộng dễ bị phản xạ sai lệch bởi bề mặt cong của bánh đà và thời gian đáp ứng (tần số lấy mẫu) của cảm biến siêu âm thường $< 40\text{ Hz}$, quá chậm đối với một hệ thống cân bằng động yêu cầu chu kỳ trích mẫu $\ge 100\text{ Hz}$.

4. Cách thức bảo trì và hiệu chuẩn hệ thống cơ điện định kỳ?

Định kỳ kiểm tra độ mòn của chổi than trên động cơ NISCA 24V, vệ sinh bề mặt tiếp xúc của bánh xe và quả bóng để duy trì hệ số ma sát lăn không trượt, đồng thời hiệu chuẩn lại điện áp bù tĩnh (offset calibration) của cảm biến khoảng cách SHARP trước mỗi phiên chạy.

5. Chi phí chế tạo và thời gian thu hồi vốn cho phòng lab đào tạo?

Chi phí linh kiện cho một bộ kit thực hành hoàn chỉnh chỉ khoảng 2.250.000 VND, thấp hơn $80%$ so với các thiết bị nhập khẩu nguyên chiếc. Đối với các cơ sở đào tạo, mô hình mang lại hiệu quả tức thì trong việc nâng cao chất lượng thực hành đồ án tốt nghiệp và môn học Điều khiển nâng cao.

Kết luận

Đồ án tốt nghiệp "Khảo sát điều khiển Linear Quadratic Regulator cho hệ Bóng trên Bánh Xe" đã hoàn thành xuất sắc các mục tiêu nghiên cứu đề ra: từ việc mô hình hóa toán học giải tích thông qua phương trình Euler-Lagrange, chứng minh tính điều khiển được toàn phần của hệ thống ($\text{rank}(M_c) = 4$), đến việc thiết kế và tinh chỉnh thành công bộ điều khiển phản hồi trạng thái tối ưu LQR.

Kết quả thực nghiệm trên phần cứng STM32F4 và động cơ DC NISCA 24V đã khẳng định tính đúng đắn của mô hình lý thuyết với thời gian xác lập ấn tượng $2.15\text{ s}$ và độ vọt lố góc nghiêng chỉ $12.6%$. Đề tài không chỉ mở ra giải pháp xây dựng các mô hình thí nghiệm tự động hóa chất lượng cao với chi phí tối ưu, mà còn tạo nền tảng vững chắc cho các nghiên cứu chuyên sâu về hệ thống điều khiển phi tuyến và robot tự cân bằng thế hệ mới.