zunia.vn

Tuyển sinh 2024 dành cho Gen-Z

zunia.vn

» Kỹ Thuật - Công Nghệ

» Cơ khí - Chế tạo máy

Mô phỏng thuật toán ổn định cân bằng ở chế độ bay treo cho máy bay hexacopter khi hỏng 1 động cơ

Chia sẻ: Bobietbay | Ngày: | Loại File: PDF | Số trang:7

Báo xấu

27
lượt xem 1
download

Download Vui lòng tải xuống để xem tài liệu đầy đủ

Bài báo này mô tả quá trình xây dựng và triển khai thuật toán ổn định cân bằng cho chế độ bay treo của một nguyên mẫu máy bay hexacopter trong mô phỏng. Các đặc tính động lực học của một nguyên mẫu máy bay và động cơ của nó được xác định.

Chủ đề:

Bình luận(0) Đăng nhập để gửi bình luận!

Lưu

Nội dung Text: Mô phỏng thuật toán ổn định cân bằng ở chế độ bay treo cho máy bay hexacopter khi hỏng 1 động cơ

HỘI NGHỊ KH&CN CƠ KHÍ - ĐỘNG LỰC 2021 MÔ PHỎNG THUẬT TOÁN ỔN ĐỊNH CÂN BẰNG Ở CHẾ ĐỘ BAY TREO CHO MÁY BAY HEXACOPTER KHI HỎNG 1 ĐỘNG CƠ SIMULATION OF A STABILIZING ALGORITHM FOR HEXACOPTER IN HOVER FLIGHT MODE WITH ONE ROTOR FAILURE NGUYỄN XUÂN DŨNG, VÕ TRUNG KIÊN, HÀ MẠNH TUẤN* Bộ môn Kỹ thuật Hàng không và Vũ trụ, Viện Cơ khí động lực, Trường Đại học Bách khoa Hà Nội *Email liên hệ: tuan.hamanh@hust.edu.vn 1. Mở đầu Tóm tắt Máy bay cánh quạt (multirotor) ngày càng trở nên Bài báo này mô tả quá trình xây dựng và triển khai phổ biến trong nhiều ứng dụng. Điều này kéo theo nhu thuật toán ổn định cân bằng cho chế độ bay treo cầu giải quyết các vấn đề kĩ thuật khi vận hành máy của một nguyên mẫu máy bay hexacopter trong bay multirotor. Một trong những vấn đề khi vận hành mô phỏng. Các đặc tính động lực học của một máy bay multirotor là sự cố hỏng động cơ. nguyên mẫu máy bay và động cơ của nó được xác Đã có các nghiên cứu nhằm xử lý sự cố này tương định. Các mô hình được xây dựng và hiệu chỉnh ứng các mức độ hỏng khác nhau của động cơ. Phương với các tham số dựa trên các đặc tính động lực pháp xử lý sự cố 1 động cơ hoạt động kém hiệu quả học của nguyên mẫu máy bay. Trạng thái của mô trên máy bay 4 cánh quạt (quadcopter) đã được nghiên hình máy bay sau đó được mô tả bởi các phương cứu trong [1]. So với máy bay quadcopter, máy bay 6 trình động học và động lực học. Điều kiện hỏng 1 cánh quạt (hexacopter) có khả năng hoạt động ổn định động cơ khi đang hoạt động trong chế độ bay treo hơn trong các điều kiện nhiễu động hay động cơ dừng được mô phỏng trong SIMULINK. Thuật toán ổn hoạt động hoàn toàn. Phương pháp phân bố lực nâng định cân bằng cho chế độ bay treo trong điều kiện trên mỗi động cơ cho máy bay hexacopter đã được hỏng 1 động cơ được xây dựng và hoàn thiện dựa nghiên cứu một cách tổng quát trong [2, 3]. trên các kết quả mô phỏng. Kết quả chất lượng ổn Phương pháp xử lý sự cố 1 động cơ dừng hoạt định của máy bay sau đó được đánh giá. động hoàn toàn trên máy bay hexacopter cũng đã được Từ khóa: Mất động cơ, thuật toán ổn định cân Guang-Xun Du và các cộng sự đưa ra và kiểm nghiệm bằng, hexacopter, UAV. bằng kết quả mô phỏng và thực nghiệm [4]. Tuy nhiên, Abstract mô phỏng trong [4] được dựa trên mô hình đơn giản hóa. Trong [5], Napolitano đã trình bày các phân tích This paper presents the development and động lực học toàn diện và đưa ra 1 mô hình động lực simulation of a hover flight stabilization học tổng quát và tương đối chính xác của máy bay. algorithm for a hexacopter prototype. The motor Mục tiêu của bài báo này là xây dựng bộ điều khiển dynamics characteristics of a hexacopter xử lý sự cố 1 động cơ dừng hoạt động hoàn toàn trên prototype are specified. The specified parameters máy bay hexacopter dựa trên phương pháp trong [4], of the motor characteristics are then used to và kiểm nghiệm kết quả bằng mô phỏng với mô hình validate with the hexacopter model. The dựa trên lý thuyết trong [5]. hexacopter model’s states in flight are derived Trong bài báo này, mô hình động lực học của 1 from the governing kinematics and dynamics loại máy bay hexacopter và bộ điều khiển xử lý sự cố equations. The single-engine failure condition is được xây dựng. Các thông số của mô hình được lấy simulated in SIMULINK software. The hover theo một nguyên mẫu máy bay hexacopter. Điều kiện flight stabilization algorithm is built and adjusted 1 động cơ dừng hoạt động hoàn toàn khi đang trong based on the responses of the simulated model to chế độ bay treo được mô phỏng trong SIMULINK. variations of the algorithms. The simulation Hiệu quả của bộ điều khiển được kiểm nghiệm bằng results are then validated. kết quả mô phỏng. Trong phạm vi bài báo này, vấn đề phát hiện sự cố không được xét đến, các biến trạng Keywords: Engine failure, stabilization algorithm, hexacopter, UAV. thái được trình bày được coi là hoàn toàn quan sát được. SỐ ĐẶC BIỆT (10-2021) 393
HỘI NGHỊ KH&CN CƠ KHÍ - ĐỘNG LỰC 2021 Hình 1. Sơ đồ động học của máy bay hexacopter được khảo sát 2. Mô hình động lực học của máy bay Hệ phương trình động học hexacopter 1 0 −sinΘ Φ̇ 2.1. Các phương trình động học, động lực học = 0 cosΦ Θ. Φ . Θ̇ (3) Loại máy bay hexacopter được khảo sát trong bài 0 −sinΦ Θ. Φ Ψ̇ báo này là loại hexacopter có cấu hình cánh quạt Hệ phương trình quỹ đạo bay: RLRLRL, trong đó R là viết tắt cho cánh quạt thuận, ̇ L là viết tắt cho cánh quạt nghịch. Khảo sát trên máy ̇ = . (4) bay hexacopter với cấu hình cánh quạt khác có thể ̇ được thực hiện một cách tương tự bằng các phương Ψ. cΘ − Ψ. Φ + Ψ. Θ. Φ Ψ. Φ + Ψ. Θ. Φ pháp nêu trong bài báo này. Τ= Ψ. Θ Ψ. Φ + Ψ. Θ. Φ − Φ. Ψ + Ψ. Θ. Φ − Θ Θ. Φ Θ. Φ Các thông số động học, động lực học của máy bay Trong đó: trong hệ quy chiếu gắn với thân máy bay và hệ m là khối lượng của máy bay hexacopter; quy chiếu gắn với mặt đất được khảo sát như trong Hình 1. g là gia tốc trọng trường; Trạng thái của máy bay được xác định thông qua các cΦ = cos(Φ) , cΘ = cos(Θ) , cΨ = cos(Ψ) ; phương trình động học, động lực học [5, 6, 7] như sau: sΦ = sin(Φ) , sΘ = sin(Θ) , sΨ = sin(Ψ) ; Hệ phương trình bảo toàn động lượng: (U, V, W), (P, Q, R) lần lượt là các vận tốc dọc trục ̇+ − = + và vận tốc góc quanh các trục của hệ tọa độ ; ̇+ − = + (1) ( , , ), ( , , ) là các lực dọc trục và momen lực quanh các trục của hệ tọa độ ; ̇ + − = + ( , , ), ( , , ) lần lượt là các momen Trong đó: quán tính quanh các trục và momen tích quán tính của − . Θ = . Θ. Φ các mặt phẳng của hệ tọa độ ; . Θ. Φ (Φ, Θ, Ψ) là các góc Euler của máy bay trong hệ Hệ phương trình bảo toàn momen động lượng: tọa độ mặt đất ; ̇ − ̇ − + − = ( , , ) là tọa độ của máy bay trong hệ tọa độ ̇ + ( − ) +( − ) = (2) . ̇ − ̇ + ( − )+ = Tiếp đến, các hệ phương trình (1), (2), (3) được 394 SỐ ĐẶC BIỆT (10-2021)
HỘI NGHỊ KH&CN CƠ KHÍ - ĐỘNG LỰC 2021 viết lại trong 2 trạng thái bay: Trạng thái ổn định và . = 0; . = 0; . = 0; = 0; … trạng thái nhiễu động Giả thiết 2. Các biến ( , , ) là đủ nhỏ. 2.2. Trạng thái ổn định = ; = 1; = Trong trạng thái bay ổn định [5], có các điều kiện sau: = ; = 1; = ̇ = 0; ̇ = 0; ̇ = 0 (5) = ; = 1; = ̇ = 0; ̇ = 0; ̇ =0 Áp dụng các điều kiện (5) và Giả thiết 1, Giả thiết Kết hợp các điều kiện (5), các hệ phương trình (1), 2 vào các hệ phương trình (1), (2), (3) được viết lại (2) được viết lại như sau: thành các hệ phương trình (8), (9), (10) như sau: ( − )= − Θ + ( ̇+ + − − )= − Θ + ( − )= Θ . Φ + (6) ( ̇+ + − − )= − Θ . Φ ( − )= Θ . Φ + (8) + Θ . Φ + ( ̇ + + − − )= − Θ . Φ − + − = − Θ . Φ + ( − ) + − = (7) ̇ − ̇ −( − ) +( − )( − )= ( − )+ = ̇ +( + )( − ) + (2 −2 ) = (9) Các biến chuyển động trong trạng thái ổn định ̇ − ̇ +( + )( − )+( + ) = được kí hiệu bởi chỉ số dưới (sub-script) “1”. Trạng thái ổn định được khảo sát trong bài báo này p = ̇ − Ψ̇ (Θ ) − ̇ (Φ ) là chế độ bay treo, với các điều kiện như sau: q = −Θ̇ (Φ ) + ̇ (Φ ) − Ψ̇ (Φ ) (Θ ) = 0; = 0; =0 +Ψ̇ (Φ ) (Θ ) + ̇ (Φ ) (Θ ) (10) = 0; = 0; =0 r = −Ψ̇ ( ) (Θ ) − Ψ̇ (Φ ) (Θ ) Φ = 0; Θ = 0; Ψ = 0 + ̇ (Φ ) (Θ ) − Θ̇ (Φ ) − ̇ (Φ ) = 0; = 0; =− 3. Mô phỏng = 0; = 0; =0 3.1. Mô hình không gian trạng thái 2.3. Trạng thái nhiễu động Các hệ phương trình (8), (9), (10) được viết lại Trong trạng thái nhiễu động [5], các biến chuyển dưới dạng không gian trạng thái như sau: động được phân tích thành 2 thành phần là giá trị của biến chuyển động trong trạng thái ổn định và thành ̇= + (11) phần nhiễu động lệch khỏi giá trị trong trạng thái ổn Trong đó, định. ∈ ; ∈ , = + ; = + ; = + = [ ] ∈ = + ; = + ; = + là vec-tơ các biến trạng thái, Φ=Φ + ; Θ=Θ + ; Ψ=Ψ + = [ ] ∈ là vec-tơ các lực, = + ; = + ; momen lực tác dụng lên máy bay và được xác định = + như sau: = + ; = + ; = + =( − ) Các nhiễu động được coi là nhiễu động nhỏ, với = [ ] ∈ là lực và các giả thiết như sau: momen lực do motor, Giả thiết 1. Các số hạng khai triển bậc lớn hơn = [ . 0 0 0] ∈ là lực và momen hoặc bằng 2 của các biến ( , , , , , , , , ) là có thể bỏ qua. lực do ngoại lực trong môi trường. . = 0; . = 0; . = 0; = 0; … Với các giá trị = [ ] là đầu SỐ ĐẶC BIỆT (10-2021) 395
HỘI NGHỊ KH&CN CƠ KHÍ - ĐỘNG LỰC 2021 vào của mô hình, và các thông số của nguyên mẫu Từ các biến vận tốc trong hệ quy chiếu mặt đất máy bay hexacopter trong Bảng 1, các biến trạng thái ( ̇ , ̇ , ̇ ) và các điều kiện ban đầu, có thể xác định [ ] được xác định thông qua việc giải hệ phương trình vi phân (11). được tọa độ ( , , ) của máy bay trong hệ quy chiếu mặt đất. Bảng 1. Thông số của nguyên mẫu máy bay Trong bài báo này, bộ giải tích phân được sử dụng Kí Thông số Giá trị Đơn vị là bộ giải tích phân theo phương pháp Dormand- hiệu Prince trong phần mềm SIMULINK [8]. M Khối lượng máy bay 0.175 kg 3.2. Bộ điều khiển trong trường hợp máy bay Ix Momen quán tính 5.2 ∗ 10 kg.m2 hoạt động bình thường Iy Momen quán tính 5.1 ∗ 10 kg.m2 Từ các biến trạng thái, bộ điều khiển Tuyến tính- Iz Momen quán tính 10 kg.m2 Vi phân (PD) cho ra giá trị điều khiển của các lực, R Khoảng cách từ động 0.1 m momen lực do động cơ: cơ đến khối tâm máy bay = [ ] Lực nâng lớn nhất của 0.5 N Các giá trị lực và momen lực điều khiển được xác mỗi động cơ định như sau: =− = [ ] =− . − . Sau khi đã tính được các biến trạng thái, giá trị của =− . − . các biến ( , , , , , ) được sử dụng để xác định quỹ đạo của máy bay trong không gian thông qua hệ =− . − . phương trình quỹ đạo bay. Trong đó: Độ lợi của thành phân vi phân = 1, ̇ độ lợi của thành phần tuyến tính = 1. ̇ = . Từ các giá trị điều khiển lực, momen lực được cấp ̇ bởi bộ điều khiển, cần xác định giá trị điều khiển lực .c − . + . . . + . . đẩy của từng động cơ [ ] để đạt được các lực và = . . + . . − . + . . momen lực này. − . . =[ ] ∈ Trong đó: Giá trị điều khiển lực đẩy của từng động cơ được = ( ), = ( ), = ( ), xác định bằng ma trận phân phối [2, 3, 4]. = ( ), = ( ), = ( ), = . Hình 2. Các góc Euler và tọa độ của máy bay trong quá trình bay với điều kiện không hỏng động cơ 396 SỐ ĐẶC BIỆT (10-2021)
HỘI NGHỊ KH&CN CƠ KHÍ - ĐỘNG LỰC 2021 Ma trận phân phối là ma trận đáp ứng điều Hình 2 thể hiện mô phỏng các góc Euler và quỹ kiện . = và được xác định bằng phương pháp đạo bay trong quá trình máy bay xác lập về vị trí cân ma trận giả-nghịch đảo (pseudo-inverse matrix) [2, 3, bằng với sai lệch trong góc Pitch và Roll ban đầu là 4] như sau: = 0.1 , = 0.1 . = .( . ) Tọa độ ( , ) liên tục tăng một cách tuyến tính theo thời gian. Đây là do các vận tốc sinh ra trong quá Lực đẩy thực của các động cơ sẽ bị bão hòa khi trình xác lập vị trí cân bằng và do mô hình này chưa đạt tới các giới hạn lực đẩy tối đa và lực đẩy tối kể đến lực cản không khí thiểu . Lực đẩy của các động cơ gây nên các lực và 4. Bộ điều khiển trong trường hợp máy bay momen như sau: mất 1 động cơ = . ̅ Hình 3, 4 thể hiện mô phỏng các góc Euler và quỹ đạo bay trong quá trình bay tương tự nhưng thêm điều −1 −1 −1 −1 −1 −1 ⎡ ⎤ kiện máy bay hỏng động cơ số 1 tại thời điểm t = 10s, √3 √3 √3 √3 ⎢0 − . − . 0 . . ⎥ với điều kiện ban đầu là: = ⎢ 2 2 2 2 ⎥ ⎢ ⎥ = 0.1 , = 0.1 . ⎢ − − − 2 2 2 2 ⎥ ⎣ − − − ⎦ Như thể hiện trong Hình 3, 4 máy bay bị mất kiểm Trong đó: soát và bị rơi sau thời điểm động cơ bị hỏng (lưu ý trục z có chiều dương hướng xuống mặt đất). Góc Roll r là khoảng cách từ trục quay động cơ đến trục z ( ) được thể hiện là vẫn cân bằng và không bị ảnh của máy bay. hưởng. Đây là do phương lực đẩy của động cơ 1 nằm là hệ số giữa lực đẩy động cơ với momen xoắn trong cùng mặt phẳng với trục Roll (trục x) và đồng phản lực. thời là do chưa xét đến sự mất cân xứng của máy bay ̅= [ ] là lực đẩy thực và nhiễu động của môi trường trong thực tế. của các động cơ. Hình 3. Các góc Euler và tọa độ của máy bay trong quá trình bay sử dụng thuật toán điều khiển cũ với điều kiện hỏng 1 động cơ Hình 4. Quỹ đạo của máy bay trong quá trình bay sử dụng thuật toán điều khiển cũ với điều kiện hỏng 1 động cơ SỐ ĐẶC BIỆT (10-2021) 397
HỘI NGHỊ KH&CN CƠ KHÍ - ĐỘNG LỰC 2021 Hình 5. Các góc Euler và tọa độ của máy bay trong quá trình bay sử dụng thuật toán điều khiển mới với điều kiện hỏng 1 động cơ Hình 6. Quỹ đạo của máy bay trong quá trình bay sử dụng thuật toán điều khiển mới với điều kiện hỏng 1 động cơ Vì thuật toán bay trong điều kiện bình thường Trong đó, độ lợi của thành phân vi phân = 1, không điều khiển được máy bay trong điều kiện hỏng độ lợi của thành phần tuyến tính = 1. 1 động cơ, cần có 1 thuật toán điều khiển khác cho Giá trị điều khiển lực đẩy của các động cơ được điều kiện bay khi máy bay hỏng 1 động cơ. Trong xác định ma trận phân phối mới ∗ . trường hợp máy bay hỏng 1 động cơ, theo [4] đã Ma trận phân phối mới ∗ được xác định như chứng minh, máy bay không thể điều khiển được tất sau: cả các trạng thái . ∗ ∗ ∗ ∗ = .( . ) = [ ] Trong đó: Thuật toán thay thế chấp nhận việc không điều − − − − − − khiển được 2 biến trạng ít quan trọng hơn tới sự ổn ⎡ ⎤ ⎢ 0 √3 √3 √3 √3 ⎥ định của máy bay là và . ∗ = ⎢ − 2 . . − 2 . . 0 2 . . 2 . . ⎥ Trong thuật toán bay dành cho điều kiện hỏng 1 ⎢ ⎥ ⎣ . 2 . − . 2 − . − . 2 2 . ⎦ động cơ, các giá trị lực và momen lực điều khiển được xác định bởi bộ điều khiển Tuyến tính - Vi phân (PD) ∈ [0; 1] là hệ số hỏng của động cơ. Xét trường như sau: hợp động cơ số 1 ngừng hoàn toàn, các động cơ còn lại hoạt động bình thường. =− . = 0; = = = = =1 =− . − . Với điều kiện động cơ 1 bị hỏng, =0∀ . =− . − . 398 SỐ ĐẶC BIỆT (10-2021)
HỘI NGHỊ KH&CN CƠ KHÍ - ĐỘNG LỰC 2021 Lực và momen lực do lực đẩy của các động cơ vẫn TÀI LIỆU THAM KHẢO được xác định theo ma trận K như trong thuật toán bay [1] Farid Sharifi, Mostafa Mirzaei, Brandon W. trong điều kiện không hỏng động cơ. Gordon, and Youmin Zhang, Fault Tolerant = . ̅ Control of a Quadrotor UAV using Sliding Mode Hình 5, 6 thể hiện mô phỏng các góc Euler và quỹ Control, 2010. đạo bay trong quá trình bay với thuật toán bay mới, [2] Guillaume J. J. Ducard, Minh-Duc Hua, trong điều kiện máy bay hỏng động cơ số 1 tại thời Disscusion and practical aspects on control điểm t = 0s, với các điều kiện ban đầu là: allocation for a multi-rotor helicopter, 2011. = 0.1 , = 0.1 . [3] Michael W. Oppenheimer, David B. Doman, Với thuật toán điều khiển bay mới, các biến trạng Michael A. Bolender, Control Allocation for Over- thái ( , ) và độ cao đều xác lập giá trị cân bằng actuated Systems, 2006. sau khoảng 6s. Trong khi đó, góc Yaw( ) tăng với [4] Guang-Xun Du, Quan Quan, Kai-Yuan Cai, vận tốc góc Yaw ( ) tăng một cách tuyến tính theo Controllability Analysis and Degraded Control for thời gian. Tại thời điểm t = 20s, đạt giá trị khoảng a Class of Hexacopters Subject to Rotor Failures, 50rad/s. Tuy nhiên, mô hình này chưa kể đến ảnh 2014. hưởng của lực cản không khí. Nếu xét đến ảnh hưởng [5] Marcello R. Napolitano, Aircraft Dynamics: From của lực cản không khí, vận tốc góc Yaw ( ) sẽ tiệm Modeling to Simulation, 2012. cận 1 giá trị cực đại xác định khi lực cản không khí (tỉ lệ với vận tốc góc) đủ lớn. [6] Robert C. Nelson, Flight Stability and Automatic Control, 2nd edition, 1998. 5. Kết luận [7] Mark Lowenberg, Fixed-Wing Lateral and Trong bài báo này, mô hình động lực học của máy Directional Dynamic Stability, 2010. bay và bộ điều khiển xử lý sự cố 1 động cơ dừng hoạt động hoàn toàn trong chế độ bay treo được xây dựng. [8] Pedro T. M. M. Margarido, Flight Dynamics and Sử dụng các thông số của một nguyên mẫu máy bay Simulation of a Generic Aircraft for hexacopter, quá trình phục hồi của máy bay sau khi Aeroservoelastic Design, 2016. gặp sự cố được mô phỏng trong SIMULINK. Kết quả mô phỏng cho thấy bộ điều khiển hoạt động hiệu quả, Ngày nhận bài: 29/6/2021 giúp máy bay giữ được cân bằng ổn định trong chế độ Ngày nhận bản sửa: 05/8/2021 bay treo, và giữ được vị trí ổn định trong không gian. Ngày duyệt đăng: 19/8/2021 SỐ ĐẶC BIỆT (10-2021) 399

CÓ THỂ BẠN MUỐN DOWNLOAD

LV.15: Bộ Đồ Án Tốt Nghiệp Chuyên Ngành Cơ Khí

65 tài liệu

2412 lượt tải

THÔNG TIN

TRỢ GIÚP

HỖ TRỢ KHÁCH HÀNG

Theo dõi chúng tôi

Chịu trách nhiệm nội dung:

Nguyễn Công Hà - Giám đốc Công ty TNHH TÀI LIỆU TRỰC TUYẾN VI NA

LIÊN HỆ

Địa chỉ: P402, 54A Nơ Trang Long, Phường 14, Q.Bình Thạnh, TP.HCM

Hotline: 093 303 0098

Email: support@tailieu.vn

Giấy phép Mạng Xã Hội số: 670/GP-BTTTT cấp ngày 30/11/2015 Copyright © 2022-2032 TaiLieu.VN. All rights reserved.