способ определения составляющих вектора скорости цели
Классы МПК: | G01C11/04 расшифровка изображений G01C3/00 Приборы для измерения расстояний по линии визирования; оптические дальномеры |
Автор(ы): | Якушин С.М. |
Патентообладатель(и): | 4 Центральный научно-исследовательский институт Министерства обороны Российской Федерации |
Приоритеты: |
подача заявки:
1997-12-26 публикация патента:
20.12.1999 |
Изобретение относится к области полигонных испытаний образцов вооружений и военной техники и может быть использовано при определении параметров движения цели по данным фоторегистрирующих (оптических) средств траекторных измерений. Техническим результатом, достигаемым при реализации данного способа, применительно к траекторным оптическим измерениям, является повышение точности определения составляющих вектора скорости цели в каждой точке наблюдения. Для достижения задачи изобретения выполняется фоторегистрация цели на фоне опорных точек и дополнительно измеряют скорости изменения картинных координат цели в каждой точке наблюдения. С учетом измеренных скоростей картинных координат цели вычисляют скорости изменения направляющих косинусов между направлениями, проходящими через заднюю главную точку фоторегистратора и изображения цели и опорных точек. Затем формируют для точки наблюдения по каждой опорной точке уравнение поправок вида C1k
Vx+C2k
Vy+X3k
Vz-cosQ =
k, где k - номер опорной точки, а
k - соответствующая поправка, Q - угол между направлениями, проходящими через заднюю главную точку фоторегистратора, изображение цели и опорную точку. В этом уравнении неизвестным являются определяемые составляющие вектора скорости цели в точке наблюдения (Vx, Vy, Vz), коэффициенты при неизвестных (C1k, C2k, C3k) вычисляют по известным пространственным координатам цели и известным направлениям на k-опорную точку, а свободным членом - скорость изменения направляющего косинуса между направлением на цель и k-опорную точку. Число аналогичных уравнений равно числу опорных точек, привлекаемых к обработке, их количество, как правило, значительно превосходит число неизвестных. Далее, применяя метод наименьших квадратов, решается задача по определению составляющих вектора скорости цели и выполняется оценка точности их определения в точке наблюдения. 1 ил.
Рисунок 1
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143004/183.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143004/183.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143004/183.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/957.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/957.gif)
Формула изобретения
Способ определения составляющих вектора скорости цели, заключающийся в выборе n опорных точек, визировании и фоторегистрации цели и опорных точек из N точек с известными координатами, дешифрировании снимков, идентификации опорных точек, измерении картинных координат цели и опорных точек в системе координат, две оси которой лежат в плоскости фотоснимка, а третья перпендикулярна этой плоскости и проходит через центр фотоснимка, получении значений направляющих косинусов для каждой точки наблюдения между линиями визирования на опорные точки и между направлениями, проходящими через заднюю главную точку фоторегистратора и изображения опорных точек, сравнении их между собой и компенсировании значений направляющих косинусов между направлениями, проходящими через заднюю главную точку фоторегистратора и изображения цели и опорных точек, определении пространственных координат цели по скомпенсированным значениям направляющих косинусов и известным направлениям на опорные точки и вычислении составляющих вектора скорости цели численным дифференцированием ее пространственных координат, отличающийся тем, что дополнительно измеряют скорости изменения картинных координат цели в каждой точке наблюдения, вычисляют, с учетом измеренной скорости изменения картинных координат цели, скорости изменения направляющих косинусов между направлениями, проходящими через заднюю главную точку фоторегистратора и изображения цели и опорных точек, формируют для точки наблюдения уравнения поправок по каждой опорной точке, при этом скорости изменения направляющих косинусов являются в этих уравнениях свободными членами, неизвестными - составляющие вектора скорости цели, а коэффициенты при неизвестных вычисляются по известным пространственным координатам цели и известным направлениям на опорные точки, затем определяют составляющие вектора скорости цели путем решения полученных уравнений поправок с применением метода наименьших квадратов.Описание изобретения к патенту
Изобретение относится к области полигонных испытаний образцов вооружения и военной техники и может быть использовано при определении параметров движения цели (объектов наблюдения, испытаний) по данным фоторегистрирующих (оптических) средств траекторных измерений. Траекторные оптические средства измеряют координатные параметры, которые позволяют непосредственно оценить только положение цели в пространстве, а именно - их пространственные координаты (X, Y, Z). В этом случае для решения задачи определения составляющих вектора скорости цели полученные пространственные координаты, как правило, в функции времени используются в качестве исходных данных. Например, аппроксимируя отдельно каждую координатную функцию подобранным определенным образом полиномом с последующим дифференцированием вычисляют составляющие вектора скорости. Такой подход имеет больше недостатков, чем преимуществ. Так, при наличии разрывов на интервале измерений можно их восстановить и получить значения полного вектора (координаты и скорости) в каждой точке и с любым шагом. Но вот точность и достоверность получаемых результатов в итоге будет низкой и это может привести к ошибочным выводам при их использовании, например, в анализе движения объекта испытания. В технической литературе подробно рассматриваются подобные способы (см., например, Гудзовский В. А., Худяков С. Т. Баллистика ракет. - М.: МО СССР, 1971). Более эффективными для решения задачи определения составляющих вектора скорости цели являются способы численного дифференцирования координат. Ближайшим к заявляемому способу по цели и конечному результату является способ определения составляющих вектора скорости летательного аппарата численным дифференцированием координат (см. Жданюк Б.Ф. Основы статистической обработки траекторных измерений. М. "Советское радио", 1978, с. 253-265). В этом способе для обеспечения необходимой точности определения производных приходится решать оптимизационную задачу по согласованию шага аргумента и порядка используемых разностей, чтобы уменьшить погрешности, вызываемые случайными ошибками дифференцируемых функций. Кроме этого, для численного дифференцирования координатных функций, как правило, применяют метод скользящего дифференцирования, при котором производная вычисляется только для одной средней точки выбранного интервала обработки. При этом скользящий интервал не должен содержать разрывов по времени. Такой подход в свою очередь затрудняет определение составляющих вектора скорости в нескольких точках как в начале, так и в конце интервала измерений. Имеется в виду, что оценки точности и достоверности получаемых характеристик в этих точках оказываются практически на порядок загрубленными по сравнению с определяемыми в средних точках. Кроме этого, наличие на интервале измерений разноточных значений координат даже в соседних точках также затрудняет обработку и существенно снижает точностные характеристики получаемых результатов. Целью изобретения является повышение точности определения составляющих вектора скорости цели по результатам оптических траекторных измерений. Это достигается тем, что фоторегистрация цели выполняется на фоне опорных точек и дополнительно измеряются скорости изменения ее картинных координат в каждой точке наблюдения. Под опорными точками (звезды, геодезические вехи) здесь понимаются точки с известными координатами (например, задаваемые значениями азимута (![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143008/945.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143064/946.gif)
Суть способа определения координат заключается в том, что определяются направляющие косинуса для каждой точки наблюдения между линиями визирования на опорные точки и между направлениями, проходящими через заднюю главную точку фоторегистратора и изображения опорных точек. Полученные значения направляющих косинусов сравнивают между собой и на величину полученной разности компенсируют вычисляемые направляющие косинусы между направлениями, проходящими через заднюю главную точку фоторегистратора и изображения цели и опорных точек. По скомпенсированным таким образом значениям направляющих косинусов и известным направлениям на опорные точки определяют пространственные координаты объекта как точку пересечения прямых круговых конусов, вершина каждого из которых совпадает с точкой наблюдения, а угол полураствора конуса равен углу между направлениями на цель и опорную точку. Далее, с учетом значений скоростей изменения картинных координат цели и вычисленных значений направляющих косинусов между направлениями, проходящими через заднюю главную точку фоторегистратора и изображения цели и опорных точек вычисляют скорости изменений этих направляющих косинусов. Затем формируют для очередной данной точки наблюдения линейные алгебраические уравнения по каждой опорной точке. Здесь число уравнений для данной точки наблюдения равно числу опорных точек, информация которых привлекается к обработке. При этом в этих уравнениях по каждой опорной точке скорости изменения направляющих косинусов являются правыми частями (свободными членами), неизвестными - определяемые составляющие вектора скорости цели, а коэффициенты при неизвестных вычисляются по известным уже пространственным координатам цели и известным направлениям на соответствующие опорные точки. Таким образом, каждое уравнение будет содержать три неизвестных - составляющие вектора скорости цели Vx, Vy, Vz. Число опорных точек, как правило, более трех. Поэтому, используя метод наименьших квадратов, решаем задачу по определению составляющих вектора скорости как задачу по избыточным данным. Аналогичные действия выполняются и для следующих точек наблюдения. Рассмотрим реализацию способа на примере фотографирования цели на фоне звезд. Предположим, что фотографирование выполняется на один кадр. В этом случае след движения цели зафиксируется в виде нескольких треков, каждый из которых имеет привязку ко времени. Точно также изобразятся и звезды. Полученные негативы используются для измерения картинных координат изображений цели и звезд на компараторе, например, типа АК-1. Тогда для одного снимка будем иметь следующие массивы:
массив картинных координат цели
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099t.gif)
массив картинных координат опорных точек
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-2t.gif)
Согласно известному способу определения пространственных координат цели вначале выполняется сравнение вычисленных направляющих косинусов между линиями визирования на опорные точки и между направлениями, проходящими через заднюю главную точку фоторегистратора и изображения опорных точек. Затем на величину полученной разности компенсируют вычисленные направляющие косинусы (cos Q) между направлениями, проходящими через заднюю главную точку фоторегистратора и изображения цели и опорных точек, и формируют массив, например, на фиксированный момент времени в виде:
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-3t.gif)
где Qi - угол между направлениями, проходящими через заднюю главную точку фоторегистратора и изображения цели и i -опорную точку;
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143008/945.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143064/946.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143004/8773.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143004/8773.gif)
t, X, Y, Z. (4)
Массивы вида (1), (2), (3), (4), а также измеренные значения изменения картинных координат цели в виде:
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-4t.gif)
являются исходными данными, используемыми для определения (составляющих вектора скорости цели. Следует отметить, что массив типа (5) (значения t, Vx, Vy) может быть получен и численным дифференцированием функций картинных координат цели. В этом случае имеем почти идеальные условия - "гладкая" кривая, несложная работа с подбором "оптимального" полинома и, наконец, решение проблемы с начальными и конечными точками на измерительном интервале, что в итоге позволяет по предложенной ниже схеме решения существенно повысить точность определения составляющих вектора скорости цели по сравнению с существующими способами численного дифференцирования пространственных координат. Представим исходные зависимости для определения составляющих вектора скорости цели (с учетом известного способа определения пространственных координат цели - см. изобретение N 4537427). Пусть в некоторой системе координат OXYZ известны координаты точек стояния оптических средств. Тогда с учетом данных массива (3) на момент времени t уравнение прямого кругового конуса с вершиной в точке 0
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143081/955.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143081/955.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143004/8773.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143081/955.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143081/955.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-5t.gif)
где k - номер опорной точки на кадре
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143081/955.gif)
Xk
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143081/955.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143081/955.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143081/955.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143081/955.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-6t.gif)
T - знак транспонирования;
X, Y, Z- координаты цели в СК OXYZ;
X0
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143081/955.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143081/955.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143081/955.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143081/955.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-7t.gif)
a11k = cos
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143008/945.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143004/183.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143064/946.gif)
a12k = -cos
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143008/945.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143004/183.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143064/946.gif)
a13k = -sin
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143008/945.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-8t.gif)
a22k = cos
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143064/946.gif)
a23k=0
a31k = sin
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143008/945.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143004/183.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143064/946.gif)
a32k = -sin
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143008/945.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143004/183.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143064/946.gif)
a33k = cos
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143008/945.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143008/945.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143064/946.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-9t.gif)
После несложных преобразований расчетное значение cos Q запишем следующим образом:
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-10t.gif)
где
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-11t.gif)
Продифференцировав выражение (10) с учетом (9) и после несложных преобразований, получим линейное алгебраическое уравнение вида:
C1k
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143004/183.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143004/183.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143004/183.gif)
где
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-12t.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-13t.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-14t.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-15t.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-16t.gif)
X, Y, Z - координаты цели в СК OXYZ;
Xoo, Yoo, Zoo - координаты точки О СК OXYZ в СК 0
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143081/955.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143081/955.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143081/955.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143081/955.gif)
B11, B12, . . . , B33 - направляющие косинусы связи СК в точке стояния оптического средства 0
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143081/955.gif)
Vx, Vy, Vz - составляющие вектора цели в СК OXYZ;
a11k, a12k, ..., a33k - см. (8). Поскольку коэффициенты при Vx, Vy, Vz в уравнении (11) содержат погрешности (в основном за счет погрешностей определения X, Y, Z цели), значение cos Q также содержит погрешности измерений, то левые и правые части не будут равны, а будут отличаться на некоторую величину поправки
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/957.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-17t.gif)
С учетом (16) для
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143081/955.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-18t.gif)
Аналогичные системы уравнений типа (17) будем иметь со всех из j-оптических средств на момент t. Пока нерешенным остается вопрос определения скорости изменения направляющих косинусов при наличии измеренных (или вычисленных) значений скорости изменения картинных координат цели (Vx, Vy - см. массив (5)). В качестве исходной зависимости воспользуемся выражением:
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-19t.gif)
где xц, yц - картинные координаты цели;
fi, yi - картинные координаты i - опорной точки;
f - фокусное расстояние камеры
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143081/955.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-20t.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-21t.gif)
После дифференцирования и несложных преобразований получим:
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143099/2143099-22t.gif)
Теперь мы располагаем всеми необходимыми данными для решения системы линейных уравнений типа (17). Поскольку число уравнений типа (16) значительно превосходит число неизвестных (Vx, Vy, Vz на момент t), то решение выполняется с применением метода наименьших квадратов. После решения на момент t будут определены составляющие вектора скорости цели (Vx, Vy, Vz) и оценки точности их определения. На чертеже приведены эмпирические функции распределения значений
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143058/916.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143058/916.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143058/916.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143011/963.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143011/963.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143011/963.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143008/945.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143064/946.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143011/963.gif)
![способ определения составляющих вектора скорости цели, патент № 2143099](/images/patents/328/2143011/963.gif)
Класс G01C11/04 расшифровка изображений
Класс G01C3/00 Приборы для измерения расстояний по линии визирования; оптические дальномеры