Thiết Kế, Chế Tạo Và Điều Khiển Ổn Định Hệ Pendubot Dựa Trên Giải Thuật LQR và Vi Xử Lý DSP TMS320F28335


Tóm tắt nghiên cứu

Nghiên cứu "Thiết kế chế tạo và điều khiển ổn định hệ Pendubot" (Mã số đề tài: T2015-84) do nhóm tác giả ThS. Trần Vi Đô (Chủ nhiệm đề tài), TS. Nguyễn Minh Tâm và ThS. Nguyễn Phong Lưu thuộc Khoa Điện - Điện tử, Trường Đại học Sư phạm Kỹ thuật TP. Hồ Chí Minh (HCMUTE) thực hiện. Đề tài tập trung giải quyết bài toán điều khiển cân bằng cho hệ thống cơ điện tử thiếu cơ cấu chấp hành (Underactuated Mechanical System) – một đối tượng phi tuyến cao, có số bậc tự do ($n=2$) lớn hơn số tín hiệu điều khiển đầu vào ($m=1$).

                      [ Cấu Trúc Hệ Thống Pendubot ]
                      
     +-----------------------------------------------------------+
     |                       HỆ PENDUBOT                         |
     |                                                           |
     |   +-------------------+          +--------------------+   |
     |   | Khớp 1 (Actuated) | -------- | Khớp 2 (Unactuated)|   |
     |   | Động cơ DC 24V    |  Link 1  | Khớp quay tự do    |   |
     |   | Encoder quang     |          | Encoder quang      |   |
     |   +-------------------+          +--------------------+   |
     +-----------------------------------------------------------+
                                   |
                                   v
             [ Tín hiệu đo góc θ1, θ2 & Vận tốc góc ]
                                   |
                                   v
     +-----------------------------------------------------------+
     |                  BỘ ĐIỀU KHIỂN & XỬ LÝ                    |
     |                                                           |
     |    +-------------------------------------------------+    |
     |    | Vi điều khiển DSP TMS320F28335 (150MHz / FPU)   |    |
     |    | - Thuật toán tối ưu toàn phương tuyến tính (LQR)|    |
     |    | - Ma trận phản hồi trạng thái: u(t) = -K·x(t)   |    |
     |    +-------------------------------------------------+    |
     |                             |                             |
     |                             v                             |
     |    +-------------------------------------------------+    |
     |    | Mạch lái Cầu H & Phát xung PWM (Nguồn 24VDC)    |    |
     |    +-------------------------------------------------+    |
     +-----------------------------------------------------------+

Về mặt phương pháp luận, nhóm nghiên cứu đã thiết lập mô hình động lực học hệ thống dựa trên phương trình Euler-Lagrange, kết hợp quy đổi tín hiệu mô-men xoắn sang điện áp động cơ DC thông qua phương pháp nhận dạng tham số ARMA và bình phương bé nhất. Thuật toán điều chỉnh toàn phương tuyến tính (Linear Quadratic Regulator - LQR) được tổng hợp dựa trên tiêu chuẩn ổn định Lyapunov và nghiệm của phương trình đại số Riccati (ARE).

Kết quả nghiên cứu đã chế tạo thành công phần cứng cơ khí (khung nhôm đúc, động cơ DC 24V tích hợp encoder, khớp quay tự do) và hệ thống mạch điện tử hoàn chỉnh sử dụng vi xử lý DSP TMS320F28335 tốc độ cao 150MHz. Kết quả kiểm chứng trên Matlab/Simulink và thực nghiệm phần cứng cho thấy hệ thống giữ cân bằng ổn định tại điểm kỳ dị thẳng đứng hướng lên ($\theta_1 = 0, \theta_2 = 0$) với độ chính xác cao và khả năng triệt tiêu dao động nhanh chóng. Nghiên cứu mang lại giá trị thực tiễn to lớn trong việc phát triển trang thiết bị phục vụ đào tạo và nghiên cứu chuyên sâu về robot học tại Việt Nam.


Bối cảnh và tầm quan trọng

Tổng quan tri thức hiện thời

