Tổng quan nghiên cứu

Hệ Pendubot (con lắc ngược hai bậc tự do thiếu cơ cấu chấp hành - Underactuated Two-Link Robot) là một trong những đối tượng nghiên cứu kinh điển và phức tạp hàng đầu trong lý thuyết điều khiển tự động hiện đại. Hệ thống cơ học này gồm hai thanh liên kết quay tự do trong mặt phẳng đứng nhưng chỉ được trang bị duy nhất một động cơ truyền động ở khớp thứ nhất, trong khi khớp thứ hai hoàn toàn không có động cơ điều khiển. Đặc tính phi tuyến bậc cao, tính bất định động học và trạng thái cân bằng không ổn định tự nhiên tạo nên thách thức kỹ thuật lớn trong việc đưa hệ thống từ trạng thái thả tự do hướng xuống sang các vị trí cân bằng thẳng đứng mong muốn.

Mục tiêu cốt lõi của đề tài là xây dựng mô hình toán học giải tích, nhận dạng chính xác các tham số vật lý của mô hình thực nghiệm bằng phương pháp cân bằng năng lượng, đồng thời thiết kế và đánh giá hai giải thuật điều khiển: Bộ điều khiển tối ưu toàn phương tuyến tính (Linear Quadratic Regulator - LQR) và Bộ điều khiển mờ (Fuzzy Logic Controller) nhằm duy trì độ ổn định thăng bằng tại hai vị trí cân bằng Down-Up và Up-Up. Toàn bộ thuật toán được tích hợp và kiểm chứng trực tiếp trên phần cứng vi xử lý số tín hiệu chuyên dụng DSP TMS320F28335 cùng động cơ DC Servo 24V.

Nghiên cứu được triển khai tại Trường Đại học Bách Khoa - Đại học Quốc gia Thành phố Hồ Chí Minh, hoàn thành vào tháng 06 năm 2014. Ý nghĩa thực tiễn của công trình thể hiện qua các chỉ số định lượng cụ thể: hệ thống đạt thời gian quá độ chỉ 0.7 giây, triệt tiêu sai số xác lập về 0 rad và thực hiện thành công chu trình vung lắc (Swing Up) trong khoảng 3.5 giây. Kết quả này cung cấp cơ sở học thuật và giải pháp kỹ thuật đáng tin cậy cho các ứng dụng công nghiệp phức tạp như tay máy robot linh hoạt, hệ thống cân bằng trên thiết bị bay không người lái và phương tiện tự hành hai bánh.

Cơ sở lý thuyết và phương pháp nghiên cứu

Khung lý thuyết áp dụng

Nghiên cứu xây dựng trên nền tảng phương pháp động lực học Euler-Lagrange để thiết lập hệ phương trình trạng thái phi tuyến mô tả chuyển động của hai khâu liên kết. Mô hình toán học tổng quát bao gồm ma trận quán tính đối xứng bậc hai $D(q)$, ma trận biểu diễn lực hướng tâm và lực Coriolis $C(q, \dot{q})$, cùng vector mômen trọng lực $G(q)$. Phương trình phi tuyến sau đó được tuyến tính hóa quanh hai điểm cân bằng Down-Up (khâu 1 hướng xuống, khâu 2 hướng lên) và Up-Up (cả hai khâu cùng hướng lên) bằng phương pháp khai triển chuỗi Taylor bậc một.

Khung lý thuyết điều khiển tối ưu LQR được áp dụng để xác định vector độ lợi phản hồi trạng thái $K$ tối ưu thông qua việc giải phương trình vi phân đại số Riccati dừng. Giải thuật này tối thiểu hóa hàm mục tiêu năng lượng toàn phương $J$ dựa trên hai ma trận trọng số $Q$ (gán giá trị 100000 cho biến trạng thái góc lệch) và $R$ (gán giá trị 1 cho tín hiệu điều khiển). Song song đó, lý thuyết logic mờ (Fuzzy Logic) cấu trúc Sugeno được thiết lập với 4 biến trạng thái đầu vào (góc lệch và vận tốc góc của từng khâu), sử dụng 3 tập mờ chuẩn hóa trên miền [-1, 1], phép suy diễn Max-Min và kỹ thuật giải mờ trung bình trọng số nhằm xử lý các biến đổi phi tuyến cục bộ. Vòng điều khiển Swing Up ứng dụng kỹ thuật hồi tiếp tuyến tính hóa kết hợp bộ điều khiển vi tích phân tỷ lệ PD với hệ số khuếch đại $K_p = 45.2$ và $K_p = 60$.

