Научная статья на тему 'Моделирование и оценивание траектории движущегося объекта'

Моделирование и оценивание траектории движущегося объекта Текст научной статьи по специальности «Математика»

CC BY
1581
141
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
МАНЕВРИРОВАНИЕ ДВИЖУЩЕГОСЯ ОБЪЕКТА / ДИСКРЕТНАЯ СТОХАСТИЧЕСКАЯ МОДЕЛЬ / ЛИНЕЙНОЕ ОЦЕНИВАНИЕ / MATLAB / MANEUVERING MOVING OBJECTS / DISCRETE STOCHASTIC MODEL / LINEAR ESTIMATION

Аннотация научной статьи по математике, автор научной работы — Семушин Иннокентий Васильевич, Цыганов Андрей Владимирович, Цыганова Юлия Владимировна, Голубков Алексей Владимирович, Винокуров Станислав Дмитриевич

Построена линейная дискретная модель кругового движения влево/вправо с заданным радиусом. Сформулирован и реализован новый алгоритм математического моделирования траектории движущегося объекта, состоящей из отрезков прямолинейного и кругового движения в условиях неполных зашумленных измерений. Показано, как применять алгоритмы оптимальной дискретной фильтрации для оценивания такой траектории. Разработан программный комплекс Моделирование и оценивание траектории подвижного объекта v1.0 для моделирования и линейного оценивания траектории движущегося объекта на основе дискретных моделей равномерного прямолинейного и кругового движения. Результаты работы могут найти применение при решении практических задач судовождения, робототехники, обработки сигналов со сканирующих дальномеров и др.

i Надоели баннеры? Вы всегда можете отключить рекламу.

Похожие темы научных работ по математике , автор научной работы — Семушин Иннокентий Васильевич, Цыганов Андрей Владимирович, Цыганова Юлия Владимировна, Голубков Алексей Владимирович, Винокуров Станислав Дмитриевич

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.
i Надоели баннеры? Вы всегда можете отключить рекламу.

Modelling and Estimation of a Moving Object Trajectory

A new linear discrete model of the left/right circular motion with the specified radius is constructed. A new algorithm for mathematical modelling of a moving object trajectory consisting of straight line segments and circular motion under the conditions of incomplete noisy measurements is formulated and implemented. It is shown how to apply algorithms for discrete optimal filtering to the evaluation of such a trajectory. A software package "Modelling and estimation of a moving object trajectory v1.0" is developed for modelling and estimation of a linear trajectory of a moving object on the basis of discrete models of uniform piecewise linear and circular motion. The results can be applied to solve practical problems of navigation, robotics, signal processing of scanning range finders and others.

Текст научной работы на тему «Моделирование и оценивание траектории движущегося объекта»

УДК 004.942

DOI: 10.14529/ mmp170309

МОДЕЛИРОВАНИЕ И ОЦЕНИВАНИЕ ТРАЕКТОРИИ ДВИЖУЩЕГОСЯ ОБЪЕКТА

И.В. Семушин1, A.B. Цыганов2, Ю.В. Цыганова1, A.B. Голубков2,

С.Д. Винокуров2

1

2

г. Ульяновск

Построена линейная дискретная модель кругового движения влево/вправо с заданным радиусом. Сформулирован и реализован новый алгоритм математического моделирования траектории движущегося объекта, состоящей из отрезков прямолинейного и кругового движения в условиях неполных зашумленных измерений. Показано, как применять алгоритмы оптимальной дискретной фильтрации для оценивания такой траектории. Разработан программный комплекс «Моделирование и оценивание траектории подвижного объекта vi.О» для моделирования и линейного оценивания траектории движущегося объекта на основе дискретных моделей равномерного прямолинейного и кругового движения. Результаты работы могут найти применение при решении практических задач судовождения, робототехники, обработки сигналов со сканирующих дальномеров и др.

Ключевые слова: маневрирование движущегося объекта; дискретная стохастическая модель; линейное оценивание; MATLAB.

Введение

В работе рассмотрены вопросы построения и оценивания линейных (относительно вектора состояния) дискретных моделей стохастических систем, описывающих траектории, состоящие из отрезков прямолинейного и кругового движения с постоянной скоростью.