Trong lĩnh vực lý thuyết điều khiển tự động và robot học hiện đại, các hệ thống cơ học thiếu cơ cấu chấp hành (underactuated systems) như Pendubot, Acrobot, Gyrobot, hay con lắc ngược hai bậc tự do luôn là đối tượng nghiên cứu kinh điển và phức tạp. Đặc tính cốt lõi của các hệ thống này là số ngõ vào điều khiển nhỏ hơn số bậc tự do của cấu hình hệ thống, tạo ra tính phi tuyến mạnh, liên kết động học chéo và các ràng buộc không khả tích (nonholonomic constraints). Việc làm chủ và điều khiển ổn định dạng hệ thống này đóng vai trò nền tảng để áp dụng vào các cấu trúc robot di động, tay máy công nghiệp tiết kiệm năng lượng, hệ thống cân bằng tên lửa và thiết bị bay không người lái (UAV).

Khoảng trống nghiên cứu tại Việt Nam

Mặc dù trên thế giới, các nhà khoa học danh tiếng như Spong, Tarn, Fantoni hay Lozano đã phát triển nhiều phương pháp điều khiển nâng cao (như Hybrid Control, Energy-based Control, Fuzzy-LQR), tại Việt Nam ở thời điểm năm 2015, việc tự chủ thiết kế, chế tạo phần cứng và điều khiển thực nghiệm hệ Pendubot còn rất hạn chế. Phần lớn các phòng thí nghiệm trong nước phải nhập khẩu thiết bị với chi phí rất cao hoặc chỉ dừng lại ở các bài toán mô phỏng lý thuyết trên phần mềm máy tính, thiếu mô hình thực nghiệm chuẩn xác để sinh viên và học viên cao học kiểm chứng giải thuật.

Tính cấp thiết và tác động kỳ vọng

Đề tài mã số T2015-84 tại Trường Đại học Sư phạm Kỹ thuật TP.HCM mang tính cấp thiết cao nhằm:

  • Xóa bỏ rào cản giữa lý thuyết mô phỏng và thực thi phần cứng thực tế trong giáo dục kỹ thuật.
  • Xây dựng quy trình khép kín: từ tính toán động lực học, nhận dạng thông số thực của động cơ, thiết kế phần cứng điện tử - cơ khí chính xác, đến lập trình nhúng thuật toán điều khiển tối ưu.
  • Cung cấp nền tảng mở (open-platform) tin cậy phục vụ giảng dạy môn Điều khiển tự động, Kỹ thuật Robot và phát triển các đề tài thạc sĩ, tiến sĩ chuyên sâu.

Phương pháp luận và cách tiếp cận

  +--------------------------------------------------------------------------+
  |                   QUY TRÌNH NGHIÊN CỨU & TRIỂN KHAI                      |
  +--------------------------------------------------------------------------+
  |                                                                          |
  |  [Bước 1] Mô hình hóa Động lực học & Quy đổi Điện - Cơ                   |
  |                                                                          |
  |  [Bước 2] Nhận dạng Tham số Động cơ (ARMA & Least Squares)               |
  |                                                                          |
  |  [Bước 3] Tuyến tính hóa & Thiết kế Bộ điều khiển Tối ưu LQR             |
  |                                                                          |
  |  [Bước 4] Mô phỏng Động học trên Matlab/Simulink                         |
  |                                                                          |
  |  [Bước 5] Thiết kế & Thi công Phần cứng Thực tế                          |
  |                                                                          |
  |  [Bước 6] Lập trình Nhúng DSP & Kiểm chứng Thực nghiệm                   |
  +--------------------------------------------------------------------------+

Thiết kế nghiên cứu và mô hình hóa toán học

Nghiên cứu áp dụng quy trình kết hợp chặt chẽ giữa giải tích lý thuyết, mô phỏng máy tính và thực nghiệm công nghiệp. Mô hình động lực học của Pendubot gồm 2 bậc tự do chuyển động trong mặt phẳng thẳng đứng được mô tả bởi hệ phương trình phi tuyến:

$$D(q)\ddot{q} + C(q, \dot{q})\dot{q} + g(q) = \tau$$

