Thiết kế bộ điều khiển bám quỹ đạo cho hệ thống Twin Rotor MIMO - Đàm Bảo Lộc

BỘ GIÁO DỤC VÀ ĐÀO TẠO ĐẠI HỌC THÁI NGUYÊN ĐÀM BẢO LỘC NGHIÊN CỨU THIẾT KẾ BỘ ĐIỀU KHIỂN BÁM QUỸ ĐẠO CHO HỆ THỐNG TWIN ROTOR MIMO LUẬN ÁN TIẾN SĨ KỸ THUẬT THÁI NGUYÊN – 2020 luan an BỘ GIÁO DỤC VÀ ĐÀO TẠO ĐẠI HỌC THÁI NGUYÊN ĐÀM BẢO LỘC NGHIÊN CỨU THIẾT KẾ BỘ ĐIỀU KHIỂN BÁM QUỸ ĐẠO CHO HỆ THỐNG TWIN ROTOR MIMO CHUYÊN NGÀNH: KỸ THUẬT ĐIỀU KHIỂN VÀ TỰ ĐỘNG HÓA MÃ SỐ: 9.16 LUẬN ÁN TIẾN SĨ KỸ THUẬT NGƯỜI HƯỚNG DẪN KHOA HỌC: 1. NGUYỄN DUY CƯƠNG 2. HORST PUTA THÁI NGUYÊN – 2020 luan an i LỜI CAM ĐOAN Tôi xin cam đoan đây là công trình nghiên cứu của cá nhân tôi dưới sự hướng dẫn của tập thể giáo viên hướng dẫn và các nhà khoa học. Các tài liệu tham khảo đã được trích dẫn đầy đủ.

Kết quả nghiên cứu là trung thực và chưa từng được ai công bố trên bất cứ một công trình nào khác. Thái Nguyên, ngày 6 tháng 9 năm 2020 Tác giả Đàm Bảo Lộc luan an ii LỜI CẢM ƠN Trong quá trình làm luận án với đề tài "Nghiên cứu thiết kế bộ điều khiển bám quỹ đạo cho hệ thống Twin Rotor MIMO", tôi đã nhận được rất nhiều sự ủng hộ về công tác tổ chức và chuyên môn của Bộ môn Tự động hóa, Trường Đại học Kỹ Thuật Công Nghiệp Thái Nguyên, của Bộ môn Điều khiển tự động, Viện Điện, Đại học Bách khoa Hà nội. Tôi xin trân trọng gửi lời cảm ơn tới hai cơ sở đào tạo này, đã luôn tạo điều kiện giúp đỡ tôi trong suốt quá trình học tập, nghiên cứu và hoàn thành luận án. Với lòng kính trọng và biết ơn sâu sắc, tôi cũng xin chân thành cảm ơn tập thể hướng dẫn là PGS.

Nguyễn Duy Cương, GS. Horst Puta, những người Thầy đã dành nhiều thời gian hướng dẫn, tận tình chỉ bảo và định hướng chuyên môn cho tôi trong suốt quá trình nghiên cứu để hoàn thành luận án. Tôi xin chân thành cảm ơn Ban lãnh đạo Trường Cao đẳng Công Nghiệp Thái Nguyên nơi tôi công tác đã tạo điều kiện thuận lợi giúp đỡ tôi trong quá trình thực hiện nghiên cứu. Cuối cùng, tôi xin chân thành cảm ơn gia đình, đồng nghiệp, những người bạn thân thiết đã luôn giúp đỡ, động viên, khích lệ, chia sẻ khó khăn trong thời gian tôi học tập để hoàn thành khóa học.

Thái Nguyên, ngày 6 tháng 9 năm 2020 Tác giả luận án Đàm Bảo Lộc luan an iii MỤC LỤC LỜI CAM ĐOAN. ii MỤC LỤC. iii BẢNG CÁC KÝ HIỆU VIẾT TẮT. xi DANH MỤC CÁC BẢNG.

xii DANH MỤC HÌNH VẼ. xiii MỞ ĐẦU. Tính cấp thiết của đề tài. Mục đích và nhiệm vụ của đề tài.

Đối tượng và phạm vi nghiên cứu của luận án. Phương pháp nghiên cứu. Những đóng góp mới, ý nghĩa khoa học và thực tiễn của luận án. Bố cục của luận án .3 CHƯƠNG 1: TỔNG QUAN VỀ TRMS - MÔ HÌNH HÓA VÀ CÁC PHƯƠNG PHÁP ĐIỀU KHIỂN.1 Mô hình hóa TRMS.1 Cấu trúc vật lý TRMS .2 Mô hình hóa bằng phương pháp lý thuyết.2 Các phương pháp điều khiển hiện có cho TRMS .1 Điều khiển tuyến tính .2 Điều khiển phi tuyến.

