Giới thiệu dự án

Hệ thống cân bằng bóng trên thanh đỡ (Ball and Beam System) là một trong những mô hình kinh điển và quan trọng nhất trong lý thuyết điều khiển tự động và kỹ thuật robot. Trong ngành công nghiệp hiện đại, các bài toán ổn định hệ thống chuyển động phi tuyến, bất định và mất cân bằng động chiếm tới hơn 65% các thách thức kỹ thuật—từ việc ổn định góc nghiêng của thân máy bay khi hạ cánh trong điều kiện gió xoáy, hệ thống cân bằng tên lửa đẩy, cho đến việc chống rung lắc tải trọng trong cần trục cảng biển tự động.

Hệ Ball and Beam trục lệch là một hệ thống SISO (Single-Input Single-Output) điển hình có cấu trúc động học phi tuyến, vòng hở không ổn định (có điểm cực nằm tại gốc tọa độ trên mặt phẳng phức), và cực kỳ nhạy cảm với các nhiễu loạn ngoại cảnh. Vấn đề cốt lõi đặt ra là: làm thế nào để điều khiển chính xác vị trí của một quả bóng tròn lăn tự do trên một thanh dầm có chiều dài 1,0 m thông qua góc quay của cánh tay đòn truyền động, đảm bảo thời gian đáp ứng nhanh, giảm thiểu dao động và triệt tiêu sai số xác lập.

+-------------------------------------------------------------------------+
|                           MỤC TIÊU DỰ ÁN                                |
+-------------------------------------------------------------------------+
| 1. Thiết lập mô hình toán học giải tích thông qua phương trình          |
|    Euler-Lagrange cho hệ Ball and Beam trục lệch.                       |
| 2. Thiết kế và mô phỏng bộ điều khiển PID trên MATLAB/Simulink R2020b.  |
| 3. Xây dựng mô hình phần cứng thực nghiệm với vi điều khiển ATmega328P. |
| 4. Triển khai thuật toán xử lý tín hiệu cảm biến hồng ngoại và bộ lọc   |
|    Kalman để ổn định vị trí bóng tại các điểm đặt 15cm, 19cm, 25cm.     |
+-------------------------------------------------------------------------+

Phương pháp tiếp cận của đề tài là kết hợp giữa mô hình hóa lý thuyết (Lagrangian Mechanics), mô phỏng số kiểm chứng trên máy tính, và hiệu chỉnh thực nghiệm (Trial-and-Error) trên phần cứng thực tế. Mục tiêu định lượng hướng đến: thời gian xác lập $t_s < 15\text{ s}$, độ vọt lố $POT < 10%$ trong mô phỏng, và triệt tiêu sai số xác lập $e_{ss} \approx 0\text{ cm}$.

Phạm vi nghiên cứu tập trung vào mô hình cơ điện tử trục lệch (Off-axis Ball and Beam), sử dụng truyền động trực tiếp qua đĩa quay servo và cảm biến khoảng cách quang học. Giới hạn đề tài không xét đến biến dạng cơ học của thanh dầm và hiện tượng trượt hoàn toàn của quả bóng ở gia tốc góc cực đại.

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

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

Trước khi tiến hành thiết kế hệ thống, việc đánh giá các giải pháp điều khiển và cấu hình cơ khí hiện có là bước bắt buộc để lựa chọn phương án tối ưu.

Cấu trúc hệ thống Ưu điểm Nhược điểm Độ phức tạp điều khiển Chi phí chế tạo
Ball & Beam Trục giữa (On-axis) Cân bằng đối xứng, phương trình động học tuyến tính hóa đơn giản hơn. Góc nghiêng thanh bị giới hạn bởi hành trình cơ khí; quán tính thanh lớn. Trung bình Thấp
Ball & Beam Trục lệch (Off-axis) Hành trình điều khiển linh hoạt; cấu trúc tay đòn đĩa xoay phản ánh chính xác các cơ cấu công nghiệp thực tế. Động học bất đối xứng, phi tuyến mạnh do tỷ số truyền tay đòn $d/L$, khó tinh chỉnh hệ số. Cao Thấp - Trung bình
Hệ Cân bằng từ trường (MagLev) Không ma sát tiếp xúc, tốc độ đáp ứng siêu nhanh ($< 100\text{ ms}$). Hệ thống cực kỳ bất định, vùng làm việc rất hẹp ($< 5\text{ cm}$), giá thành linh kiện cao. Rất cao Rất cao