Trong đó:

  • $q = [q_1, q_2]^T$ là vector vị trí góc của Link 1 và Link 2.
  • $D(q)$ là ma trận quán tính đối xứng xác định dương.
  • $C(q, \dot{q})$ là ma trận chứa các thành phần Coriolis và lực ly tâm.
  • $g(q)$ là vector trọng trường.
  • $\tau = [\tau_1, 0]^T$ là vector mô-men điều khiển (chỉ có mô-men tại khớp 1 do động cơ DC sinh ra).

Để điều khiển thực tế, nhóm nghiên cứu đã chuyển đổi quan hệ từ mô-men sang điện áp phần ứng $e(t)$ cấp cho động cơ DC dựa trên các phương trình cân bằng điện - cơ:

$$e = L_m \frac{di}{dt} + R_m i + E_b, \quad E_b = K_b \omega$$ $$J_m \frac{d\omega}{dt} = \tau_m - T_f - C_m \omega - \tau_1, \quad \tau_m = K_t i$$

Kỹ thuật nhận dạng tham số động cơ (Parameter Identification)

Do động cơ DC sử dụng không có đầy đủ datasheet từ nhà sản xuất, nhóm tác giả đã thiết lập thuật toán nhận dạng tham số thực nghiệm:

  1. Sử dụng phương trình vi phân sai phân biến đổi về dạng mô hình chuỗi thời gian tự hồi quy trung bình trượt (ARMA).
  2. Đo đạc tín hiệu điện áp ngõ vào $e(t)$, dòng điện phần ứng $i(t)$ và vận tốc quay $\omega(t)$ theo chu kỳ lấy mẫu $\Delta t$.
  3. Áp dụng giải thuật ước lượng bình phương bé nhất (Least Squares Optimization) để giải ma trận và tính toán chính xác các thông số: điện trở phần ứng $R_m = 2.6824\ \Omega$, điện cảm $L_m$, hằng số phản điện $K_b$, hằng số mô-men $K_t$, mô-men quán tính rô-to $J_m$, và hệ số ma sát $C_m, T_f$.

Kỹ thuật thiết kế bộ điều khiển LQR

Mô hình toán học sau khi nhận dạng được tuyến tính hóa quanh điểm làm việc cân bằng không ổn định thẳng đứng hướng lên ($x_0 = [0, 0, 0, 0]^T$). Không gian trạng thái có dạng:

$$\dot{x} = Ax + Bu$$

Hàm mục tiêu chất lượng toàn phương $J$ được xác định nhằm tối thiểu hóa sai lệch trạng thái và năng lượng điều khiển:

$$J = \int_{0}^{\infty} \left( x^T Q x + u^T R u \right) dt$$

Ma trận trọng số được lựa chọn: $$Q = \text{diag}([10, 1, 10, 1]), \quad R = 10$$

Nghiệm của phương trình đại số Riccati (Algebraic Riccati Equation - ARE):

$$A^T S + SA - S B R^{-1} B^T S + Q = 0$$

Từ đó, vector hệ số hồi tiếp trạng thái tối ưu được xác định:

$$K = R^{-1} B^T S = [-35.0660, \dots]$$ $$u(t) = -K x(t)$$

Triển khai hệ thống phần cứng và đảm bảo độ tin cậy

  • Bộ xử lý trung tâm: DSP TMS320F28335 (Texas Instruments) kiến trúc 32-bit, tốc độ 150 MHz, tích hợp bộ xử lý số thực dấu chấm động (FPU), hỗ trợ 18 kênh ePWM, 2 bộ giải mã Encoder QEP 32-bit.
  • Cảm biến: Hai encoder quang độ phân giải 400 xung/vòng (quadrature encoder) gắn tại trục động cơ (Link 1) và khớp tự do (Link 2).
  • Mạch phối ghép & Cách ly: Tích hợp IC đệm chuyển đổi điện áp logic từ 5V (Encoder) sang 3.3V (DSP), mạch chuyển đổi xung vi sai sang xung NPN, lọc nhiễu đường truyền tín hiệu.
  • Mạch công suất: Mạch cầu H chịu dòng cao điều khiển động cơ DC 24V thông qua tín hiệu điều biến độ rộng xung (PWM) và tín hiệu quy định chiều quay (DIR).
  • Phần mềm: Lập trình tự động thông qua Embedded Target Preference của Matlab/Simulink nhúng trực tiếp xuống DSP.

