5.1. Phương pháp điều khiển trượt: (Sliding Mode Control SMC)
5.1.3. Kết quả mô phỏng
❖ Thông số mong muốn trường hợp tổng quát
Thông số Mô tả Giá trị
phi_d Góc Roll mong muốn Quadrotor đạt được 50
theta_d Góc Pitch mong muốn Quadrotor đạt được 80
psi_d Góc Yaw mong muốn Quadrotor đạt được 100
z_d Độ cao mong muốn Quadrotor đạt được 10m
Bảng 5.1. Thơng số mong muốn của mơ hình trường hợp tổng quát
❖ Góc nghiêng Roll:
Hình 5.5 . Góc nghiêng Roll
Đồ thị hình 5.5 biểu diễn góc Roll trong luật điều khiển U2 (Luật điều khiển góc nghiêng Roll). Trong thời gian đầu tín hiệu có dao động nhưng sau khoảng 5s tín hiệu đã hồn tồn ổn định.
Trang 69 ❖ Đáp ứng góc nghiêng Roll (50)
Hình 5.6. Đáp ứng góc nghiêng Roll
Đồ thị hình 5.6 biểu diễn đáp ứng góc nghiêng Roll của Quadrotor trong không gian. Trong thời gian đầu tín hiệu điều khiển có dao động nhưng sau khoảng 5s tín hiệu điều khiển bám theo tín hiệu đặt và ổn định.
❖ Góc lật Pitch
Hình 5.7. Góc Pitch
Đồ thị hình 5.7 biểu diễn góc Pitch trong luật điều khiển U3 (Luật điều khiển góc lật Pitch). Trong thời gian đầu tín hiệu có dao động nhưng sau khoảng 5s tín hiệu đã hoàn toàn ổn định
Trang 70 ❖ Đáp ứng góc lật Pitch (80)
Hình 5.8. Đáp ứng góc lật Pitch
Đồ thị hình 5.8 biểu diễn đáp ứng góc lật Pitch của Quadrotor trong khơng gian. Trong thời gian đầu tín hiệu điều khiển có dao động nhưng sau khoảng 5s tín hiệu điều khiển bám theo tín hiệu đặt và ổn định
❖ Góc xoay Yaw
Hình 5.9. Góc Yaw
Đồ thị hình 5.9 biểu diễn góc Yaw trong luật điều khiển U4 (Luật điều khiển góc lật Yaw). Trong thời gian đầu tín hiệu có dao động nhưng sau khoảng 5s tín hiệu đã hoàn toàn ổn định.
Trang 71 ❖ Đáp ứng góc xoay Yaw (100)
Hình 5.10. Đáp ứng góc xoay Yaw
Đồ thị hình 5.10 biểu diễn đáp ứng góc xoay Yaw của Quadrotor trong khơng gian. Trong thời gian đầu tín hiệu điều khiển có dao động nhưng sau khoảng 5s tín hiệu điều khiển bám theo tín hiệu đặt và ổn định
❖ Độ cao z
Hình 5.11. Độ cao z
Đồ thị hình 5.11 biểu diễn độ cao z trong luật điều khiển U1 (Luật điều khiển độ cao z). Trong thời gian đầu tín hiệu có dao động nhưng sau khoảng 5s tín hiệu đã hoàn toàn ổn định.
Trang 72 ❖ Đáp ứng độ cao z (10m)
Hình 5.12. Đáp ứng độ cao z
Đồ thị hình 5.12 biểu diễn đáp ứng độ cao z của Quadrotor trong không gian. Trong thời gian đầu tín hiệu điều khiển có dao động nhưng sau khoảng 3s tín hiệu điều khiển bám theo tín hiệu đặt và ổn định
❖ Tọa độ Quadrotor trong khơng gian
Hình 5.13. Tọa độ Quadrotor trong khơng gian
Đồ thị hình 5.13 biểu diễn đáp ứng tọa độ của Quadrotor trong không gian. Khi đạt độ cao 10m và giá trị đặt các góc Roll, Pitch, Yaw thì Quadrotor đã hồn tồn ổn định trong khơng gian.
Trang 73 ❖ Tốc độ 4 động cơ của Quadrotor
Hình 5.14. Tốc độ đáp ứng của 4 động cơ Quadrotor
Đồ thị hình 5.14 mô tả tốc độ 4 động cơ của Quadrotor nhằm đáp ứng các
thông số mong muốn như bảng 5.1. Trong khoảng thời gian quá độ thì Quadrotor có tốc độ khơng ổn định nhằm nâng Quadrotor lên đồng thời tạo góc cho phù hợp với thơng số đặt. Khi Quadrotor lên đến trạng thái z = 10m, thì Quadrotor ổn định tốc độ riêng của từng động cơ (tốc độ mỗi động cơ khác nhau nhằm đáp ứng góc Roll, Pitch, Yaw), đồng thời tổng lực nâng của 4 động cơ gây nên bằng với trọng lực P của Quadrotor. Lúc này, Quadrotor nằm ở 1 độ cao cố định, nhưng thân Quadrotor sẽ trượt theo phương Ox và Oy do phụ thuộc vào các góc Roll, Pitch, Yaw.
❖ Đáp ứng Quadrotor theo phương Ox: Đồ thị hình 5.15 biểu diễn đáp ứng của
Quadrotor theo phương Ox trong không gian.
Trang 74
Quadrotor sẽ di chuyển theo phương Ox phụ thuộc vào giá trị đặt các góc Roll, Pitch, Yaw
❖ Đáp ứng Quadrotor theo phương Oy: Đồ thị hình 5.16 biểu diễn đáp ứng của
Quadrotor theo phương Oy trong khơng gian.
Hình 5.16. Đáp ứng theo phương Oy của Quadrotor.
Quadrotor sẽ di chuyển theo phương Oy phụ thuộc vào giá trị đặt các góc Roll, Pitch, Yaw
5.1.4. Nhận xét kết quả mô phỏng
Dựa vào đồ thị đáp ứng các ngõ ra của Quadrotor, chúng ta thấy kết quả mô phỏng luật điều khiển SMC cũng khá tốt. Tín hiệu ngõ ra nhanh chóng tiến về giá trị đặt và ổn định. Trong khoảng thời gian 0 – 5s thì có hiện tượng dao động ở các ngõ ra, nhưng sau thời gian 5s thì hệ thống đã hồn tồn ổn định. Tuy nhiên độ vọt lố của hệ thống điều khiển khá cao do lựa chọn các hằng số (c_z, c_phi, c_theta, c_psi) của bộ điều khiển chưa thật tối ưu. Các trường hợp mô phỏng đều cho đồ thị
đúng như mong muốn tín hiệu ngõ ra nhanh chóng đạt đến giá trị đặt.