Линейность этих моделей позволяет применять методы оптимальной дискретной фильтрации без упрощающей линеаризации для решения важных практических задач: оценивание траектории и обнаружение момента непредвиденного изменения режима движения (маневрирования). Такая постановка задачи математического моделирования и оценивания траектории может рассматриваться при решении задач судовождения, так как прямолинейное и/или круговое движение является типовым для морского подвижного объекта, а задача оценивания его траектории и обнаружения момента маневрирования является крайне важной в силу опасности непредвиденного изменения режима движения.

В настоящее время робототехника является другой актуальной областью исследований, в которой применимы результаты данной работы, так как траектория движения мобильного робота также имеет характер прямолинейного и/или кругового движения. Методы построения и оценивания траектории движения робота с помощью дискретных линейных моделей могут быть использованы для решения задач слежения за движущимися объектами.

Главное преимущество предлагаемого в работе подхода заключается в том, что нелинейная в целом математическая модель траектории движущегося объекта заменяется набором линейных динамических моделей, для которых на каждом участке

движения можно применять вместо нелинейных фильтров (имеющих неизбежные погрешности вычислении вследствие линеаризации) оптимальные линейные дискретные алгоритмы калмановской фильтрации [1]. Таким образом, нет необходимости применять нелинейные фильтры, такие как расширенный фильтр Калмана, линеаризованный фильтр Калмана [2] и др.

Однако, предлагаемый в работе п од ход неизбежно влечет необходимость решения другой задачи - скорейшего обнаружения момента изменения режима движения (маневрирования) движущегося объекта. Решение этой задачи будет предметом дальнейших исследований авторов.

В первом разделе рассмотрены линейные модели движения. Построена дискретная линейная модель кругового движения при повороте влево/вправо. Во втором разделе сформулирован новый алгоритм математического моделирования траектории движущегося объекта, состоящей из отрезков прямолинейного и кругового движения влево либо вправо с заданным радиусом. В третьем разделе приведены методы оптимальной дискретной фильтрации: стандартный алгоритм Калмана и две его численно устойчивые модификации (квадратно-корневой фильтр и 1ГО-фильтр). В четвертом разделе дано краткое описание разработанного авторами программного комплекса «Моделирование и оценивание траектории подвижного объекта у1.0>. Наконец, в пятом разделе приведены результаты вычислительного эксперимента, подтверждающие работоспособность предложенного подхода к моделированию и оцениванию сложной, изменяющейся во времени траектории движущегося объекта.

1. Математическая модель траектории движущегося объекта

Следуя [3], введем четырехмерный вектор состояния

х

Х1 Х2 Хз Х4

где Х1 - координата х вдоль оси Ох, м, х2 - скорость ьх вдоль оси Ох м/с, х3 -координата у вдоль оси Оу, м, х4 - скорость уу вдоль оси Оу, м/с для непрерывной модели кругового равномерного движения влево (МКРД-Л)

х г

0 1 0 0

0 0 0

0 0 0 1

0 0 0

Хг +

0

^п(^пх в '^ву ) 0

Ып&пУз + V вх I

(1)

с известными начальными условиями

х в

х1в = хв

х2в '^вх

Хззв = У в

х4в = Уву_

(2)

и также для непрерывной модели кругового равномерного движения вправо

(МКРД-П)

0

ос t

0 1 0 0

—un 0 0 0

0 0 0 1

0 0 —un 0

Xt +

Uni^nXs + Vsy) 0

Un (UnVs - Vsx)

(3)

с известными начальными условиями (2) в момент переключения Ь = в. Полагая, что измеряются только координаты х\, х3 (скорости

Х2 Х4 измеряются), запишем

вектор наблюдения

