tài liệu hướng dẫn thí nghiệm lý thuyết điều khiển tuyến tính ee3288 và cơ sở điều khiển tự động ee3289

Bạn đang xem bản rút gọn của tài liệu. Xem và tải ngay bản đầy đủ của tài liệu tại đây (4.35 MB, 29 trang )

Trang 1<div class="page_container" data-page="1">

TRƯỜNG ĐẠI HỌC BÁCH KHOA HÀ NỘI TRƯỜNG ĐIỆN – ĐIỆN TỬ

LÝ THUYẾT ĐIỀU KHI N TUY N TÍNH EE3288 ỂẾ–

</div>Trang 2<div class="page_container" data-page="2">

MỤC LỤC

GIỚI THI U Ệ ... 3

THÔNG TIN CHUNG V CÁC BÀI THÍ NGHI M Ề Ệ ... 4

BÀI 1. XÂY D NG HÀM TRUY N TỰ Ề ỐC ĐỘ CHO ĐỘNG CƠ ... 5

EE3288 LÝ THUYẾT ĐIỀU KHIỂN TUYẾN TÍNH ... 20

EE3289 CƠ SỞ ĐIỀU KHIỂN TỰ ĐỘNG ... 25

</div>Trang 3<div class="page_container" data-page="3">

GIỚI THIỆU

Tài liệu hướng dẫn thí nghi m này trình bày chi ti t các thi t bệ ế ế ị ph n c ng, ph n m m cầ ứ ầ ề ủa hệ thống điều khiển con lắc ngược của QUANSER QUBE-SERVO 2 dựa trên ph n mầ ềm MATLAB/SIMULINK và QUARC® được cài đặt trên máy tính. Các bài thí nghi m cung c p ệ ấcho sinh viên ki n th c và m t s kế ứ ộ ố ỹ năng về mô hình hóa đối tượng, nh n d ng và ki m ch ng ậ ạ ể ứmơ hình, thi t k bế ế ộ điều khi n, mô ph ng và tri n khai th c nghi m hể ỏ ể ự ệ ệ thống điều khi n thể ời gian th c s d ng các bự ử ụ ộ điều khi n PID và bể ộ điều khi n ph n h i tr ng thái. Bể ả ồ ạ ộ điều khi n ểnăng lượng cũng sẽ được giới thiệu như một phần mở rộng kiến thức đã được học trên lớp.

Sinh viên c n ầ chấp hành nghiêm túc các quy định v an toàn ề điện n, ội quy phịng thí nghiệm và hướng d n cẫ ủa cán b phộ ụ trách trong su t q trình làm thí nghi m t i phịng thí ố ệ ạnghi mệ . Sinh viên được yêu cầu đọc nội dung và tìm hiểu trước nội dung mỗi bài thí nghiệm trước khi n đế thực hiện thí nghiệm, th c hiện đầy đủự và tuân thủ các bước ti n hành thí nghiế ệm theo hướng d n, ghi lẫ ại đầy đủ các k t quế ả thực nghi m và tr l i các câu h i sau khi làm thệ ả ờ ỏ ực nghiệm. Cán bộ hướng d n s thông báo th i gian và n i dung báo cáo thí nghi m khi sinh viên ẫ ẽ ờ ộ ệhoàn thành 4 bài thí nghiệm.

</div>Trang 4<div class="page_container" data-page="4">

- Tên học phần: Lý thuyết điều khiển tuyến tính - Mã học phần: ET3288

- Nhận dạng tham số từ đáp ứng bước nhảy - Kiểm chứng lại mơ hình.

Bài 2 Điều khiển v trí dùng bị ộ điều khiển tỉ lệ (P) và tỉ lệ - vận tốc (PV):

- Thiết kế bộ điều khiển vị trí của động cơ

dùng bộ điều khiển tỉ lệ (P) và bộ điều khiển tỉ lệ - vận tốc (PV)

- Thực nghiệm hệ thống điều khiển vị trí

dùng bộ điều khiển P, PV

M1, M2, M3

A1 2 t tiế D8-905

Bài 3 Điều khiển hệ th ng con lắc ngược trên ố

không gian trạng thái :

- Mơ hình trạng thái tuyến tính của đối

tượng con lắc ngược. Kiểm tra tính điều khiển được