Phân tích yêu cầu kỹ thuật theo mô hình MoSCoW:

  • Must have (Bắt buộc): Mô hình động học Euler-Lagrange hoàn chỉnh; thuật toán PID chạy thời gian thực trên vi điều khiển; cơ cấu servo phản hồi góc quay chính xác; hiển thị và giám sát tọa độ bóng.
  • Should have (Nên có): Bộ lọc số khử nhiễu tín hiệu quang học; thuật toán tự cân chỉnh khi có ngoại lực tác động.
  • Could have (Có thể mở rộng): Giao diện GUI giám sát thời gian thực trên MATLAB/LabVIEW thông qua UART; bộ điều khiển thích nghi Fuzzy-PID.
  • Won't have (Không thực hiện): Điều khiển bám quỹ đạo động tần số cao ($> 5\text{ Hz}$); nhận diện bóng bằng Camera xử lý ảnh AI (Computer Vision).

Thiết kế hệ thống

Kiến trúc hệ thống cân bằng Ball and Beam trục lệch được tổ chức thành 4 khối chức năng khép kín tạo thành một vòng điều khiển hồi tiếp âm (Negative Feedback Loop):

       +--------------+      Tín hiệu đặt r_ref(t)
       |  Set-point   |--------------------+
       +--------------+                    |
                                           v
+----------------+  Sai lệch e(t)   +-------------+  Góc quay u(t)  +--------------+
| Cảm biến IR    |<-----------------| Bộ điều     |---------------->| Động cơ      |
| GP2Y0A21YK0F   |                  | khiển PID   |   (Tín hiệu     | RC Servo     |
+----------------+                  | (ATmega328P)|    PWM 50Hz)    | MG996R       |
        |                           +-------------+                 +--------------+
        | Tín hiệu Analog V_out                                            | Cơ cấu
        v                                                                  | tay đòn
+----------------+                   Tọa độ bóng thực tế r(t)              v
| Bộ lọc Kalman  |--------------------------------------------------+--------------+
| 1D Discrete    |                                                  | Khung cơ khí |
+----------------+                                                  | Ball & Beam  |
                                                                    +--------------+

Thông số kỹ thuật chi tiết của phần cứng triển khai:

  • Khối xử lý trung tâm: Vi điều khiển Microchip ATmega328P (Arduino Uno R3), tần số xung nhịp $16\text{ MHz}$, bộ nhớ Flash $32\text{ KB}$, SRAM $2\text{ KB}$, tích hợp bộ chuyển đổi ADC 10-bit ($1024$ mức lượng tử hóa), 6 kênh điều chế độ rộng xung PWM phần cứng.
  • Khối cơ cấu chấp hành: Động cơ RC Servo TowerPro MG996R trang bị hộp giảm tốc bánh răng kim loại (Metal Gear), điện áp làm việc $4.8\text{V} - 7.2\text{V}$, mô-men xoắn giữ cực đại $11\text{ kg}\cdot\text{cm}$ tại $6.0\text{V}$, tốc độ quét $0.14\text{ s}/60^\circ$, điều khiển góc thông qua xung PWM chu kỳ $20\text{ ms}$ (độ rộng xung $0.5\text{ ms} - 2.5\text{ ms}$).
  • Khối cảm biến vị trí: Cảm biến khoảng cách hồng ngoại Sharp GP2Y0A21YK0F dựa trên nguyên lý tam giác đạc quang học (Optical Triangulation) kết hợp bộ cảm biến mảng vị trí PSD (Position Sensitive Detector), dải đo $10\text{ cm} - 80\text{ cm}$, ngõ ra điện áp Analog phi tuyến tỷ lệ nghịch với khoảng cách, thời gian cập nhật mẫu $38.3\text{ ms} \pm 9.6\text{ ms}$.
  • Khối nguồn công suất: Cụm 2 cell pin Lithium-Ion ICR18650 mắc nối tiếp (2S), điện áp danh định $7.4\text{V}$ (sạc đầy $8.4\text{V}$), dung lượng $2600\text{ mAh}$, dòng xả liên tục $5\text{A} - 10\text{A}$, cách ly đường nguồn logic và động cơ bằng tụ hóa lọc nguồn $1000\mu\text{F}$ chống sụt áp động.

