Xác định tọa độ UAV sử dụng phương pháp TDOA

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

Thêm vào BST

Báo xấu

73
lượt xem 5
download

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

Bài viết đề cập phương án sử dụng nguyên lý TDOA để xác định tọa độ cho UAV và xây dựng thuật toán để xác định tọa độ cho UAV từ ba trạm phát tín hiệu, đồng thời đưa ra ví dụ minh họa để chứng minh tính hiệu quả của phương pháp đề xuất.

Chủ đề:

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

Lưu

Nội dung Text: Xác định tọa độ UAV sử dụng phương pháp TDOA

Nghiên cứu khoa học công nghệ XÁC ĐỊNH TỌA ĐỘ UAV SỬ DỤNG PHƯƠNG PHÁP TDOA Phạm Thị Phương Anh1*, Nguyễn Vũ2 Tóm tắt: Dẫn đường và định hướng cho UAV là một vấn đề hết sức quan trọng. Thông thường các hệ thống dẫn đường định vị sử dụng GPS và INS. Trong một số trường hợp khi các hệ thống này không đảm bảo yêu cầu hoạt động cần có phương pháp phụ trợ để đảm bảo chất lượng của hệ thống. Bài báo đề cập phương án sử dụng nguyên lý TDOA để xác định tọa độ cho UAV và xây dựng thuật toán để xác định tọa độ cho UAV từ ba trạm phát tín hiệu, đồng thời đưa ra ví dụ minh họa để chứng minh tính hiệu quả của phương pháp đề xuất. Từ khóa: UAV; GPS; INS; TDOA 1. MỞ ĐẦU Dẫn đường và định hướng cho UAV là một vấn đề hết sức quan trọng. Các hệ thống định vị và dẫn đường trên nền tảng GPS cũng như trên nền tảng INS đã được nghiên cứu phát triển [5, 6]. Tuy nhiên, trong điều kiện có nhiễu tín hiệu GPS không sử dụng được, hệ thống dẫn đường INS sẽ bị sai số tích lũy theo thời gian. Để khắc phục nhược điểm này, dưới đây sẽ trình bày phương pháp định vị dựa trên nguyên lý TDOA. TDOA là phương pháp định vị dựa trên độ lệch thời gian đến và đã được áp dụng cho các hệ thống rada [7] cũng như các hệ thống thông tin di động [8]. Trong đó, phương pháp này được áp dụng để xác định tọa độ các đối tượng di động bằng các phương tiện trên mặt đất, và tín hiệu chủ động là từ các phương tiện di động. Trong thực tế hoạt động của UAV, việc hệ thống điều khiển trên khoang xác định chính xác tọa độ của nó để phục vụ nhiệm vụ của UAV là rất cần thiết. Phương pháp TDOA dùng để xác định tọa độ các đối tượng di động bằng các trạm thu mặt đất cũng có khả năng áp dụng cho mục tiêu di động xác định tọa độ của mình, chỉ có điểm khác biệt là thay bằng các trạm thu, dưới mặt đất sẽ bố trí các trạm phát. Trong bài toán xử lý tín hiệu rada TDOA, nhiều phương pháp tính toán được áp dụng để khắc phục ảnh hưởng của nhiễu tín hiệu từ mục tiêu đến là tín hiệu phức tạp, không biết trước và chứa đựng nhiễu. Các thuật toán này đã được đề cập trong [1-3]. Khác với bài toán xử lý tín hiệu rada TDOA, bài toán xác định tọa độ UAV dựa trên độ chênh lệch thời gian đến sử dụng tín hiệu chủ động đã biết nên việc xử lý đơn giản hơn cho phép xác định chính xác thời điểm tín hiệu tới, chính vì vậy, có thể sử dụng phương pháp đại số tường minh để tính toán. Vấn đề xác định tọa độ của đối tượng di động, cụ thể là phương tiện ngầm cũng được đề cập trong [4] dựa trên khoảng cách từ phương tiện ngầm đến các điểm mốc đặt trước, tuy nhiên, phương pháp xác định khoảng cách từ phương tiện ngầm đến các cột mốc chưa được trình bày. Thuật toán đề xuất dưới đây sử dụng độ chênh lệch thời gian đến từ các cột mốc chuẩn để xác định độ lệch khoảng cách của UAV tới các điểm chuẩn và qua đó xác định tọa độ của UAV. 2. PHƯƠNG PHÁP XÁC ĐỊNH TỌA ĐỘ UAV NHỜ 3 CỘT MỐC CHUẨN Bản chất của phương pháp này là căn cứ vào độ lệch thời gian truyền từ cột mốc gốc và các cột mốc chuẩn khác đến UAV, có thể xây dựng được hệ phương trình Tạp chí Nghiên cứu KH&CN quân sự, Số Đặc san Viện Điện tử, 9 - 2020 69
Kỹ thuật điện tử với 2 ẩn số là tọa độ của UAV, sau đó, tiến hành giải hệ phương trình sẽ xác định được tọa độ của UAV. 2.1. Đặt vấn đề Giả sử, tọa độ của cột mốc gốc là C0  x0 y0 h0  , cột mốc chuẩn 1 là C1  x1 y1 h1  và cột mốc chuẩn 2 là C2  x2 y2 h2  , tọa độ của UAV là Pa  xa ya ha  . Khi đó, ta có hệ phương trình sau:   ha  h0    xa  x0    ya  y0    ha  h0    xa  x1    ya  y1   c * t1 (1) 2 2 2 2 2 2    ha  h0    xa  x0    ya  y0    ha  h2    xa  x2    ya  y2   c * t2 2 2 2 2 2 2   Trong đó, c là vận tốc ánh sáng trong không khí, c = 300.000.000 m/s. Hệ phương trình (1) là hệ phương trình bậc 2 có 2 phương trình và 2 ẩn. Hệ phương trình (1) có thể giải bằng phương pháp tính gần đúng theo thuật toán nhích dần. Để có thể giải một cách tường minh, chọn cách bố trí sao cho các điểm chuẩn C0 , C1 , C2 nằm trên một đường thẳng, không mất tính tổng quát, chọn C0 là gốc tọa độ, đường nối C0 , C1 , C2 là trục hoành. Khi đó, tọa độ các điểm chuẩn là C0  0 0 h0  , C1  x1 0 h1  , C2  x2 0 h2  . Giả sử khu vực hoạt động của UAV nằm giữa mặt phẳng phía trên của hệ tọa độ. Khi đó, ta có hệ phương trình sau:   ha  h0   xa2  ya2   ha  h0    xa  x1   ya2  c * t1  l1 2 2 2   (2)  ha  h0   xa2  ya2   ha  h0    xa  x2   ya2  c * t2  l2 2 2 2   Để tiện trình bày, đặt ya2   ha  h0   da2 . 2 Khi đó, (2) trở thành:  d 2  x 2  d 2   x  x 2  l  a (3a)  2 a a a 1 1 (3)         2  2 2  ad x a d a xa x2 l 2 (3b ) Hai phương trình (3a) và (3b) tương tự nhau. Thực hiện bước biến đổi cho phương trình (3a). Trước tiên ta đổi vế: da2  xa2  l1  d a2   xa  x1  2 (4) Lấy bình phương hai vế: da2  xa2  l12  2l1 da2  xa2  da2   xa  x1  2 (5) Tiếp tục chuyển vế nhận được: 2 xa x1  x12  l12  2l1 d a2  xa2 (6) Lấy bình phương hai vế, nhận được:  l  x12   4 x12 xa2  4 x1  l12  x12  xa  4l12  d a2  xa2  2 2 1 (7) 70 P. T. P. Anh, N. Vũ, “Xác định tọa độ UAV sử dụng phương pháp TDOA.”
Nghiên cứu khoa học công nghệ Chuyển vế về dạng phương trình bậc 2 với ẩn số xa , nhận được:  4x  4l12  xa2  4 x1  l12  x12  xa   l12  x12   4l12 d a2  0 2 2 1 (8) Thực hiện các phép biến đổi tương tự cho phương trình (3b) nhận được:  4x  4l22  xa2  4 x2  l22  x22  xa   l22  x22   4l22 d a2  0 2 2 2 (9) Lấy tích của phương trình (8) với l22 trừ đi tích của phương trình (9) với l12 nhận được phương trình bậc 2 với ẩn xa : ¨ d  v.cos.Δ  u. v. cos Đặt: a   4 x12  4l12  l22   4 x22  4l22  l12  b  4 x1  l12  x12  l22  4 x2  l22  x22  l12  c   l12  x12  l22   l22  x22  l12  Nhận được phương trình bậc 2 : axa2  bxa  c  0 . (10) Với các nghiệm là:  b  b 2  4ac  a1 x   2a  (11)  b  b  4ac 2  xa 2  2a Vấn đề đặt ra là phương trình (10) có nghiệm thực dương hay không và nếu có thì có duy nhất hay không. Điều này được chứng minh bằng các bổ đề sau. 2.2. Bổ đề 1 Quỹ tích các điểm trong nửa mặt phẳng trên có khoảng cách đến hai điểm trên trục hoành không đổi là một đường cong đơn điệu đồng biến hoặc nghịch biến. Chứng minh Phương trình các điểm có khoảng cách đến 2 điểm x0 , x1 là hằng số d được biểu thị bằng phương trình sau: f  x, y   y 2   x  x0   y 2   x  x1   d  const (12) 2 2 df  x, y   1  dy  1  dy    (13)    2 y  2  x  x0     2 y  2  1   x  x  2 y   x  x0  dx 2 2  dx  2 y   x  x1 2 2  dx   df  x, y   1  dx  1  dx     2  x  x0   2 y    2  x  x1   2 y    0 (14) dy  2 y 2   x  x 2  dy  2 y 2   x  x1 2  dy   0  Tạp chí Nghiên cứu KH&CN quân sự, Số Đặc san Viện Điện tử, 9 - 2020 71
Kỹ thuật điện tử Vì f  x, y   const   y y 2   x  x 2  y 2   x  x 2 dx   x  x0  y   x  x1    x  x1  y   x  x0  2 2 2 2  1 0 (15) dy  y 2   x  x0  y 2   x  x1  2 2  y   x  x0  y   x  x1  2 2 2 2   dx   y y 2   x  x1   y 2   x  x0  2 2  (16) dy  x  x  y 2   x  x 2   x  x  y 2   x  x 2 0 1 1 0 Biến đổi mẫu số ta có:  x  x0  y 2   x  x1    x  x1  y 2   x  x0   2 2  2 2    x  x0  y 2   x  x1   y 2   x  x0     x  x0    x  x1   y 2   x  x0  2    x  x1  d   x2  x1  y 2   x  x1  2 (17) Kết hợp (16) với (17) cùng điều kiện (12) nhận được: dx  y.d  (18) dy  x  x  y 2   x  x 2  d  x  x  1 0 1 0 y 2   x  x1   x  x0 và  x1  x0   d nên mẫu số luôn dương. 2 Vì Như vậy, trong nửa mặt phẳng trên, vì y>0 nên  dx  sgn     sgn  d  => x và y đơn điệu đồng biến hoặc nghịch biến (19)  dy  Bổ đề được chứng minh. 2.3. Bổ đề 2 Hai đường cong đồng biến y  f1 ( x) và g  f 2 ( x) nếu có đạo hàm tại mọi điểm dy dg dy dg xi thỏa mãn  (20) hoặc  (21) chỉ có thể cắt nhau tại một dx xi dx xi dx xi dx xi điểm. Chứng minh : Giả sử chúng cắt nhau tại 2 điểm  x1 , y1  và  x2 , y2  Khi đó: y1  g1 , y2  g2 và y2  y1  g2  g1 (22) Tuy nhiên, nếu có điều kiện (20) thì:  x2 dy   x2 dg   y2  y1   dx    g 2  g1   dx   dx   dx   x1   x1  Hoặc nếu có điều kiện (21) thì: 72 P. T. P. Anh, N. Vũ, “Xác định tọa độ UAV sử dụng phương pháp TDOA.”
Nghiên cứu khoa học công nghệ  x2 dy   x2 dg   y2  y1   dx    g 2  g1   dx   dx   dx   x1 x1 dy dg Nên (22) không thể xảy ra. Điều kiện (22) chỉ xảy ra khi  x . dx dx Bổ đề được chứng minh. Kiểm tra điều kiện thỏa mãn bổ đề 2 của hai hàm (12) thứ tự là: f  x, y   y 2   x  x0   y 2   x  x1   d1 ; 2 2 f  x, g   y 2   x  x0   y 2   x  x2   d 2 2 2 dx d1 Khi đó,  y, (23) dy x1 y  x 2  d1 x 2 dx d 2  g (24) dg x2 y  x 2  d 2 x 2 Tại điểm y  ya và g  ya , lấy hiệu 2 phương trình (23) và (24). dx dx d1 x2 y  x  d1d 2 x  d 2 x1 y  x  d1d 2 x 2 2 2 2      ya dy dg x1 y 2  x 2  d1 x x2 y 2  x 2  d 2 x y 2  x 2  d 2 x1  d1 x2      ya (25) x1 y 2  x 2  d1 x x2 y 2  x 2  d 2 x vì d2 x1  d1 x2  const và các thành phần còn lại của (25) đều lớn hơn “0” nên  dx dx  sgn  1  2   const (26), có nghĩa là luôn thỏa mãn các điều kiện (20) và (21).  dy dy  Kết hợp bổ đề 1 và bổ đề 2 cùng với các điều kiện thỏa mãn bổ đề 2 (26) ta thấy phương trình (10) sẽ có 1 bộ nghiệm thực dương và đây là nghiệm duy nhất. Trên cơ sở thuật toán xác định tọa độ UAV nhờ 3 cột mốc chuẩn sẽ được xây dựng. 3. THUẬT TOÁN XÁC ĐỊNH TỌA ĐỘ UAV SỬ DỤNG 3 CỘT MỐC CHUẨN 3.1. Thuật toán Bước 1. Xác định thời điểm các xung chuẩn đến UAV. Để cho các xung không cần phải mang thông tin về điểm xuất phát, cho xung từ cột mốc 1 đi trước 1 khoảng  từ cột mốc 2 và xung từ cột mốc 2 đi trước xung từ cột mốc 3 một  x x   x x   x x x x  khoảng  với   max  1 0  ,  2 1   ;   max  1 0 . 2 0  (27)  c   c    c c  Các thời điểm đó là t0 , t1 , t2 . Tạp chí Nghiên cứu KH&CN quân sự, Số Đặc san Viện Điện tử, 9 - 2020 73
Kỹ thuật điện tử Bước 2. Xác định độ lệch khoảng cách giữa UAV đến cột mốc thứ nhất với các cột mốc thứ 2 và thứ 3 là: l1   t1  t0    .c , l2   t2  t0  2  .c Bước 3. Giải hệ phương trình (10) tìm các nghiệm xa1 , xa 2 . Đặt xa1 và xa 2 vào phương trình (7) xác định d a . Chọn cặp nghiệm xai , d a là số thực dượng, d a  0 gọi xai là xa . Bước 4. Xác định độ cao ha bằng khí áp kế. Bước 5. Xác định tọa độ ya theo công thức: ya  da2   ha  h0  2 Tọa độ của UAV sẽ là M  xa , ya , ha  . 3.2. Ví dụ thực hiện thuật toán 3.1 Ví dụ 1: Bước 1. Giả sử các điểm chuẩn D0  0;0  ;D1  20.000;0  ;D2  40.000;0  Tọa độ thực của UAV là M1  5000;10000 m . 42 Theo (26) chọn    0,14ms. 300 Xác định tọa độ UAV cho hai trường hợp với độ chính xác thời gian đo thời gian khác nhau. a) Thời gian tín hiệu đi từ cột mốc 0,1,2 đến mục tiêu thứ tự là: (Đo thời gian với độ chính xác là 0,1ns) t0 (s)  37, 2678 ; t1 (s)  60,0925  1.400 ; t2 (s)  121,3355  2.800 Bước 2. Xác định độ lệch khoảng cách  c  0,3km / s  l1   t1  t0    .c  22,8247.0,300  6,84741 km  l2   t2  t0    * c  84,0674*0,300  25, 22022  km  Bước 3. Giải phương trình (10) xác định xa và từ đó xác định d a Nhận được xa  5,000020439 ; da  9,9999 Bước 4,5. Giả sử độ cao khí áp kế là ha  h0 bằng độ cao cột phát sóng khi đó: ya  da2   ha  h0   d a  9,9999 2 b) Thời gian tín hiệu đi từ cột mốc 0,1,2 đến mục tiêu thứ tự là: (Đo thời gian với độ chính xác là 10 ns) t0 (s)  37, 26 ; t1 (s)  60,09  140 ; t2 (s)  121,33  280 Bước 2. Xác định độ lệch khoảng cách: l1   t1  t0    .c  22,83.0,300  6,849  km  l2   t2  t0    * c  84,07*0,300  25, 221 km  Bước 3. Giải phương trình (10) xác định xa và từ đó xác định d a . 74 P. T. P. Anh, N. Vũ, “Xác định tọa độ UAV sử dụng phương pháp TDOA.”
Nghiên cứu khoa học công nghệ Nhận được xa  4,9984 ; da  10.0013. Bước 4,5. Giả sử độ cao khí áp kế là ha  h0 bằng độ cao cột phát sóng khi đó: ya  da2   ha  h0   da  10.0013 2 Nhận xét: Nếu đo thời gian với độ chính xác 0,1ns thì sai số vị trí là  0;0,1 m. Nếu đo thời gian với độ chính xác 10ns thì sai số vị trí là 1, 6;1,3 m. Ví dụ 2: Bước 1. Giả sử các điểm chuẩn D0  0,0  ;D1  20.000,0  ;D2  40.000,0  Tọa độ thực của mục tiêu M1  7000,15000  . 42 Theo (26) chọn    0,14ms. 300 Thời gian tín hiệu đi từ cột mốc 0,1,2 đến mục tiêu thứ tự là: t0 (s)  55,1765 ; t1 (s)  66,1648  140 ; t2 (s)  120,8305  280 Bước 2. Xác định độ lệch khoảng cách: l1   t1  t0    .c  10,9883.300  3, 29649  km  l2   t2  t0    * c  65,6540*300  19,6962  km  Bước 3. Giải phương trình (10) xác định xa và từ đó xác định d a . Nhận được xa  7,000001455 ; da  14,9997. Bước 4,5. Giả sử độ cao khí áp kế là ha  h0 bằng độ cao cột phát sóng khi đó: ya  da2   ha  h0   da  14,9997. 2 4. KẾT LUẬN Các thuật toán và các ví dụ cụ thể trình bày trên cho thấy, phương pháp TDOA áp dụng cho đối tượng di động, hay phương pháp “TDOA đảo” là một giải pháp đơn giản dễ áp dụng và bảo đảm tính ổn định của quá trình xác định tọa độ đối tượng di động phục vụ cho điều khiển đối tượng thực hiện các mục đích khác nhau. Phương pháp đề xuất có thể ứng dụng trong UAV hoặc các phương tiện bay khác khi có các hệ thống cơ sở hạ tầng đồng bộ. Tuy nhiên, để hoàn chỉnh phương pháp này cần tiếp tục nghiên cứu về khả năng chống nhiễu của các tín hiệu truyền đến cả về mặt kỹ thuật và chiến thuật, đồng thời đánh giá sai số của phương pháp một cách toàn diện. TÀI LIỆU THAM KHẢO [1]. Phạm Quyết Thắng, Nguyễn Mạnh Cường, “Thuật toán nâng cao độ chính xác định vị mục tiêu trong rađa thụ động TDOA”, Tạp chí Nghiên cứu Khoa học và Công nghệ quân sự, Số 33, 10/2014, tr.28-35. [2]. Phạm Quyết Thắng, Trần Văn Hùng, Vũ Văn Đáng, Phạm Văn Toàn, “Nâng cao độ chính xác định vị mục tiêu trong hệ thống rađa thụ động TDOA bằng thuật toán di truyền”, Tạp chí Nghiên cứu Khoa học và Công nghệ quân sự, Số 40, 12/2015, tr.63-69. Tạp chí Nghiên cứu KH&CN quân sự, Số Đặc san Viện Điện tử, 9 - 2020 75
Kỹ thuật điện tử [3]. Phạm Quyết Thắng, Trần Văn Hùng, “Nghiên cứu sử dụng thuật toán tiến hóa vi phân tăng tốc độ hội tụ và nâng cao độ chính xác định vị mục tiêu trong hệ thống ra đa thụ động TDOA”, Tạp chí Nghiên cứu Khoa học và Công nghệ Quân sự, Số 42, 4/2016, tr.51-59. [4]. Phạm Văn Phúc, Trần Đức Thuận, Nguyễn Việt Anh, Nguyễn Quang Vịnh , “Xây dựng thuật toán xác định vị trí và tư thế cho phương tiện ngầm”, Tạp chí Nghiên cứu Khoa học và Công nghệ Quân sự, Số 56, 8/2018, tr.3-13. [5]. Q. Honghui, J.B.Moore , “Direct Kalman filtering approach for GPS/INS imtergration”, IEEE Transactions on Aerospace and Electronic Systems, pp. 687–693, Apr 2002. [6]. F. Caron, E. Duflos, D. Pomorski, and P.Vanheeghe, “GPS/IMU data fusion using multisensor Kalman filtering; introduction of contextual aspects”, Information Fusion, pp. 221-230, 2006. [7]. J.Zh,L.Tao, and Y. Hong, “Study on moving target detection to passive radar based on fm broadcast transmitter,” Journal of Systems Engineering and Electronic, vol. 18, no. 3, pp.462,2007. [8]. C.Drane, M.Macnaughtan, and C.Scott, “Positioning GSM telephones”, IEEE Communication Magazine, vol.36.no Apr 1998 [9]. S.Drake, K.Brown, J.Fazackerley, and A.Finn, “Autononous control of multiple UAVs for the passive location of radas,” In Intelligent Sensor, Sensor networks ang iinformation processing conference, 2005, proceedings of the 2005 intermation conference on, pp. 403-409, dec 2005. ABSTRACT DETERMINING UAV COORDINATE THE USE OF TDOA Locating and directing are the two most important prerequisites for controlling mobile vehicles. Typically, guidance systems rely on GPS or INS. In certain circumstances, these system cannot ensure reliability, therefore requiring an alternative method to maintain operation. The article mentions a guidance method using the TDOA principle in order to identify the device's coordinates, and build an algorithm for coordination using a trio of transmitters. Examples are included to prove the effectiveness of the proposed method. Keywords: GPS; INS; TDOA. Nhận bài ngày 30 tháng 3 năm 2020 Hoàn thiện ngày 24 tháng 8 năm 2020 Chấp nhận đăng ngày 28 tháng 8 năm 2020 Địa chỉ: 1 Viện Tự động hóa KTQS, Viện KHCN quân sự; 2 Cục Khoa học quân sự/BQP. * Email: ptpanh2003@yahoo.com. 76 P. T. P. Anh, N. Vũ, “Xác định tọa độ UAV sử dụng phương pháp TDOA.”