Phương pháp nghiên cứu

Nguồn dữ liệu thực nghiệm được thu thập trực tiếp từ hệ thống phần cứng Pendubot chế tạo cơ khí chính xác với hai thanh liên kết có khối lượng lần lượt là 69 gam và 60 gam. Vị trí góc quay được đo lường thông qua hai bộ mã hóa vòng quay quang học (Optical Rotary Encoder): Encoder 1 có độ phân giải 900 xung/vòng và Encoder 2 có độ phân giải 2000 xung/vòng, truyền tín hiệu về khối ngoại vi eQEP tích hợp sẵn của vi xử lý DSP TMS320F28335 ở tần số lấy mẫu 100 Hz.

Cỡ mẫu nghiên cứu bao gồm 10 tập dữ liệu đáp ứng thời gian thực liên tiếp khi kích thích hệ thống bằng tín hiệu thử dạng hàm nấc (step input). Phương pháp chọn mẫu là chọn mẫu xác suất ngẫu nhiên có kiểm soát trong các chu kỳ dao động tự do và cưỡng bức, nhằm loại bỏ các sai số đo lường ngẫu nhiên do nhiễu rung cơ học.

Lý do lựa chọn phương pháp phân tích năng lượng kết hợp thuật toán tích phân hình thang lùi và bình phương cực tiểu không âm (Non-negative Least Squares) là vì phương pháp này chuyển đổi các phương trình vi phân phi tuyến phức tạp thành hệ đại số tuyến tính theo 5 tham số đặc trưng động học, giúp nhận dạng chính xác các hệ số quán tính mà không bị ảnh hưởng bởi thành phần ma sát nhỏ tại các ổ đỡ trục quay.

Quy trình nghiên cứu kéo dài trong timeline 12 tháng với 4 mốc thời gian: thiết kế cơ khí 3D trên Solidworks (tháng 1 đến tháng 3), thi công mạch khuếch đại công suất và lập trình ngoại vi DSP (tháng 4 đến tháng 6), mô phỏng thuật toán trên Matlab/Simulink 2009b (tháng 7 đến tháng 9), và hiệu chỉnh thực nghiệm, tối ưu hóa mã nguồn C trên môi trường Code Composer Studio (tháng 10 đến tháng 12).

Kết quả nghiên cứu và thảo luận

Những phát hiện chính

Quá trình nghiên cứu và thử nghiệm đã đem lại các phát hiện kỹ thuật định lượng mang tính đột phá:

  • Nhận dạng chính xác 5 thông số động học của hệ Pendubot thực nghiệm qua 10 tập dữ liệu đo: giá trị trung bình của tham số quán tính khâu một đạt 0.0382, khâu hai đạt 0.0125, thành phần liên kết chéo đạt 0.0089, tham số trọng lực khâu một đạt 0.1819 và khâu hai đạt 0.0452. Độ chính xác của mô hình nhận dạng đạt mức tương thích trên 95% so với hành vi vật lý thực tế.
  • Bộ điều khiển tối ưu LQR thể hiện chất lượng điều khiển vượt trội tại cả hai cấu hình Down-Up và Up-Up: thời gian quá độ để đưa hệ thống về điểm cân bằng ổn định chỉ mất 0.7 giây, độ vọt lố xấp xỉ 0%, và sai số xác lập đo được bằng 0 rad đối với cả góc lệch cánh tay lẫn góc lệch con lắc.
  • Bộ điều khiển Fuzzy với hệ 81 quy tắc chuẩn hóa duy trì được trạng thái cân bằng trong phạm vi điều kiện góc ban đầu hẹp (dưới 0.3 rad), tuy nhiên thời gian đáp ứng chậm hơn LQR khoảng 40% và tồn tại dao động tự do nhỏ quanh điểm cân bằng với biên độ sai số xác lập xấp xỉ 0.02 rad.
  • Giải thuật vung lắc Swing Up kết hợp chuyển mạch trạng thái sang LQR đưa con lắc từ vị trí tự do hoàn thành chu trình vung và giữ vững thăng bằng ổn định chỉ trong tổng thời gian 3.5 giây, cải thiện 30% tốc độ so với các phương pháp điều khiển trượt phân cấp truyền thống.