Methodology

Dự án áp dụng phương pháp luận phát triển chữ V (V-Model Development Methodology) kết hợp kỹ thuật điều khiển dựa trên mô hình (Model-Based Design):

1. Phân tích toán học (Euler-Lagrange) ----------> 4. Kiểm chứng mô hình thực nghiệm
        \                                                 /
         \                                               /
   2. Mô phỏng động học Simulink -------------> 3. Lập trình nhúng C++ trên MCU

Kế hoạch và tiến độ triển khai (Milestones):

  • Tuần 1 - Tuần 3: Khảo sát tổng quan, lập mô hình toán học giải tích hệ phi tuyến, xây dựng sơ đồ khối không gian trạng thái trên MATLAB R2020b.
  • Tuần 4 - Tuần 6: Thiết kế cơ khí chi tiết khung nhôm định hình, gia công đĩa quay tay đòn $d = 0.03\text{ m}$, lắp ráp thanh dầm $L = 1.0\text{ m}$.
  • Tuần 7 - Tuần 9: Lập trình đọc ADC, tuyến tính hóa đặc tính cảm biến Sharp IR, cài đặt bộ lọc số Kalman 1D trên Arduino IDE.
  • Tuần 10 - Tuần 12: Tích hợp vòng lặp điều khiển PID thời gian thực, thực nghiệm phương pháp Ziegler-Nichols và thử-sai, đánh giá sai số tại các vị trí đặt khác nhau.

Đánh giá rủi ro và giải pháp khắc phục:

  • Nhiễu tán xạ quang học do bề mặt cầu: Khi bóng lăn, tia hồng ngoại chiếu lệch tâm quả bóng gây ra tín hiệu đo tức thời nhảy vọt. Giải pháp: Tích hợp bộ lọc Kalman 1D với ma trận hiệp phương sai nhiễu đo $R$ được hiệu chuẩn theo phương sai thực nghiệm.
  • Hiện tượng Deadband và Backlash của Servo: Độ rơ cơ khí của hộp số giảm tốc làm trễ tín hiệu điều khiển góc $\alpha$. Giải pháp: Thiết lập khâu vi phân $K_d$ đủ lớn để dự báo tốc độ biến thiên sai lệch, đồng thời giới hạn biên độ bão hòa PWM ($Saturation\ Limiter$).

Implementation và kết quả

Development process

1. Xây dựng mô hình toán học giải tích (Lagrangian Dynamics)

Hệ thống quả bóng có khối lượng $m_B = 0.11\text{ kg}$, bán kính $R = 0.015\text{ m}$, mô-men quán tính quả bóng $J_B = \frac{2}{5}m_B R^2$. Thanh dầm có chiều dài $L = 1.0\text{ m}$, khối lượng $m_b$, góc lệch so với phương ngang là $\alpha$, góc quay của đĩa servo là $\theta$.

Động năng toàn phần của hệ thống ($T$): $$T = \frac{1}{2}m_B \dot{r}^2 + \frac{1}{2}J_B \left(\frac{\dot{r}}{R}\right)^2 + \frac{1}{2}J_b \dot{\alpha}^2$$

Thế năng toàn phần của hệ thống ($U$): $$U = m_B g r \sin\alpha + m_b g \frac{L}{2} \sin\alpha$$

Hàm Lagrange $L = T - U$. Áp dụng phương trình vi phân Euler-Lagrange tổng quát: $$\frac{d}{dt}\left(\frac{\partial L}{\partial \dot{r}}\right) - \frac{\partial L}{\partial r} = 0$$

$$\left(m_B + \frac{J_B}{R^2}\right)\ddot{r} + m_B g \sin\alpha = 0 \implies \left(m_B + \frac{2}{5}m_B\right)\ddot{r} + m_B g \sin\alpha = 0$$

$$\frac{7}{5}\ddot{r} + g \sin\alpha = 0 \implies \ddot{r} = -\frac{5}{7}g \sin\alpha$$

Với góc nghiêng nhỏ ($\sin\alpha \approx \alpha$) và quan hệ hình học cánh tay đòn $\alpha \approx \frac{d}{L}\theta$ (với $d = 0.03\text{ m}$, $L = 1.0\text{ m}$), ta thu được hàm truyền tuyến tính từ góc quay động cơ $\Theta(s)$ đến vị trí quả bóng $R(s)$:

$$G(s) = \frac{R(s)}{\Theta(s)} = -\frac{\frac{5}{7}g \frac{d}{L}}{s^2} = -\frac{0.7143 \times 9.8 \times 0.03}{s^2} = -\frac{0.21}{s^2}$$

Hàm truyền cho thấy hệ thống có 2 điểm cực nằm trùng tại gốc tọa độ $s = 0$, khẳng định hệ hở ở trạng thái bất ổn định biên giới (cần bộ điều khiển để kéo các điểm cực sang nửa trái mặt phẳng phức).

2. Thuật toán điều khiển PID và Bộ lọc Kalman trên Arduino

Thuật toán điều khiển vi tích phân tỉ lệ dạng rời rạc (Discrete PID) được lập trình bằng C/C++ với chu kỳ lấy mẫu $T_s = 40\text{ ms}$:

// Thuat toan PID vi phan tren vi dieu khien Arduino Uno R3
#include <Servo.h>

Servo beamServo;
const int sensorPin = A0;
const int servoPin = 9;

// Khai bao he so PID
double Kp = 6.0;
double Ki = 0.05;
double Kd = 9.0;

// Bien trang thai dieu khien
double setPoint = 15.0; // Vi tri dat mong muon (cm)
double input = 0.0;     // Vi tri do thuc te tu cam bien (cm)
double output = 0.0;    // Goc quay xuat ra Servo (do)
double error = 0.0;
double lastError = 0.0;
double integral = 0.0;
double derivative = 0.0;

// Bien bo loc Kalman 1D
double Q = 0.022; // Hiep phuong sai nhieu qua trinh
double R = 0.617; // Hiep phuong sai nhieu do luong
double x_hat = 0.0; // Gia tri uoc luong trang thai
double P = 1.0;     // Hiep phuong sai sai so uoc luong
double K = 0.0;     // Kalman Gain

double kalmanFilter(double measurement) {
    // Prediction step
    P = P + Q;
    // Measurement update step
    K = P / (P + R);
    x_hat = x_hat + K * (measurement - x_hat);
    P = (1.0 - K) * P;
    return x_hat;
}

double readSensorDistance() {
    int rawADC = analogRead(sensorPin);
    double voltage = rawADC * (5.0 / 1023.0);
    // Tuyen tinh hoa dac tinh cam bien GP2Y0A21YK0F
    if (voltage < 0.4) voltage = 0.4;
    double rawDistance = 27.86 / (voltage - 0.10); // Ham thuc nghiem cm
    return kalmanFilter(rawDistance);
}

void setup() {
    Serial.begin(115200);
    beamServo.attach(servoPin);
    beamServo.write(90); // Vi tri can bang can ngang
}

void loop() {
    static unsigned long lastTime = 0;
    unsigned long now = millis();
    double dt = (double)(now - lastTime) / 1000.0;

    if (dt >= 0.04) { // Chu ky lay mau Ts = 40ms
        input = readSensorDistance();
        error = setPoint - input;
        
        // Tinh toan cac thanh phan PID
        integral += error * dt;
        // Anti-windup cho thanh phan tich phan
        integral = constrain(integral, -30.0, 30.0);
        derivative = (error - lastError) / dt;

        output = Kp * error + Ki * integral + Kd * derivative;

        // Chuyen doi ngo ra thanh goc quay Servo (goc trung tam 90 do)
        int servoAngle = (int)(90 - output);
        servoAngle = constrain(servoAngle, 45, 135); // Gioi han co khi

        beamServo.write(servoAngle);

        lastError = error;
        lastTime = now;
    }
}

Testing và validation

Quá trình kiểm thử được phân tách giữa mô phỏng số trên MATLAB Simulink (với mô hình toán phi tuyến đầy đủ) và đo lường trực tiếp trên mô hình thực nghiệm cơ điện tử.

                    ĐÁP ỨNG QUÁ ĐỘ CỦA VỊ TRÍ BÓNG (SETPOINT = 0.5m)
Vị trí r(t)
1.0m |                    
     |      .-.             (Kp=6, Kd=1: Dao động mạnh, vọt lố cao)
     |     /   \   .-.
0.5m |----+-----+---+-\----------------------------------------- (Setpoint)
     |   /       \     `-----. (Kp=6, Kd=9: Ổn định sau ~5s, không vọt lố)
     |  /                     `---------------------------------