[1 0 0 0 0 0 10

Zt

Xt + Vt,

(4)

включающий вектор погрешностей измерения координат, у = [Уи\У2г\У который считаем гауссовым белым шумом с нулевым математическим ожиданием и матрицей ковариации Я > 0.

Теорема 1. [3] Пусть 1^1 = ^Jv2sx + v2sy > 0, где

вектор скорости в точке

с координатами х3, у в в момен т Ь = в переключения с модели прямолинейного равномерного движения (МПРД) на модель кругового равномерного движения (МКРД). Тогда единственное решение для модели МКРД-Л с некоторым параметром шп > 0 дается выражениями

Xu = xs + r sin[un(t — s) + a] — r sin a," x21 = run cos[un(t — s) + a], x3t = ys — r cos[un(t — s) + a] + r cos a X4t = run sin[un(t — s) + a]

(5)

и описывает движение объекта влево от направления вектора vs по дуге окружности с координатами центра

xc = xs — r sin а, Ус = Vs + r cos а,

а единственное решение для модели МКРД-П с некоторым параметром шп > 0 дается выражениями

xlt = xs + r sin[un(t — s) — a] + r sin a, " x21 = run cos[un(t — s) — a], x3t = ys + r cos[un(t — s) — a] — r cos a x4t = —run sin[un(t — s) — a]

(6)

и описывает движение объекта, вправо от на,правления, вектора по дуге окружности с координатами центра,

xs + r sin a,

Ус = ys — r cos a,

где sin a = f^, cos a = r^, r = —.

fs|J fs|J Шп

V

s

Подробное доказательство см. в работе [3].

Для непрерывной модели прямолинейного равномерного движения (МПРД) имеем очевидные уравнения

х г

0 1 0 0

0 0 0 0

0 0 0 1

0 0 0 0

Хг

(7)

с известными начальными условиями (2) в момент переключения Ь = в с одной модели движения на другую.

Будем считать, что наблюдения за объектом производятся дискретно во времени с постоянным интервалом и+1 — = т. Модели МКРД-Л и МКРД-П имеют стандарт-ныи вид непрерывных инвариантных во времени линеиных динамических систем

х(ь) = Гх(ь) + Бп(г),

(8)

где матрицы Г, Б для модели МПРД определены в (7), а для моделей МКРД-Л и МКРД-П - в (1) и (3) соответственно; и(Ь) = 1. Выполнив переход от непрерывной модели (8) к модели в дискретном времени [2, с. 40-42], получим следующий результат:

Дискретная модель Д-МКРД кругового движения по окружности при повороте влево/вправо

хг+1 = Фхг + , г Е Z,

Ф

Б'

Фс 0 0 Фс

(Хв — ш-1Уву )(1 — сов шпт)

(ШпХв — Уву) йт ШпТ (ув + и-1Увх)(1 — сов ШпТ) (ШпУв + V вх ) вт ШпТ

Фс

сов ШпТ — Шп вШ ШпТ

Ш- 1 вШ ШпТ сов Шп Т

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

(9)

Б

я

(Хв + Ш-1Уву )(1 — сов ШпТ)

Уву

(ш пХв + Уву) вт ШпТ

Увх )(1 — сов ШпТ) (ш пУв — Увх) вт ШпТ

(ув — Ш

Дискретная модель (9) описывает движение по дуге окружности влево (против часовой стрелки) либо вправо (по часовой стрелке). Рассмотрим возможность добавления в уравнение состояния дискретной модели (9) аддитивной стохастической составляющей движения. Тогда общее уравнение дискретной модели примет вид

хт = Фх; + Б л + От,

йг

(10)

В уравнении (10) О - матрица передачи дискретного белого шума В случае,

если шум не является дискретным белым, модель шума должна быть включена в

уравнение состояния, тем самым повышая его размерность. Считаем, что шумовая

составляющая может присутствовать во второй и четвертой компонентах вектора

состояния х: _

00

10

00

01

О

т.е. проекции скоростей движения объекта на координатные оси Ох и Оу могут быть непостоянными.

Дискретная версия Д-МПРД получается из непрерывной версии (7), после добавления стохастической составляющей в том же виде (10), но с матрицами

Ф

ФР 0 0 Ф„

Ф.

1 т 0 1

В,

d —

(П)

2. Алгоритм моделирования движения объекта

Разработаем новый алгоритм математического моделирования траектории движущегося объекта, состоящей из отрезков прямолинейного и кругового движения влево/вправо с заданным радиусом.

Примем следующее правило «переключения> с одного режима на другой: при переключении режимов (маневрировании объекта) последнее вычисленное значение вектора состояния объекта считаем начальным значением для нового режима движения. В начале моделирования начальное значение вектора состояния известно. Сформулируем полученный результат:

АЛГОРИТМ 1. [Математическое моделирование траектории движущегося объекта]

I. Начальные данные:

> положить к = 0 (дискретное врем,я);

> задать значения хь, т, Q, R;

> установить план траектории из p отрезков прямолинейного и/или кругового движения;

> для т-го отрезка кругового движения задать радиус поворота rm.

II. Моделирование траектории: for т = 1 to p do

1 > определить тип т-го отрезка траектории type и его длину length-,

2 > if type = ПРД then

3 > for i = к + 1 to к + length do

4 > вычисл,ить Xi согласно (10);

end else

определить значение радиуса поворота гт; вычислить значение шп = л/хк(2)2 + Хк(4)2/гт и матрицу

5 >

6 > Фе(Ши,Хк );

7 > if type — КРД-Л then

8 > вычислить матрицу В^(шп,Хк);

else

9 > вычислить матрицу BR(uin,Xk);

end

10 > for i = к + 1 to к + length do

11 > вычислить Xi согласно (9);

end

12 > присвоить к = i; end

III. Конец.

3. Алгоритмы линейного оценивания

Поскольку в дискретной модели измерений (4) присутствуют случайные погрешности, значения вектора состояния xk в дискретные моменты времени tk недоступны для прямого наблюдения. Для того, чтобы иметь возможность оценивать Xk, применим алгоритмы оптимальной дискретной фильтрации. Для дискретных линейных систем с гауссовыми шумами оптимальным алгоритмом линейного оценивания является фильтр Калмана [1]. Следует отметить, что при решении практических задач целесообразно применять современные численно эффективные реализации дискретного фильтра Калмана (ФК) - квадратно-корневые и UD реализации. Особенность таких алгоритмов (в отличии от стандартной схемы Калмана) заключается в том, что они обладают свойством численной устойчивости по отношению к ошибкам машинного округления, препятствуя таким образом расходимости оценок, вычисляемых в алгоритме фильтрации. Недавний подробный обзор современных численно устойчивых реализаций дискретного ФК содержится в [4].

Рассмотрим три варианта алгоритма оптимальной дискретной фильтрации: стан-д&ртныи фильтр Калмана (CKF), квадратно-корневой ковариационный фильтр (SECF) и ковариационный UD-фильтр (UD-CF). Все алгоритмы представлены в одностадийной форме.

АЛГОРИТМ 2. [CKF - Conventional KF]

0. Начальные данные: X0 = x0 и Р0 = П0, П0 > 0.

1. Рекуррентно обновлять величины (к > 0)

коэффициент обр. связи: КРкк = ФРкHТR-l, Re,k = R + HPkHт; ковариация ошибки: Рк+1 = ФРкФт + GQGT — Kp,кReкк;

оценка: Xk+i = ФХк + Bd + Кр, k (zk — HXk).

2. Конец.

В следующем алгоритме используют разложение Холесского [5] A = SaSJ^ положительно определенной симметрической матрицы A, где фактор Холесского Sa -нижняя треугольная матрица.

АЛГОРИТМ 3. [SRCF - Square-Root Covariance Filter]

0. Начальные данные: X0 = х0, P0 = П0 > 0 R> 0 Q > 0. Вычислить нижние треугольные факторы Холецкого: Sno, Sr, Sq.

1. Рекуррентно обновлять Spk+1 и хк+\ (0 < к < N - 1):

® По Н с1И Д6 н н ы м SPk, Sr, Sq сформировать блочную матрицу

А

к —

0

Spk Нк SPk ФТ

сТ/^Т SQ G

0

© Для блочной матрицы Ак ВЫПОЛНИТЬ QE-пpeoбpaзoвaниe и получить в результате блочную матрицу

к

SP K Т

öRek Kp,k

0 0

SRk+1 0

где Ak е R(m+n+qMm+n)5 Qk е R(n+m+q)x(n+m+q) _ матрица QR_ преобразования QkAk = Rk, приводящего к верхней треугольной блочной матрице Rk е R(m+n+q):х (m+n).

® Вычислить оценку вектора состояния:

Xk+i = ФХь + Bd + Kp,kS-1k(zk - HXk).

2. Конец.

В третьем алгоритме используют модифицированное разложение Холесского [5,6] A = UaDaUa положительно определенной симметрической матрицы A, где модифи-цировсшныб факторы Холесского {UA,DA} - пара матриц, в ко торой UA верхняя треугольная матрица с единицами на диагонали, Da > 0 - диагональная матрица.

АЛГОРИТМ 4. [UD-CF - UD Covariance Filter]

0. Начальные данные: X0 = х0 и P0 = П0 > 0.

Вычислить UD-факторы Холецкого: {Uno,Dno}, {Ur,Dr}, {Uq,Dq}.

1. Рекуррентно обновлять {Upk+1 ,Dpk+1} и Xk+i (0 < к < N - 1):

® Для пар {UPk,DPk}, {Ur,Dr}, {Uq,Dq} сформировать блочные матрицы

dk — diag{dq,dpfc ,dr }, a,

T

GUq Фирк 0 0 HUpk Ur

© Для п&ры блочных матриц {Ак, Т>к } выполнить модифицированную ВЗ В6

Ак

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

относительно весовой матрицы Vk и получить в результате пару блочных матриц {Ак, Т>\,}:

V\ = Diag{Dpfc+1 ,DR^k},

Al

UPk + 1 Kp,k URe,k

0 URek

таких.

ЧТО «/4k

Ak BJ

и

Ak Vk Ak

a vk

Ak

T

где Vk E

^(д+п+т)х(д+п+т^ Ак £ Я+п+т)х{п+т) £>к £ ^(9+п+т)х(п+т) _ матри_

ца М\¥С8-преобразования к верхней треугольной блочной матрице Ак £ Е(п+т)х(п+т) и диагональной матрице V]k £ Е(п+т)х(п+т).

Вычислить оценку вектора состояния

Xk+i = ФXk + Bd + Kp,kURe (zk - Hxk)•

2. Конец.

Условия применения алгоритмов. Считаем, что дискретные моменты времени ]3 = 1,.. . ,р, переключения с одного режима движения на другой (маневрирования) известны. Тогда в момент переключения ]3 на новый режим движения началь-ныв значения для работы алгоритма фильтрации принимаем следующие: Хo = Хjs-l, По = Pjs-l, т.е. за начальные условия берем значения оценки вектора состояния и ковариационной матрицы ошибки оценивания, полученные на предыдущем шаге обработки измерений. Затем при заданном типе кругового движения (влево или вправо) и радиусе г^ кругового движения вычислявм сначала шп = \]Х0(2)2 + Х0(4)2/rjs, а затем пересчитываем матрицы-параметры алгоритма фильтрации: Фс = Фс(шп,Х0), Б^/К = Бьл/К(шп, Х0). Далее вычисляем оценки вектора состояния Хк и ковариацион-ныв матрицы ошибки оценивания Рк согласно выбранному алгоритму фильтрации до тех пор, пока не произойдет переключение на очередной режим движения.

