Кораблев В.Г. и др. Проверка достоверности определения координат... УДК 629.5.058.53 : [621.396.333 : 629.783] : 656.61.052
Проверка достоверности определения координат движущегося судна с помощью двух разнесенных приемников GPS
В.Г. Кораблев, С.В. Пашенцев, Ю.И. Юдин
Судоводительский факультет МА МГТУ, кафедра судовождения
Аннотация. В работе рассмотрен принцип обработки данных о местоположении движущегося судна, поступающих от двух разнесённых на объекте приёмников глобальной спутниковой навигационной системы (GPS). Определен метод "отсеивания" недостоверных измерений по сравнению полученных по результатам измерений расстояний между приёмниками с заранее известной величиной разнесения.
Abstract. The foundations of movable vessel's position data proceeding from two distant GPS-receivers has been considered in the work. The method of filtering inadequate measurements by comparison the distance (obtained in measurements) between GPS-receivers with known in advance diversity value has been worked out in the paper.
Ключевые слова: спутниковые навигационные системы, точность определения местоположения судна Key words: satellite navigation systems, accuracy of vessel position localization
1. Введение
Современные средства спутниковой навигации позволяют определять местоположение габаритного объекта с точностью, превышающей в несколько раз габаритные размеры самого объекта. Поэтому знание местоположения только центра масс морского подвижного объекта становится недостаточным, например, при маневрировании в ограниченных акваториях или движении по каналу. В таких случаях для судоводителя является важным знание действительного местоположения, например, контурных точек объекта. Для судна, как твердого тела, достаточно знать положение только двух точек, чтобы определить положение любой точки (Пашенцев, 2000).
При использовании двух разнесённых приемников GPS мы получаем информацию о местоположении двух точек объекта, расположенных на известном расстоянии друг от друга. В этом случае возникает необходимость оценки достоверности информации о положении выбранных точек объекта, с целью её дальнейшего использования при построении траектории движения объекта (судна) или зоны его навигационной безопасности.
2. Постановка эксперимента
Для проведения натурных экспериментов были использованы два 32-х канальных приемника "Qstarz BT-Q818", выполненные на чипсете МТК. Был разработан программный модуль обработки выходного протокола данных NMEA-0183 для построения алгоритма фильтрации сигнала при определении грубых промахов в измерениях. Эксперименты проводились в районах Баренцева (п. Мурманск), Северного (п. Ставангер) и Охотского морей (п. Холмск). Данные о местоположении приемников (разнесенных и с совмещенной базой) записывались и затем обрабатывались с целью получения информации о величине расчетного расстояния между приемниками.
3. Оценка расстояния между приёмниками
Поскольку расстояние L между приёмниками известно с высокой точностью (например, они разнесены по оконечностям судна по длине), то вычисленное по полученным от приёмников координатам расстояние между ними можно сравнивать с "истинным". При этом критерием "отсева" получаемых при движении судна координат является соответствие, в заданных пределах, значений расчётного и истинного расстояния между точками расположения приёмников. Данный принцип актуально применять на подвижном объекте, когда из-за постоянного изменения позиции объекта (судна) набрать достаточную статистику и точно оценить СКП места представляется затруднительным.
Рассмотрим два приёмника, расположенных на расстоянии Lист друг от друга, назовём это расстояние "базой". Очевидно, что величина L будет определяться по формуле:
L = V(X 2 - X1)2 + (Y2 - YJ2 ,
где X2, X\, Y2, Yi - координаты, получаемые от двух приёмников, переведенные в абсолютные прямоугольные координаты на плоскости. При обработке координат использована универсальная поперечная проекция Меркатора, поэтому все величины выражены в метрах.
В реальных условиях рассчитанная величина Ь отличается от "базы" из-за наличия в измерениях случайных погрешностей:
L =V«X
2) - (X1 + £х1)) + (Y + e72) - Y + e7,)Г , где £xi, &X2, £y1, £y2 - величины случайных погрешностей "север-юг" и "восток-запад" составляющих каждого приемника, которые, как известно, имеют нормальное распределение с параметрами ¿Цхь Мх2, №1, My2 и 0X1, 0X2, On, Cy2, рассчитываемыми по результатам серии измерений на неподвижном судне.
На рис. 1 представлены результаты натурного эксперимента, проведенного на судне с приёмниками GPS, разнесёнными по бортам судна (база Luст = 19 м) в виде " треков" двух приёмников, а также в виде окружностей полученные СКП и предельные СКП места, которые, соответственно, равны: СКП, = 6,242 м, СКП2 = 5,817 м,
СКП, Пред = 12,483 м, СКП2пред = 11,634 м.
Для оценки степени достоверности координат, полученных одновременно от двух разнесённых приёмников GPS, следует построить функцию плотности вероятности величины
L = Л/(X2 - X1)2 + (Y2 - Y1)2 ,
c помощью которой рассчитать доверительный интервал с заданной надёжностью, и затем использовать границы интервала для определения грубых "промахов" в определении координат на движущемся объекте. Попытаемся это сделать с помощью прямого преобразования функций плотности вероятности.
Возьмем для начала самый простой случай, когда антенны приёмников расположены в одной точке, то есть база Lu,ст = 0, т.е. X2 = Xb Y2 = Yb Будем считать, что случайные величины X2, Xb Y2, Y1 независимы, и имеют одинаковую дисперсию 0X1 = 0x2 = On = 0Y2 = о.
Тогда выражение
L — J (( X 2 + £ X 2) - ( X 1 + £ X1))2 + (( Y 2 + £y 2) - (Y1 + £Y 1))
можно записать в виде
L — (£ X 2 £ X 1) + (£Y 2 £Y 1)
(1) (2)
Выполнить прямое преобразование плотности вероятности этого выражения представляется сложным, поэтому мы рассмотрим центрированные (несмещённые) случайные величины
(£х 1 - £х 1 ) , 2 — ¿х 2 ) , 1 — 1) , 2 — 2), где ¿х 1 , £х 2 ,£г 1 ,£т 2 - значения математических ожиданий соответствующих случайных величин.
V«
) (£ X1 £ X1 )) + (( £ Y 2 £Y 2 ) (£Y 1 £Y 1)) —
+ £ X1 £X 2 ) + (£Y 2 £Y1 + £Y1 £
(3)
При условии, что база Ь = 0 м, то есть антенны двух идентичных приёмников расположены в одной точке, уместно предположить, что равны и величины математических ожиданий случайных
погрешностей (£х 1 2 =£т 1 =£т2 ). Тогда:
V(£ X 2 "^X1 + £ X1 £ X 2 ) + (£Y 2 Y1 + ^Y1 Y 2 )
— V(£ X 2 - £ X 1) + (£ Y 21 - £ Y 1) — L .
(4)
Таким образом, в случае, когда антенны приемников совмещены, величину Ь можно вычислять, как функцию несмещённых случайных величин. Функция плотности вероятности нормально распределённой несмещённой случайной величины имеет вид (Соколов, Чистякова, 2005):
1 ^
P ( X ) —
о
л/2п
(5)
X 2
)
2
X1
e
Кораблев В. Г. и др. Проверка достоверности определения координат.
Функция плотности вероятности разности двух нормально распределённых несмещённых
случайных величин имеет вид:
Р (х 2 - х J = Р ( У 2 - У1) =
1
(o х 1 + ^ х
_1_^
(О y 1 + О У ^
2 <Ох 1 + О х 2 ) 2 _
1
2■(оy! +Оy 2)2
2о v2п 1
- e
2о422П
(6)
у 1 ^ у 2 .
Функция плотности вероятности разности двух нормальных несмещённых величин, возведённых в квадрат, имеет вид:
Р (( х 2 - х 1 ) 2 ) =
Р )
1
Р (( У 2 - У1)2) =
л/хГ 2 О л/2
Р(УУ) = 1
4у 2e^[2
к ■ х
(7)
п ■ У
Чтобы определить функцию плотности вероятности суммы квадратов разностей, необходимо выполнить свертку плотностей:
Р ( х ) = J Р1( х ) Р2( х - t) dt = J
1
1
jL 2о yj2п ■ х
2о^/2п (х - t)
-( х - t )
8 О :
dt
(8)
4 а ^к ■ х
Определение функции плотности вероятности при извлечении из выражения квадратного корня:
Р(z = л[х ) = Р(х) ■ |х 1
■ 2 х
4 Сл/п^ х а42ж
Формула (9) есть ни что иное, как функция плотности вероятности гамма-распределения вида:
(9)
K
Яс
Г (с)
где с = 1.5, Я = 1/8о2, К = 8 о2.
На рис. 2 изображены графики полученной функции плотности вероятности искомой величины L для различных значений О.
На рис. 3 представлены траектории двух приёмников с совмещённой базой L = 0 (вверху), построенные по экспериментальным данным, и гистограммы частот распределения величины L (внизу), рассчитанной по координатам, полученным от двух приёмников GPS в одинаковые моменты времени. Пунктирной кривой на рисунках показан график гамма-функции с параметрами Я = 1 и c = М(Ь). Сплошной кривой показан график гамма-функции с параметрами Я = 1 и c = 1,5. В табл. 1 приведены выборочные моменты, коэффициент ассиметрии и эксцесс для рассматриваемых данных.
На рис. 4 представлены траектории двух приёмников с разнесенной базой L (левая колонка), построенные по экспериментальным данным, и гистограммы частот распределения величины L (правая колонка), рассчитанной по координатам, полученным от двух приёмников GPS в одинаковые моменты времени. Из полученных результатов натурных испытаний видно, что функция плотности распределения величины L так же, как и в случае с совмещенными приемниками, с достаточной достоверностью описывается гамма-функцией (показана на рисунке сплошной линией). Для сравнения пунктиром показан график нормально распределённой величины, построенный с использованием выборочных данных. В табл. 2 приведены выборочные моменты, коэффициент ассиметрии и эксцесс для рассматриваемых данных.
Задавая необходимый доверительный интервал для значения L, можно отсеивать те значения полученных координат от приёмников, по которым вычисленная величина L не попадает в заданный интервал. Последствия применения такого "фильтра" представлены графически на рис. 5 в виде исходных треков приёмников и треков, прошедших обработку, с различными значениями доверительного интервала для расстояния между приёмниками.
х
х
8 о
8О
х
8О
e
- У
8о
e
-х
8О
e
e
- х
8 О
.2
хс-1 e ~Ях
Таблица 1. Числовые характеристики выборки по данным двух совмещенных приемников
Выборочный Выборочный Выборочный Выборочный Коэффициент Выборочный
момент момент ц2 момент ц3 момент /14 ассиметрии эксцесс
1 1,68 1,026 1,173 4,347 1,13 1,135
2 1,252 0,528 0,353 0,955 0,92 0,427
3 1,716 1,814 0,346 1,773 0,464 -0,376
4 2,282 2,819 6,19 47,24 1,308 2,944
Рис. 3. Траектории движения двух совмещенных приёмников GPS и гистограммы частот рассчитанного расстояния между приемниками
Таблица 2. Числовые характеристики выборки по данным от двух разнесенных приемников
Выборочный Выборочный Выборочный Выборочный Коэффициент Выборочный
момент /!1 момент ц2 момент момент /14 ассиметрии эксцесс
1 21,907 5,916 80,988 3820,000 0,392 0,132
2 10,155 11,055 23,146 454,431 0,629 0,716
3 13,86 12,902 -7,217 534,549 -0,156 0,212
4 12,899 10,304 -2,409 254,315 -0,073 -0,605
Рис. 4. Траектории движения двух разнесённых приёмников GPS и гистограммы частот рассчитанного расстояния между приёмниками
Кораблев В.Г. и др. Проверка достоверности определения координат
Рис. 5. Траектории движения двух разнесенных приемников GPS до и после обработки 4. Заключение
Для проверки достоверности определения местоположения движущегося объекта с применением двух разнесённых приёмников GPS целесообразно по полученным координатам вычислять расстояние между приёмниками, сравнивая полученную величину с истинным значением "базы" Lucm, принимая полученные координаты в случае попадания в заранее определенный интервал с заданным значением надёжности. В случае использования идентичных приемников с одинаковой систематической погрешностью, при расчете величины L, она будет свободна от этих погрешностей, поскольку при вычитании (X - X\ и Y2 - Y1) они будут компенсироваться.
Недостатком данного метода является "отсеивание" координат от обоих приёмников в случае, если фактически только один из них дает точное местоположение, а второй с погрешностью, превышающей заданные пределы.
Литература
Пашенцев С.В. Построение зоны навигационной безопасности объекта и его кинематических характеристик на основе обсервации двух разнесенных точек объекта. Вестник МГТУ, т.3, № 1, c.13-16, 2000.
Соколов Г.А., Чистякова Н.А. Теория вероятностей. Учебник. М., "Экзамен", 416 с., 2005.