- Thiết kế bộ điều khiển phản hồi trạng thái

gán điểm cực

- Thực nghiệm hệ thống điều khiển với bộ

điều khiển gán điểm cực

M1, M2, M3

A1 2 tiết D8-905

Bài 4 Thiết kế bộ điều khiển PV và bộ điều khiển theo phương pháp năng lượng cho h con lệ ắc ngược:

- Thiết kế bộ điều khiển phản hồi trạng thái

dạng tỉ lệ - vận tốc (PV)

- Thiết kế bộ điều khiển năng lượng và bộ

điều khiển lai

- Thực nghiệm hệ thống điều khiển với bộ

điều khiển PV và bộ điều khiển lai

M1, M2, M3

A1 2 tiết D8-905

</div>Trang 5<div class="page_container" data-page="5">

BÀI 1 XÂY D NG HÀM TRUY. ỰỀN TỐC ĐỘ CHO ĐỘNG CƠ

𝜏𝑠+ 1

Hình 1.1 Tín hiệu vào ra trên đối tượng. Từ đồ thị trên Hình 1.1, ta xác định được:

𝐾 =∆𝑦∆𝑢Xác định đầu ra có giá tr𝑦 ị như sau từ đồ thị:

𝑦(𝑡1) = 0.632∆𝑦 + 𝑦0

Từ đó ta có giá trị 𝑡1 và h ng sằ ố thời gian tương ứng như sau:𝜏 = 𝑡1− 𝑡0

Câu h i ôn t p: ỏ ậ

- Tại sao ta l i có h sạ ệ ố 0.632 trong cơng th c tính ứ ở trên?

- Từ đâu ta có cơng thức tính 𝐾 như trên?

</div>Trang 6<div class="page_container" data-page="6">

THIẾT B C N THIỊ ẦẾT

Hình 1.2 Danh m c các thi t b bao gụ ế ị ồm: (1) động cơ QUBE Servo 2– tích h p module ợtruyền thơng QFLEX 2 USB, (2) Module đĩa tả ặi n ng, (3) Module con l c, (4) Cáp ắ USB 2.0 A/B, (5) Nguồn điệ 24V, 2.71A, (6) Dây cáp điện, (7) Hướng dẫn sử dụng. n

</div>Trang 7<div class="page_container" data-page="7">

TRÌNH T Ự TIẾN HÀNH THÍ NGHI M Ệ

Hình 1.3 Sơ đồ ệ thố h ng trong MATLAB/SIMULINK

1. Mở mơ hình SIMULINK đã có trong máy tính. Với khâu Step, chọn đặt điện áp 2V lên động cơ servo. Click đúp vào HIL Initialize block và chọn thiết bị đang được sử dụng.

2. Sau đó chọn nút Build Model ở thanh công c cụ ủa SIMULINK.

3. Khi mơ hình đã được dịch xong thành code nhúng, ch n nút ọ Connect to Target.

4. Cuối cùng, ch n nút ọ Run để bắt đầu ch y mơ hình v i thạ ớ ời gian thực. Khi mu n k t thúc ố ếmô hình, ch n nút ọ Stop trong SIMULINK.

</div>Trang 8<div class="page_container" data-page="8">

Hình 1.4 Sơ đồ ệ thố h ng ki m tra hàm truyể ền.

9. Chỉnh định các tham số mơ hình sao cho phù hợp và iải thích. g10. Dừng bộ điều khiển Quarc.

11. Ngắt nguồn cấp cho Qube–Servo 2.

</div>Trang 9<div class="page_container" data-page="9">

BÀI 2. ĐIỀU KHI N VỂỊ TRÍ ĐỘNG CƠ SỬ DỤNG Ộ ĐIỀU KHIỂN TỈ B

MỤC TIÊU

Khi hồn thành xong bài thí nghi m này, sinh viên sệ ẽ bi t cách thi t k bế ế ế ộ điều khi n t lể ỉ ệ và b ộđiều khiển t l kết hợp vận tốc (PV), tiến hành mô phỏng hệ thống điều khiển và th c nghiỉ ệ ự ệm kiểm ch ng chứ ất lượng c a hủ ệ thống

CƠ SỞ LÝ THUYẾT

