CC BY
125
УДК 681.513.3
АЛГОРИТМ ИЗМЕРЕНИЯ УГЛОВЫХ КООРДИНАТ ЛИНИИ ВИЗИРОВАНИЯ ОПЕРАТОРА
Б. А. Алпатов,
доктор техн. наук, профессор О. Е. Балашов, канд. техн. наук, доцент А. И. Степашкин,
канд. техн. наук, доцент
Рязанский государственный радиотехнический университет Д. В. Трофимов, начальник сектора НКЦ ВКТ
ОАО «Государственный Рязанский приборный завод»
Рассматривается один из возможных вариантов построения нашлемной системы обзора и целеуказания, а также приводится алгоритм вычисления угловых координат оптической оси нашлемного видеодатчика, принимаемой в качестве линии визирования оператора.
Ключевые слова — нашлемная система целеуказания, измерение угловых координат.
Введение
Неотъемлемой частью современных видеокомпьютерных бортовых систем (самолетов, вертолетов и т. п.) является нашлемная система позиционирования (НСП), предназначенная для повышения точности решения задач обзора оператором внешней обстановки, целеуказания и автоматического сопровождения объектов [1-3]. Принцип работы НСП в составе бортовой оптико-механической системы состоит в том, что оператор, экипированный шлемом с закрепленными на нем специальными очками со встроенным микродисплеем, поворотом головы меняет в пространстве направление своей линии визирования, отслеживаемой видеодатчиком (ВД) оптико-механической системы с помощью НСП, при этом изображение с ВД передается на микродисплей шлема [4].
Принцип построения нашлемной системы позиционирования
Направление визирной линии оператора зависит не только от поворота его головы, но и от положения зрачков его глаз. Поэтому в определенной мере целесообразна замена истинной визирной линии оператора искусственной, например, оптической осью ВД, закрепленного на шлеме
оператора, изображение с которого также можно подавать на микродисплей очков (рис. 1). Направление оптической оси ВД, отмечаемое перекрестием на его изображении, не обязательно в точности должно соответствовать естественной визирной линии оператора, который при целеуказании движением головы (шлема оператора) должен оптическую ось (в дальнейшем будем называть ее визирной линией оператора) направить строго на объект (совместить на изображении объект с перекрестием). Использовать такой ВД с изменяемым полем зрения есть смысл в режиме целеуказания при нахождении объекта интереса непосредственно в поле зрения оператора.
Оптическая ось
Линия визирования оператора
■ Рис. 1. Расположение ВД и светодиодов на шлеме пилота
В данной работе для измерения угловых координат направления оптической оси нашлемного ВД (иначе — угловых координат положения шлема оператора) используется оптический способ. Для этого на шлеме закрепляют светодиоды, играющие роль реперных точек для видеокамеры измерительной системы НСП. Количество и размещение светодиодов определяется алгоритмом измерения угловых координат линии визирования и необходимой точностью измерения. В разрабатываемой системе предлагается использовать четыре светодиода, три из которых образуют основной реперный треугольник, а четвертый, размещенный сбоку, образует с двумя ближайшими к нему реперами дополнительный реперный треугольник. На рис. 1 показаны основной (затенен) и дополнительный реперные треугольники. По умолчанию подразумевается, что речь будет вестись об основном реперном треугольнике. Ориентация треугольника описывается системой координат O2KLM, привязанной к треугольнику так, что точка О2 совпадает с одним из реперов, ось O2L проходит через два репера, плоскость O2KL является плоскостью треугольника, а ось 02М перпендикулярна плоскости треугольника и образует правую систему координат (рис. 2).
Будем считать, что на этапе производства оборудования НСП измерена ориентация и положение реперного треугольника относительно системы координат, связанной со шлемом оператора. Система координат шлема ориентирована так, что одна из осей совпадает с оптической осью ВД (ось О^, рис. 2), закрепленного на шлеме. Таким образом, определив расположение в пространстве системы координат, привязанной к реперному треугольнику, можно вычислить ориентацию шлема и направление оптической оси оператора.
Вычислять положение и ориентацию реперного треугольника предлагается с помощью измерительной системы НСП, которая реализуется с использованием одной видеокамеры (рис. 3). В задачу измерительной системы входит опреде-
X
■ Рис. 2. Системы координат шлема и реперного треугольника
В С'
Линия визирования' оператора ___
■ Рис. 3. Расположение видеодатчика НСП
ление пространственных координат реперных точек в ее системе координат и пересчет измеренных координат в систему координат строительных осей летательного аппарата (носителя) с переводом их в угловые координаты визирной линии оператора в этой системе.
Конструктивное размещение светодиодов должно быть таким, чтобы они всегда находились в поле зрения видеокамеры измерительной системы. Для выполнения указанного условия может потребоваться большее количество светодиодов, позволяющих определить направление визирной линии оператора в широких диапазонах изменения положения и ориентации шлема оператора.
Модель изображения
Модель изображения, формируемая ВД измерительной системы НСП, может быть представлена следующим образом. На изображении, формируемом ВД, светодиоды (центры изображения светодиодов) представлены точками А, В, С и D (рис. 4). Координаты центров изображений светодиодов Ха, YA, Хв, Yв, Хс, Yc, Хв, YD в плоскости изображения каждого кадра (измерительная система координат OXY) определяются в блоке определения координат оптико-механической си-
■ Рис. 4. Изображение, формируемое ВД измерительной системы НСП
стемы [5]. Оптической оси ВД соответствует точка О на изображении. Считается известным угловое поле зрения ВД, которому соответствует прямоугольное изображение, формируемое ВД, размером 2Хм х 2УМ. По измеренным значениям ХА,
YA, Хв, Yв, Хс, Yc, Хв, YD и известным расстояниям между светодиодами (замеряются на этапе производства шлема) на момент получения видеокадра вычисляются пространственные координаты реперов в измерительной системе координат, по которым определяются угловые координаты линии визирования оператора.
Примем в качестве модели изображения, формируемого ВД с полем зрения (29д х 2фд), изображение размером 2Хд х 2Yд, получающееся на чувствительной прямоугольной пластине EFGH, перпендикулярной к оптической оси ВД SO и расположенной на расстоянии R от точки S (центра оптической системы ВД). Построение модели изображения осуществляется при условии, что любая произвольная точка пластины воспринимает только световой поток луча, проходящего через данную точку и центр S ВД (рис. 5, точка Б' на рисунке не показана для упрощения иллюстрации). Указанная модель изображения в некотором масштабе, зависящем от величины R и фокусного расстояния линзы, будет повторять изображение, формируемое ВД. В дальнейшем под создаваемым ВД изображением будем понимать изображение на плоском прямоугольнике EFGH, размеры которого определяются величинами R,
9д, фд.
Алгоритм вычисления угловых координат оптической оси оператора
Для вычисления угловых координат оптической оси нашлемного видеодатчика рассмотрим векторы SA, БД, SC, SD, пространственно ориентированные на реперные светодиоды А, В', С', Б'. Проекции векторов БА, БД, БС, ББ на оси системы координат STUV с учетом параллельности плоскостей EFGH и STV равны [Ха R Уд], [Хв R Ув], [Хс R Ус], [Хб R Уд]. Таким образом, координаты векторов БА, БД, БС, ББ в системе координат STUV равны
Та II Х Та = Я; Уа = —А
Тд = Хд; ид = Я; Уд = —д!
СТ II X и = Я; Ус = —с;
Тб II X Тб = Я; Уб = —Б
(1)
Изменение модуля вектора не меняет его направления, поэтому можно перейти к рассмотрению векторов Ба, БЪ, Бс, Бd с координатами
Т = ^ 9 иа = 1;
а Хд R МХд ё д а
V = —— = ^фд; Т = tg9д;
а —д R д ^ Ъ Хд R Мхд Д
тт = 1. у = —В—Д_ = tgф .
ъ = ; Уь = —д я = ы—А tg фд;
Т = ХсХд = tg9Д; ис = 1;
с Хд Я КХд Д с
V = —С—Д = КУС ^ ф ■ Т ХБ ХД КХБ tg 9 ■
Ус - —и - к—сtg фд’ Т=ХБ~я=КБ * 9д>
и=1 у =——=К—Б% фд’ (2)
где NXA, NYA, NXB, NYB, NXC, NYC, NXD, NYD’ NXд, NY!І — представление соответствующих величин в пикселях реально обрабатываемого изображения.
Рассматривая треугольники AASB', AASC', AB'SC', с использованием теоремы косинусов можно записать следующие выражения:
А'В'2 = БА'2 + БД'2 -2БА'БД'соь(А А'БД');
А'С'2 = БА'2 + БС'2 - 2БА'БС'соь(А А'БС');
ВС'2 = БД'2 + БС'2 - 2БД'БС'соэ(/ Д'БС'). (3)
Угол ZASB' между векторами БА' и БД' равен углу между векторами Ба и БЪ, поэтому его можно вычислить по выражению
(Ба,БЪ)
АА'БД' = асов ,_____. (4)
Ба|Бъ|
Углы ZASC', ZB 'SC' вычисляются аналогично. В НСП расстояния между светодиодами AB', BС', АС' являются известными величинами (измерены). Поэтому выражения (3) можно рассматривать как систему трех уравнений с тремя неизвестными SA, SB', SC' (расстояния от оптического центра ВД до центров светодиодов).
Уравнения в (3) относительно каждой переменной имеют второй порядок. Поэтому решить систему представляется возможным, например,
следующим способом. Решим в символьном виде первое уравнение относительно неизвестной SA, являющееся квадратным уравнением. Получившиеся два корня поочередно подставим во второе уравнение. Аналогично поступим с третьим уравнением, решим его символьно относительно неизвестной SC и подставим корни во второе уравнение. В результате из второго уравнения системы (3) получим нелинейное уравнение четвертого порядка, решение которого можно найти аналитически или численными методами в диапазоне допустимых расстояний от ВД до светодиодов. В результате решения системы уравнений (3) получим шестнадцать возможных решений. Решения, содержащие отрицательные значения или не укладывающиеся в диапазон допустимых значений, можно сразу отбросить, так как расстояния от ВД до светодиодов неотрицательные величины и имеют диапазон значений, ограниченный физическими возможностями оператора по перемещению в кабине носителя головы (шлема) и расположением оператора относительно ВД системы позиционирования. Для общности будем учитывать все шестнадцать решений.
По значениям расстояний от центра ВД до светодиодов (&А', SB', SC') и координатам векторов (Ба, Sb, Sc), указывающих направление на светодиоды, можно вычислить координаты светодиодов в системе координат ВД STUV. Получив шестнадцать наборов возможных координат вершин реперного треугольника АЛВС, перейдем к процедуре поиска единственного истинного решения.
По вычисленным координатам точек А, В', С' и измеренному, например на этапе производства, взаимному расположению всех светодиодов легко найти в системе координат STUV координаты точки D' [TD', UD, VD']. В результате в общем случае получим шестнадцать наборов координат точек А, В', С' и D' для каждого решения системы (3). Для выбора истинного решения необходимо сравнить направление вектора SD' (вектор направлен из начала координат точки S в вычисленную точку D’) с направлением вектора Бй. Только для одного (истинного) решения направления векторов SD' и Бй совпадут.
Если решение системы уравнений (3) было получено с использованием численных методов, то выбирать решение, описывающее положение реперного треугольника в пространстве, следует такое, чтобы абсолютное значение угла между вектором БЛ' , соответствующего решению системы (3), и вектором Бй было как можно меньше.
По координатам вершин реперного треугольника легко определить ориентацию реперного треугольника в пространстве в текущий момент времени. Для этого следует вычислить направляющие косинусы базиса системы координат O2KLM
в системе координат ВД STUV. Таким образом, можно найти углы Эйлера, показывающие поворот системы координат реперного треугольника относительно системы координат ВД НСП. Будем считать, что измерены углы поворота системы координат реперного треугольника относительно системы координат ВД НСП в момент юстировки. Тогда легко вычислить текущие угловые координаты линии визирования оператора как разность текущих углов поворота и углов поворота в момент юстировки системы координат реперного треугольника относительно измерительной системы НСП.
Заключение
Таким образом, решена задача вычисления угловых координат линии визирования оператора. Использование НСП в комплексе бортового оптикоэлектронного оборудования позволяет расширить возможности последнего, повысить точность решения задачи автоматического сопровождения объектов, уменьшить нагрузку на оператора.
Исследования выполнены при поддержке государственного контракта № П1002 от 27 мая 2010 г., заключенного с Министерством образования и науки.
1. Алпатов Б. А., Бабаян П. В., Балашов О. Е., Сте-пашкин А. И. Обработка изображений и управление в системах автоматического сопровождения объектов: учеб. пособие / Рязан. гос. радиотехн. ун-т. — Рязань, 2011. — 236 с.
2. Алпатов Б. А., Балашов О. Е., Степашкин А. И. Повышение точности сопровождения объектов бортовой оптико-механической системой с двухосным карданным подвесом // Мехатроника, автоматизация, управление. 2008. Вып. 9. С. 20-23.
3. Алпатов Б. А., Балашов О. Е., Степашкин А. И. Прогнозирование угловых координат движущихся объектов в бортовых оптико-механических системах // Информационно-управляющие системы. 2011. № 5. С. 2-7.
4. Балашов О. Е., Степашкин А. И. Нашлемная система обзора и целеуказания // Вестник Рязанского государственного радиотехнического университета. 2011. Вып. 4 (38). С. 40-44.
5. Алпатов Б. А., Балашов О. Е., Степашкин А. И. Управление приводами гиростабилизированной платформы в видеокомпьютерной системе сопровождения объектов // Вестник Рязанской государственной радиотехнической академии. 2003. Вып. 12. С. 38-41.