4. Программный комплекс «Моделирование и оценивание траектории подвижного объекта vl.0>

Программный комплекс «Моделирование и оценивание траектории подвижного объекта vl.0> предназначен для моделирования и линейного оценивания траектории движущегося объекта на основе дискретных моделей равномерного прямолинейного и кругового движения.

Программный комплекс написан на языке MATLAB с реализацией графического интерфейса пользователя в среде визуального программирования GUIDE. В нем реализованы режимы построения детерминированной или стохастической траектории, а также моделирование измерений в присутствии аддитивной гауссовой помехи с возможностью оценивания вектора состояния модели движения объекта с помощью алгоритмов оптимальной дискретной фильтрации: CKF, SRCF и UD-CF. Результаты моделирования доступны пользователю в виде временных графиков элементов вектора состояния, оценок элементов вектора состояния и графика траектории движения объекта и ее оценки на фазовой плоскости. В программе предусмотрена возможность сохранения числовых результатов в текстовом файле.

Главное окно программы

На рисунке представлен интерфейс программы. Сверху расположены пять окон, в которых динамически строятся графики траектории движения объекта на плоскости Oxy либо оценки траектории в зависимости от выбранного режима, а также графики элементов вектора состояния либо их оценок. Программа предоставляет возможность проводить численное моделирование в двух режимах: 1) в режиме построения траектории движущегося объекта согласно моделям Д-МПРД (прямолинейное движение) и Д-МКРД (круговое движение с заданным радиусом); 2) при наличии помех измерений в режиме линейного оценивания.