Hàm truy n liên h giề ệ ữa điện áp vào và vị trí rotor được cho như sau:

𝑃(𝑠) = Θm( )𝑠𝑉m(𝑠)=

𝐾𝑠(𝜏𝑠 + 1)

trong đó, 𝐾 [rad/(V.s)], 𝜏 [s] xác định từ thực nghiệ , Θm m(𝑠) = ℒ[𝜃m(𝑡)] là vị trí của rotor, 𝑉m(𝑠) = ℒ[𝑣𝑚(𝑡)] là điện áp đặt lên động cơ với điều kiện đầu bằng 0.

• Hệ thống điều khiển sử dụng bộ điều khiển PID cho đối tượng có hàm truyền 𝑃(𝑠) có sơ đồkhối như Hình 2.1.

Hình 2.1 Sơ đồ khối hệ thống điều khiển sử dụng PID • Bộ điều khiển có dạng 𝑢(𝑡) = 𝑘𝑝𝑒(𝑡) + 𝑘𝐼∫ 𝑒(𝜏)𝑑𝜏𝑡𝑡 + 𝑘𝑑

𝑑𝑡 , 𝑘𝑝, 𝑘𝐼=1

𝑇𝐼, 𝑘𝑑 lần lượt là các h s t l tích phân, và vi phân c a bệ ố ỉ ệ, ủ ộ điều khi n. ể

Hệ thống điều khiển PV (tỉ l - v n tệ ậ ốc) có sơ đồ như Hình 2.2.

Hình 2.2 Sơ đồ hệ thống điều khi n v trí s d ng bể ị ử ụ ộ điều khi n ể PV.

</div>Trang 10<div class="page_container" data-page="10">

Bộ điều khi n có d ng sau: ể ạ 𝑢(𝑡)= 𝑘𝑝( 𝑟(𝑡) − 𝑦(𝑡)) − 𝑘𝑑

𝑑𝑡 , với 𝑘𝑝, 𝑘𝑑 ≥ 0 . V i b ớ ộđiều khiển này, h kín có dệ ạng khâu dao động bậc hai.

1. Xây d ng mơ hình lý thuy t hàm truy n hự ế ề ệ kín điều khi n vể ị vtrí ới bộ điều khiển P và bộ điều khiển PV.

2. Xây d ng mơ hình SIMULINK v i bự ớ ộ điều khi n ể P như Hình 2.3 và trả l i các câu h i sau: ờ ỏ

Hình 2.3. Mơ hình SIMULINK điều khi n vể ị trí QUBE-Servo 2 s d ng bử ụ ộ điều khi n t l . ể ỉ ệ• Điện áp đưa vào QUBE-Servo 2 được giới hạn bởi ±10 V. Xác định hệ số tỉ lệ 𝑘𝑝max

cho tín hiệu đặ ạng xung vng biên độ ±0.5 radt d sao cho không xu t hi n hiấ ệ ện tượng bão hịa?

• Đưa mơ hình hệ kín v d ng h b c hai: ề ạ ệ ậ 𝑌(𝑠)𝑅(𝑠)= 𝜔𝑛2

𝑠2+2𝜁𝜔 𝑠+𝜔𝑛 𝑛2 với 𝜔𝑛là tần số dao động tự nhiên và 𝜁 là ệ ố h s gi m t c. Có th gán c hai tham sả ố ể ả ố 𝜔𝑛 và b ng cách ch n tham s 𝜁 ằ ọ ố𝑘𝑝 hay khơng?

• Với khối Signal Generator, ch n tín hiọ ệu là d ng ạ square wave với biên độ 0.5 rad và t n sầ ố 0.4 Hz.

• Chạy mơ hình với 𝑘𝑝= 1 và 𝑘𝑝= 1.5. Vẽ đáp ứng vị trí và vận tốc của đối tượng. • Với 𝑘𝑝= 1.5, từ đồ thị đáp ứng bước nh y (tham khả ảo Hình 2.4), hãy tìm độ quá điều

chỉnh (𝑃𝑂 =100(𝑦𝑚𝑎𝑥−𝑅0)

𝑅0 ) và th i gian t o nh ờ ạ đỉ (𝑡𝑝= 𝑡𝑚𝑎𝑥− 𝑡0).

