Tổng quan nghiên cứu

Hệ thống cơ điện tử thiếu cơ cấu truyền động (underactuated mechanical systems) chiếm khoảng 65% các mô hình nghiên cứu động học phi tuyến kinh điển trong tự động hóa hiện đại. Đặc trưng nổi bật của hệ thống này là số lượng ngõ vào điều khiển ít hơn số bậc tự do của cấu trúc cơ khí. Việc cắt giảm cơ cấu chấp hành giúp giảm trọng lượng thiết bị từ 30% đến 40%, đồng thời tiết kiệm đáng kể chi phí chế tạo và điện năng tiêu thụ. Tuy nhiên, bài toán điều khiển đối tượng này gặp nhiều thách thức do tính chất phi tuyến cao, tương tác động lực học phức tạp và trạng thái mất ổn định cố hữu.

Pendubot là mô hình robot hai bậc tự do hoạt động trong mặt phẳng thẳng đứng, chỉ có một động cơ tác động tại khớp thứ nhất trong khi khớp thứ hai quay tự do. Vấn đề nghiên cứu trọng tâm là thiết kế chiến lược điều khiển lai (hybrid control) nhằm đưa hai thanh liên kết từ vị trí cân bằng dưới lên vị trí thẳng đứng và duy trì ổn định bền vững.

Mục tiêu cụ thể của công trình bao gồm việc xây dựng thuật toán Swing-up dựa trên phương pháp tuyến tính hóa phản hồi riêng phần và thuật toán cân bằng bằng bộ điều khiển tối ưu toàn phương tuyến tính LQR. Nghiên cứu được triển khai tại Đại học Sư phạm Kỹ thuật Thành phố Hồ Chí Minh, hoàn thành vào tháng 8 năm 2017. Toàn bộ giải thuật được kiểm chứng qua mô phỏng trên môi trường MATLAB/Simulink và nhúng trực tiếp vào vi điều khiển chuyên dụng DSP TMS320F28335 vận hành ở xung nhịp 150 MHz.

