1. Trang Chủ
  2. Tự động hoá
  3. Mô hình toán học hệ thống dẫn đường quán tính

Mô hình toán học hệ thống dẫn đường quán tính

Trong điều khiển thiết bị bay chúng ta phải giải quyết vấn đề dẫn đường. Một trong các phương pháp dẫn đường là dẫn đường quán tính không dùng thông tin bên ngoài vật thể chuyển động mà dùng thông tin về gia tốc của bản thân vật thể chuyển động để xác định các tham số dẫn đường. Bài viết này trình bày về một mô hình động học mới cho hệ thống dẫn đường quán tính. Thông tin khoa học công nghệ MÔ HÌNH TOÁN HỌC HỆ THỐNG DẪN ĐƯỜNG QUÁN TÍNH Nguyễn Thái Hòa*, Đỗ Xuân Ngọc, Đào Văn Hưng, Đỗ Ngọc Tuấn T

Thể loại Tài liệu miễn phí Tự động hoá

Số trang 8

Ngày tạo 8/15/2019 2:26:31 PM +00:00

Loại tệp PDF

Kích thước 0.68 M

Tên tệp

Tải Mô hình toán học hệ thống dẫn đường quán tính (.pdf)

Xem mẫu

  1. Thông tin khoa học công nghệ MÔ HÌNH TOÁN HỌC HỆ THỐNG DẪN ĐƯỜNG QUÁN TÍNH Nguyễn Thái Hòa*, Đỗ Xuân Ngọc, Đào Văn Hưng, Đỗ Ngọc Tuấn Tóm tắt: Trong điều khiển thiết bị bay chúng ta phải giải quyết vấn đề dẫn đường. Một trong các phương pháp dẫn đường là dẫn đường quán tính không dùng thông tin bên ngoài vật thể chuyển động mà dùng thông tin về gia tốc của bản thân vật thể chuyển động để xác định các tham số dẫn đường. Bài báo này trình bày về một mô hình động học mới cho hệ thống dẫn đường quán tính. Từ khóa: Hệ thống dẫn đường quán tính; Hệ tọa độ quán tính; Khối đo lường quán tính; Góc Euler. 1. ĐẶT VẤN ĐỀ Hệ thống dẫn đường quán tính (INS) dựa trên nguyên lý tính quãng đường đi qua để xác định các tham số chuyển động của thiết bị bay (TBB) so với một hệ tọa độ nào đó. Ưu điểm cơ bản của hệ thống INS là xác định đồng thời các tham số chuyển động của TBB mà không cần thông tin nào từ bên ngoài nên đảm bảo tính độc lập cao. Tuy nhiên, nhược điểm của hệ thống INS là sai số định vị tăng theo thời gian. Vì vậy vấn đề hạn chế sai số trong hệ thống INS đã có nhiều nghiên cứu về lý thuyết cũng như giải pháp được ứng dụng trong thực tế. Một trong các phương pháp hạn chế sai số trong hệ thống INS là sử dụng các mô hình động lực học phi tuyến kết hợp với lọc Kalman trong thiết kế hệ thống. Bài báo này, trình bày mô hình động lực học phi tuyến sử dụng véc tơ quay cho thuật toán dẫn đường quán tính. Trong mô hình động học véc tơ quay, đầu ra của con quay hồi chuyển được đo trực tiếp và ước lượng theo cấu trúc phản hồi của véc tơ quay. Cấu trúc phản hồi có nghĩa là đầu ra của con quay hồi chuyển được xấp xỉ từ véc tơ quay trước đó. Đặc tính này cho sự liên kết chặt chẽ giữa các sai số của phép đo và ước lượng. Hơn nữa cũng tính chất này cho phép việc tính toán các góc nhanh hơn phương pháp Euler. Thông tin về vận tốc từ khối đo lường quán tính (IMU) được sử dụng làm các phép đo đầu vào. Và vì thế, vận tốc và các thành phần của véc tơ quay được sử dụng như là các biến trạng thái trong mô hình động lực học phi tuyến. 2. NGUYÊN LÝ DẪN ĐƯỜNG QUÁN TÍNH Trong nội dung này, chúng tôi trình bày tóm lược về nguyên lý dẫn đường quán tính, cũng như các phương trình động lực học dùng trong hệ thống dẫn đường quán tính. Xét các chuyển động diễn ra theo thuyết tương đối hẹp Galilean. Theo đó cơ sở toán học của dẫn đường quán tính là định luật cơ bản của Newton về quy luật cơ học chuyển động của trọng tâm TBB trong hệ tọa độ quán tính (i-frame). Quy luật này được mô tả như sau [4]:  d2R   n  g ( R) (1) dt 2   Trong đó R là véc tơ vị trí của TBB; n là véc tơ gia tốc nhận cảm của khối  tâm TBB; g ( R) là véc tơ gia tốc trọng trường của TBB do lực hấp dẫn trái đất Tạp chí Nghiên cứu KH&CN quân sự, Số Đặc san CNTT, 04 - 2019 169
  2. Công nghệ thông tin  d2R sinh ra (xét chuyển động trong trọng trường trái đất); là gia tốc tuyệt đối dt 2 của TBB. Phương trình (1) thể hiện việc miêu tả toán học của một chuyển trong hệ tọa độ quán tính là đơn giản. Tuy nhiên, khi giải các bài toán chuyển động trong thực tế sẽ thuận tiện hơn khi chúng ta chuyển các hệ tọa độ quán tính sang hệ tọa độ không quán tính [3-5]. Trên cơ sở phương trình (1) người ta xây dựng các mô hình toán thể hiện động lực học cho chuyển động, cũng như các thuật toán cho các hệ thống dẫn đường  quán tính. Thông tin về gia tốc nhận cảm n có thể đo được bằng ba cảm biến gia  tốc bố trí trực giao; thông tin về gia tốc trọng trường g ( R) thường được mô tả  dưới dạng hàm đã biết của R tùy thuộc vào việc mô hình hóa trái đất. Xét phương trình (1) dưới dạng Cô-si:   dV     n  g ( R)  dt   (2) d R V   dt Khi xét các phương trình (2) này trong hệ tọa độ quay với vận tốc góc  , ta có:   dV dV      V  dt dt   (3)  d R  dR   V   dt dt dV dR   Trong đó , là đạo hàm của các véc tơ R và V trong hệ tọa độ quay với dt dt vận tốc góc  . Các phương trình trên là cơ sở cho phép ta xây dựng các thuật toán dẫn đường quán tính khác nhau. Thực tế để xây dựng các thuật toán số cho hệ thống dẫn đường quán tính, người ta phải lựa chọn dạng cơ sở cho hệ tọa độ dẫn đường để xác định các tham số định vị và định hướng. Hệ tọa độ lựa chọn do kiểu loại TTB, đặc điểm quỹ đạo, và nhiệm vụ cần giải quyết quy định. Thông thường đối với TBB gần trái đất, người ta hay dùng hệ tọa với mặt phẳng cơ sở là mặt phẳng ngang và được định hướng bằng các trục theo phương vị (các trục hướng về phía bắc và phía đông). Khi các trục của tọa độ đã được định vị theo một hướng xác định, người ta quay với vận tốc xác định. Và thông tin về vị trí của đối tượng được xác định bằng kinh độ, vĩ độ và độ cao trên Ellipsoid của trái đất. 3. MÔ HÌNH TOÁN HỌC HỆ THỐNG DẪN ĐƯỜNG QUÁN TÍNH Trong phần này, chúng tôi trình bày một số mô hình toán học phi tuyến mô tả mối tương quan giữa các trạng thái dẫn đường, cũng như trình bày mô hình toán học sai số cho các đo đạc trong hệ thống dẫn đường quán tính. 3.1. Mô hình động lực học vận tốc 170 N. T. Hòa, …, Đỗ Ngọc Tuấn, “Mô hình toán học hệ thống dẫn đường quán tính.”
  3. Thông tin khoa học công nghệ Phương trình (2) xét trong hệ tọa độ địa lý địa phương (ENU), hệ động lực học vận tốc được biểu diễn:   ve  vv   ae    2  vn sin   e u  2 vu cos     ( N  h) cos   N h  ve    d    ve  vn vu v   a    2   ev sin     g  w1. (4) dt    n n  ( N  h) cos   M h  vu    2 2  a  ve  vn  v 2 cos    u N  h M  h e   Trong đó: g là véc tơ gia tốc trọng trường, h là độ cao, M , N là bán kính cong của trái đất được xác định theo công thức [1]: a 1  e 2  a M 3 2 ,N  12 1  e2 sin 2   1  e2 sin 2   Vĩ độ  là giá trị khởi tạo ban đầu của khối đo lường quán tính (IMU), và  T là tốc độ quay của trái đất. Véc tơ v enu   ve , vn , vu  là vận tốc trong hệ tọa độ ENU. Nhiễu trạng thái của mô hình động lực học, ký hiệu w1 , nhiễu này được giả định bao gồm nhiễu trắng (Gaussian white noise), sai số bán kính trái đất (sai số do phương pháp mô hình hóa trái đất), sai số về khởi tạo vị trí ban đầu, sai số hệ thống của khối IMU. Gia tốc trong hệ tọa độ ENU, ký hiệu là a enu , và được tính toán theo công thức:  ae  a   an   Cimu enu enu a A  a imu  b a  . (5)  au  enu Với Cimu là ma trận chuyển trạng thái từ hệ tọa IMU (body frame) sang hệ tọa độ ENU, và a imu là đầu ra của gia tốc kế trong hệ tọa độ IMU, và ba là sai số của gia tốc kế (sai số này là tổ hợp của ba thành phần: constant bias, turn-on bias, và random walk noise). Hệ số tỉ lệ  SFiia |i 1,2,3  và ma trận độ chệch không  MAajk | j ,k 1,2,3; j  k  của gia tốc kế được mô tả bởi:  SF11a MA12a MA13a    Aa  I 33   MA21a SF22a MA23a  . (6)  MA31a a a  MA32 SF33   Các giá trị về hệ số tỉ lệ, và độ chệch không của gia tốc kế được lấy từ đặc tính của khối đo lường quán tính IMU. enu Véc tơ quay liên quan đến ma trận chuyển trạng thái Cimu của công thức (5) được cho bởi [6]: Tạp chí Nghiên cứu KH&CN quân sự, Số Đặc san CNTT, 04 - 2019 171
  4. Công nghệ thông tin  1  cos    sin     enu Cimu   cos    I 33  2  . T   .    (7)      T 12 Trong đó, véc tơ quay     e ,  n , u  ,     T .  , và ma trận của phản đối xứng của véc tơ quay được cho bởi:  0  u  n       u 0  e  . (8)   e e 0  3.2. Mô hình động lực học trạng thái Có nhiều nghiên cứu về mô hình hệ động lực học của véc tơ quay, một trong các mô hình hệ động lực của véc tơ quay được cho dưới dạng:  1 1   .sin    2    I33      T 1        imu . (9)  2  .  2 1  cos     Trong đó,  imu là vận tốc góc trong hệ tọa IMU. Tuy nhiên công thức này không xét vận tốc quay của trái đất, cũng như không xét vận tốc quay của véc tơ vận tốc. Vì vậy, khi xem xét tới vận tốc quay của trái đất, hiệu ứng lực Coriolis, và gia tốc ly tâm thì phương trình động lực học (9) được xem xét dưới dạng:     imu  imu  enu  enu  w2 . (10)   Với    sin      imu  1 .1  T 2 1  cos      I 33  1 .1T        2  (11)    sin     T   enu  1 .1  2 1  cos      I33  1.1   2    T   Và 1  . Sai số của mô hình động lực, ký hiệu w2 được giả định là nhiễu  trắng, bao gồm cả sai số bán kính trái đất và sai số nhiễu của con quay hồi quyển. Vận tốc góc  enu bao gồm vận tốc góc của trái đất enu , vận tốc góc ly tâm  a và hiệu ứng lực Coriolis  c . Theo [6] chúng ta có thể mô tả:  v     n   0   0   M  h   ve   enu  enu   a   c   cos     0    . (12)  N h     sin   ve tan        0   N h    Vận tốc góc  imu được xác định theo công thức: 172 N. T. Hòa, …, Đỗ Ngọc Tuấn, “Mô hình toán học hệ thống dẫn đường quán tính.”
  5. Thông tin khoa học công nghệ  imu  A g  imu  b g  . (13) Trong đó b g là nhiễu, ký hiệu hệ số tỉ lệ  SFiig |i 1,2,3  và ma trận độ chệch không  MAjkg | j ,k 1,2,3; j  k  của con quay hồi chuyển, khi đó:  SF11g MA12g MA13g    Ag  I 33   MA21g SF22g MA23g  . (14)  MA31g g MA32 SF33  g   Các hệ số tỉ lệ, độ chệch không được lấy từ đặc tính kỹ thuật của con quay. 3.3. Mô hình đo đạc Vận tốc và tốc độ góc được sử dụng làm phép đo tham chiếu. Mô hình toán học cho phép đo vận tốc được xây dựng khá đơn giản, một trong các mô hình đó có thể mô tả như sau:  ve  1 0 0   ve  v   0 1 0  v   w . (15)  n   n 3 vu  0 0 1  vu  Trong đó, sai số của mô hình w3 chính là nhiễu trắng của đầu ra các gia tốc kế. Với các mô hình động lực học đo đạc cho phương trình (15) được cho bởi biểu thức [6]:   v     n  M h 1         ve   cos     w .  imu   imu    enu (16)      N h   3        sin   ve tan         N  h   Trong đó w3 là nhiễu trắng phép đo của con quay hồi chuyển. Từ mô hình động lực học đo đạc, người ta thiết kế các bộ lọc để giảm thiểu các sai số. Thực tế người ta thường dùng các bộ lọc Kalman trong thiết kế hệ thống [2]. 4. MÔ PHỎNG VÀ ĐÁNH GIÁ KẾT QUẢ Trong phần này, chúng tôi trình bày mô hình IMU với mục đích mô phỏng. Vì vậy các thành phần sai số được giả thiết là các quá trình Gauss-Markov bậc nhất với tự tương quan là hằng số. Hằng số tự tương quan trong mô phỏng là 7000s. Các phương trình mô tả sai số của con quay hồi chuyển, gia tốc kế được sử dụng trong mô phỏng được cho bởi: 1 1 ba   ba  2 a2  a u  t  và b g   b g  2 g2  g u  t  a g Với ba và b g là các sai số của gia tốc kế và con quay hồi chuyển;  a và  g hằng số tự tương quan;  a  50,  g  0.02 là độ lệch chuẩn của các nhiễu ngẫu nhiên; u  t  là hàm kỳ vọng của nhiễu trắng. Tạp chí Nghiên cứu KH&CN quân sự, Số Đặc san CNTT, 04 - 2019 173
  6. Công ngh nghệệ thông tin Các phép đo ccủa ủa gia tốc kế đđư ược ợc mô tả theo mô hình:  sin   a    cos  sin   g . imu    cos  cos   Với g là véc tơ gia ttốc V ốc trọng tr ờng trong hệ tọa độ quán tính;  ,  , là ba góc trường Euler đđịnh ịnh hhư ướng. ớng. Mô hình hóa phép đo vvới ới nhiễu trắng, phép đo đđư ược ợc xác định bởi: 0.01 a  a  b  0.01 u  t  . enu imu a  0.1  Mô hình đo đđạc ạc đối với con quay hồi chuyển đđược ợc cho bởi: 3.4 106     enu   b  b g  3.6 106  u  t  5.4 106      cos  cos   0  Với    cos  cos   90  là đđầu Với b ầu ra của con quay hồi chuyển tại vĩ độ     sin    với ới góc phphương ương vvịị  . Ban đầu đầu góc phphương ương vvịị đư ợc khởi tạo llàà 50 với được ới sai số 0.5, phương phương sai ccủa ủa nhiễu được ước được ớc lượng l ợng qua bộ lọc Kalman thích nghi. Độ lệch chuẩn của nhiễu chúng tôi sử ử dụng trong mô phỏng nh như ư trong B Bảng ảng 1: B ảng 1. Độ Bảng Độ lệch chuẩn của các quá trình nhi nhiễu. ễu. --5 --8 Vận ận tốc đông (m/s) 2.5 x 10 Vector quay đông (rad) 4.4 x 10 --5 Vận ận tốc bắc (m/s) 2.5 x 10 Vector quay bbắc ắc (rad) 4.4 x 10--8 Vận ận tốc llên ên (m/s) 3.3 x 10--5 Véc tơ quay lên (rad) 4.4 x 10--8 1 Góc phương vvịị tham chiếu thực vvà Hình 1. à góc phương vvị ước ước lư l ượng ợng. 174 N. T. Hòa, …, Đỗ ỗ Ngọc Tuấn Tuấn,, ““Mô Mô hình toán h học ọc hệ thống dẫn đđư ường tính.”” ờng quán tính
  7. Thông tin khoa học công nghệ Kết quả mô phỏng (hình 1) cho thấy góc phương vị được tính bằng phương pháp véc tơ qoay (đường nét liền) gần giá trị thực hơn so với phương pháp tính bằng góc Euler (đường nét đứt). Góc phương vị tính theo phương pháp góc Euler nhấp nhô khoảng 140 trước khi hội tụ và phải mất tới 13 giây để hội tụ về giá trị thực. Trong khi đó đối với phương pháp véc tơ quay góc phương vị nhấp nhô khoảng 20 và mất khoảng 3 giây để hội tụ về giá trị thực. Hình 2. Sai số phép đo của phương pháp véc tơ quay. Trên Hình 2 là hình ảnh mật độ nhiễu của các phép đo mô phỏng con quay hồi chuyển trục X, trục Y và trục Z. Các giá trị trung bình của nhiễu trong phép đo trong khoảng từ 15 giây và 50 giây lần lượt tương ứng là 3.5 x 10-6 (rad/s), 3.64 x 10-6 (rad/s), và 5.44 x 10-6 (rad/s). Vì vậy các phương sai của nhiễu được thiết kế cho bộ lọc Kalman thích nghi với sai số tối đa khoảng 2.9%. 5. KẾT LUẬN Tùy theo những ứng dụng thực tiễn, dẫn đường quán tính được mô tả và mô hình hóa bằng thuật toán số và được thể hiện bằng kỹ thuật để giải quyết vấn đề được đặt ra. Ưu điểm của dẫn đường quán tính là chỉ cần dùng thông tin nội tại của bản thân vật thể chuyển động mà không cần các thông tin từ bên ngoài. Tuy nhiên, sai số của dẫn đường quán tính tăng theo thời gian. Chính vì vậy đã có rất nhiều nghiên cứu để cải thiện vấn đề sai số cho các hệ thống dẫn đường quán tính. Một trong các phương pháp hạn chế sai số trong hệ thống dẫn đường quán tính là sử dụng các mô hình động lực học phi tuyến kết hợp với lọc Kalman trong thiết kế hệ thống. Trong bài báo này, chúng tôi cũng đã trình bày về một mô hình IMU với những đánh giá kết quả thực tế thu được. TÀI LIỆU THAM KHẢO [1]. Jay A. Farrell, and Matthew Barth, The Global Positioning System & Inertial Navigation, McGraw-Hill, 1998. Tạp chí Nghiên cứu KH&CN quân sự, Số Đặc san CNTT, 04 - 2019 175
  8. Công nghệ thông tin [2]. Mohinder S. Grewal, Angus P. Andrews, Kalman Filtering Theory and Practice, Prentice Hall, 1993. [3]. Robert Grover Brown, Patrick Y.C. Hwang, Introduction to Random Signals and Applied Kalman Filter, John Wiley & Sons, 1997. [4]. Robert M. Rogers, Applied Mathematics in Integrated Navigation Systems, AIAA, 2000. [5]. Oleg Salychev, Inertial Systems in Navigation and Geophysics, Bauman MSTU Press, Moscow, 1998. [6]. Mohinder S. Grewal, Lawrence R. Weill, and Angus P. Andrews, Global Positioning systems, Inertial Navigation and Integration, Wiley Interscience, 2001. ABSTRACT A MATHEMATICAL MODEL OF INERTIAL NAVIGATION SYSTEMS In controlling flight vehicles, we have to solve navigation problems. One of the navigation methods is inertial navigation without using information from outside the moving object that uses information about the acceleration of the moving object itself to determine the navigational parameters. This paper presents a new dynamic mathematical model of inertial navigation systems. Keywords: Inertial navigation system; Inertial coordinates; Inertial measurement unit; Euler angle. Nhận bài ngày 28 tháng 12 năm 2018 Hoàn thiện ngày 28 tháng 02 năm 2019 Chấp nhận đăng ngày 25 tháng 3 năm 2019 Địa chỉ: Viện Công nghệ thông tin/Viện KH-CNQS. * Email: thaihoa78th@gmail.com. 176 N. T. Hòa, …, Đỗ Ngọc Tuấn, “Mô hình toán học hệ thống dẫn đường quán tính.”
nguon tai.lieu . vn
Kiến trúc - Xây dựng Tự động hoá Điện - Điện tử Kĩ thuật Viễn thông Cơ khí - Chế tạo máy Năng lượng Hoá dầu Hoá học Sinh học