Hình 2.4. Đáp ứng bước nhảy của hệ dao động bậc hai

</div>Trang 11<div class="page_container" data-page="11">

3. Xây d ng mơ hình ự SIMULINK sử d ng b ụ ộ điều khiển t l - v n t c ỉ ệ ậ ố như trên Hình 2.5 và thực hiện thí nghi m theo trình tệ ự sau:

• Cài đặt bộ phát tín hi u (ệ Signal Generator) để ạo ra xung vng có biên độ là 0.5 trad và t n sầ ố 0.4 Hz. Chú ý r ng khâu ằ D trong trong mô hình được thay th b i khâu vi ế ởphân thực 𝐷(𝑠) = 𝜔𝑓𝑠

𝑠+𝜔𝑓 (khâu vi phân n i ti p v i bố ế ớ ộ l c thơng th p). ọ ấ• Đưa mơ hình hệ kín về dạng: 𝐺(𝑠) = 𝜔𝑛2

𝑠2+2𝜁𝜔 𝑠+𝜔𝑛 𝑛2. Từ đó tìm cơng thức liên hệ giữa hệ số tỉ lệ 𝑘𝑝 và vi phân theo t n s𝑘𝑑 ầ ố dao động t nhiên ự 𝜔𝑛 và hệ s suy giố ảm 𝜁 trong mơ hình.

Hình 2.5. Sơ đồ ệ thống điề h u khi n trong Simulink/Matlab ể

• Tìm các tham số 𝑘𝑝 và 𝑘𝑑 để thời gian đỉnh 0.15 giây và độ quá điều chỉnh là 2.5 % (khi đó ta có tương ứng 𝜔𝑛= 32.3 rad/s và 𝜁 = 0. ). 76

• Chạy hệ thống QUBE-Servo 2 v i bớ ộ điều khi n PV s d ng các tham s c a bể ử ụ ố ủ ộ điều khiển đã tìm được. Lưu đáp ứng vị trí và điện áp động cơ.

• Đo độ q điều chỉnh và thời gian đỉnh của đáp ứng hệ thống QUBE-Servo 2. Chúng có th a mãn thỏ ời gian đỉnh và độ quá điều chỉnh như yêu cầu mà khơng b bão hịa tín ịhiệu điều khiển (nằm ngoài ±10 V)? Tại sao đáp ứng c a hủ ệ thống QUBE-Servo 2 có sai lệch tĩnh, trong khi đó đáp ứng c a mơ hình thì l i khơng? ủ ạ

• Nếu đáp ứng thu được không đáp ứng được yêu cầu đặt ra, thử chỉnh các tham số điều khiển cho đến khi thỏa mãn. Lưu hình Matlab thu được, các tín hiệu đo được, và nhận xét về cách chỉnh định bộ điều khiển để thu được những kết quả đó.

6. Dừng bộ điều khi n ể QUARC®. 7. T t ngu n hắ ồ ệ thống QUBE-Servo 2.

</div>Trang 12<div class="page_container" data-page="12">

GIAN TRẠNG THÁI MỤC TIÊU

Sau khi hoàn thành xong bài thí nghiệm này, sinh viên s có th xây d ng mơ hình tr ng thái cho ẽ ể ự ạhệ thống, bi t thi t k bế ế ế ộ điều khi n phể ản hồi trạng thái cho hệ thống, tiến hành điều khi n thể ực và đánh giá chất lượng hệ thống điều khiển.

CƠ SỞ LÝ THUY T Ế

Xét mô hình con lắc cho như ở Hình 3.1 bao g m thanh quay n i tr c ti p vồ ố ự ế ới động cơ QUBEServo 2 (có thể điều khi n tr c tiể ự ếp được) ạ t i O và m t con l c n i vộ ắ ố ới đầu cu i c a thanh quay ố ủtại điểm A. Các tham số và kí hiệu của mơ hình đối tượng bao gồm:

-𝑟 Độ dài thanh quay

𝐽𝑟 Momen quán tính c a thanh quay (theo trủ ục 𝑧)

𝜃 Góc quay so v i trớ ục 𝑥0 (chiều dương là chiều ngược chiều kim đồng hồ). Động cơ quay theo chiều dương khi điện áp đặt 𝑣𝑚> 0.