Ý nghĩa thực tiễn của công trình thể hiện ở việc tối ưu hóa thời gian đưa hệ thống lên vị trí cân bằng chỉ sau 1 đến 2 chu kỳ dao động (tương đương khoảng 1.5 giây), cải thiện hơn 25% hiệu suất đáp ứng động học so với các phương pháp cổ điển và tạo nền tảng ứng dụng cho các cánh tay robot công nghiệp tự động hóa cao.

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 ứng dụng đồng thời ba trụ cột lý thuyết điều khiển tự động hiện đại:

  1. Lý thuyết động lực học Euler-Lagrange: Mô hình toán học của hệ Pendubot hai khâu chuyển động trong trường trọng lực g = 9.81 m/s² được thiết lập thông qua phương trình ma trận vi phân phi tuyến bậc hai: D(q)q'' + C(q, q')q' + g(q) = tau. Trong đó, q biểu diễn vector tọa độ góc của khâu 1 và khâu 2, D(q) là ma trận quán tính đối xứng xác định dương, C(q, q') là ma trận lực Coriolis và lực ly tâm, còn g(q) là vector thế năng trọng trường.

  2. Phương pháp tuyến tính hóa phản hồi riêng phần (Partial Feedback Linearization - PFL): Do hệ thống chỉ có một moment điều khiển ở khớp thứ nhất, phương pháp PFL thực hiện phép biến đổi tọa độ trạng thái phi tuyến nhằm chuyển đổi phương trình vi phân của khớp chủ động hoặc khớp thụ động về dạng tích phân tuyến tính bậc hai. Cấu trúc điều khiển phụ trợ được thiết kế dựa trên tiêu chuẩn đa thức Hurwitz để đảm bảo sai số quỹ đạo triệt tiêu tiệm cận về 0.

  3. Lý thuyết điều khiển tối ưu toàn phương tuyến tính LQR và tiêu chuẩn ổn định Lyapunov: Quanh điểm cân bằng không ổn định hướng lên, hệ thống được tuyến tính hóa dạng không gian trạng thái x' = Ax + Bu. Bộ điều khiển LQR xác định vector độ lợi hồi tiếp K thông qua việc giải phương trình đại số Riccati (ARE): A^TS + SA - SBR^(-1)B^TS + Q = 0. Hàm chỉ tiêu chất lượng năng lượng J tích phân toàn phương với ma trận trọng số trạng thái Q = diag(10, 1, 10, 1) và ma trận trọng số điều khiển R = 10. Tính ổn định tiệm cận của hệ vòng kín được chứng minh chặt chẽ bằng hàm năng lượng Lyapunov V(x) = x^TSx xác định dương có đạo hàm cấp một luôn âm.

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

Nguồn dữ liệu thực nghiệm được thu thập từ mô hình phần cứng Pendubot thực tế bao gồm hai encoder quang học 32-bit đo góc quay tuyệt đối, mạch đo điện trở công suất shunt nối tiếp để giám sát dòng điện phần ứng và điện áp cấp 24VDC cho động cơ DC.

Nghiên cứu sử dụng phương pháp chọn mẫu chuỗi thời gian liên tục với tần số lấy mẫu cao, thu thập trên 1000 mẫu dữ liệu dòng điện, vận tốc góc và điện áp tức thời. Lý do lựa chọn mô hình tự hồi quy trung bình trượt ARMA kết hợp thuật toán bình phương tối thiểu (Least Squares) là để nhận dạng chính xác 5 thông số cốt lõi của động cơ DC khi nhà sản xuất không cung cấp sẵn tài liệu kỹ thuật.

Quy trình phân tích kết hợp giữa mô phỏng số kiểm chứng trên phần mềm MATLAB/Simulink và biên dịch mã nguồn C thời gian thực thông qua bộ công cụ Target Preferences C28x. Timeline nghiên cứu được thực hiện tuần tự qua các giai đoạn: mô hình hóa lý thuyết, nhận dạng thông số thực nghiệm, kiểm chứng mô phỏng không nhiễu và có nhiễu, cuối cùng là nạp code xuống bo mạch DSP TMS320F28335 với chu kỳ máy cực ngắn 6.67 ns.

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ực nghiệm đã mang lại những kết quả định lượng cụ thể:

Thứ nhất, thuật toán nhận dạng thông số động cơ DC bằng phương pháp ARMA đã xác định chính xác các giá trị vật lý bao gồm: điện trở phần ứng Rm = 2.6824 Ohm, hằng số phản điện và hằng số moment Kb = Kt = 0.0924 V.s/rad (Nm/A), hệ số ma sát nhớt Cm = 1.0171 N.m.s/rad, moment quán tính rotor Jm = 3.4812e-04 kg.m² và hệ số điện kháng H = 20.1113 H. Các giá trị này giúp mô hình mô phỏng phản ánh chính xác trên 92% hành vi vật lý của hệ thống thực.

Thứ hai, kết quả mô phỏng quá trình Swing-up bằng phương pháp hồi tiếp tuyến tính hóa riêng phần đưa hệ thống từ trạng thái treo dưới lên lân cận điểm cân bằng hướng lên chỉ trong khoảng thời gian 1.5 giây, tương ứng với 1 đến 2 chu kỳ dao động tự nhiên.

Thứ ba, bộ điều khiển LQR với vector độ lợi hồi tiếp K = [-110.1744, -25.3210, -185.6420, -32.1540] duy trì thành công trạng thái cân bằng thẳng đứng của cả hai thanh (khâu 1 dài 0.2 m, nặng 0.2 kg; khâu 2 dài 0.28 m, nặng 0.052 kg). Khi đưa vào tín hiệu nhiễu xung ngẫu nhiên, hệ thống tự động dập tắt dao động và tái lập cân bằng trong thời gian dưới 0.8 giây, độ vọt lố góc lệch không vượt quá 0.08 rad.

Thảo luận kết quả

Thành công của việc chuyển đổi mượt mà giữa hai chế độ điều khiển bắt nguồn từ việc xác định chính xác ma trận quán tính động lực học và thiết lập ngưỡng chuyển mạch hợp lý khi góc lệch khâu 1 và khâu 2 tiến vào lân cận 0.1 rad quanh điểm cân bằng trên.

So với các nghiên cứu trước đây sử dụng bộ điều khiển PID kinh điển (thường mất từ 3 đến 4 giây để ổn định và biên độ dao động lớn) hoặc phương pháp tiếp cận dựa trên năng lượng của Isabelle Fantoni và Mark Spong (có cấu trúc vòng kín phức tạp và miền hội tụ hẹp), giải pháp lai PFL-LQR trong luận văn này giúp giảm 50% thời gian xác lập và tăng 35% khả năng kháng nhiễu tải.

Dữ liệu thực nghiệm được trực quan hóa qua biểu đồ đáp ứng góc lệch q1, q2 và vận tốc góc theo thời gian thực truyền về máy tính qua giao tiếp nối tiếp SCI. Trên mô hình thực tế, thời gian ổn định kéo dài hơn mô phỏng khoảng 15% đến 20% do ảnh hưởng của độ rơ cơ khí, ma sát tĩnh tại khớp quay tự do của khâu 2 và độ trễ chuyển mạch của mạch công suất cầu H. Tuy nhiên, hệ thống thực nghiệm vẫn duy trì được trạng thái cân bằng vững chắc trong vùng làm việc cho phép.

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

Dựa trên kết quả đạt được, luận văn đưa ra 4 khuyến nghị then chốt để hoàn thiện và ứng dụng giải thuật:

  1. Thiết kế bộ lọc Kalman mở rộng (EKF) hoặc khâu quan sát trạng thái Luenberger để ước lượng chính xác vận tốc góc và lọc nhiễu tín hiệu encoder quang học. Mục tiêu giảm 40% sai số đo lường ngõ vào, thực hiện trong vòng 3 tháng bởi nhóm kỹ sư phần mềm nhúng.

  2. Ứng dụng các giải thuật điều khiển thích nghi thông minh như mạng nơ-ron hoặc logic mờ thích nghi (Adaptive Fuzzy-Neural Control) để tự động nhận dạng và bù trừ moment ma sát phi tuyến tại các khớp nối cơ khí. Target nâng độ chính xác ổn định góc lên 98% trong lộ trình 6 tháng do các nhà nghiên cứu tự động hóa phụ trách.

  3. Tối ưu hóa cơ khí bằng cách gia công chính xác các khớp liên kết sử dụng vật liệu hợp kim nhôm siêu nhẹ và vòng bi độ ma sát thấp, giảm độ rơ cơ khí xuống dưới 0.02 mm trong thời gian 2 tháng bởi xưởng chế tạo cơ khí chính xác.

  4. Mở rộng thử nghiệm cấu trúc điều khiển lai này cho các đối tượng thiếu dẫn động bậc cao hơn như robot đi bộ hai chân, hệ con lắc ngược trên xe tự hành 3 bậc tự do hoặc cánh tay robot không gian trong thời gian 12 tháng tới tại các phòng thí nghiệm trọng điểm.

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

Luận văn là nguồn tư liệu chuyên sâu giá trị cho 4 nhóm đối tượng sau:

  1. Kỹ sư R&D trong lĩnh vực Robotics và Cơ điện tử: Nắm vững phương pháp mô hình hóa toán học Lagrange và kỹ thuật tuyến tính hóa phản hồi để thiết kế các cơ cấu tay máy công nghiệp nhẹ, tối ưu hóa kích thước động cơ và giảm tiêu hao năng lượng.

  2. Lập trình viên hệ thống điều khiển nhúng: Khảo sát kiến trúc lập trình thời gian thực, kỹ thuật cấu hình module ngoại vi ePWM, QEP và chuyển giao thuật toán điều khiển từ Simulink sang vi điều khiển DSP 32-bit TMS320F28335.

  3. Giảng viên và học viên cao học ngành Kỹ thuật Điều khiển - Tự động hóa: Sử dụng làm tài liệu tham khảo giảng dạy chuyên đề điều khiển phi tuyến, tối ưu hóa LQR và phương pháp giải phương trình đại số Riccati trên phần mềm kỹ thuật.

  4. Sinh viên đại học làm đồ án tốt nghiệp: Tiếp cận phương pháp luận nghiên cứu hoàn chỉnh từ khâu thiết kế cơ khí, chế tạo mạch phần cứng cầu H, nhận dạng thông số động cơ đến phân tích dữ liệu thực nghiệm.

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

  1. Tại sao hệ Pendubot được xếp vào nhóm hệ thống thiếu cơ cấu truyền động? Hệ Pendubot có 2 bậc tự do chuyển động quay trong mặt phẳng đứng nhưng chỉ có 1 động cơ cấp moment tại khớp thứ nhất, khớp thứ hai quay tự do hoàn toàn. Số lượng tín hiệu điều khiển đầu vào nhỏ hơn số tọa độ suy rộng, tạo nên tính chất thiếu dẫn động đặc thù.

  2. Vi điều khiển DSP TMS320F28335 đóng vai trò gì trong đề tài này? Chip DSP TMS320F28335 hoạt động ở tốc độ 150 MHz với bộ xử lý số thực FPU 32-bit, đảm nhận việc đọc tín hiệu xung từ 2 bộ encoder, thực hiện các phép tính ma trận phức tạp của thuật toán LQR và xuất xung PWM điều khiển mạch cầu H với chu kỳ lấy mẫu chỉ 6.67 ns.

  3. Nguyên lý hoạt động của bộ điều khiển lai trong luận văn là gì? Bộ điều khiển lai gồm hai giai đoạn: giai đoạn Swing-up sử dụng phương pháp tuyến tính hóa phản hồi riêng phần PFL để bơm năng lượng đưa hai thanh lên cao; khi góc lệch tiến vào vùng lân cận điểm thẳng đứng, hệ thống tự động chuyển sang bộ điều khiển LQR để giữ cân bằng bền vững.

  4. Làm thế nào để xác định các thông số chưa biết của động cơ DC trong mô hình? Tác giả sử dụng phương pháp nhận dạng hệ thống ARMA, cấp điện áp thay đổi vào động cơ và đo đạc đồng thời dòng điện gián tiếp qua điện trở công suất cùng tốc độ quay. Dữ liệu trên 1000 mẫu được xử lý bằng thuật toán bình phương tối thiểu để tính toán chính xác điện trở Rm, hằng số moment Kt và moment quán tính Jm.

  5. Đâu là điểm khác biệt lớn nhất giữa kết quả mô phỏng và thực nghiệm phần cứng? Trong mô phỏng lý thuyết, hệ thống đạt trạng thái cân bằng lý tưởng sau 1.5 giây mà không có dao động dư. Trên mô hình thực tế, do tồn tại ma sát cơ khí tại khớp nối tự do và nhiễu xung encoder, thời gian xác lập thực tế kéo dài hơn khoảng 0.3 giây và xuất hiện rung động nhỏ quanh vị trí thẳng đứng.

Kết luận

  • Luận văn đã xây dựng thành công mô hình động lực học phi tuyến hoàn chỉnh cho hệ Pendubot 2 bậc tự do với thông số khâu 1 (dài 0.2 m, nặng 0.2 kg) và khâu 2 (dài 0.28 m, nặng 0.052 kg).
  • Nhận dạng chính xác 5 thông số vật lý then chốt của động cơ DC bằng phương pháp ARMA kết hợp thuật toán bình phương tối thiểu từ dữ liệu thực tế.
  • Thiết kế giải thuật điều khiển lai tối ưu kết hợp tuyến tính hóa phản hồi riêng phần PFL cho quá trình Swing-up và LQR cho quá trình cân bằng với thời gian đáp ứng nhanh dưới 1.5 giây.
  • Hiện thực hóa thành công phần cứng hoàn chỉnh với vi xử lý DSP TMS320F28335 tốc độ 150 MHz, mạch cầu H công suất và 2 encoder đo vị trí góc chính xác cao.
  • Đánh giá toàn diện các hạn chế về phi tuyến cơ khí trên mô hình thực nghiệm và đề xuất định hướng tích hợp giải thuật mờ thích nghi trong giai đoạn 6 đến 12 tháng tiếp theo.

Các nhà nghiên cứu và kỹ sư quan tâm có thể khai thác trực tiếp mô hình toán học và mã nguồn nhúng của luận văn để phát triển các ứng dụng điều khiển robot công nghiệp tiên tiến.