Phát hiện chính của nghiên cứu

Dựa trên quá trình mô phỏng và chạy thực nghiệm trên phần cứng, nghiên cứu đã rút ra 4 phát hiện cốt lõi:

Hạng mục so sánh Mô phỏng Matlab/Simulink Thực nghiệm phần cứng DSP TMS320F28335
Góc Link 1 ($\theta_1$) Xác lập cân bằng trong ~1.5s, độ vọt lố < 5% Ổn định quanh vị trí $0^\circ \pm 0.8^\circ$, triệt tiêu rung trong ~2.0s
Góc Link 2 ($\theta_2$) Xác lập cân bằng trong ~1.8s, không dao động dư Ổn định quanh vị trí $0^\circ \pm 1.2^\circ$, dao động tự do được dập tắt
Tín hiệu điều khiển ($u$) Điện áp đáp ứng mượt mà, biến thiên trong dải 0-24V Xung PWM điều biến liên tục, dòng điện khởi động không vượt ngưỡng
Độ trễ tính toán Lý tưởng (không xét trễ xử lý) Chu kỳ trễ lấy mẫu và tính toán cực ngắn (< 1ms), đáp ứng thời gian thực

1. Khả năng ổn định vững chắc của bộ điều khiển LQR

Bộ điều khiển LQR tuyến tính hóa phát huy hiệu quả xuất sắc trong vùng lân cận điểm cân bằng trên. Cả Link 1 và Link 2 từ trạng thái lệch góc ban đầu nhanh chóng hội tụ về vị trí thẳng đứng cân bằng mà không xảy ra hiện tượng bão hòa điện áp kéo dài.

2. Tầm quan trọng của khâu nhận dạng tham số động cơ DC

Thực nghiệm chứng minh rằng nếu chỉ sử dụng mô hình điều khiển mô-men lý thuyết ($\tau$), hệ thống thực tế sẽ mất ổn định do hiện tượng trễ dòng điện và ma sát cơ khí. Việc mô hình hóa chi tiết động cơ DC và nhận dạng tham số chính xác ($R_m, L_m, K_b, K_t$) là điều kiện tiên quyết giúp thuật toán LQR tính toán được điện áp đặt $e(t)$ chính xác cho mạch cầu H.

3. Hiệu năng vượt trội của chip xử lý DSP TMS320F28335

Khối FPU 32-bit của chip TMS320F28335 cho phép tính toán các phép nhân ma trận dấu chấm động với chu kỳ lệnh chỉ 6.67ns. Bộ xử lý ngoại vi eQEP tích hợp đọc trực tiếp 2 kênh xung pha A/B từ encoder với tần số cao mà không làm quá tải CPU, loại bỏ hoàn toàn hiện tượng trôi xung hoặc trễ pha tín hiệu góc quay.

4. Khắc phục triệt để nhiễu cảm biến và rung cơ khí

Các phát hiện bất ngờ trong quá trình thi công thực tế cho thấy rung động cơ khí tại bệ đỡ gây ra nhiễu gai điện áp trên đường truyền encoder. Vấn đề này đã được nhóm nghiên cứu giải quyết thông qua việc gia cố đế thép chịu lực và thiết kế bổ sung tầng IC đệm nắn sóng xung, giúp tín hiệu phản hồi đạt độ mịn và độ tin cậy tuyệt đối trước khi vào DSP.


Đóng góp khoa học và giá trị ứng dụng

                +-------------------------------------------------------+
                |             CÁC ĐÓNG GÓP KHOA HỌC CHÍNH               |
                +-------------------------------------------------------+
                                            |
        +-----------------------------------+-----------------------------------+
        |                                   |                                   |
        v                                   v                                   v