𝐿𝑝 Chiều dài con lắc. B là tr ng tâm c a con lọ ủ ắc, nằm ở chính gi a con lữ ắc:𝑙 = 𝐿𝑝/2.

𝐽𝑝 Moment quán tính c a con l c v i kh i tâm ủ ắ ớ ố B𝛼 Góc quay c a con lủ ắc khi hướng xuống đất 𝑚 , 𝑚𝑟𝑝 Khối lượng tay quay và khối lượng con lắc

𝑏𝑟, 𝑏𝑝 Hệ s ma sát cố ủa trục động cơ và của trục con l c ắ

Hình 3.1 Mơ hình con l c ắ ngược

A B

+

</div>Trang 13<div class="page_container" data-page="13">

Mơ hình tốn đơn giản hóa c a h con lủ ệ ắc được cho b i hở ệ phương trình vi phân:

(𝐽𝑟+ 𝑚𝑝𝑟2+ 𝑚𝑝𝑙2sin2𝛼)𝜃 − 𝑚𝑝𝑙𝑟 cos 𝛼 𝛼 + 2𝑚𝑝𝑙2sin 𝛼 cos 𝛼 𝜃 𝛼 + 𝑚𝑝𝑙𝑟 sin 𝛼 𝛼 2= 𝜏 − 𝑏𝑟𝜃 (3.1) −𝑚𝑝𝑙𝑟 cos 𝛼 𝜃 + ( 𝐽𝑝+ 𝑚𝑝𝑙2)𝛼 − 𝑚𝑝𝑙2sin 𝛼 cos 𝛼 𝜃 2− 𝑚𝑝𝑔𝑙 sin 𝛼 = −𝑏𝑝𝛼 (3.2)

trong đó 𝐽𝑟=𝑚𝑟𝑟2

3 , 𝐽𝑝=𝑚𝑝𝐿𝑝212 =𝑚𝑝𝑙

3 . Momen l c tác dự ụng vào đế c a thanh t a sinh bủ ự ởi động cơ servo là 𝜏 =𝑘𝑚

𝑅𝑚(𝑣𝑚− 𝑘𝑚𝜃 ). T i mạ ột lân cận đủ nh c a ỏ ủ 𝜃 = 0, 𝛼 = 0, 𝜃 = 0, 𝛼 = 0, s d ng ử ụxấp xỉ sin 𝛼 ≈ 𝛼, cos 𝛼 = 1 − 2 (sin𝛼 2)2≈ 1, 𝛼2≈ 0, 𝜃 2≈ 0, 𝛼 2≈ 0, 𝜃 𝛼 ≈ 0, ta thu đượcphương trình vi phân tuyến tính mơ tả hệ:

(𝐽𝑟+ 𝑚𝑝𝑟2)𝜃 − 𝑚𝑝𝑙𝑟𝛼 = 𝜏 − 𝑏𝑟𝜃 (3.3) −𝑚𝑝𝑙𝑟𝜃 + ( 𝐽𝑝+ 𝑚𝑝𝑙2)𝛼 = 𝑚𝑝𝑔𝑙𝛼 − 𝑏𝑝𝛼 (3.4 )Viết l i hạ ệ dướ ại d ng mô hình trên khơng gian tr ng thái: ạ

𝑥 = 𝐴𝑥 + 𝐵𝑢 𝑦 = 𝐶𝑥 + 𝐷𝑢

trong đó các vector bi n tr ng ế ạ thái và vector biến đầu ra đượ định nghĩa lần lược t bởi 𝑥 =[𝑥1, 𝑥2, 𝑥 , 𝑥 ]34⊤= [𝜃(𝑡), 𝛼(𝑡), 𝜃 (𝑡), 𝛼 (𝑡)]⊤, 𝑦(𝑡) = [𝑥1, 𝑥 ]2⊤= [𝜃(𝑡), 𝛼( )]𝑡 ⊤. Tín hiệu điều khiển là điện áp đặt vào động cơ 𝑢 = 𝑉𝑚 được tìm t phương trình 𝜏 =ừ 𝑘𝑡(𝑢−𝑘𝑚𝜃 )

