Xem mẫu

  1. Tên lửa & Thiết bị bay XÂY DỰNG MÔ HÌNH ĐIỀU KHIỂN CHUYỂN ĐỘNG DẠNG AFFINE CHO UAV TRI-ROTORS Đặng Văn Thành*, Trần Đức Thuận Tóm tắt: Bài báo phân tích và biến đổi mô hình động học Tri-rotors để xây dựng mô hình điều khiển dưới dạng affine, từ đó thuận lợi hơn cho việc áp dụng các công cụ điều khiển hiện đại để xây dựng thuật toán điều khiển bay cho UAV Tri-rotors. Từ kết quả trên, đề xuất một mô hình động học của UAV Tri-rotors, sử dụng công cụ Matlab-simulink để mô phỏng trạng thái ổn định động của UAV Tri-rotors trong không gian để khẳng định tính đúng đắn của mô hình đã xây dựng. Từ khóa: Tri-rotor; UAV; Góc nghiêng; Góc chúc; Góc hướng; affine; Động lực học. 1. MỞ ĐẦU Máy bay không người lái UAV dạng Tri-rotors là một chủng loại UAV có cấu tạo đơn giản, xong điều khiển nó lại có tính phức tạp hơn so với các chủng loại UAV khác. Đối với các chủng loại UAV khác đã có nhiều công trình nghiên cứu tương đối chi tiết, còn đối với Tri-rotors còn chưa được nghiên cứu chi tiết ở Việt Nam. Các công trình [1-3] đã xây dựng mô hình động học cho chuyển động của Tri-rotors. Để xây dựng được các thuật toán điều khiển, cần tiếp tục phân tích và biến đổi mô hình động học của Tri-rotors về các dạng phù hợp để áp dụng các phương pháp điều khiển hiện đại. Vấn đề này sẽ được trình bày trong bài báo. Trong bài báo này, nhóm tác giả sẽ cụ thể hóa mô hình động học của các tác giả [1] thành mô hình một hệ thống điều khiển, phân định rõ véc tơ hàm trạng thái và véc tơ tín hiệu điều khiển, chỉ rõ ma trận hệ số điều khiển. Từ đó, đưa đối tượng điều khiển Tri-rotors về dạng affine, giúp cho việc tổng hợp luật điều khiển được thực hiện thuận lợi hơn. Đây là điểm khác biệt với các công trình đã công bố. 2. XÂY DỰNG MÔ HÌNH ĐIỀU KHIỂN CHUYỂN ĐỘNG TRI-ROTORS Hình 1 đến hình 3 mô tả UAV dạng Tri-rotors và các hệ tọa độ dùng để khảo sát chuyển động của nó trong không gian. Hình 1. Mô hình của Hình 2. Hệ tọa độ sử dụng Hình 3. Góc nghiêng Tri-rotors. trong mô hình toán UAV. động cơ cánh quạt. Trong [1, 3] đã xây dựng mô hình động học mô tả chuyển động cho tri-rotors với các tham số đặc trưng sau: u   p   x     v  ;    q  ;     ;    y        (1)  w   r     z  Trong đó:  là véc tơ vận tốc tâm khối Tri-rotors trong hệ tọa độ mặt đất;  là véc tơ 16 Đ. V. Thành, T. Đ. Thuận, “Xây dựng mô hình điều khiển chuyển động … UAV Tri-rotors.”
  2. Nghiên cứu khoa học công nghệ tốc độ quay của Tri-rotors với các thành phần p, q, r ;  ,  ,  là ba góc tư thế của Tri- rotors so với hệ tọa độ mặt đất; x , y , z là tọa độ tâm khối Tri-rotors trong hệ tọa độ mặt đất. Trên Tri-rotors có thể được thiết kế và chế tạo các cơ cấu cơ điện để thay đổi các góc  i ( i  1, 2, 3 ) là ba góc nghiêng của động cơ cánh quạt trong mặt phẳng vuông góc với trục cánh quạt (có ba động cơ điện để thay đổi các góc). Hệ phương trình mô tả chuyển động tâm khối và chuyển động quay của Tri-rotors như sau:    (2)   R (3) Ở đây,  và R là các ma trận xác định như sau: sin( )cos ( ) sin( ) sin( ) cos( )  1   -cos( ) sin( ) cos( )cos ( ) 0  (4) cos( )   cos ( ) sin( ) 0   c( )c( ) c( )s ( )  s ( )   R  c( )s( )+c( ) s ( )s( ) c( )c( )  s( )s( ) s ( )  c( )s ( )  (5) s( )s ( )-c( )c( ) s( ) c( )s( )+c( )s( ) s ( ) c( )c( )  Hệ phương trình mô tả sự thay đổi véc tơ vận tốc tâm khối Tri-rotors: [rv  qw  g s( ) s( )  gc( )c( )s( )      k f 3 ( 2 s ( )   2 s ( ))]   2m 2 2 3 3    [ pw  ru  gc( ) s ( )  gc( ) s ( ) s ( )  u  (6)   v    k f 2 22 s( 2 ) 32 s( 3 )      m 1  w ( s ( 1 )   ]  2 2  [qu  pv  gc( )c( )     kf 2 2 2    m (1 c(1 )  2 c( 2 )  3 c( 3 ))]  Hệ phương trình mô tả sự thay đổi véc tơ vận tốc quay của Tri-rotors:  I 2  I3 k 3 2  [ qr  t (2 s ( 2 )  32 s ( 3 ))   I1 2 I1   k 3l   f (22 c ( 2 )  32 c( 3 ))]   2 I1    I I k  p  [ 3 1 pr  t (212 s (1 )  22 s ( 2 )  32 s ( 3 ))  (7)  I2 2I2     q     k l  r    f (212 c(1 )  22 c( 2 )  32 c( 3 ))]   2I  2    I1  I 2 kt 2 2 2  [ I pq  (1 c(1 )  2 c( 2 )  3 c( 3 ))  3 I 3    kfl 2   (1 s (1 )  22 s ( 2 )  32 s ( 3 ))]   I3  Tạp chí Nghiên cứu KH&CN quân sự, Số 66, 4 - 2020 17
  3. Tên lửa & Thiết bị bay Ở đây: c(.) , s(.) là hàm số cos (.) và sin(.) ; I1 , I 2 , I 3 là mô men quán tính của Tri- rotors theo các trục 1, trục 2, trục 3; l là khoảng cách từ tâm cánh quạt đến tâm Tri-rotors; 1 , 2 , 3 là tốc độ quay cánh quạt Tri-rotors; kt , k f là các hệ số tỉ lệ thể hiện quan hệ giữa lực và mô men tạo ra của một cánh quạt với tốc độ quay của cánh quạt, tức là: Fi  k f i2 , i  1, 2, 3 (8) Ở đây, coi ba cánh quạt tương đương nhau, nên các hệ số tỉ lệ bằng nhau. Vì vậy, hệ số kt , k f dùng chung cho cả 3 cánh quạt. Để thay đổi các biến trạng thái của véc tơ  và véc tơ  trong hai hệ phương trình vi phân (6) và (7) trên Tri-rotors có thể được thiết kế và chế tạo các cơ cấu cơ điện để thay đổi các góc  i , i  1, 2, 3 , hoặc các tốc độ các cánh quạt i , i  1, 2, 3 . Có thể thay đổi cả hai loại thông số trên. Trong bài báo này, xét trường hợp thay đổi cả hai loại thông số trên. Như vậy, tín hiệu điều khiển ở đây sẽ ba tốc độ quay cánh quạt i , i  1, 2, 3 và ba góc  i , i  1, 2, 3 và các góc này có giá trị thay đổi trong giải:     i  (9) 2 2 Gọi các biến của véc tơ lệnh điều khiển như sau: 2 u1  1 sin(1 )  u   2 sin( )   2  2 2  u3  3 sin( 3 )   2 U   2  (10)  4  1 cos (1 )  u  u   2   5  2 cos ( ) 2    u6  3 cos ( 3 )  2 Để thuận tiện trong việc tổng hợp luật điển khiển U, tức là luật thay đổi các giá trị sẽ ký hiệu lại các véc tơ ở biểu thức (1) như sau:  x   x1     x4  X 1     y    x2  ; X 2        x5    (11)  z   x3     x6   p   x7  u   x10  X 3     q    x8  ; X 4     v    x11      (12)  r   x9   w   x12  Với cách đặt biến ở các biểu thức (11), (12) các hệ phương trình trạng thái (3), (2) sẽ có dạng sau: X 1  RX 4 (13) X  X 2 3 (14) Trong đó, hai ma trận R ,  của các biểu thức (5) và (4) được viết lại như sau: 18 Đ. V. Thành, T. Đ. Thuận, “Xây dựng mô hình điều khiển chuyển động … UAV Tri-rotors.”
  4. Nghiên cứu khoa học công nghệ  s ( x4 )c ( x5 ) s ( x5 )  s ( x4 )c ( x5 )  R   c ( x4 ) s ( x5 )c ( x6 )  s ( x4 ) s ( x6 ) c ( x5 )c ( x6 ) s ( x4 ) s ( x5 )c ( x6 )  c ( x4 ) s ( x6 )   (15)  c ( x4 ) s ( x5 ) s ( x6 )  s ( x4 ) s ( x6 )  c ( x5 ) s ( x6 ) s ( x4 ) s ( x5 ) s ( x6 )  c ( x4 )c ( x6 )   s( x5 )c( x4 ) s( x5 ) s( x4 ) c( x5 )  1    c( x5 ) s( x4 ) c( x5 )c( x4 ) 0  (16) c( x5 )  c( x4 ) s( x4 ) 0  Thực hiện hai phép nhân ma trận (13) và (14) nhận được:  f11 ( X 2 , X 4 )  X 1  F1 ( X 2 , X 4 )   f12 ( X 2 , X 4 )  (17)  f13 ( X 2 , X 4 )  trong đó: f11 ( X 2 , X 4 )  s ( x4 )c( x5 ) x10  s ( x5 ) x11  s ( x4 )c( x5 ) x12 (18) f12 ( X 2 , X 4 )  (c( x4 ) s ( x5 )c( x6 )  s ( x4 ) s ( x6 )) x10  c( x5 )c( x6 ) x11 (19)  ( s ( x4 ) s ( x5 )c( x6 )  c( x4 ) s ( x6 )) x12 f13 ( X 2 , X 4 )  (c( x4 ) s ( x5 ) s ( x6 )  s ( x4 ) s ( x6 )) x10  c( x5 ) s ( x6 ) x11 (20)  ( s ( x4 ) s ( x5 ) s ( x6 )  c( x4 )c( x6 )) x12  f 21 ( X 2 , X 3 )  X 2  F1 ( X 2 , X 3 )   f 22 ( X 2 , X 3 )   (21)  f 23 ( X 2 , X 3 )  trong đó: f 21 ( X 2 , X 3 )  ( s ( x5 )c( x4 ) x7  s ( x5 ) s ( x4 ) x8  c( x5 ) x9 ) / c( x5 ) (22) f 22 ( X 2 , X 3 )  (c( x5 ) s ( x4 ) x7  c( x5 )c( x4 ) x8 ) / c( x5 ) (23) f 23 ( X 2 , X 3 )  (c( x4 ) x7  s ( x4 ) x8 ) / c( x5 ) (24) Với cách đặt biến ở các biểu thức (11), (12) các hệ phương trình trạng thái (6), (7) sẽ có dạng sau:  I 2  I3 k 3  [ x8 x9  t (u2  u3 )   I1 2 I1   k 3L   f (u5  u6 )]   2 I1    I I k  p   x7  [ 3 1 x7 x9  t (2u1  u2  u3 )  (25)  I2 2I 2  X 3     q    x8     k l  r   x9    f (2u4  u5  u6 )]   2I  2    I1  I 2 kt  [ I x7 x8  I (u4  u5  u6 )  3 3    kfl   (u1  u2  u3 )]   I3  Tạp chí Nghiên cứu KH&CN quân sự, Số 66, 4 - 2020 19
  5. Tên lửa & Thiết bị bay [ x9 x11  x8 x12  g s( x6 ) s( x4 )  gc( x6 )c( x4 ) s( x5 )     kf 3    2m (u2  u3 )]    u   x10  [ x7 x12  x9 x10  gc( x4 ) s ( x6 )  gc( x6 ) s ( x4 ) s ( x5 )  X 4    v    x11    k 3 u2 u3  (26)  f (u1   ]     x12    w m 2 2  [ x x  x x  gc( x )c( x )   8 10 7 11 6 5   kf    (u4 +u5 +u6 )]   m  Hai hệ phương trình trạng thái (25) và (26) tiếp tục được biểu diễn được viết dưới dạng sau: X 3  F3 ( X 3 )  B3U (27) X 4  F4 ( X 2 , X 3 , X 4 )  B4U (28) Trong đó:  I 2  I3   x8 x9  I  f31 ( X 3 )   1   I  I  F3 ( X 3 )   f32 ( X 3 )    3 1 x7 x9  (29) I  f33 ( X 3 )   2   I1  I 2   x7 x8   I3   k 3l kt 3l k f 3l k f 3l  0  t 0    2 I1 2 I1 2 I1 2 I1   kl kt l kt l kfl kfl kfl  B3    t   (30)  I2 2I2 2I2 I2 2I2 2I 2    kf l kfl kfl kt kt kt   I3 I3 I3 I3 I3 I 3    f 41 ( X 2 , X 3 , X 4 )  F4 ( X 2 , X 3 , X 4 )   f 42 ( X 2 , X 3 , X 4 )  (31)  f 43 ( X 2 , X 3 , X 4 )  f 41 ( X 2 , X 3 , X 4 )  x9 x11  x8 x12  g s( x6 ) s( x4 )  gc( x6 )c( x4 ) s( x5 ) (32) f 42 ( X 2 , X 3 , X 4 )  x7 x12  x9 x10  gc( x4 ) s ( x6 )  gc( x6 ) s ( x4 ) s ( x5 ) (33) f 43 ( X 2 , X 3 , X 4 )  x8 x10  x7 x11  gc( x6 )c( x5 ) (34) 20 Đ. V. Thành, T. Đ. Thuận, “Xây dựng mô hình điều khiển chuyển động … UAV Tri-rotors.”
  6. Nghiên cứu khoa học công nghệ  k 3 kf 3  0  f 0 0 0   2m 2m  k 3 k 3 kf 3   f  f  0 0 0  B4   m 2m 2m  (35)      kf kf kf   0 0 0 m m m  Kết hợp các hệ phương trình (17), (21), (30), (31) có hệ đầy đủ mô tả quá trình điều khiển Tri-rotors như sau: X 1  F1 ( X 2 , X 4 )   X  F ( X , X ) 2 1 2 3   (36)  X 3  F3 ( X 3 )  B3U   X 4  F4 ( X 2 , X 3 , X 4 )  B4U  Từ hệ phương trình (36) cho thấy hệ phương trình mô tả quá trình điều khiển Tri- rotors là hệ phi tuyến đã có cấu trúc affine [4]. 3. MÔ PHỎNG ĐỘNG LỰC HỌC UAV DẠNG TRI-ROTORS Tiến hành mô phỏng trên ngôn ngữ Matlab-simulink với mô hình (36) đối với một Tri- rotors có các thông số kỹ thuật sau: - Khối lượng: 2,0kg; - Khoảng cách từ tâm UAV đến trọng tâm các động cơ: l = 0,3m; - Mô men quán tính theo trục x, Ix=0.1075 (kg.m2) ; 2 - Mô men quán tính theo trục y, Iy =0.0725 (kg.m ) ; 2 - Mô men quán tính theo trục z, Iz =0.1350 (kg.m ); - Hệ số kf =0.0000172; Hệ số kt=0.000002; - Các cánh quạt có thể thay đổi tốc độ trong giải sau: i  (0  314) rad/ s, i  1, 2,3 (37) - Gia tốc trọng trường: 9,81m/s2. Trên các hình mô phỏng từ 4 đến mô phỏng 15 là kết quả mô phỏng trường hợp Tri- rotors dịch chuyển từ một vi trí bất kỳ về gốc hệ tọa độ và cất cánh thẳng đứng. Trong quá trình cất cánh có lúc bị nhiễu gió tác động. Các hình mô phỏng 4, 5, 6, 7, 8, 9 là biểu đồ các thành phần u1 , u 2 , u3 , u 4 , u5 , u6 của véc tơ điều khiển U , còn trên các hình mô phỏng 10, 11, 12 là các đồ thị sự thay đổi của các góc:  (góc chúc ngóc),  (góc cren),  (góc hướng), trên hình mô phỏng 13, 14, 15 là vị trí tâm khối Tri-rotors theo các trục x , y , z . Mô phỏng các thành phần của véc tơ điều khiển U: Tạp chí Nghiên cứu KH&CN quân sự, Số 66, 4 - 2020 21
  7. Tên lửa & Thiết bị bay Hình 4. Tín hiệu điều khiển U1. Hình 5. Tín hiệu điều khiển U2. Hình 6. Tín hiệu điều khiển U3. Hình 7. Tín hiệu điều khiển U4. Hình 8. Tín hiệu điều khiển U5. Hình 9. Tín hiệu điều khiển U6. Mô phỏng sự thay đổi của các góc  (chúc ngóc),  (hướng),  (cren) và vị trí tâm khối Tri-rotors theo các trục x , y , z 22 Đ. V. Thành, T. Đ. Thuận, “Xây dựng mô hình điều khiển chuyển động … UAV Tri-rotors.”
  8. Nghiên cứu khoa học công nghệ Hình 10. Sự thay đổi góc  . Hình 11. Sự thay đổi góc  . Hình 12. Sự thay đổi góc  . Hình 13. Tâm khối theo trục x. Hình 14. Tâm khối theo trục y. Hình 15. Tâm khối theo trục z. 4. KẾT LUẬN Việc phân tích đặc điểm hệ động học với cơ cấu thay đổi phương các lực tạo ra từ các cánh quạt của Tri-rotors đã xây dựng hệ phương trình mô tả quá trình điều khiển bay cho Tri-rotors và đã đưa hệ về dạng affine. Từ tính chất affine có thể áp dụng các công cụ điều khiển hiện đại (như điều khiển backstepping, điều khiển trượt, điều khiển thích nghi, điều khiển tối ưu [5]) để xây dựng thuật toán điều khiển bay cho Tri-rotors. Tạp chí Nghiên cứu KH&CN quân sự, Số 66, 4 - 2020 23
  9. Tên lửa & Thiết bị bay Kết quả mô phỏng cho thấy, cấu trúc điều khiển theo mô hình (36) đảm bảo tính điều khiển được (điều khiển vị trí tâm khối và tư thế UAV dạng tri-rotors về vị trí và tư thế mong muốn). Từ mô hình này, có thể thử nghiệm thiết kế các luật điều khiển khác nhau và đánh giá hiệu quả của các luật điều khiển đó. TÀI LIỆU THAM KHẢO [1]. Hoàng Quang Chính, Nguyễn Công Toàn. “Nghiên cứu xây dựng mô hình toán và mô phỏng UAV tri-rotor” . Tuyển tập công trình Hội nghị toàn quốc lần thứ 2 về Điều khiển và Tự động hóa- VCCA-2013, tr 556-563. [2]. Đặng Văn Thành, Trần Đức Thuận. "Khảo sát chuyển động UAV tri-rotor trong trường hợp một động cơ thay đổi tốc độ và góc nghiêng", Tạp chí Nghiên cứu KH&CN quân sự, số 52, 12-2017. [3]. Dong-Wan Yoo. “Dynamic Modeling and Control System Design for Tri-rotor UAV”. Proceedings of the 2010 3rd International Symposium on System and Control in Aeronautics and Astronautics, 2010. [4]. Nguyễn Doãn Phước. “Phân tích và điều khiển hệ phi tuyến” NXB Bách khoa, 2012. [5]. Nguyễn Doãn Phước. “Lý thuyết điều khiển nâng cao”. NXB Khoa học và Kỹ thuật, 2009. ABSTRACT AFFINE MOTION CONTROL MODEL FOR UAV TRI-ROTORS This paper analyzes the Tri-rotor dynamical model to transform it to affine form control system model, which is easier to apply the modern control theories to synthesize the Tri-rotor UAV control law. Select a specific Tri-rotor UAV’s model, using the Matlab-Simulink to simulate the steady-state motion in space to demonstrate the correctness of this model. Keywords: Tri-rotor; UAV; Roll; Pitch; Yaw; Affine; Dynamics. Nhận bài ngày 03 tháng 9 năm 2019 Hoàn thiện ngày 21 tháng 01 năm 2020 Chấp nhận đăng ngày 10 tháng 4 năm 2020 Địa chỉ: Viện Khoa học và Công nghệ quân sự. * Email: thanhdv051975@gmail.com. 24 Đ. V. Thành, T. Đ. Thuận, “Xây dựng mô hình điều khiển chuyển động … UAV Tri-rotors.”
nguon tai.lieu . vn