Программа позволяет моделировать траекторию (возможно, затттумленную), состоящую из конечного числа отрезков прямолинейного и кругового движения. План и параметры траектории можно задать в окне с названием «Trajectory:». Кроме того, можно выбрать тип вычислительного эксперимента: моделирование («Modeling») либо оценивание («Estimation»), а также выбрать алгоритм линеиного оценивания (CKF, SRCF или UD-CF) . задать начальные значения (координаты объекта и проекции скорости), период дискретизации т и матрицы ковариаций шумов в уравнении состояния Q и в уравнении измерения Д. После нажатия кнопки «START» выполняется динамическое моделирование. Полученные результаты можно сохранить в виде текстового файла с целью их дальнейшего анализа.

5. Результаты численного моделирования

На рисунке показаны результаты численного моделирования в режиме оценивания зашумленной траектории движущегося объекта. Для вычисления оценок вектора состояния выбран алгоритм UD-CF. Перед началом моделирования был установлен следующий план траектории: движение начинается из точки с координатами (0, 0); 10 тактов дискретного времени объект двигался в режиме равномерного прямолинейного движения, затем в течение 50 тактов дискретного времени объект совершал круговое движение влево с радиусом r = 2, и в течение 60 тактов дискретного времени объект совершал круговое движение вправо с радиусом r = 5.