+-----------------------+       +-----------------------+       +-----------------------+
|  ĐÓNG GÓP LÝ THUYẾT   |       | ĐÓNG GÓP PHƯƠNG PHÁP  |       |   ỨNG DỤNG ĐÀO TẠO    |
+-----------------------+       +-----------------------+       +-----------------------+
| - Hoàn thiện mô hình  |       | - Kết hợp ARMA và LQR |       | - Thiết bị thí nghiệm |
|   toán Euler-Lagrange |       |   trong hệ cơ điện tử |       |   chuẩn tại HCMUTE    |
| - Quy đổi chính xác   |       | - Ứng dụng thành công |       | - Giáo cụ trực quan   |
|   mô-men sang điện áp |       |   Code Generation từ  |       |   cho sinh viên ĐH &  |
| - Kiểm chứng Lyapunov |       |   Simulink sang C2000 |       |   Học viên Cao học    |
+-----------------------+       +-----------------------+       +-----------------------+

Đóng góp về mặt lý thuyết và phương pháp luận

  • Chuẩn hóa quy trình mô hình hóa: Xây dựng tường minh hệ phương trình trạng thái phi tuyến và tuyến tính hóa của hệ Pendubot gắn liền với mô hình toán học chi tiết của động cơ điện một chiều.
  • Tích hợp nhận dạng tham số: Ứng dụng thành công mô hình chuỗi thời gian ARMA và thuật toán ước lượng ma trận để nhận dạng tham số động cơ DC không rõ nguồn gốc thông số, tạo tiền đề cho các ứng dụng điều khiển chính xác trong thực tế.

Cải tiến kỹ thuật và công nghệ

  • Thiết kế phần cứng tối ưu: Phát triển trọn bộ phần cứng bao gồm cơ khí chính xác (nhôm đúc, vòng bi ma sát thấp) và hệ thống mạch điện tử chuyên dụng (DSP value module, mạch đệm xung, mạch cầu H, mạch giao tiếp máy tính qua FT232R).
  • Lập trình nhúng hiện đại: Khai thác hiệu quả luồng thiết kế tự động sinh mã (Automatic Code Generation) từ Matlab/Simulink xuống vi xử lý C2000 TMS320F28335, rút ngắn thời gian phát triển và giảm thiểu sai sót do lập trình thủ công.

Ý nghĩa thực tiễn và giáo dục

  • Sản phẩm đào tạo nội địa hóa: Tạo ra một bộ thiết bị thí nghiệm hoàn chỉnh, hoạt động ổn định và tin cậy tại Phòng thí nghiệm Điều khiển tự động – Khoa Điện - Điện tử, Trường ĐH Sư phạm Kỹ thuật TP.HCM.
  • Tiết kiệm chi phí đầu tư: Giúp nhà trường tự chủ công nghệ thiết bị thí nghiệm hiện đại với chi phí chỉ bằng một phần nhỏ so với các hệ thống thương mại nhập khẩu từ nước ngoài (như Quanser hay Googol Tech).

Đối tượng quan tâm và lợi ích tiếp nhận

Nghiên cứu mang lại giá trị thiết thực cho nhiều nhóm đối tượng trong giới khoa học và công nghiệp:

  • Giảng viên và nhà nghiên cứu học thuật: Có tài liệu tham khảo chi tiết về quy trình mô hình hóa động lực học, tính toán đại số Riccati và giải thuật tối ưu hóa cho các hệ thống thiếu cơ cấu chấp hành.
  • Học viên cao học và sinh viên ngành Điều khiển tự động, Cơ điện tử, Robotics: Tiếp cận một nền tảng thí nghiệm mở để thực hành, triển khai thử nghiệm các thuật toán điều khiển phi tuyến nâng cao như: Điều khiển trượt (Sliding Mode Control), Điều khiển thích nghi (Adaptive Control), Mạng Nơ-ron và Logic mờ (Fuzzy-Neural Networks), hoặc giải thuật di truyền (GA).
  • Kỹ sư phát triển hệ thống nhúng & Robot công nghiệp: Nắm bắt kỹ thuật thiết kế mạch công suất cầu H, mạch giao tiếp cách ly công nghiệp và kỹ năng lập trình thời gian thực trên dòng vi điều khiển DSP C2000 chuyên dụng của Texas Instruments.
  • Các trường đại học kỹ thuật: Mô hình mẫu để tự chủ nghiên cứu, chế tạo trang thiết bị phục vụ đào tạo STEM và tự động hóa chất lượng cao.

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

