Khảo sát chuyển động UAV Tri-rotors trong trường hợp một động cơ thay đổi tốc độ và góc nghiêng

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

Thêm vào BST

Báo xấu

21
lượt xem 1
download

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

Bài viết trình bày kết quả mô hình toán học của Tri-rotors với 3 trục giống hệt nhau, đặt lệch nhau một 1200 , hai động cơ cố định, có cùng tốc độ quay, một động cơ thay đổi tốc độ và góc lệch trục động cơ.

Chủ đề:

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

Lưu

Nội dung Text: Khảo sát chuyển động UAV Tri-rotors trong trường hợp một động cơ thay đổi tốc độ và góc nghiêng

Nghiên cứu khoa học công nghệ KHẢO SÁT CHUYỂN ĐỘNG UAV TRI-ROTORS TRONG TRƯỜNG HỢP MỘT ĐỘNG CƠ THAY ĐỔI TỐC ĐỘ VÀ GÓC NGHIÊNG Đặng Văn Thành*, Trần Đức Thuận Tóm tắt: Bài báo trình bày kết quả mô hình toán học của Tri-rotors với 3 trục giống hệt nhau, đặt lệch nhau một 1200, hai động cơ cố định, có cùng tốc độ quay, một động cơ thay đổi tốc độ và góc lệch trục động cơ. Từ mô hình toán học, tiến hành mô phỏng, kết quả mô phỏng giúp cho việc xây dựng thuật toán điều khiển và lựa chọn cấu hình của Tri-rotors. Từ khóa: Tri-rotors, UAV, Roll, Pitch, Yaw, Động lực học. 1. MỞ ĐẦU Máy bay không người lái (UAV) có khả năng ứng dụng rộng rãi cho các mục đích khác nhau, được dùng để phục vụ trinh thám hay tấn công quân sự, hoặc các hoạt động trong đời sống xã hội dân sinh như quản lý, bảo vệ rừng và động vật hoang dã, quản lý giao thông đô thị, thám hiểm, vận tải hàng hóa, cứu hộ, cứu nạn tại các khu vực nguy hiểm (về địa hình, phóng xạ,…), cảnh báo nguy hiểm (sóng thần, sạt lở bờ sông, tràn dầu biển…) quan trắc ô nhiễm không khí, ô nhiễm nguồn nước, chụp ảnh trên trái đất…vv. Hiện có nhiều mẫu thiết kế khác nhau về cấu trúc đã được công bố, tuy nhiên vấn đề xây dựng mô hình mô tả chuyển động có điều khiển cần phải làm rõ. 2. MÔ HÌNH TOÁN 2.1. Đặc điểm Mô hình 3D của Tri-rotors được mô tả trong hình 1. Tri-rotors có cấu trúc cân với 3 cánh tay giống nhau với chiều dài l, đặt lệch nhau một góc 120 độ, trên đầu mỗi cánh tay có gắn hệ truyền động cơ chấp hành để tạo ra lực nâng. Đối với các UAV Tri-rotors phổ biến hiện nay trên mỗi cánh tay có lắp thêm một động cơ servo để thay đổi góc của lực nâng (phương của lực nâng). Để điều khiển UAV Tri-rotors phổ biến hiện nay, người ta thường thay đổi tốc độ quay của 3 cánh quạt (thay đổi giá trị của 3 lực nâng) và 3 phương của 3 lực nâng đó, tức là véc tơ điều khiển đầu vào là 6 thành phần. Trong bài toán này, nhóm tác giả đề xuất phương án tích hợp UAV Tri-rotors như sau: Trên hai cánh tay của UAV Tri-rotors gắn hai động cơ cánh quạt tốc độ không đổi và trên hai nhánh này không gắn động cơ servo thay đổi phương của lực nâng. Ở nhánh còn lại sẽ gắn động cơ thay đổi tốc độ quay cánh quạt (tức thay đổi giá trị lực nâng) và một động cơ servo để thay đổi phương lực nâng này. Như vậy trong UAV này chỉ có hai tín hiệu điều khiển. 2.2. Mô hình toán Tri-rotors Để xây dựng mô hình toán của Tri-rotors chúng ta gắn các hệ tọa độ cho bài toán. Trên hình 3: - Hệ tọa độ gắn với trái đất E với các trục Xe , Ye , Ze (gốc tọa độ là tâm Tri-rotors ở thời điểm xuất phát). - Hệ tọa độ gắn với vật B với cách trục tọa độ Xb , Yb , Zb (gốc tọa độ là tâm Tri-rotors). - Hệ tọa độ gắn với ba cánh quạt với các trục tọa độ X l , Yl , Z l như thể hiện trên hình 4. i i i Ta coi Tri -motors là một vật rắn chịu lực. Để có được các phương trình động lự c của Tri-rotors, chúng ta cần phải tính được tất cả các lực và mômen xoắn tác động lên Tri- rotors, các ký hiệu và lực, mômen được thể hiện trên hình 4. Ngoài ra để nhận được phương trình động học cả Tri-motor, ta giả định rằng cơ cấu chấp hành, tức là động cơ Tạp chí Nghiên cứu KH&CN quân sự, Số 52, 12 - 2017 23 Tên lửa & Thiết bị bay cánh và động cơ quay trục động cơ tác động rất nhanh nên động lực học của chúng ta có thể bỏ qua. Hình 1. Mô hình của Tri-rotors. Hình 2. Hệ tọa độ sử dụng trong mô hình toán UAV. Hình 3. Góc nghiêng động cơ cánh quạt 1. Zl3 X l3 2 Yl3 Zl1 f 1 1200 Yl1 α 1200 X l1 1200 1 Zl2 3 X l2 Yl2 Hình 4. Sơ đồ tọa đặt hệ trục độ trên mỗi động cơ. 24 Đ. V. Thành, T. Đ. Thuận, “Khảo sát chuyển động UAV… thay đổi tốc độ và góc nghiêng.” Nghiên cứu khoa học công nghệ 2.2.1. Lực Có hai lực chính tác động lên UAV, đó là lực đẩy động cơ và trọng lực của UAV. a. Lực đẩy Tổng lực đẩy Fp bằng tổng lực tạo ra từ 3 cánh quạt.  Theo Hình.4, chọn động cơ (2) và (3) quay cùng chiều, cùng tốc độ, trục động cơ hướng thẳng đứng (góc nghiêng bằng 0), Riêng động cơ cánh quạt (1) đượ thay đổi tốc độ và phương của nó được thay đổi trong mặt phẳng 1Z l Yl bằng việc thay đổi góc α. Không 1 1 mất tính tổng quát ta giả sử:  s   s  0 ,  s   2 3 1 và m  m   p   p  2 , 2 3 2 3 m   p  1 . 1 1 Khi đó các lực đẩy của ba cánh quạt như sau [4]:  0   0      Fpl11   f1 sin     k f 12 sin    f1 cos    k  2 cos    f 1  0   0    F   0    0  l2 p2 (1)  f 2   k f 22    0  0   0      F   0    0    0  l3 p3  f3   k f 32   k f 22      Lực đẩy từ mỗi cánh quạt: fi  k f  p2i trong đó: k f là hằng số tốc độ đẩy,  p là tốc độ i cánh quạt. Trong hệ tọa độ gắn với vật B, các lực đẩy được xác định: Fpbi  Rlbi Fplii (2) Với Rlbi là các ma trận quay. Từ hình 4, với Tri-rotors có thể được rút ra như sau:   0 l b  0  l b  0 - Từ l1 đến B: l b 1 , 1 , 1 2  l b  0  l b  0 - Từ l2 đến B: l b   , 2 , 2 2 3 2 l3b  0  l3b  0 - Từ l3 đến B: l b  , , 3 3 Các ma trân quay cục bộ từ các hệ tọa độ động cơ cánh quạt li sang hệ tọa độ gắn với vật B như sau:  1 3   0  2 2  1 0 0 b   b  3 1  Rl1  0 1 0 , Rl2     0 , 0 0 1  2 2   0 0 1     Tạp chí Nghiên cứu KH&CN quân sự, Số 52, 12 - 2017 25 Tên lửa & Thiết bị bay  1 3    0  2 2   3 1  Rlb3    0 (3)  2 2   0 0 1     Tổng lực đẩy tác động lên UAV là: Fpb  Fpb1  Fpb2  Fpb3  k f H  (4) ở đây: 0 3 2  3 2 0 0 0   H f  1  1 2  1 2 0 0 0 (5) 0 0 1 1 1 1  m21 sin      0   0    2  (6) m1 cos     m2 2   2   m3  b. Trọng lực Tổng trọng lực trong hệ tọa độ mặt đất được đưa ra như:  0  F   0  g e (7)   gM tot  Mtot là tổng khối lượng UAV. Trong hệ tọa độ gắn với vật B: Fgb  Reb Fge (8) Ở đây: Reb ma trận xoay giữa hệ tọa độ E và B. Ký hiệu các góc Roll (v), Pitch (v), Yaw (v) quay quanh các trục Xe, Ye, Ze, ta có: Fgb  gM tot H g (9) với:   sin v sin v  cosv sin  v cos v    H g   sin v cos v  cos v sin  n sinv  (10)  cos v cos v  Tổng các lục tác động lên Tri-rotors trong hệ tọa độ gắn với vật B là: F b  FPb  Fgb  k f H f   gM tot H g (11) 2.2.2. Mô men Hai mô men chính tác động lên Tro-rotors là mô men xoắn đẩy và mô men xoắn kéo a. Mô men xoắn đẩy Mô men xoắn đẩy được tạo ra bởi các lực đẩy của 3 cánh quạt tác động lên xung quanh vật B, thành phần mô men xoắn đẩy là: 26 Đ. V. Thành, T. Đ. Thuận, “Khảo sát chuyển động UAV… thay đổi tốc độ và góc nghiêng.” Nghiên cứu khoa học công nghệ Tpbi  lib .Fpbi (12) ( lib là véc tơ độ dài của cánh thứ i tính từ trục động cơ cánh quạt đến trung tâm khối lượng Tri-rotors) Tổng mô men xoắn đẩy hệ tọa độ gắn vật B: Tpb  Tpb1  Tpb2  Tpb3  k f Ht  (13) 0 0 0 0  3 2 3 2   Với H t  0 0 0  1 12 12  (14) 1 1 1 0 0 0    được xác định ở phương trình (6). b. Mô men xoắn kéo Mô men xoắn kéo là mô men xoắn được tạo ra từ các lực kéo khí động học tạo ra do các chất lỏng môi trường xung quanh các cánh quạt, mô men xoắn kéo trên cánh quạt thứ I có thể được tính bằng: Tdi  kt p2i ( kt là hằng số mô men kéo, Nms 2 ). Trong hệ tạo độ cục bộ của động cơ cánh quạt, mô men xoắn kéo được tính:  0   Ii 2  T    kt mi sin  si  di (15)  2    kt mi cos si  Trong hệ tọa độ gắn với vật B, mô men xoắn kéo tổng quát được tính: Tdbi  Rlbi .TdIii [..], với lựa chọn ban đầu về đặc trưng Tri-rotors lưacj chọn, ta có các mo men xoắn kéo của từng cánh quạt như sau:  0   0  b  2  b   Td1    kt m1 sin  si  ; Td2   0  ;  2   k  2   kt m1 cos si   t m2   0  b   T  0  d3 (16)  k  2   t m3  Đặt:  kt m2 sin  s  U1 1 i  kt m21 cos  si  U 2 Tổng mô men xoắn kéo trong hệ tọa độ B được xác định như sau: Tdb  Tdb1  Tdb2  Tdb3  kt H f  (17) H f và  được định nghĩa trong (5) và (6) Tổng mô men xoắn tác động lên Tri-rotors trong hệ tọa độ gắn với vật B là: T b  Tpb  Tdb   k f H t  kt H f   (18) 2.3. Mô hình động lực học Tạp chí Nghiên cứu KH&CN quân sự, Số 52, 12 - 2017 27 Tên lửa & Thiết bị bay Xét Tri-rotors là một vật cứng, có khối lượng không đổi, chuyển động của Tri-rotors có thể được mô tả bởi định luật Newton-Euler thứ hai trong hệ tọa độ gắn với mặt đất: * Chuyển động tình tiến:   M tot vve  vve Fe   M tot (19) t t * Chuyển động quay:   I veve  Te  (20) t F e và T e lần lượt là tổng lực và mô men xoắn tác động lên UAV, vve là vận tốc tịnh tiến, ve là vận tốc góc, I ve là ma trận mô men quán tính thuộc hệ tọa độ gắn với trái đất. Chuyển các phương trình chuyển động sang hệ tọa độ mặt đất, ta có: vve  Rbe .vvb (21) do vậy: vve  ( Rbe .vvb )  e b   Rb .vv  Rbe .vvb (22) t t Từ tính chất chung của ma trận chuyển đổi, ta có: Rbe  ( Reb ) 1  ( Reb )T (23)  d R b T e     R  b T (24) e dt Reb   S ( b ).Reb (25) Vậy phương trình (22) có dạng: vve  Rbe .vvb  Rbe .S (vb ).vvb (26) t T S ( b ) là ma trận nghiêng của véc tơ vận tốc góc vb , với vb   p q r  thì S ( b ) được xác định:  0 r q S (vb )   r 0  p  (27)  q p 0  Tương tự, từ phương trình (20) ta có:   I veve   Rbe I vb vb  Rbe S (ve ) I vbvb (28) t Giả sử khối lượng Tri-rotors không thay đổi theo thời gian, do đó I vb là hằng số và F e  Rbe F b , T e  RbeT b . Thay các kết quả từ các phương trình (26) và (28) vào phương trình (19) và (20) ta nhận được tổng lực và mô men tác động lên Tri-rotors trên hệ tọa độ gắn với vật B là: F b  M tot  vvb  S (vb )vvb  (29) b b b b b b T  I   S ( ) I  v v v v v (30) b b Thay F , T từ (11) và (18) ta có: 28 Đ. V. Thành, T. Đ. Thuận, “Khảo sát chuyển động UAV… thay đổi tốc độ và góc nghiêng.” Nghiên cứu khoa học công nghệ k f H f   gM tot H g  M tot  vvb  S (vb )vvb  (31) k f H t  kt H f    I vb vb  S (vb ) I vbvb (32) Cho v và v là véc tơ góc và véc tơ vị trí của tri-rotors thuộc hệ tọa độ mặt đất E: T T v  v  v  v  và v   xv yv zv  (33) Mô tả đầy đủ các phương trình động lực học của tri-rotors, ta có các môi quan hệ sau: ve   vb (34) ve  ( Reb ) 1 vvb (35) Trong đó:  là ma trận quay giữa vận tốc góc vb trong hệ tọa độ gắn với tri-rotors, vận tốc góc trong hệ tọa độ tái đất E ve . Ma trận  được xác định như sau: Theo định lý công vận tốc góc:            (36) Chiếu phương trình () lên các trục tọa độ của hệ tọa độ mặt đất E, ta có:   0 0 v  T v (37)  cos v  sin v 0  0    sin v        sin v cos v 0       cos v  (38)  0 0 1  0   0    Tương tự ta có:  v cos  v cos v     v    cos  v sin v  (39)   sin  v  Từ đó ta có hệ thức:  x   0  sin v cos  v cos v       y    0 cos v cos  v sin v  (40)   1 0  sin  v   z  Từ phương trình động học (40) ta suy ra được phương trình vi phân động học trong hệ quy chiếu động:   sin  cos v sin  sin v cos   x   1         cos  sin v cos  cos v 0   y  (41)   cos   cos v sin v 0  z     Suy ra: sin  cos v sin  sin v cos   1     cos  sin v cos  cos v 0  (42) cos    cos v sin v 0    1 Với  v  . Từ các tính chất ma trận quay ta có:  Reb   Rbe 2 2 Tạp chí Nghiên cứu KH&CN quân sự, Số 52, 12 - 2017 29 Tên lửa & Thiết bị bay Từ các phương trình (31), (32), (34) và (35). Hệ phương trình động lực học của tri- rotors như sau: kf H f  vvb  gH g  S (vb )vvb  M tot  vb  ( I vb ) 1 S (vb ) I vbvb  ( I vb ) 1  k f H t  kt H f   (43) v  vb ve  Rbe vvb Hệ phương trình trên có thể được viết dưới dạng rút gọn, trong mỗi biến trạng thái là một véc tơ thành phần sau: u   p v   xv  b   b     e   vv  v  , v   q  , v   v  , v   yv  (44)  w   r   v   zv  Sử dụng phần mềm Matlab để giải hệ phương trình trên ta có kết quả như sau: u  v  v   b v (45)    w  rv  qw  g sin( v ) sin(v )  g cos( v ) cos(v ) sin( v )     pw  ru  g cos( v ) sin(v )  g cos( v ) sin(v ) sin( v )   Kf    m21 sin( )    M tot   Kf   qu  pv  g cos( v ) cos( v )   M tot  m21 cos( )  222    b    p   v   q    r  I  I 3K f l 2   2 3 qr   m2  m23    I1 2 I1  I  I K   3 1 pr  t 2m2 sin   I2 2I2  1        K t l 2m2 sin   m2  m2    (46)  2I2 1 2 3     I1  I 2 pq  K t  2 cos    2   2   I3 I3  m1 m2 m3       K t l  2 sin    I  m1    3    v   r   p cos v  q sin v  tan  v      v      q cos v  p sin v  (47)    p cos v q sin v        cos  cos   30 Đ. V. Thành, T. Đ. Thuận, “Khảo sát chuyển động UAV… thay đổi tốc độ và góc nghiêng.” Nghiên cứu khoa học công nghệ  xv  v   y v    e  zv  u cos v cos  v  w sin  v sin v  v cos  v sin v    u  cos v sin v  cos v sin v sin  v     v  cos cos   sin sin  sin    (48) v v v v v     w cos  v sin v    u  sin v sin v  cos v sin v sin  v     v cos  sin  cos sin  sin     v v v v v   +w cos v sin  v  3. MÔ PHỎNG ĐỘNG LỰC HỌC UAV TRI-ROTORS Các thông số tri-rotors sử dụng: - Khối lượng: 0.9kg - 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.02396 (kg.m2) - Mô men quán tính theo trục y, Iy =0.01271(kg.m2) - Mô men quán tính theo trục z, Iz =0.01273(kg.m2) - Hệ số kf=0.0000172 - Hệ số kt=0.0000002 - Tốc độ góc quay cánh quạt phải và trái: ω2=419rad/s (~4000 vòng/phút) - Gia tốc trọng trường: 9,81m/s2 Thời gian lấy mẫu: 5s Mô hình của UAV với hệ phương trình động học (43) được trình bày trên hình 5. Hình 5. Mô hình giải hệ phương trình vi phân Simulink. 3.1. Mô phỏng 1. UAV đang bay, các cánh quạt dừng quay. Tạp chí Nghiên cứu KH&CN quân sự, Số 52, 12 - 2017 31 Tên lửa & Thiết bị bay Kết quả cho thấy lúc này UAV rơi tự do. 3.2. Mô phỏng 2. Khi UAV đang bay, các động cơ cùng tốc độ, động cơ trước góc nghiêng bằng 0. Kết quả cho thấy khi 3 động cơ cùng tốc độ, quay cùng chiều thì UAV bay lên, đồng thời góc yaw cũng thay đổi tăng dần. 3.3. Mô phỏng 3. Rotor 1 giảm tốc độ: 1  350 rad/s, 2  3  419 rad/s. 32 Đ. V. Thành, T. Đ. Thuận, “Khảo sát chuyển động UAV… thay đổi tốc độ và góc nghiêng.” Nghiên cứu khoa học công nghệ Ta thấy rằng khi đó UAV mất ổn định theo cả 3 trục, các góc roll, pitch thay đổi bất thường, góc yaw cũng thay đổi. 3.4. Mô phỏng 4. Khi UAV bay lên, Rotor 1 giảm độ: 1  350 rad/s, đồng thời lệch góc α=50, 2  3  419 rad/s. Khí đó ta thấy UAV thay đổi mât ổn định, ban đầu tăng độ cao, sau đó giảm dần và lệch về phía trục x, các góc roll, pitch và yaw thay đổi không có quy luật. Tạp chí Nghiên cứu KH&CN quân sự, Số 52, 12 - 2017 33 Tên lửa & Thiết bị bay 4. KẾT LUẬN Bài báo đã trình bày kết quả nghiên cứu mô hình động lực học của Tri-rotors với giả thiết có sự thay đổi của các tham số một rotors. Đã xây dựng hệ phương trình phù hợp với phần mềm tính toán Matlab-Simulink. Qua kết quả mô phỏng cho thấy UAV Tri-rotors với hai đại lượng điều khiển (tốc độ cánh quạt và góc đặt cánh quạt) là một đối tượng có tính chất điều khiển được. Vấn đề ổn định hoặc chuyển động theo quỹ đạo mong muốn đòi hỏi phải có các nghiên cứu tiếp theo. TÀI LIỆU THAM KHẢO [1]. Nguyễn Đức Cương, “Mô hình hóa và mô phỏng chuyển động của các khí cụ bay tự động”, NXB QĐND 2002. [2]. Phạm Vũ Uy, “Cơ sở khí động học cho khí cụ bay”. NXB QĐND 2014. [3]. Nguyễn Văn Khang, “Động lực học hệ nhiều vật”, NXB KHKT, 2007. [4]. M. K. Mohamed, “Design and control of UAV system: a Tri-Rotor aircraft” [Doctor of Philosophy], University of Manchester, UK, 2012. [5]. Dong-Wan Yoo, “Dynamic Modeling and Control System Design for Tri-rotor UAV”, Proceedings of the 2010 3rd International Symposium on Systems and Control in Aeronautics and Astronautics, 2010. ABSTRACT SURVEYING THE MOTION OF UAV TRI-ROTORS IN A CASE OF ONE ENGINE CHANGING THE SPEED AND INCLINED ANGLE In the article, the result of the rotor with 3 axis coordinates, one and one 1200, two fixed base, with the way speed, a motor change the speed and angle Motion engine is reported. From the mathematical model, simulations, simulation results help to build tri-rotors control and configuration algorithms. Nhận bài ngày 12 tháng 10 năm 2017 Hoàn thiện ngày 01 tháng 11 năm 2017 Chấp nhận đăng ngày 20 tháng 12 năm 2017 Địa chỉ: Viện KH-CN quân sự. * Email: dangvanthanh2004@yahoo.com. 34 Đ. V. Thành, T. Đ. Thuận, “Khảo sát chuyển động UAV… thay đổi tốc độ và góc nghiêng.”