Thảo luận kết quả

Nguyên nhân chính dẫn đến sự vượt trội của giải thuật LQR bắt nguồn từ việc cấu trúc toán học của phương trình vi phân Riccati đã tối ưu hóa đồng thời cả quỹ đạo sai lệch trạng thái và mức năng lượng tiêu hao thông qua ma trận trọng số $Q$ và $R$. Khi có xung lực nhiễu tác động từ môi trường bên ngoài, LQR lập tức xuất tín hiệu điện áp bù biên độ lớn lên tới 24V để nhanh chóng kéo các biến trạng thái về gốc tọa độ.

Trong khi đó, bộ điều khiển Fuzzy tuy không đòi hỏi mô hình toán học giải tích chi tiết nhưng bị giới hạn bởi việc cố định 3 tập mờ (Âm, Không, Dương). Điều này khiến lực điều khiển ở vùng lân cận điểm cân bằng bị chuyển mạch thô, dẫn đến hiện tượng trễ pha và khả năng bù nhiễu yếu hơn khi biên độ nhiễu vượt ngưỡng 0.15 rad.

Khi so sánh với các công trình quốc tế cùng lĩnh vực, kết quả vung lắc trong 3.5 giây của nghiên cứu nhanh hơn đáng kể so với mức trung bình 5.0 giây của phương pháp điều khiển trượt phân cấp trong các báo cáo gần đây.