𝑅𝑚 . Bộ điều khi n ểphản hồi trạng thái có d ng ạ 𝑢 = −𝐾𝑥 + 𝑤, trong đó 𝐾 là ma trận có kích thước 4 × 1 và 𝑤 là tín hiệu đặt bên ngồi. Hệ kín v i bớ ộ điều khiển đã cho có phương trình:

𝑥 = 𝐴𝑥 − 𝐵𝐾𝑥 + 𝐵𝑤 = (𝐴 − 𝐵𝐾)𝑥 +𝐵𝑤 .

Để 𝑥 = 0 ổn định tiệm cận, 𝐾 cần được chọn sao cho mọi điểm c c của ma trự ận 𝐴 − 𝐵𝐾 đều nằm bên trái trục ảo. Vị trí các điểm cực s quyẽ ết định chất lượng điều khi n c a hể ủ ệ. N u h ế ệ điều khiển được hồn tồn, ta có thể gán tùy ý vị trí các điểm cực của 𝐴 − 𝐵𝐾.

Sơ đồ hệ thống điều khiển phản hồi trạng thái được cho như trong Hình 3.2

Hình 3.2 Sơ đồ hệ thống điều khiển phản hồi trạng thái.

</div>Trang 14<div class="page_container" data-page="14">

3. Thực hiện thiết kế bộ điều khiển gán điểm cực dựa trên các yêu cầu sau:

• Tìm các điểm cực của đối tượng. Nhận xét vị trí của các điểm cực này, các điểm cực này ảnh hưởng như thế nào đến hệ thống?

• Thiết kế bộ điều khiển gán điểm cực làm ổn định đối tượng.

• Cài đặt bộ phát tín hiệu có dạng xung vng, biên độ bằng và tần số là 1 0.125 Hz. Đặt khối khuếch đại kết nối với bộ phát tín hiệu bằng 0.

• Xây dựng và chạy bộ điều khiển QUARC@

• Đưa thanh lắc quanh vị trí cân bằng (sai lệch không quá 10𝑜) cho đến khi bộ điều khiển làm việc.

• Khi thanh lắc được giữ cân bằng, ưu đồ thị đáp ứng vị trí, góc nghiêng và điện áp.l• Chọn ma tr n ậ 𝐾 sao cho vị trí hai điểm cực trội 𝑝1, 𝑝2 được chọn ứng với tần số dao

động tự nhiên 𝜔𝑛= 4, hệ s suy giố ảm 𝜁 = 0.65, và hai điểm cực còn lại được gán tại 𝑝3= −30, 𝑝4= −45. Để ử ụ s d ng ma trận 𝐾 mới, vào mơ hình Simulink và chọn Edit|Update Diagram.

• Dưa vào tần số và hệ số suy giảm đã cho, tính thời gian đỉnh và độ q điều chỉnh.• Vẽ đồ thị vị trí và góc nghiêng và kiểm tra lại tính tốn.

4. Dừng bộ điều khi n ể QUARC@ và ng t ngu n hắ ồ ệ thống QUBE-Servo 2.

</div>Trang 15<div class="page_container" data-page="15">

BÀI 4. THIẾT KẾ BỘ ĐI U KHIỂỀN PV VÀ B ĐIỀU KHI N THEO ỘỂ

PHƯƠNG PHÁP NĂNG LƯỢNG CHO H CON LỆẮC NGƯỢC

MỤC TIÊU

Khi hoàn thành xong bài thí nghi m này, sinh viên bi t thi t k bệ ế ế ế ộ điều khi n t lể ỉ ệ - v n t c (PV) ậ ốvà bộ điều khi n swing-up cho hể ệ thống con lắc ngược, tiến hành điều khi n thể ực và đánh giá chất lượng hệ thống điều khiển.

CƠ SỞ LÝ THUY T Ế

• Bộ điều khiển tỉ lệ vận tốc- (PV)

Bộ điều khi n t l - v n t c cho hể ỉ ệ ậ ố ệ thống con lắc ngược có dạng như sau:𝑢 = 𝐾(𝑥𝑟𝑒𝑓− 𝑥) = 𝑘𝑝,𝜃(𝜃𝑟− 𝜃 − 𝑘) 𝑝,𝛼𝛼 − 𝑘𝑑,𝜃𝜃 − 𝑘𝑑,𝛼 𝛼 . trong đó 𝑥𝑟𝑒𝑓= [𝜃𝑟 0 0 0]⊤ và 𝐾 = [𝑘𝑝,𝜃 𝑘𝑑,𝛼 𝑘𝑑,𝜃 𝑘𝑑,𝛼].