1. Phát hiện quan trọng nhất của đề tài này là gì?

Phát hiện quan trọng nhất là việc chứng minh tính khả thi và độ ổn định cao của giải thuật LQR khi điều khiển cân bằng hệ Pendubot trên phần cứng thực tế thông qua việc quy đổi chính xác từ mô-men sang điện áp động cơ và nhận dạng đúng các tham số cơ - điện bằng phương pháp ARMA.

2. Phương pháp nghiên cứu của đề tài có điểm gì đặc biệt?

Điểm đặc biệt là phương pháp tiếp cận toàn diện từ "Lý thuyết $\rightarrow$ Nhận dạng tham số $\rightarrow$ Mô phỏng Simulink $\rightarrow$ Thiết kế phần cứng $\rightarrow$ Nhúng mã nguồn thực tế". Việc tích hợp công cụ lập trình Target của Matlab trực tiếp xuống DSP TMS320F28335 giúp đơn giản hóa việc thử nghiệm và tối ưu hóa giải thuật.

3. Kết quả của nghiên cứu có thể khái quát hóa (generalize) cho các hệ thống khác không?

Có. Phương pháp mô hình hóa, nhận dạng tham số động cơ và cấu trúc phần cứng (DSP + IC đệm + Cầu H + Encoder) trong nghiên cứu này hoàn toàn có thể áp dụng cho các hệ thống thiếu cơ cấu chấp hành khác như: Con lắc ngược trên xe (Cart-Pole Inverted Pendulum), Con lắc quay (Furuta Pendulum), Robot 2 bánh tự cân bằng, hoặc tay máy Acrobot.

4. Những hạn chế và bước phát triển tiếp theo (Next Steps) của nghiên cứu là gì?

Đề tài mới tập trung vào bài toán giữ cân bằng (balancing control) tại lân cận điểm cân bằng trên. Hướng phát triển tiếp theo bao gồm:

  • Nghiên cứu giải thuật đưa hệ từ vị trí buông thõng tự nhiên lên vị trí cân bằng (Swing-up Control) dựa trên phương pháp năng lượng hoặc điều khiển trượt.
  • Tích hợp điều khiển thông minh lai (Hybrid/Fuzzy-LQR) để mở rộng biên độ ổn định khi có nhiễu tác động mạnh từ môi trường.

5. Ứng dụng thực tế của cơ cấu Pendubot trong công nghiệp là gì?

Mặc dù là mô hình phòng thí nghiệm, nguyên lý điều khiển của Pendubot là nền tảng để thiết kế cơ chế giữ thăng bằng cho robot hình người (Humanoid Robots), hệ thống giảm chấn chống rung lắc cho cần cẩu trục tại cảng biển, thiết bị cân bằng cho tàu thủy trên biển và hệ thống phóng tên lửa hàng không vũ trụ.


Kết luận

Công trình nghiên cứu khoa học cấp trường "Thiết kế chế tạo và điều khiển ổn định hệ Pendubot" (Mã số: T2015-84) do nhóm tác giả tại Trường Đại học Sư phạm Kỹ thuật TP.HCM thực hiện đã hoàn thành xuất sắc các mục tiêu đề ra. Nghiên cứu không chỉ làm chủ nền tảng lý thuyết điều khiển tối ưu LQR trên mô hình phi tuyến thiếu cơ cấu chấp hành mà còn chế tạo thành công sản phẩm phần cứng hoàn chỉnh, hoạt động ổn định và chính xác.

Đây là đóng góp khoa học tiêu biểu, thúc đẩy phong trào tự chủ công nghệ chế tạo thiết bị thí nghiệm trong các trường đại học kỹ thuật tại Việt Nam. Kết quả của đề tài mở ra nhiều hướng nghiên cứu tiếp theo về điều khiển Swing-up và điều khiển thông minh, sẵn sàng chuyển giao công nghệ phục vụ đào tạo nguồn nhân lực chất lượng cao trong kỷ nguyên Tự động hóa và Robot học.