Mô hình động học chuyển động của phương tiện ngầm

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

Thêm vào BST

Báo xấu

36
lượt xem 2
download

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

Nghiên cứu xây dựng các phương trình mô tả động học theo từng chủng loại của phương tiện ngầm một cách chính xác là cơ sở để xây dựng các thuật toán điều khiển đạt hiệu quả cao.

Chủ đề:

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

Lưu

Nội dung Text: Mô hình động học chuyển động của phương tiện ngầm

Tên lửa & Thiết bị bay MÔ HÌNH ĐỘNG HỌC CHUYỂN ĐỘNG CỦA PHƯƠNG TIỆN NGẦM Phạm Văn Phúc1*, Trần Đức Thuận2, Nguyễn Quang Vịnh2 Tóm tắt: Nghiên cứu xây dựng các phương trình mô tả động học theo từng chủng loại của phương tiện ngầm một cách chính xác là cơ sở để xây dựng các thuật toán điều khiển đạt hiệu quả cao. Trên cơ sở nghiên cứu các đặc tính thủy động học chung cho một lớp các đối tượng hoạt động dưới nước, các tác giả đã phát triển và xây dựng phương trình chuyển động trong mặt phẳng đứng và mặt phẳng ngang của phương tiện ngầm tự hành trong hệ tọa độ 6 bậc tự do. Từ khóa: Phương tiện ngầm; Mô hình động học; Thủy động học. 1. ĐẶT VẤN ĐỀ Phương tiện ngầm (UV) hoạt động dưới nước cần phải đáp ứng đầy đủ các chỉ tiêu chất lượng về động lực học, đó là tính điều khiển được theo độ sâu và theo hướng, là tính ổn định chuyển động khi chịu tác động từ bên ngoài, là khả năng lưu giữ các tham số quỹ đạo cho trước. Đặc tính động học chung cho các loại phương tiện hoạt động dưới nước đã được nhiều tác giả trên thế giới trình bày khái quát và có xét đến sự tác động của các loại nhiễu loạn bên ngoài [2],[3]. Tuy nhiên mô hình đối tượng trong các công trình này là mô hình tổng quan, chưa sát với các đặc tính động học của các loại phương tiện ngầm hiện có trong biên chế của Hải Quân Việt Nam. Trong [1], từ mô hình động học chung của UV, các tác giả đã phát triển cho mô hình động học của một dạng ngư lôi thiết kế của Nga có hai chân vịt đồng trục quay ngược chiều. Trên cơ sở tài liệu [1,2,3,4], chúng tôi đã phát triển mô hình động học chuyển động trong các mặt phẳng cho một dạng phương tiện ngầm tự hành điều khiển bằng bánh lái, tốc độ nhỏ, hoạt động trong một giới hạn nhất định có xét đến sự ảnh hưởng của dòng chảy đại dương trong hệ tọa độ 6 bậc tự do. 2. NỘI DUNG 2.1. Phương trình chuyển động tổng quát của phương tiện ngầm Chuyển động của UV được miêu tả trong 2 hệ tọa độ, đó là hệ tọa độ gắn liền trái đất 0xyz , hệ tọa độ gắn liền UV AXYZ . Theo đó vị trí của UV được xác định bởi điểm quy chiếu A và hướng quay của UV được xác định bởi 3 góc Roll – Pitch – Yaw. Hình 1. Các hệ tọa độ xác định vị trí của phương tiện ngầm. Vị trí của UV được xác định bởi véc tơ định vị: T   1T 2T  (1) 14 P. V. Phúc, T. Đ. Thuận, N. Q. Vịnh, “Mô hình động học … của phương tiện ngầm.” Nghiên cứu khoa học công nghệ trong đó, 1 là véc tơ xác định vị trí điểm quy chiếu của hệ động trong hệ quy chiếu gắn T liền trái đất, 1   x y z   R 3 ;  2 là véc tơ xác định hướng của UV, T  2       R 3 . Gọi   v1T v2T  là véc tơ vận tốc suy rộng của UV trong hệ tọa T độ gắn liền với UV, trong đó: v1  u v w là véc tơ vận tốc chuyển động của tâm T khối, véc tơ vận tốc góc của UV là v2   p q r . Đạo hàm theo thời gian véc tơ định vị trong hệ tọa độ gắn liền trái đất ta có mối quan hệ giữa  và véc tơ vận tốc  như sau[2]:   J ( ) ; J ( )  diag  J 1 ( ) J 2 ( ) (2) trong đó: c c  s c  c s s s s  c c s  J 1 (2 )   s c c c  s s s c s  s s c    s c s c c  1  s t c t  J 2 (2 )  0 c  s  0 s / c c / c  Áp dụng phương trình Newton – Euler ta nhận được phương trình chuyển động của UV dưới nước có dạng như sau: M UV  CUV ( )    (3) trong đó, M UV là ma trận quán tính của UV, và được xác định như sau:  m 0 0 0 mzG  myG   0 m 0  mzG 0 mxG    M 11 M 12   0 0 m myG  mxG 0  M UV     (4)  M 21 M 22   0 mzG mxG I xx  I xy  I xz   mzG 0  myG  I yx I yy  I yz     myG mxG 0  I zx  I zy I zz  T trong đó, rG   xG yG zG  là véc tơ vị trí khối tâm của UV trong hệ tọa độ gắn liền với UV; I xx , I yy , I zz là momen quán tính theo các trục xx, yy, zz ; I xy , I xz , I yx , I yz , I zx , I zy là mô men quán tính theo các trục tương ứng; m là khối lượng của UV. CUV ( ) chứa các lực Coriolis và lực hướng tâm ,ma trận CUV ( ) có dạng: Tạp chí Nghiên cứu KH&CN quân sự, Số 58, 12 - 2018 15 Tên lửa & Thiết bị bay  0 0 0 0 mw  m   0 0 0  mw 0 mu    0 0 0 mv  mu 0  CUV ( )    (5)  0 mw  mw 0 I zz r  I q yy    mw 0 mu  I zz r 0 I xx p     mv  mu 0 I yy q  I xx p 0    bao gồm tất cả các ngoại lực tác dụng lên UV như lực đẩy do động cơ đẩy tạo ra, lực thủy động, lực thủy tỉnh, lực của các bánh lái, tác động của dòng chảy. Ta có biểu thức sau:     phu   td  g ( )   bl   (6) Lực phụ  phu : khi UV chuyển động trong nước, các phần tử nước bao quanh UV cũng bị tăng tốc do đó nó tạo ra một lực tác dựng lại UV, lực này tỉ lệ với gia tốc của UV và được tính theo công thức sau:  phu   M phu  C phu ( ) (7) trong đó M phu là ma trận khối lượng quán tính phụ, các phần tử của nó phụ thuộc vào hình dáng và kích thước của UV; Ma trận C phu ( ) được tính toán từ ma trận M phu và véc tơ  tương tự như khi tính ma trận CUV ( ). Lực thủy động  td : thường được tính toán tỉ lệ bậc một và bậc hai đối với vận tốc của UV. Phương pháp thường được dùng để mô tả lực cản này là tính lực cản riêng của từng chuyển động theo các trục. Việc tính toàn phần lớn đều được xác định bằng thực nghiệm theo công thức sau:  td  D ( ) (8) trong đó D ( ) là ma trận cản xác định dương và được xác định như sau [1]:  X u|u| | u | X uv u  X v|v| | v | X uwu  X w|w| | w | 0 0 0  0 Yuvd u  Yv|v| | v | Yuvl u 0 0 0 0    0 0 Zuwd u  Z w|w| | w |  Z uwl u 0 0 0 D( )    (9)  0 0 0 0 0 0    0 0 M uwl u 0 0 0  0 Nuvl u 0 0 0 0   Lực thủy tĩnh g ( ) : lực này do trọng lượng gây ra và đặt tại tâm của UV và lực đẩy Aschimet đặt tại tâm nỗi của UV. T T trọng lượng của UV: P   0 0 G    0 0 mg  T lực đẩy Aschimet: FA   0 0   gV  với  là trọng lượng riêng của nước, g là gia tốc trọng trường, V là thể tích nước mà UV chiếm chỗ. Trong hệ tọa độ gắn liền với UV, lực thủy tĩnh được tính theo công thức sau:  f c ( )  f n ( )  g ( )    (10)  rn  f c ( )  rn  f n ( )  16 P. V. Phúc, T. Đ. Thuận, N. Q. Vịnh, “Mô hình động học … của phương tiện ngầm.” Nghiên cứu khoa học công nghệ  0   0  1   1 trong đó: f c ( 2 )  J ( 2 ) 0 ; f n ( 2 )  J1 ( 2 )  0 . 1      mg     gV  Lực nâng của bánh lái  bl , được tính bằng thực nghiệm và tính theo công thức sau: 1  bl   C L bl S bl  e u 2  L ( ) (11) 2 trong đó, CL bl là tốc độ thay đổi hệ số lực nâng và Sbl là diện tích bề mặt của bánh lái.  e (rad ) là góc ảnh hưởng của bánh lái. Lực, mô men bánh lái được viết dưới dạng ma trận như sau:  X uul u 0 0 X upl u 0 0     0 Yuvh u 0 0 0 Yurh u   0 0 Z uws u 0 Z uqs u 0  L ( )    (12)  K uu u 0 0 K upl u 0 0   l   0 0 M uws u 0 M uqs u 0     0 N uvh u 0 0 0 N urh u  Lực đẩy  của UV: mỗi động cơ đẩy của UV khi quay sẽ tạo ra lực đẩy ui , như vậy khi có p động cơ đẩy thì sẽ có véc tơ chứa các lực này: T u  u1 u2 ... u p  (13) Khi đó lực đẩy của UV được tính theo công thức sau:   Bu (14) 6 xp trong đó, B  R là ma trận hằng số, được dùng để tính lực đẩy cho từng hệ động cơ đẩy. Tổng hợp các ngoại lực và mô men ngoại lực tác động lên UV là [1]:  Xext  X HS  Xuu u2l  Xuuuu  Xuu  Xuvuv  Xuwuw  Xv|v|v | v |  Xvr vr   l   X ww | | w | w |  Xupup  X wq wq  X qq qq  X rr rr  X pl  Yext  YHS  Yuuh u h  Yurur  Yuvuv  Yv|v|v | v | Yvv  Ywp wp  Ypq pq  Yr r 2  2 (15) Zext  ZHS  Zuus u s  Zuwuw  Zuquq  Zvpvp  Zw|w|w | w | Zw w  Zq q  Zrprp  Kext  KHS  Kuuuu  K p p  Kuul u l  Kup 2  Mext  MHS  Muus u s  Muwuw  Muquq  Mvpvp  Mw w  Mq q  Mrprp 2  N  N  N u2  N ur  N uv  N v  N wp  N pq  N r  ext HS uuh h ur uv v wp pq r Thế các lực trên vào phương trình (3) ta thu được phương trình vi phân chuyển động của UV như sau: M   C ( )  D ( )  L( )  g( )  Bu (16) trong đó: M  M UV  M phu ; C ( )  CUV ( )  C phu ( ) Từ (2), (6), (9), (12), (15), (16) phương trình chuyển động tổng quát của UV trong hệ tọa độ 6 bậc tự do có thể được viết dưới dạng sau [1]: Tạp chí Nghiên cứu KH&CN quân sự, Số 58, 12 - 2018 17 Tên lửa & Thiết bị bay (m  Xu )u  Xuuuu  ( Xv|v| | v |  Xuvu)v  ( Xuwu  X|w|w | w |)w  Xupup  ( Xwq w     Xqqq  mw)q  ( Xvr v  Xrr r  mv)r  X pl  Xuu u2l l  2 (m  Yv )v  Yrr  (Yv|v| | v | Yuvu0 )v  mpw  Ywp wp  Ypq pq  (Yuru  mu)r  Yuu u h h (m  Z )w  Z q  mqu  (Z | w | Z u)w  (Z v  Z r  mv) p  Z uq  Z u2 w q |w|w uw vp rp uq uu s  s  2 (Ixx  Kp ) p  Kuuuu  Kupup  (I yy  Izz )qr  z f B cos sin  Kuu u l l (17) M w  (I  M )q  M uw  (M v  M r) p  (I  I )rp  M uq   w yy q uw vp rp zz xx uq   z f Bsin  xf B cos cos  Muu u s 2  s Nvv  (Izz  Nr )r  Nuvuv  Nwp wp  (I xx  I yy ) pq  Npq pq  Nurur  xf B cos sin   h  Nuu u2h x  u cos cos  v(cos sin sin  sin cos)  w(cos sin cos  sin sin)  y  u sin cos  v(sin sin sin  cos cos)  w(sin sin cos  cos sin)  z  u sin  v(cos sin)  wcos cos  (18)   p  q tan  sin   r tan  cos    q cos  r sin    q sin sec  r cos sec 2.2. Phương trình chuyển động của phương tiện ngầm trong các mặt phẳng Giả thiết rằng môi trường nước mà phương tiện ngầm chuyển động là lý tưởng, các trục quán tính được làm trùng với các trục đối xứng của nó. Dòng chảy ổn định và các số gia góc của các tham số động hình học nhỏ nên có thể tuyến tính hóa các đặc trưng thủy động lực học của phương tiện ngầm. Phương trình chuyển động của phương tiện ngầm trong hệ tọa độ 6 bậc tự do là hệ nhiều đầu vào nhiều đầu ra với nhiều tham số cần phải tính toán bằng thực nghiệm, vì thế việc xây dựng bộ điều khiển trong trường hợp này là rất khó khăn. Chuyển động của phương tiện ngầm trong nước được xem là 2 chuyển động độc lập nhau, đó là chuyển động theo góc hướng trong mặt phẳng ngang và chuyển động theo góc chúc góc trong mặt phẳng đứng. Trong thực tế cả 2 chuyển động này liên quan và ảnh hưởng lẫn nhau, tuy nhiên nếu hạn chế số bậc tự do để đơn giản hóa các phương trình chuyển động trong các mặt phẳng mà không làm mất đi các đặc tính động học tổng quát của phương tiện ngầm, từ đó cho phép xây dựng các bộ điều khiển theo từng mặt phẳng. 2.2.1. Phương trình chuyển động trong mặt phẳng ngang Dựa vào những đặc điểm trên cũng như giã thiết rằng chuyển động của phương tiện ngầm theo Cren là không điều khiển, vận tốc chuyển động theo trục dọc là không đổi u  u0 , góc hướng nhỏ, các thông số ban đầu  0  r0  0 . Khi này có thể xem   r , góc nghiêng  luôn được ổn định xung quanh điểm không (khi đó mới phân chia chuyển động tổng quát của UV thành chuyển động trong mặt phẳng ngang và chuyển động trong mặt phẳng đứng), khi đó sin  0; cos  1, vận tốc dài và vận tốc góc của UV trong hệ T tọa độ gắn liền được biểu diễn dưới dạng [3]:   (u, v, 0, 0, 0, r ) . Với các điều kiện trên, khi hạn chế số bậc tự do, từ (17), (18) chuyển động của AUV trong mặt phẳng ngang được mô tả bởi hệ phương trình sau: 18 P. V. Phúc, T. Đ. Thuận, N. Q. Vịnh, “Mô hình động học … của phương tiện ngầm.” Nghiên cứu khoa học công nghệ 2 mYv Yr 0 v  Y|v|v | vtd | Yuvutd mutd Yurutd 0 vtd   Yuuh utd   N I  N 0  r    N u N u 0   r    N u2   v zz r    uv td ur td     uuh td  h (19)  0 0   1   0 1 0    0    2.2.2. Phương trình chuyển động trong mặt phẳng đứng Giả thiết UV chuyển động không trượt nghĩa là lực bên Y  0 , tất cả các lực, mô men được biểu diễn trong mặt phẳng đứng, độ nghiêng bên bằng không, vận tốc chuyển động thẳng của UV không đổi u  u0 , các thông số ban đầu  0  q0  0 . Khi đó   q , trong mặt phẳng đứng véc tơ vận tốc của AUV được viết lại   (u , 0, w, 0, q , 0)T [3]. Với các điều kiện trên, tương tự như trong mặt phẳng ngang, từ (17), (18) chuyển động của AUV trong mặt phẳng đứng khi có xét đến ảnh hưởng của dòng chảy đại dương được mô tả bởi hệ phương trình: 2 mZw Zq 0 0w   Z|ww| | wtd | Zuwutd Zuqutd 0 0wtd   Zuus utd   M I M        w yy q 0 0 q   Muwutd Muqutd 0 0 q  Muus utd2    s (20)  0 0 1 0   0 1 0 0    0           0 0 0 1 z   0 0 0 0 z   0  3. KẾT QUẢ MÔ PHỎNG Với những phân tích trên, nhóm tác giả sử dụng phần mềm MATLB/SIMULINK mô phỏng chuyển động của PTN trong mặt phẳng đứng (hình 2). Với dữ liệu đầu vào là một chủng loại UV [1] có quỹ đạo dự kiến và phương pháp điều khiển kinh điển PD, kết quả nhận được (hình 3) cho thấy với nhiều tham số và kịch bản mô phỏng khác nhau, dưới tác động của dòng chãy đại dương nhưng quỹ đạo của PTN vẫn bám sát quỹ đạo dự kiến, điều này khẳng định được tính đúng đắn của mô hình động học của UV. Hình 2. Sơ đồ mô phỏng trạng thái của UV trong mặt phẳng đứng. Hình 3. Quỹ đạo tham chiếu và quỹ đạo của UV trong mặt phẳng đứng. Tạp chí Nghiên cứu KH&CN quân sự, Số 58, 12 - 2018 19 Tên lửa & Thiết bị bay 4. KẾT LUẬN Chuyển động của phương tiện ngầm mà bài báo đề cập bao gồm 3 chuyển động tịnh tiến và 3 chuyển động quay trong hệ tọa độ 6 bậc tự do. Phương trình động lực học chuyển động dưới tác động của các lực và mô men được biểu diễn dưới dạng các phương trình vi phân.Trên cơ sở hệ phương trình mô tả chuyển động của phương tiện ngầm có vây, với giả thiết là sự thay đổi các tham số động học góc là nhỏ, các tác giả đã tuyến tính hóa các đặc trưng thủy động để xây dựng các hệ phương trình chuyển động của phương tiện ngầm theo hai mặt phẳng nhưng vẫn đảm bảo được các đặc trưng động học cơ bản. Các hệ phương trình mô tả chuyển động trong hai mặt phẳng mà nhóm tác giả xây dựng là cơ sở để mô phỏng khi xây dựng bài toán dẫn đường và điều khiển trong nghiên cứu, thiết kế, chế tạo các loại phương tiện ngầm. TÀI LIỆU THAM KHẢO [1]. Trần Đức Thuận, Nguyễn Quang Vịnh, Trương Duy Trung, “ Mô hình động học chuyển động của Ngư lôi”. Tạp chí nghiên cứu KH-CNQS, Số 25, T6-2013, tr.7-16. [2]. Conte G. and Serrani A., “Modeling and simulation of underwater vehicles,” Proceedings of the 1996 IEEE International Symposium on Computer-Aided Control System Design, pp. 62-67, Dearborn, Michigan, September 1996. [3]. Xiao Liang., “Modeling and Computer Simulation for Autonomous Underwater Vehicles with Fins” journal of computers, vol. 8, no. 4, pp 1058-1064, 2013. [4]. Nahon M., “A Simplified Dynamics Model for Autonomous Underwater Vehicles,” Journal of Ocean Technology, vol. 1, no. 1, pp. 57-68, 2006. ABSTRACT A DYNAMICS MODEL OF UNDERWATER VEHICLE Studying the construction of dynamic equations describing the dynamics of different types of underwater vehicles is the basis for the development of efficient control algorithms. Based on the study of general hydrodynamic characteristics for a class of underwater subjects, the authors have developed and constructed a general equation for motion in the vertical plane and the horizontal plane of the underwater vehicle in coordinate system of 6 degrees of freedom. Keywords: Underwater vehicles; Dynamics models; Hydro dynamics. Nhận bài ngày 16 tháng 08 năm 2018 Hoàn thiện ngày 11 tháng 10 năm 2018 Chấp nhận đăng ngày 11 tháng 12 năm 2018 Địa chỉ: 1 Trường Cao đẳng Kỹ thuật hải quân; 2 Viện Khoa học và Công nghệ quân sự. * Email: phucanhquansg@gmail.com. 20 P. V. Phúc, T. Đ. Thuận, N. Q. Vịnh, “Mô hình động học … của phương tiện ngầm.”