Динамический метод, использующий движение объекта

Система уравнений с учетом динамики объекта в общем случае включает семь неизвестных: три составляющие начальных координат вектора-базы в момент времени t0, три составляющие приращений координат вектора-базы за время наблюдения Dt и величину длины базы В, для ее решения необходимо принять сигналы шести НКА.

Задаваясь априорными значениями начальных координат x0, y0, z0, можно вычислить приращения координат вектора-базы Dxj, Dyj, Dzj, за j-й интервал времени. В первом приближении величинами x0, y0, z0, можно пренебречь ввиду малости коэффициентов Dkxij, Dkyij, Dkzij. В дальнейшем, после определения начального положения вектора-базы, его можно использовать в качестве априорных данных. При таком упрощении имеем систему уравнений с тремя неизвестными.

При измерении за K временных интервалов можно составить следующие системы уравнений:

Для j-го временного интервала (j = 1,2,¼K)

(2.2.1)

Дополнительная система уравнений для всех интервалов

(2.2.2)

Решая систему уравнений (2.2.2), можно с точностью 2-3 мм определить траекторию вектора-базы за любой интервал времени. Однако для определения ориентации знания траектории недостаточно, требуется знание начального положения вектора-базы x0, y0, z0. Полученные в результате решения системы уравнений (2.2.2) величины Dxj, Dyj, Dzj являются точками траектории вектора-базы за время наблюдения. Эти точки лежат на поверхности шара с радиусом, равным В, с центром в начале координат. Таким образом, задача определения начального положения вектора-базы сводится к определению параметров сферы возможных положений вектора-базы по заданной траектории, т.е. к задаче аппроксимации.

Начальное положение вектора-базы можно определить, решая систему уравнений. Раскрывая скобки, получим:

(2.2.3)

или

(2.2.4)

Система (2.2.4) является линейной относительно неизвестных начальных координат базы x0, y0, z0.

Погрешность вычисления x0, y0, z0 зависит от величины приращений Dxj, Dyj, Dzj: чем больше по абсолютной величине приращения координат, тем выше точность вычисления начальных координат, при этом траектория вектора-базы не должна находиться в одной плоскости (в этом случае система уравнений (2.2.4)является вырожденной).

При известной величине базы систему уравнений (2.2.4) можно дополнить нелинейным уравнением из системы. В результате будем иметь следующую систему уравнений:

(2.2.5)

Эта система уравнений остается невырожденной, даже если траектория вектора-базы будет лежать в одной плоскости.

Для решения системы уравнений (2.2.5) требуется поворот вектора-базы на достаточно большой угол.

Блок схема алгоритма

Рис. 2.3 Блок-схема динамического алгоритма определения угловой направленности вращающегося объекта

Другое по теме:

Проектирование многоразрядного десятичного сумматора комбинационного типа
Двоично-десятичный код, в котором находятся числа. - 2421 Система логических элементов - ИЛИ, ИЛИ-НЕ. Критерий оптимальности элементов для проектирования логических схем - минимальное количество логических элементов. ...

Оценивание суммарной погрешности СИ
Структурная схема анализируемого СИ: Блоки 1, 3-6 безынерционные с коэффициентами преобразования К1 = 1; К3=10; К4 = 50; К5 = 5; К6 =  = 0,2. На выходе преобразователя, образуемого блоками 1 - 6, включен в ...