В левом верхнем большом окне изображен график траектории движения на плоскости Oxy. Тонкой черной линией обозначены данные измерений zk (зашумленная траектория), а толстой линией обозначены вычисленные оценки координат объекта.

В четырех меньших окнах справа изображены временные графики оценок координат объекта и графики оценок проекций скоростей на координатные оси.

Таким образом, на данном практическом примере подтверждена работоспособность алгоритмов моделирования и оценивания траектории движущегося объекта.

Заключение

Перечислим полученные в работе новые результаты:

1. Построена новая дискретная модель Д-МКРД кругового движения влево (против часовой стрелки)/вправо (по часовой стрелке) с заданным радиусом.

2. Сформулирован и подтвержден на практике новый алгоритм математического моделирования траектории движущегося объекта, состоящей из отрезков прямолинейного и кругового движения влево либо вправо с заданным радиусом. Такое представление сложной траектории позволяет применять методы оптимальной дискретной фильтрации для ее оценивания в условиях зашумленных неполных измерений.

3. Разработан программный комплекс «Моделирование и оценивание траектории подвижного объекта vl.Û> для моделирования и линейного оценивания траектории движущегося объекта на основе дискретных моделей равномерного прямолинейного и кругового движения.

Результаты работы могут найти применение при решении практических задач судовождения, робототехники, обработки сигналов со сканирующих дальномеров и др. Они также послужат отправной точкой для решения более сложной задачи обнаружения момента переключения и диагностики режимов движения в реальном времени. Решение указанной задачи позволит построить новые алгоритмы слежения за объектом, движущимся по сложной траектории.

Работа частично поддержана Российским фондом фундаментальных исследований (грант M 16-41-730784)

Литература

1. GrewaI, M.S. Kalman Filtering: Theory and Practice / M.S. Grewal, A.P. Andrews. - New

Jersey: Prentice Hall, 2001.

2. Maybeck, P.S. Stochastic Models, Estimation and Control. V. 1 / P.S. Maybeck. - N.Y.; San

Francisco; Tondon: Academic Press, 1979.