Dữ liệu thực nghiệm của nghiên cứu được trực quan hóa rõ nét qua các biểu đồ đáp ứng thời gian thực (hiển thị đồng thời trên giao diện giám sát C#): trục tung biểu diễn góc nghiêng (rad) và điện áp điều khiển (V), trục hoành biểu diễn thời gian (giây), kết hợp cùng bảng thống kê so sánh đối chiếu giữa giá trị đặt lý thuyết và phản hồi cảm biến encoder, làm rõ cơ chế hội tụ tiệm cận của hệ thống kín.

Đề xuất và khuyến nghị

Nhằm tối ưu hóa hiệu quả điều khiển và mở rộng khả năng ứng dụng thực tiễn của hệ Pendubot trong các hệ thống tự động hóa công nghiệp, nghiên cứu đề xuất 4 giải pháp trọng tâm:

  1. Phát triển giải thuật điều khiển mờ thích nghi (Adaptive Neuro-Fuzzy Control): Tiến hành tích hợp mạng nơ-ron để tự động học và hiệu chỉnh trực tuyến 81 luật mờ cùng các hàm liên thuộc theo thời gian thực, đặt mục tiêu rút ngắn thời gian xác lập của bộ điều khiển mờ xuống dưới 0.5 giây và triệt tiêu dao động xác lập về mức dưới 0.005 rad. Timeline thực hiện: 6 tháng; Đơn vị phụ trách: Nhóm nghiên cứu Điều khiển thông minh và Trí tuệ nhân tạo.
  2. Nâng cấp phần cứng cảm biến và vi xử lý điều khiển: Thực hiện thay thế các encoder quang học tương đối hiện tại bằng encoder quang tuyệt đối có độ phân giải cao 4000 xung/vòng, đồng thời chuyển đổi từ DSP TMS320F28335 sang dòng vi xử lý 64-bit đa lõi thế hệ mới để nâng tần số quét lấy mẫu từ 100 Hz lên 1000 Hz, giúp giảm thiểu 80% nhiễu lượng tử hóa tín hiệu góc. Timeline thực hiện: 3 tháng; Đơn vị phụ trách: Kỹ sư thiết kế phần cứng nhúng và Phòng thí nghiệm Cơ điện tử.
  3. Mở rộng thuật toán điều khiển trượt thích nghi bền vững (Robust Sliding Mode Control): Nghiên cứu ứng dụng bề mặt trượt bậc cao kết hợp kỹ thuật triệt tiêu hiện tượng rung chấn (chattering), nhằm nâng cao khả năng kháng nhiễu tải trọng ngoài lên 150% so với tải danh định tại vị trí Up-Up. Timeline thực hiện: 9 tháng; Đơn vị phụ trách: Nghiên cứu sinh và Giảng viên chuyên ngành Tự động hóa.
  4. Xây dựng hệ thống giám sát SCADA công nghiệp và mô hình bản sao số 3D (Digital Twin): Nâng cấp phần mềm C# thành nền tảng giám sát phân tán qua giao thức mạng công nghiệp Ethernet/IP, trực quan hóa chuyển động 3D của robot với độ trễ truyền thông dưới 5 mili-giây. Timeline thực hiện: 4 tháng; Đơn vị phụ trách: Đội ngũ kỹ sư phần mềm tự động hóa và tích hợp hệ thống.

Đối tượng nên tham khảo luận văn

Luận văn mang lại giá trị học thuật và giải pháp ứng dụng thiết thực cho 4 nhóm đối tượng chính:

  • Học viên cao học và nghiên cứu sinh ngành Kỹ thuật Điều khiển & Tự động hóa: Tài liệu cung cấp toàn diện phương pháp luận mô hình hóa Euler-Lagrange, phương pháp nhận dạng năng lượng và quy trình giải ma trận Riccati trên mô hình phi tuyến. Use case: Khai thác làm tài liệu nghiên cứu cơ sở để phát triển các đề tài luận văn thạc sĩ và bài báo khoa học về tay máy robot thiếu cơ cấu chấp hành.
  • Kỹ sư lập trình hệ thống nhúng và DSP: Cung cấp hướng dẫn chi tiết về kỹ thuật kết nối Matlab/Simulink thông qua Target Support Package TC2 để sinh mã C tự động trên DSP TMS320F28335, xử lý khối ngoại vi eQEP và mạch điều chế PWM 24V. Use case: Triển khai các hệ thống điều khiển truyền động số và servo công nghiệp có tốc độ tính toán cao.
  • Giảng viên và nghiên cứu viên tại các trường đại học kỹ thuật: Nguồn tư liệu hoàn chỉnh từ bản vẽ cơ khí 3D, sơ đồ mạch điện tử đến giải thuật điều khiển LQR - Fuzzy để xây dựng giáo cụ thực hành chuyên sâu. Use case: Thiết kế các bài thí nghiệm môn học Điều khiển phi tuyến, Kỹ thuật Robot và Hệ thống nhúng.
  • Kỹ sư R&D trong ngành công nghiệp Robot và Phương tiện tự hành: Cung cấp giải pháp cân bằng động học cho các cơ cấu chịu tác động phi tuyến mạnh. Use case: Ứng dụng thuật toán điều khiển thăng bằng vào việc thiết kế robot tự hành hai bánh (AGV), tay máy vận chuyển linh hoạt và hệ thống giữ ổn định bệ phóng trên tàu thuyền.

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

Hệ Pendubot có điểm gì khác biệt cốt lõi so với hệ con lắc ngược một bậc tự do truyền thống?

Hệ Pendubot bao gồm hai cánh tay nối tiếp nhau trong không gian nhưng chỉ có một động cơ chấp hành duy nhất ở khớp thứ nhất, tạo nên tính chất thiếu cơ cấu chấp hành (underactuated). Trong khi hệ con lắc đơn có cấu trúc tuyến tính hóa đơn giản, Pendubot đòi hỏi việc đo lường đồng thời hai góc quay bằng hai encoder 900 xung và 2000 xung để xử lý tương tác động lực học liên kết phi tuyến phức tạp.

Tại sao phương pháp cân bằng năng lượng lại được lựa chọn để nhận dạng tham số hệ thống?

Phương pháp năng lượng cho phép chuyển đổi phương trình vi phân phi tuyến bậc cao thành dạng hàm đại số tuyến tính đối với 5 tham số động học của hệ thống. Dựa trên 10 tập dữ liệu đáp ứng thực nghiệm thu thập từ tín hiệu kích thích hàm nắc, phương pháp bình phương cực tiểu không âm giúp tính toán chính xác các mômen quán tính mà không cần tháo rời từng bộ phận cơ khí.

Vì sao bộ điều khiển LQR lại đạt chất lượng kháng nhiễu tốt hơn bộ điều khiển Fuzzy trong thực nghiệm?

Bộ điều khiển LQR tối ưu hóa toàn diện chỉ tiêu năng lượng và sai số trạng thái thông qua việc giải chính xác phương trình đại số Riccati, cho phép xuất tín hiệu điện áp phản hồi liên tục với thời gian xác lập cực nhanh 0.7 giây. Ngược lại, bộ điều khiển Fuzzy sử dụng 81 luật với các tập mờ chia thô, gây trễ pha khi gặp tác động nhiễu đột ngột từ môi trường.

Sự khác biệt về độ phức tạp khi điều khiển cân bằng tại vị trí Down-Up so với vị trí Up-Up là gì?

Tại vị trí Down-Up, khâu thứ nhất hướng xuống nên trọng lực hỗ trợ một phần trạng thái ổn định tự nhiên; trong khi tại vị trí Up-Up, cả hai khâu đều hướng lên trên, làm ma trận trạng thái $A$ xuất hiện các giá trị riêng không ổn định lớn hơn. Do đó, vị trí Up-Up đòi hỏi vector độ lợi phản hồi trạng thái $K$ có biên độ khuếch đại lớn hơn để đảm bảo tính ổn định tiệm cận.

Việc kết hợp Matlab/Simulink với Code Composer Studio trên DSP TMS320F28335 mang lại lợi ích gì?

Việc sử dụng thư viện Target Support Package TC2 giúp chuyển đổi trực tiếp sơ đồ khối mô phỏng trên Simulink sang mã nguồn C nhúng cho DSP, giúp tiết kiệm hơn 50% thời gian lập trình so với viết code thủ công. Điều này cho phép kỹ sư vừa tận dụng được khả năng tính toán mạnh mẽ của Matlab, vừa tối ưu hóa được phần cứng xử lý số 32-bit tốc độ cao.

Kết luận

  • Xây dựng hoàn chỉnh mô hình toán học giải tích và hệ thống phần cứng thực nghiệm Pendubot hai bậc tự do sử dụng động cơ DC Servo 24V cùng vi xử lý nhúng DSP TMS320F28335.
  • Nhận dạng thành công 5 thông số động học cốt lõi bằng phương pháp cân bằng năng lượng dựa trên 10 tập dữ liệu thực nghiệm với độ chính xác đạt trên 95%.
  • Thiết kế giải thuật Swing Up hồi tiếp tuyến tính hóa kết hợp PD, thực hiện đưa hệ thống lên vùng cân bằng ổn định trong thời gian ấn tượng 3.5 giây.
  • Triển khai và đối sánh thực nghiệm hai bộ điều khiển LQR và Fuzzy tại hai vị trí Down-Up và Up-Up, chứng minh LQR vượt trội với thời gian xác lập 0.7 giây, độ vọt lố 0% và khả năng kháng nhiễu mạnh mẽ.
  • Phát triển thành công phần mềm giám sát, thu thập và lưu trữ dữ liệu thời gian thực trên nền tảng C# với độ trễ truyền thông thấp.

Đóng góp lớn nhất của luận văn là cung cấp giải pháp toàn diện từ lý thuyết mô hình hóa, chế tạo cơ điện tử đến thực thi các thuật toán điều khiển hiện đại trên nền tảng phần cứng xử lý số thực tế. Trong giai đoạn 6 đến 12 tháng tới, hướng nghiên cứu sẽ tập trung nâng cấp giải thuật mờ thích nghi nơ-ron và điều khiển trượt bền vững. Hãy liên hệ và tham khảo chi tiết công trình để ứng dụng ngay những giải pháp điều khiển phi tuyến tiên tiến vào các dự án kỹ thuật robot và tự động hóa chuyên sâu.