CC BY
159
УДК 519.711.3
UDC 519.711.3
МЕТОД ОПРЕДЕЛЕНИЯ КООРДИНАТ И ПАРАМЕТРОВ ДВИЖЕНИЯ НЕЛИНЕЙНО ДВИЖУЩЕГОСЯ ОБЪЕКТА С ИСПОЛЬЗОВАНИЕМ ТОЛЬКО УГЛОМЕРНОЙ ИНФОРМАЦИИ
Пюннинен Сергей Александрович Северо-западный государственный заочный технический университет, Санкт-Петербург, Россия
В статье рассмотрен метод расчета оценки траектории нелинейно движущегося объекта с использованием только угломерной информации. Метод обладает свойствами непрерывности, робастности и позволяет повысить точность определения параметров движения по сравнению с существующими методами
Ключевые слова: ТРАЕКТОРНЫЙ АНАЛИЗ, АПРОКСИМАЦИЯ, НЕЛИНЕЙНОЕ ДВИЖЕНИЕ, УГЛОМЕРНАЯ ИНФОРМАЦИЯ, ПАРАМЕТРЫ ДВИЖЕНИЯ
METHOD OF DETECTION OF COORDINATES AND MOTION PARAMETERS FOR NONLINEAR MOTION OBJECT USING BEARINGS-ONLY INFORMATION
Pyunninen Sergei Alexandrovich North-West State Technical Universities,
St. Petersburg, Russia
The article describes the method of calculating the estimation trajectory of a nonlinear moving object using bearings-only information. The method has the properties of continuity, robustness, and improves the accuracy detection of the parameters motion in comparison with existing methods
Keywords: TRAJECTORY ANALYSIS, APPROXIMATION, NONLINEAR MOTION, BEARINGS-ONLY INFORMATION, MOTION PARAMETERS
Одними из наиболее сложных видов алгоритмов в навигационных системах, являются алгоритмы определения координат и параметров движения объектов (КПДО) по угломерной информации [1,2,5]. На сегодняшний день, существует несколько математических методов пригодных для реализации указанных алгоритмов, при этом каждый из них обладает рядом существенных ограничений в области определения КПДО нелинейно движущихся объектов [3,4,6,7]. Применение методов системного анализа позволило нам сформулировать новую постановку задачи и выработать на её основе новый метод решения, обладающий рядом существенных преимуществ.
Постановка задачи
Объект наблюдения (ОН) движется в двумерном пространстве по
гладкой траектории, которая представляет собой функцию вектора
координат от времени, и заключает в себе всю полноту информации о положении, параметрах и характере движения наблюдаемого объекта.
Траектория наблюдателя, описывается аналогичной функцией, полагающейся известной и адекватной реальным положению и параметрам движения наблюдателя.
В дискретные моменты времени ti, выбранные на равномерной сетке с началом координат t0 и шагом At, наблюдатель осуществляет измерение угла пеленга на объект наблюдения P(t). Под углом пеленга понимается угол между направлением на север и направлением на объект наблюдения.
Наблюдение угла пеленга производится с некоторой ошибкой -называемой ошибкой измерений и считающейся распределенной по нормальному закону распределения [2].
Необходимо по данным наблюдения восстановить траекторию движения цели с заданной точностью.
Метод ^полиномов
Задача построения траектории объекта наблюдения представляет
собой задачу построения функции аппроксимирующей некие дискретные значения, полученные в результате обработки наблюдений.
Для решения этой задачи требуется ввести функцию реализующую связь данных наблюдения с оцениваемыми параметрами.
Сделаем это посредством задания уравнения прямой, проходящей через позиции наблюдателя и ОН и являющейся линией пеленга (рисунок 1).
/ х,у О X
Рисунок 1. Определение линии пеленга на ОН.
X, у - координаты наблюдателя, х, у - координаты ОН, Р - угол
пеленга на ОН.
Уравнение прямой имеет вид:
У - У = К (X - Х ), (1)
где К - линейный угловой коэффициент.
Будем полагать, что наблюдатель движется по траектории,
описываемой функциями X = X(т), у = у (т).
Для нахождения функции траектории движения объекта построим аппроксимирующие функции координат от времени наблюдения
х = х(т), у = у(т), выражая их посредством линейной комбинации ортогональных многочленов, например полиномов:
| х(т) = а0Т0 (т) + «12;(т) +... + апТп (т)
1 У(т) = Шт)+Шт) +... + ЬпТп (т), (2)
где
Тп (т)- полиномы Чебышева 1-го или 2-го рода [8];
те [—1;1] - приведенное время наблюдения.
Сетку дискретизации для каждого из г е [1,т] измерений рассчитаем по формуле:
21 -1 - ^
г 1_____________________________т_
t -1,
т1
(3)
где - время I -того наблюдения, ^ - время первого наблюдения, tm - время последнего наблюдения.
В ходе решения задачи, мы получаем данные о положении наблюдаемого объекта в виде углов пеленга р, которые затем
преобразуются в угловые коэффициенты к для уравнения (1) следующим образом:
В силу вычислительных особенностей тригонометрических функций, присутствующий в данных наблюдения углов пеленга шум оказывает неравномерное воздействие на точность вычислений при различных значениях аргумента функции.
Для минимизации влияния шумовых возмущений для каждого уравнения наблюдения будем осуществлять тождественное преобразование координат, поворачивающее базовую систему координат таким образом, чтобы углы наблюдения в новой системе координат были близки к 0°.
Для этого, осуществим поворот координат на угол а, который будем выбирать таким образом, чтобы а = р / 2 - р. При этом угловой коэффициент кі в уравнении (1) примет вид:
Запишем координаты объекта наблюдения в системе повернутых координат
Аналогичные преобразования выполним и для координат наблюдателя.
Переписав уравнение (1) для повернутой системы координат и сгруппировав известные члены в правую часть, получим:
к, = (г (р - р, 1=^ (р),
V У
(4)
ха, = х, с°8(а)+у, 8іп(а)
Уаг = Уг ) - Хг У
(6)
Учитывая (5) и подставив (6) в (7) получим:
Уі 00$(ц ) - X 8Іп(Ц ) = Уі С08(а ) - Хі 8Іп(Ц )•
(8)
Обозначим Бі = соб(ц), Сі = Бт(ц )•
Для удобства запишем (8) как :
БіУі- СіХі = Біуі- СіХ •
(9)
Подставив аппроксимирующие функции (2) в (9) для каждого из произведенных наблюдений, а затем, преобразовав полученную систему к матричному виду, получим матричное уравнение:
АХ = ^, (10)
где
( ВТ0(Ті) ■■■ Бі Тп(т) -СіГ0(Гі) - -СТ(т) ^
V БтТ0(Тт ) - БтТп (Тт ) СтТ0 (Тт ) - -СтТп (Тт )
(11)
т п т
х = (ъо - ьп, ао ■■■ ап )Т;
(12)
Б^У1(Т1) - С1 Х1(Т1)
БтУт (Тт ) - СтХт (Тт )
(13)
Здесь (11) представляет собой матрицу наблюдений, а (13) вектор столбец, содержащий координаты наблюдателя.
Решив систему (10) относительно X, мы найдем коэффициенты
Ъ0 - Ъп , «0 - ап •
Подставив найденные коэффициенты (2), мы получим искомые функции, определяющие траекторию движения объекта наблюдения.
Применение системы ортогональных полиномов Чебышева позволяет вести наблюдения за объектом на равномерной временной сетке, при этом количество измерений может превышать 2*п, где п- степень полинома, аппроксимирующего траекторию объекта.
В данном случае, необходимо привести матрицу А к квадратному виду. Для решения данной задачи воспользуемся широко применяемым методом наименьших квадратов, который позволит осуществить дополнительную фильтрацию измерений. В результате система (10) примет вид:
АТАХ = Ат¥. (14)
Дальнейшее решение системы осуществляется аналогично решению системы (10).
Сравнительный анализ точности определение параметров движения
для исследуемых методов
Далее приведем основные результаты сравнительного
моделирования ошибки определения дистанции до наблюдаемого объекта по методу К-пеленгов и Методу К- полиномов.
На рисунках 2-5 представлены результаты для различных типов движения объекта наблюдения.
Ось э
Рисунок 2. Ошибка определения дистанции до ОН, при равномерном
прямолинейном движении.
Заштрихованная поверхность - метод ^пеленгов; Каркасная поверхность - метод ^полиномов.
Рисунок 3. Ошибка определения дистанции до ОН при равноускоренном прямолинейном движении. Заштрихованная поверхность - метод ^пеленгов; Каркасная поверхность - метод ^полиномов.
Рисунок 4. Ошибка определения дистанции до ОН при нелинейном
движении.
Заштрихованная поверхность - метод ^пеленгов; Каркасная поверхность - метод ^полиномов.
Рисунок 5. Ошибка определения дистанции до ОН при равномерном
движении с изменением курса.
Заштрихованная поверхность - метод ^пеленгов; Каркасная поверхность - метод ^полиномов.
Распределение осей на графиках 2-5:
- Ось К- порядковый номер дискретного наблюдения;
- Ось Б- максимальный уровень шума при наблюдении угла пеленга (в угловых минутах);
- Ось Е- ошибка определения дистанции (в % от дальности до ОН).
Для каждого, представленного на графике типа движения расчет произведен по данным серии из 1000 вычислительных экспериментов.
Параметры экспериментов: моделирование шума определения угла наблюдения по нормальному закону с макс. уровнем шума - 60', время наблюдения - 600 с., период дискретных наблюдений - 15 с., начальная дистанция до наблюдаемого объекта - 3000 м.
Рис. 2 показывает практическую эквивалентность исследуемых методов для случая равномерного прямолинейного движения ОН. Из приведенных на рис. 3-5 графиков видно, существенное улучшение точности определения дистанции при использовании метода К-полиномов для нелинейно движущегося объекта.
Сводные данные по проведенным сравнительным исследованиям точности определения КПДО для различных типов движения, приведены в
Таблице 1.
Таблица 1 - СРАВНЕНИЕ ТОЧНОСТИ ОПРЕДЕЛЕНИЯ КПДО ПО МЕТОДУ К-ПЕЛЕНГОВ И МЕТОДУ К-ПОЛИНОМОВ
Макс. Ошибка определения Ошибка определения
Тип движения уровень дистанции, % модуля скорости, %
объекта шума, Метод N Метод N Метод N Метод N
угл. мин. пеленгов полиномов пеленгов полиномов
Равномерное 10' 0,02-3 0,01-1,5 0,01 -1,5 0,01 -1,3
прямолинейное 60' 3-8 2,5-6 3-12 8 - 2,
Равноускоренное 10' 15-80 1-40 25-100 1-30
прямолинейное 60' 35-190 15-80 35-150 17-90
По параболе с 10' 60-350 10-40 60-280 5-32
постоянным ускорением 6 о 80-420 25-65 70-350 22-45
Равномерное с 10' 70-400 15-50 60-340 12-48
изменением курса 60' 80-450 25-70 80-410 22-57
Обсуждение результатов
Предложенный метод относится к классу геометрических методов и
обладает значительной вычислительной простотой и позволяет:
1) осуществлять адекватную оценку траекторий ОН различного уровня сложности, в том числе и нелинейных траекторий;
2) осуществлять последующую оценку вектора скорости, ускорения, скорости изменения ускорения ОН, путем анализа функции координат ОН от времени;
3) осуществлять непрерывное решение задачи, в не зависимости от параметров движения ОН;
4) формировать более точные оценки КПДО по сравнению с применяемым на практике методом N-пеленгов, в случаях нелинейного движения наблюдаемого объекта;
5) осуществлять решение задачи в трехмерном пространстве. Для этого потребуется дополнить систему (2) уравнением, учитывающим высоту места наблюдаемого объекта, и расширить матричное уравнение (10) соответствующими уравнениями наблюдения.
Метод может быть применен:
1) в качестве самостоятельного метода определения КПДО нелинейно движущихся ОН;
2) в качестве альтернативного метода определения параметров движения линейно движущихся объектов;
3) в качестве метода выработки предварительных оценок в составе адаптивных и других методов, требующих задания предварительных оценок параметров движения объектов.
Список используемой литературы
1. Benlian Xu. An adaptive tracking algorithm for bearings-only maneuvering target /
Benlian Xu, Zhiquan Wang // IJCSNS International Journal of Computer Science and
Network Security, 2007.- January. Vol. 7, no. 1. - Pp. 304-312.
2. Hammel S.E. Optimal observer motion for localization with bearing measurements / S.E.Hammel, P.T.Liu, E.J.Hilliard, K.F.Gong.- Computers and Mathematics with Applications:-18 (1-3).-1989.- pp. 171-180.
3. Landelle B. Robustness considerations for bearings-only tracking/B. Landelle/ Information Fusion 11th International Conference on - France: Thales Optronique, Universite Paris-Sud, - 2008. - P. 8
4. Li. R. Survey of maneuvering target tracking. part I. dynamic models. /R. Li and V.P. Jilkov/Aerospace and Electronic Systems,- IEEE Transactions on 39(4), 2004.-Pp. 1333-1364.
5. Middlebrook D.L. Bearings-only tracking automation for a single unmanned underwater vehicle: Thesis (S.M.) Massachusetts Institute of Technology, Dept. of Mechanical Engineering, 2007.
6. Sang J.S. Input estimation with multiple model for maneuvering target tracking / Sang Jin Shin, Taek Lyul Song// Control Engineering Practice, 2002.-December. Vol. 10, no. 12. - Pp. 1385-1391.
7. Кудрявцев К. В. Исследование и разработка метода рационального определения параметров движения морских объектов по угломерной информации. / К. В. Кудрявцев/ Дис. канд. техн. Наук. - Москва, 2006.- 116с.- РГБ ОД, 61: 065/3066.
8. Павлов Б.В., Современные методы навигации и управления движением: модели и методы обработки информации в задачах управления движением / Б.В.
Павлов, Д. А. Г ольдин// Общероссийский семинар «Проблемы управления»// Институт проблем управления им. В.А. Трапезникова РАН.- 2010. - №3.- Сс. 7982.