Sơ đồ cấu trúc hệ thống điều khiển được cho như hình 4.1.

Hình 4.1 Sơ đồ hệ thống điều khiển PV Đặt 𝑒 = 𝜃 − 𝜃𝑟 thì 𝑒 = 𝜃 , = 𝜃 . Thay luật điều khi n ể 𝜏 =𝑘𝑡

𝑅𝑚(𝑉𝑚− 𝑘𝑚𝜃 ) = 𝜂(𝑉𝑚− 𝑘𝑚𝜃 ) trong đó 𝑉𝑚= 𝑢 = 𝜂−1𝑢1− 𝑘𝑝,𝜃𝑒 − 𝑘𝑝,𝛼𝛼 − 𝑘𝑑,𝜃𝑒 − 𝑘 𝛼 vào phương trình con lắc ngược 𝑑,𝛼

</div>Trang 16<div class="page_container" data-page="16">

( 𝐽𝑝+ 𝑚𝑝𝑙)𝑠 + 𝑏𝑝𝑠 − 𝑚𝑝𝑔𝑙

𝑃(𝑠) , 𝛼(𝑠)𝑈1(𝑠)=

𝑚𝑝𝑙𝑟𝑠𝑃(𝑠)trong đó:

𝑃(𝑠) = [(𝐽𝑟+ 𝑚𝑝𝑟2)𝑠2+ (𝜂(𝑘𝑑,𝜃+ 𝑘𝑚) + 𝑏𝑟)𝑠 + 𝑘𝑝,𝜃𝜂][( 𝐽𝑝+ 𝑚𝑝𝑙2)𝑠2+ 𝑏𝑝𝑠 − 𝑚𝑝𝑔𝑙]+ 𝑚𝑝𝑙𝑟𝑠2[−𝑚𝑝𝑙𝑟𝑠2+ 𝑘𝑑,𝛼𝜂𝑠 + 𝑘𝑝,𝛼𝜂]

•

Bộ điều khiển vịng ngồi theo phương pháp năng lượng

Các bộ điều khiển dựa trên mơ hình tuy n tính c a hế ủ ệ đượ ửc s dụng khi con lắc ở lân cận điểm cân b ng không ằ ổn định. Xét giản đồ lực của con lắc như ở Hình 4.2, trong đó góc 𝛼 ∈ (−𝜋, 𝜋)được tính t ừ điểm cân bằng ổn định tới vị trí con l c v i chiắ ớ ều dương ngược chiều kim đồng h . ồ

Hình 4.2. Giản đồ ự l c con lắc ngược

Để đưa con lắc vào vùng có thể s dụng các bộ ử điều khiển tuyến tính, ta có th tăng tốc độ quay ểcon lắc để tăng dần năng lượng c a con l c tủ ắ ừ trạng thái ngh (ỉ 𝛼 = 0, 𝛼 = 0). Năng lượng đưa thêm vào con l c c n lắ ầ ớn hơn năng lượng tiêu tán do ma sát trong quá trình con l c chuyắ ển động. Phương trình động l c h c c a con l c v i tín hi u u vào ự ọ ủ ắ ớ ệ đầ 𝑢 = 𝛼 là gia t c dài c a thanh ngang ố ủđược cho bởi:

B 𝑙

𝑢 = 𝛼> 0𝑧

𝑚

𝑝

𝑔A

𝐽

𝑝

𝛼

</div>Trang 17<div class="page_container" data-page="17">

𝑢energy= (𝐸𝑟− 𝐸 cos 𝛼,)hoặc điều khi n ể swing-up:

𝑢energy= sat𝑢max(𝜇 𝐸( 𝑟− 𝐸 sign cos 𝛼) ( ))

với 𝐸𝑟được chọn có giá tr lớn hơn thế năng tối thiểu của con lắc ở miền |𝛼| − 𝜋 ≤ 𝛼ị max, sat𝑢max(𝑥) là hàm bão hòa, nh n giá tr ậ ị 𝑢max khi |𝑥| > 𝑢max, và sign(⋅) là hàm d u. ấ