3. Семушин, И.В. Ориентированная на фильтрацию Калмана математическая модель установившейся циркуляции для анализа траектории цели / И.В. Семушин, Ю.М. Кроли-вецкая, Е.С. Петрова // Автоматизация процессов управления. - 2013. - № 4 (34). -С. 14-20.

4. Семушин, И.В. Устойчивые алгоритмы фильтрации - обзор и новые результаты для систем судовождения / И.В. Семушин, Ю.В. Цыганова, К.В. Захаров // Информационные технологии и вычислительные системы. - 2013. - № 4. - С. 90-112.

5. Семушин, И.В. Вычислительные методы алгебры и оценивания / И.В. Семушин. - Ульяновск: УлГТУ, 2011.

6. Bierman, G.J. Factorization Methods for Discrete Sequential Estimation / G.J. Bierman. -N.Y.: Academic Press, 1977.

Иннокентий Васильевич Семушин, доктор технических наук, профессор, кафедра информационных технологий, Ульяновский государственный университет (г. УльяНОВСК, Российская Федерация), [email protected].

Андрей Владимирович Цыганов, К&НДИДсХТ физико-математических наук, доцент, кафедра высшей математики, Ульяновский государственный педагогический университет им. И.Н. Ульянова (г. Ульяновск, Российская Федерация), [email protected].

Юлия Владимировна Цыганова, К&НДИДсХТ физико-математических наук, доцент, кафедра информационных технологий, Ульяновский государственный университет (г. Ульяновск, Российская Федерация), [email protected].

Алексей Владимирович Голубков, магистрант, кафедра высшей математики, Ульяновский государственный педагогический университет им. И.Н. Ульянова (г. Ульяновск, Российская Федерация), [email protected].

Станислав Дмитриевич Винокуров, аспирант, кафедра высшей математики, Ульяновский государственный педагогический университет им. И.Н. Ульянова (г. УльяНОВСК, Российская Федерация), [email protected].

Поступила в редакцию 3 октября 2016 г.

MSC 93А30, 93Е10 DOI: 10.14529/mmp170309

MODELLING AND ESTIMATION OF A MOVING OBJECT TRAJECTORY

I.V. Semushin1, A.V. Tsyganov2, Yu.V. Tsyganova1, A.V. Golubkov2, S.D. Vinokurov2

Ulyanovsk State University, Ulyanovsk, Russian Federation 2

E-mail: [email protected], [email protected], [email protected], [email protected], [email protected]

A new linear discrete model of the left/right circular motion with the specified radius is constructed. A new algorithm for mathematical modelling of a moving object trajectory

consisting of straight line segments and circular motion under the conditions of incomplete noisy measurements is formulated and implemented. It is shown how to apply algorithms for discrete optimal filtering to the evaluation of such a trajectory. A software package "Modelling and estimation of a moving object trajectory vl.O" is developed for modelling and estimation of a linear trajectory of a moving object on the basis of discrete models of uniform piecewise linear and circular motion. The results can be applied to solve practical problems of navigation, robotics, signal processing of scanning range finders and others.

Keywords: maneuvering moving objects; discrete stochastic model; linear estimation; MATLAB.

References

1. Grewal M.S., Andrews A.P. Kalman Filtering: Theory and Practice. New Jersey, Prentice Hall, 2001.

2. Maybeck P.S. Stochastic Models, Estimation and Control. N.Y., San Francisco, London, Academic Press, 1979.

3. Semushin I.V., Krolivetskaya Yu.M., Petrova E.S. Kalman Filter Oriented Mathematical Model of the Steady-Circle Path. Automation of Control Processes, 2013, no. 4 (34), pp. 14-20. (in Russian)

4. Semushin I.V., Tsyganova Yu.V., Zakharov K.V. Robust Filter Algorithms - Survey and New Results for Ship Navigation. Information Technology and Computing Systems, 2013, no. 4, pp. 90-112. (in Russian)

5. Semushin I.V. Computational Methods of Algebra and Estimation. Ulyanovsk, U1STU Publishers, 2011.

6. Bierman G.J. Factorization Methods For Discrete Sequential Estimation. N.Y., Academic Press, 1977.

Received October 3, 2016

i Надоели баннеры? Вы всегда можете отключить рекламу.