35 CHƯƠNG 2: ĐIỀU KHIỂN TUYẾN TÍNH HÓA CHÍNH XÁC TRMS KHI CÓ MÔ HÌNH CHÍNH XÁC .1 Phương pháp cơ sở: Điều khiển bù trọng trường.1 Tuyến tính hóa chính xác bằng phản hồi .2 Điều khiển vòng ngoài để bám quỹ đạo mẫu .3 Bộ điều khiển chung .2 Phương pháp đề xuất cho hệ Euler-Lagrange song tuyến khi có mô hình chính xác. 40 luan an iv 2.1 Bộ điều khiển bám quỹ đạo mẫu .2 Đánh giá chất lượng bền vững của bộ điều khiển đề xuất cho hệ Euler- Lagrange song tuyến bất định .3 Áp dụng cho TRMS và kiểm chứng chất lượng bộ điều khiển bằng mô phỏng trên MatLab. 51 CHƯƠNG 3: ĐIỀU KHIỂN BÙ BẤT ĐỊNH HÀM THEO NGUYÊN LÝ TỐI ƯU HÓA TỪNG ĐOẠN SAI LỆCH MÔ HÌNH TRÊN TRỤC THỜI GIAN .1 Thuật toán nhận dạng thành phần bất định hàm .1 Lớp hệ bất định có mô hình trạng thái song tuyến .2 Nhận dạng nhiễu theo nguyên tắc cực tiểu hóa từng đoạn bình phương sai lệch mô hình .2 Xây dựng bộ điều khiển thích nghi bám quỹ đạo mẫu cho hệ Euler-Lagrange song tuyến bất định .1 Bộ điều khiển kết hợp điều khiển bám và bù bất định .2 Kiểm chứng chất lượng bằng mô phỏng trên MatLab với TRMS. 67 CHƯƠNG 4: KIỂM CHỨNG CHẤT LƯỢNG BẰNG THỰC NGHIỆM.1 Mô tả bàn thí nghiệm .1 Các thiết bị trên bàn thí nghiệm…………………………………………….2 Cấu trúc tổng thể bàn thí nghiệm TRMS của ĐHKTCN Thái Nguyên .2 Cài đặt bộ điều khiển cho bàn thí nghiệm TRMS .3 Kết quả thí nghiệm và đánh giá .1 Tiến hành thí nghiệm .2 Kết quả và đánh giá chất lượng.