Bộ điều khi n ể lai thu được bằng cách ghép b ộ điều khiển năng lượng và b ộ điều khi n tuy n tínhể ế , mơ t bả ởi phương trình:

𝑢 = {𝑢linear= −𝐾𝑥, nếu |𝛼| − 𝜋 <200,𝑢energy, trường hợp khác.

Hình 4.3 Sơ đồ SIMULINK hệ thống điều khi n t l - v n t c ể ỉ ệ ậ ố

Bộ điều khi n tể ỉ l - vệ ận t c ố (PV):

1. Mở mô hình Simulink q_qube2_balance như trong Hình 4.3.

2. Cài đặt các hệ số của bộ điều khiển như sau: 𝑘𝑝,𝜃= −2, 𝑘𝑝,𝛼= 30, 𝑘𝑑,𝜃= −2, và 𝑘𝑑,𝛼=2.5. Chạy bộ điều khiển QUARC@.

3. Đưa thanh lắc đến vị trí cân bằng ph trên cho đến khi bộ điều khiển làm việc. Lưu lại ía đáp ứng vị trí, góc nghiêng và điện áp điều khiển.

4. Khi thanh lắc được giữ thăng bằng, mô tả các đáp ứng về vị trí và góc nghiêng

</div>Trang 18<div class="page_container" data-page="18">

5. Thay đổi khối hằng số (được nối với đầu vào dương của bộ tổng của bộ điều khiển). Quan sát đáp ứng vị trí. Khơng đặt giá trị quá lớn, giữ vị trí trong khoảng ±45oso với vị trí lúc đầu.

6. Dừng bộ điều khiển QUARC@.

Bộ điều khiển lai swing-up và ph n h i tr ng thái: ả ồ ạ

Hình 4.4: Mơ hình SIMULINK ử ụ s d ng bộ điều khi n lai (swing-up và ph n h i tr ng thái) ể ả ồ ạ1. Mở mơ hình q_qube_swingup.mdl như ở Hình 4.4.

2. Chạy script setup_qube_rotpen.m để t i các tham s sả ố ử d ng trong mô ph ng. ụ ỏ3. Để dừng bộ điều khi n swing-up, ch n hể ọ ệ số mu trong khối Slider Gain ằ b ng 0. 4. Chạy mơ hình SIMULINK.

5. Quay con l c b ng tay t i các vắ ằ ạ ị trí khác nhau và theo dõi đồ thị năng lượng (mJ ại các ) tgóc l ch khác nhau ( ), ghi l giá trệ 𝛼 ại ị năng lượng khi con lắc ở ị v trí th ng góc ẳ 𝛼 = 𝜋. 6. Nhấn Stop để dừng hệ con lắc. Sau đó thay đổi các tham s bố ộ điều khi n c a Swing-Up ể ủ

Control như sau: mu=50m/s/J, Er=10.0 mJ, u_max=6m/s2.

7. Thay đổi giá trị đặt năng lượng từ 10.0 mJ tới 30 mJ. Quan sát và ghi lại đồ thị góc quay (Pendulum), đồ thị năng lượng (Pendulum Energy), và đồ thị giá trị điện áp motor Motor Voltage (V) tương ứng v i m i giá trớ ỗ ị năng lượng đặt.

8. C ố định Er = 20 mJ và thay đổ ệ số mu trong kho ng ti h ả 20 ới 60 m/s/J. Mô t s ả ựthay đổi tương ứng của luật điều khiển.

9. Chọn giá trị Er sao cho con l c có thắ ể đạ ớt t i mi n ề |𝛼| − 𝜋 < 200, u_max=6 m/s2 dựa trên các quan sát trước. Ghi đáp ứng của đối tượng với bộ điều khiển lai (các đồ thị trong Scope).

10. Dừng bộ điều khi n. ể

11. Tắt nguồn hệ thống QUBE-Servo 2.

12. (Khơng b t bu c) ắ ộ Giải thích (toán h c) lý do các luọ ật điều khiển năng lượng có thể đưa giá tr t i mi n ị 𝛼 ớ ề |𝛼| − 𝜋 < 200 sau th i gian h u h n. ờ ữ ạ

</div>