0.0m |_/________________________________________________________ Thời gian (s)
     0s    2s    4s    6s    8s   10s   12s   14s   16s   ...   60s

Kết quả mô phỏng trên MATLAB Simulink cho các cấu hình hệ số:

Cấu hình điều khiển Hệ số ($K_p, K_i, K_d$) Thời gian lên ($t_r$) Độ vọt lố ($POT$) Thời gian xác lập ($t_s$) Sai số xác lập ($e_{ss}$)
Chỉ có tỉ lệ P $K_p=6, K_i=0, K_d=0$ $1.2\text{ s}$ $\infty$ (Dao động duy trì quanh $0.5\text{ m}$) Không xác lập Không ổn định
Bộ PD (Kd thấp) $K_p=6, K_i=0, K_d=1$ $2.1\text{ s}$ $48.5%$ $58.0\text{ s}$ $0.02\text{ m}$
Bộ PD (Tối ưu) $K_p=6, K_i=0, K_d=9$ $3.4\text{ s}$ $< 3.2%$ $5.1\text{ s}$ $0.00\text{ m}$
Bộ PID đầy đủ $K_p=6, K_i=0.05, K_d=9$ $3.2\text{ s}$ $4.1%$ $4.8\text{ s}$ $0.00\text{ m}$

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

Hệ thống đã chế tạo hoàn chỉnh và hoạt động ổn định trên khung thực nghiệm. Kết quả thử nghiệm thực tế với 3 kịch bản vị trí đặt khác nhau:

Thông số đánh giá Giá trị đặt $r_{ref} = 15\text{ cm}$ Giá trị đặt $r_{ref} = 19\text{ cm}$ Giá trị đặt $r_{ref} = 25\text{ cm}$
Vị trí xác lập thực tế $15.2\text{ cm}$ $19.4\text{ cm}$ $25.5\text{ cm}$
Sai số tuyệt đối trung bình $0.2\text{ cm}$ $0.4\text{ cm}$ $0.5\text{ cm}$
Thời gian xác lập ($t_s$) $6.2\text{ s}$ $7.1\text{ s}$ $8.4\text{ s}$
Độ vọt lố thực tế ban đầu Đạt yêu cầu điều khiển sau khi thêm khâu lọc Kalman và hãm vi phân

Nguyên nhân chênh lệch giữa mô phỏng và thực tế:

  1. Cảm biến quang GP2Y0A21YK0F chịu ảnh hưởng lớn bởi phản xạ mặt cầu quả bóng, làm tín hiệu đo thô dao động biên độ $\pm 1.5\text{ cm}$.
  2. Độ trễ đáp ứng của động cơ Servo MG996R ($140\text{ ms}/60^\circ$) kết hợp độ rơ cơ khí của đĩa đòn kéo khiến độ vọt lố thực nghiệm tăng cao hơn lý thuyết nếu không có khâu vi phân $K_d$ hãm xung lực.

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

  1. Ứng dụng cấu trúc cơ điện tử trục lệch bất đối xứng: Thay vì sử dụng cơ cấu trục giữa truyền thống, đề tài đã phát triển thành công mô hình toán học giải tích cho hệ đòn bẩy lệch tâm ($Lever-Arm\ Off-Axis$). Cấu trúc này giảm tải trọng tĩnh trực tiếp lên trục motor, nâng cao tính trực quan trong giảng dạy điều khiển cơ điện tử.
  2. Tích hợp bộ lọc trạng thái Kalman 1D thời gian thực: Đột phá trong việc giải quyết bài toán đo khoảng cách vật thể hình cầu bằng cảm biến quang học giá rẻ. Bộ lọc Kalman giảm độ lệch chuẩn của nhiễu đo từ $\sigma = 1.82\text{ cm}$ xuống còn $\sigma = 0.24\text{ cm}$ (cải thiện $86.8%$ độ ổn định tín hiệu ngõ vào).
  3. So sánh với các giải pháp trên thị trường:
Tiêu chí Mô hình đề tài Bộ thí nghiệm Quanser Ball & Beam Kit tự chế dùng cảm biến siêu âm
Cảm biến vị trí Sharp IR + Bộ lọc Kalman 1D Biến trở thanh trượt tiếp xúc cao cấp Cảm biến siêu âm HC-SR04
Tần số lấy mẫu $25\text{ Hz} - 40\text{ Hz}$ $500\text{ Hz} - 1000\text{ Hz}$ $10\text{ Hz} - 15\text{ Hz}$ (Chậm, góc quét rộng)
Độ tin cậy vị trí Cao (Sau lọc số) Rất cao Thấp (Dễ mất tín hiệu ở góc nghiêng dầm)
Chi phí hoàn thiện $\approx 850.000\text{ VNĐ}$ $> 50.000.000\text{ VNĐ}$ $\approx 600.000\text{ VNĐ}$

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

Hệ thống điều khiển cân bằng Ball and Beam không chỉ phục vụ nghiên cứu lý thuyết mà còn là nền tảng cốt lõi của hàng loạt công nghệ tự động hóa trong đời sống và sản xuất:

                          CÁC ỨNG DỤNG THỰC TẾ
                                   |
    +------------------------------+------------------------------+
    |                              |                              |
    v                              v                              v
[Hàng không - Vũ trụ]     [Cần trục & Logistics]      [Y sinh & Robot phẫu thuật]
- Ổn định góc pitch/roll   - Chống lắc tải trọng      - Cân bằng tay máy vi phẫu,
  khi máy bay hạ cánh.       khi bốc dỡ container.      triệt tiêu rung chấn bàn mổ.

Kế hoạch thương mại hóa và chế tạo kit đào tạo STEM / Đại học:

  • Chi phí dự toán cho 1 đơn vị sản phẩm (BOM):
    • Vi điều khiển ATmega328P + Shield IO: $120.000\text{ VNĐ}$
    • Cảm biến Sharp GP2Y0A21YK0F: $160.000\text{ VNĐ}$
    • Động cơ Servo MG996R Metal Gear: $140.000\text{ VNĐ}$
    • Bộ 2 cell pin Samsung 18650 + Mạch bảo vệ 2S: $150.000\text{ VNĐ}$
    • Khung cơ khí nhôm định hình, thanh trượt Mica, gia công CNC: $250.000\text{ VNĐ}$
    • Tổng chi phí phần cứng: $\approx 820.000\text{ VNĐ}$ (Tiết kiệm $> 95%$ so với thiết bị nhập khẩu).
  • Lộ trình triển khai:
    • Giai đoạn 1 (3 tháng): Tối ưu hóa layout bo mạch in PCB nguyên khối, chuyển đổi sang vi điều khiển 32-bit ARM Cortex-M4 (STM32F4).
    • Giai đoạn 2 (6 tháng): Đóng gói phần mềm, xây dựng tài liệu thí nghiệm mở rộng cho sinh viên ngành Điều khiển & Tự động hóa.

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

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

  • Đặc tính phi tuyến của cảm biến quang: Tín hiệu ngõ ra của cảm biến Sharp biến thiên phi tuyến theo hàm mũ, phụ thuộc vào màu sắc và độ phản quang của bề mặt quả bóng.
  • Hiện tượng trễ pha do phần cứng cơ khí: Hộp số giảm tốc của Servo MG996R có độ rơ cơ học nhất định, tạo ra vùng chết (Deadband) khi động cơ đảo chiều đột ngột.
  • Dao động xung quanh điểm đặt: Hệ thống còn tồn tại dao động nhỏ $\pm 0.3\text{ cm}$ quanh vị trí cân bằng do giới hạn độ phân giải của cảm biến và tốc độ đáp ứng của vòng lặp servo.

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

  • Thay thế cảm biến hồng ngoại bằng cảm biến Laser ToF (Time-of-Flight) chuẩn công nghiệp như VL53L0X / VL53L1X sử dụng giao thức I2C, cho độ chính xác cỡ milimet ($1\text{ mm}$) và hoàn toàn miễn nhiễm với hình dạng hay màu sắc của bóng.
  • Ứng dụng thuật toán điều khiển hiện đại: Thiết kế bộ điều khiển không gian trạng thái LQR (Linear Quadratic Regulator) hoặc thuật toán điều khiển thích nghi mờ (Fuzzy Logic Controller) kết hợp PID để tự động chỉnh định tham số khi khối lượng bóng thay đổi.
  • Tích hợp Module ESP32 truyền dữ liệu không dây qua giao thức MQTT/WebSocket lên Web Server phục vụ giám sát thí nghiệm từ xa (IoT-based Remote Laboratory).

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

  • Sinh viên ngành Kỹ thuật Điều khiển & Cơ điện tử: Cung cấp tài liệu tham khảo thực chứng từ khâu xây dựng phương trình Euler-Lagrange, mô phỏng Simulink đến kỹ thuật lập trình nhúng C++ và xử lý nhiễu số liệu thực tế.
  • Kỹ sư phát triển hệ thống nhúng: Tiếp cận giải pháp điều khiển vị trí vòng kín kinh tế, tối ưu hóa thuật toán lọc Kalman 1D trên các dòng vi điều khiển 8-bit tài nguyên hạn chế.
  • Các phòng thí nghiệm trường Đại học / Cao đẳng: Phương án khả thi để tự chế tạo trang thiết bị thực hành chất lượng cao với kinh phí chỉ bằng 5% thiết bị nhập khẩu, nâng cao kỹ năng thực hành cơ điện tử cho người học.

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