86 KẾT LUẬN VÀ KIẾN NGHỊ .87 CÁC CÔNG TRÌNH ĐÃ CÔNG BỐ .88 TÀI LIỆU THAM KHẢO .90 PHỤ LỤC luan an v CÁC KÝ HIỆU ĐƯỢC SỬ DỤNG Ký hiệu Ý nghĩa toán học/vật lý h Góc đảo lái trong mặt ngang của TRMS (Yaw angle) v Góc chao dọc trong mặt đứng của TRMS (Pitch angle)  hR Góc đảo lái mẫu trong mặt ngang của TRMS vR Góc chao dọc trong mặt đứng của TRMS h Vận tốc góc của cánh tay đòn tự do trong mặt ngang v Vận tốc góc của cánh tay đòn tự do trong mặt đứng k Sai lệch nhận dạng giữa trạng thái x k  x (tk ) đo được từ mô hình hệ thống và trạng thái mẫu z k  z (tk ) của hệ đó khi không có thành phần bất định max Lượng quá điều chỉnh   1, 2 , , m  T Vector của m biến điều khiển  Ma trận Hurwitz h Từ thông của động cơ đuôi m Từ thông của động cơ chính  Một chỉ số đánh giá sai lệch bám cho trước Lân cận gốc v Vận tốc góc của cánh quạt chính h Vận tốc góc của cánh quạt đuôi Mih Tổng hợp mô men trong mặt phẳng ngang i Miv Tổng hợp mô men trong mặt phẳng đứng i A(x ) Ma trận hệ thống phụ thuộc trạng thái luan an vi B (x ) Ma trận điều khiển phụ thuộc trạng thái Bh Hệ số ma sát nhớt của khớp quay trong mặt ngang Ma trận hàm, phụ thuộc q cùng đạo hàm q của nó, có tên gọi C (q ,q ) là ma trận lực hướng tâm (centripetal and coriolis forces) d (q ,t ) Thành phần bất định theo biến khớp d (x , t ) Bất định hàm theo biến trạng thái d k  d (tk ) Nhiễu ước lượng lượng tử hóa d (x , t ) Nhiễu ước lượng Eah Sức phản điện động phần ứng của động cơ đuôi Eav Sức phản điện động phần ứng của động cơ chính F Ma trận điều khiển trong phương trình Euler-Lagrange Fv v  Lực đẩy do cánh quạt chính tạo ra Fh h  Lực đẩy do cánh quạt đuôi tạo ra g Gia tốc trọng trường Vector hàm, phụ thuộc biến khớp q , có tên gọi là vector lực g (q ) ma sát và gia tốc trọng trường h Chiều dài của khớp quay iah Dòng điện phần ứng của động cơ đuôi iav Dòng điện phần ứng của động cơ chính I Ma trận đơn vị J1 Mô men quán tính của cánh tay đòn tự do J2 Mô men quán tính của thanh đối trọng J3 Mô men quán tính của khớp xoay J mm Mô men quán tính của rotor động cơ một chiều luan an vii J m ,prop Mô men quán tính của cánh quạt chính J t ,prop Mô men quán tính của cánh quạt đuôi J mr Mô men quán tính của động cơ chính Jtr Mô men quán tính của động cơ đuôi Jv Tổng mô men quán tính trong mặt đứng Jh Tổng mô men quán tính trong mặt ngang kchn Hằng số mô men cáp dẹt theo chiều âm góc đảo lái k fhp Hằng số lực đẩy cánh quạt động cơ đuôi quay theo chiều dương k fhn Hằng số lực đẩy cánh quạt động cơ đuôi quay theo chiều âm k fvp Hằng số lực đẩy cánh quạt động cơ chính quay theo chiều dương k fvn Hằng số lực đẩy cánh quạt động cơ chính quay theo chiều âm km Hằng số của mô men xen kênh do ảnh hưởng của tốc độ lực đẩy cánh quạt chính lên chuyển động của cánh tay đòn tự do trong mặt ngang ksfh Hằng số mô men ma sát tĩnh trong mặt ngang ksfv Hằng số mô men ma sát tĩnh trong mặt đứng kthp Hệ số phụ thuộc vào chiều vận tốc góc cách quạt đuôi khi quay theo chiều dương kthn Hệ số phụ thuộc vào chiều vận tốc góc cách quạt đuôi khi quay theo chiều âm ktvp Hệ số phụ thuộc vào chiều vận tốc góc cách quạt chính khi quay theo chiều dương ktvn Hệ số phụ thuộc vào chiều vận tốc góc cách quạt chính khi quay theo chiều âm luan an viii kt Hằng số của mô men xen kênh do ảnh hưởng của tốc độ lực đẩy cánh quạt đuôi lên chuyển động của cánh tay đòn tự do trong mặt đứng. kvfh Hệ số mô men ma sát Viscous trong mặt ngang kvfv Hệ số mô men ma sát Viscous trong mặt đứng kg Hệ số hiệu ứng con quay hồi chuyển L Hàm Largrange lT 2 Khoảng cách từ trọng tâm của thanh đối trọng đến khớp xoay lb Chiều dài của thanh đối trọng lcb Khoảng cách từ đối trọng đến khớp xoay lm Chiều dài phần chính của cánh tay đòn tự do lt Chiều dài phần đuôi của cánh tay đòn tự do Lm Điện cảm phần ứng của động cơ chính Lt Điện cảm phần ứng của động cơ đuôi m Khối lượng mT 1 Tổng khối lượng của cánh tay đòn tự do lT 1 Trọng tâm của cánh tay đòn tự do mt Khối lượng phần phía bên cánh quạt đuôi của thanh ngang mtr Khối lượng động cơ đuôi mts Khối lượng vành bảo vệ cánh quạt đuôi mm Khối lượng phần phía bên cánh quạt chính của thanh ngang mmr Khối lượng động cơ chính mms Khối lượng vành bảo vệ cánh quạt chính mb Khối lượng của thanh đối trọng luan an ix mT 2 Tổng khối lượng của thanh đối trọng mcb Khối lượng của đối trọng mh Khối lượng của khớp xoay M fric .h Mô men ma sát của chuyển động cánh tay đòn tự do trong mặt ngang M fric .