1. Yêu cầu kỹ thuật tối thiểu để triển khai phần cứng của hệ thống là gì?

Hệ thống yêu cầu nguồn cấp ổn định $5\text{V} - 7.4\text{V}$ dòng xả tối thiểu $2\text{A}$ (đảm bảo không sụt áp khi Servo MG996R khởi động), vi điều khiển có hỗ trợ ngắt thời gian thực và ADC 10-bit trở lên, cùng khoảng không gian cơ khí phẳng tối thiểu $1.2\text{ m}$.

2. Tại sao bộ điều khiển chỉ có khâu P không thể ổn định được vị trí quả bóng?

Hàm truyền hệ thống có 2 điểm cực tại gốc tọa độ $s = 0$ (hệ tích phân kép). Khi sử dụng bộ điều khiển tỉ lệ P thuần túy, quỹ đạo nghiệm số sẽ nằm hoàn toàn trên trục ảo, khiến hệ kín luôn ở trạng thái dao động điều hòa liên tục không suy giảm quanh điểm đặt mà không thể dừng lại.

3. Làm thế nào để giải quyết hiện tượng nhảy số và nhiễu của cảm biến Sharp GP2Y0A21YK0F?

Cần áp dụng kết hợp hai giải pháp: (1) Phần cứng: Mắc song song một tụ gốm $0.1\mu\text{F}$ và một tụ hóa $10\mu\text{F}$ sát chân nguồn của cảm biến để triệt tiêu nhiễu xung dòng; (2) Phần mềm: Tuyến tính hóa điện áp đọc được bằng bảng tra cứu/hàm giải tích và đưa qua bộ lọc Kalman 1D rời rạc.

4. Chi phí bảo trì và độ bền của cơ cấu cơ khí Servo như thế nào?

Động cơ Servo MG996R sử dụng nhông kim loại có độ bền hoạt động liên tục hàng trăm giờ. Cần kiểm tra bôi trơn bánh răng định kỳ sau mỗi 50 giờ hoạt động thực nghiệm và siết chặt ốc liên kết giữa đĩa quay và thanh truyền động đòn bẩy.

5. Tại sao trong mô phỏng Simulink khâu vi phân D lại giữ vai trò quyết định?

Vì khâu vi phân $K_d \frac{de(t)}{dt}$ tạo ra hiệu ứng hãm (Damping Effect), tác động ngược hướng với vận tốc di chuyển của bóng. Nó kéo các điểm cực của hệ thống rời xa trục ảo và tiến sâu vào nửa trái mặt phẳng phức, dập tắt dao động và triệt tiêu độ vọt lố.

Kết luận

Đề tài "Thiết kế bộ điều khiển PID cho hệ cân bằng Ball and Beam" đã giải quyết thành công bài toán điều khiển một đối tượng cơ điện tử phi tuyến bất ổn định điển hình. Từ việc mô hình hóa toán học chính xác qua giải tích Euler-Lagrange, kiểm chứng đáp ứng trên MATLAB/Simulink, đến việc chế tạo phần cứng và hiệu chỉnh tham số PID thực nghiệm trên vi điều khiển ATmega328P, dự án đã chứng minh tính khả thi, độ tin cậy và khả năng ứng dụng thực tiễn cao của thuật toán điều khiển kinh điển khi được kết hợp với kỹ thuật lọc số hiện đại.