CC BY
92
УДК 629.78.05 + 520.6.05 В01: 10.18287/2412-7329-2016-15-1-122-131
ОПРЕДЕЛЕНИЕ ВЗАИМНОГО ПОЛОЖЕНИЯ И ОРИЕНТАЦИИ НАНОСПУТНИКОВ ПО АНАЛИЗУ ВИДЕОИЗОБРАЖЕНИЙ
© 2016 С. П. Симаков, Е. В. Устюгов
Самарский государственный аэрокосмический университет имени академика С. П. Королёва (национальный исследовательский университет)
В статье рассмотрено использование видеоизображений для определения ориентации и положения второго наноспутника (НС) относительно первого по серии фотокадров, сделанных первым НС. В качестве измерительных средств на первом НС используются коммерческие оптические камеры. Для решения поставленной задачи разработан подход, включающий в себя: алгоритм обработки изображений, генетический алгоритм дифференциальной эволюции и модель движения относительно центра масс. При этом учитываются требования к аппаратуре НС, которая накладывает ограничения по вычислительным ресурсам бортовой цифровой вычислительной машины (БЦВМ) и по качеству изображения, получаемого с оптической камеры. Разработанный подход более экономичный, чем известные методы определения относительного положения и ориентации. Верификация подхода проводилась на модельной задаче разделения двух НС, рассматриваемого на коротком интервале времени. Выявлена зависимость координат центра масс второго НС от текущей ориентации и пиксельных координат ориентира на фотокадре. Приведены графики погрешности определения ориентации и положения центра масс второго НС относительно первого. Подход показывает приемлемую точность на интервалах до 10 секунд для рассматриваемой задачи. При этом точность значительно падает с увеличением расстояния до второго НС.
Наноспутник, видеонавигация, генетический алгоритм, алгоритм обработки изображений, модель движения, относительные параметры движения.
Метод определения местоположения при помощи регистрирующей видеоаппаратуры широко применяется на больших космических аппаратах (КА). На данный момент проводятся многочисленные эксперименты, связанные с видеонавигацией. В качестве примера по использованию видеонавигации на КА можно привести эксперимент европейского космического агентства Mango-Tango [1; 2], целью которого является демонстрация технологий, связанных с наведением, навигацией и управлением, а также сближение в составе спутниковой группировки. На борту КА Mango установлена система видеорегистрации, при помощи которой фиксируется положение КА Tango на расстоянии до 500 км, а также определяется его положение на близком расстоянии (порядка 10 м) во время запланированных манёвров сближения.
Примером подобных экспериментов в России является эксперимент, проведённый на микроспутнике «Чибис-М». В рамках научной программы микроспутника «Чибис-М» с помощью специально разработанной оптической камеры был произведён эксперимент по определению положения и ориентации грузового корабля Прогресс-13М при отделении микроспутника от грузового корабля. В работе [3] описывается алгоритм, при помощи которого обрабатывалась поступающая при проведении эксперимента информация. Алгоритм использует метод Ньютона для нахождения трёх составляющих кватерниона ориентации и трёх координат центра масс. На каждом шаге алгоритма вычисляется несколько итераций методом Ньютона, что делает алгоритм требовательным к ресурсам БЦВМ.
Цитирование: Симаков С.П., Устюгов Е.В. Определение взаимного положения и ориентации наноспутников по анализу видеоизображений // Вестник Самарского государственного аэрокосмического университета имени академика С.П. Королёва (национального исследовательского университета). 2016. Т. 15, № 1. С. 122-131. DOI: 10.18287/2412-7329-2016-15-1-122-131
Поскольку аналогичную задачу планируется решить на борту НС, то с учётом требований к аппаратуре НС, которая накладывает ограничения по вычислительным ресурсам БЦВМ и по качеству изображения, получаемому с оптической камеры, необходимо разработать подход, требующий меньшего количества вычислений, чем предложенный в [3].
Целью работы является разработка подхода, позволяющего определить относительное положение и относительную ориентацию двух близко летящих НС в условиях отсутствия информационного обмена между ними.
Под понятием относительного положения понимается положение центра масс второго НС относительно первого в системе координат, связанной с первым НС.
В работе используются следующие системы координат:
1. Связанная система координат первого НС (ССК 1) 01 х1 у1 г1 с началом в центре масс первого НС (рис. 1). Ось 01 х1 направлена вдоль продольной оси НС. Ось 01 у1 располагается в плоскости сим-
метрии, совпадающей с плоскостью траектории, и направлена вверх. Ось 012Х дополняет систему координат до правой.
2. Связанная система координат второго НС (ССК 2) 02 х2 у 2 2 2 с началом в центре масс второго НС (рис. 1). Направления координатных осей принимаются аналогично ССК 1.
3. Приборная система координат первого НС (ПСК) 0рх(у[2\ с началом в
центре плоскости матрицы камеры первого НС (рис. 1). Направления координатных осей принимаются аналогично ССК 1. ПСК получена параллельным переносом вдоль оси 01 х1 ССК 1 на расстояние 0х0р, известное из конструктивных параметров первого НС. Плоскость 0 у[2[ совпадает с плоскостью камеры.
4. Система координат камеры (СКК) 0кXкУк с началом в верхнем левом углу фотокадра (рис. 2). Ось 0к Хк направлена по горизонтали вправо, ось 0кУк - по вертикали вниз.
Рис. 1. Выбранные системы координат
wY.
Рис. 2. Система координат камеры
Матрицу перехода от ССК 1 к ССК 2 представим в виде:
A = üj ,(i, j = 1,3), a11 = cos в cos у, a12 = cos в sin у, a13 = - sine,
a21 = - cos p sin у + sin p sin в cos у, a 22 = cos p cos у + sin у sine sin p, a 23 = sin pcose,
a31 = sin psiny + cospsinecosy, a32 = - sin pcos у + cos psin в sin y, a33 = cos ecos p.
Компоненты матрицы параметризованы углами Крылова: в - угол тангажа, у - угол рыскания, p - угол крена [4].
При решении поставленной задачи учитывалось действие только возмущающего гравитационного момента. Проекции
гравитационного момента на оси ССК 2 определяются по формулам [4]:
3^
R '
3^
R
3^
Mxg = (I2 - Iy )ü23ü33 ,
Myg =~Ü(Ix - Iz
M2g = R3 i1 y - Ix )a13a2
где а ^, (', ] = 1,3) - элементы матрицы перехода от ССК 1 к ССК 2; Я - расстояние от притягивающего центра до спутника; ц
- гравитационный параметр Земли; Iх, 1у,
- главные центральные моменты инерции спутника.
Так как оси ССК 2 совпадают с главными центральными осями инерции НС, то уравнения движения НС относительно центра масс принимают форму динамических уравнений Эйлера [4]:
Ix® х + (I2 - Iy )®y®Z = Mxe ,
Iy(0 y + ( Ix - Iz )®2®x = Mye ,
Izé 2 + (Iy - Ix = Mze,
(1)
где Мхв, Мув, М2в - проекции главного момента внешних сил на оси ССК 2; с х, с у , - проекции угловых скоростей сс на оси ССК 2.
Учтём, что орбита круговая, и дополним динамические уравнения Эйлера тремя кинематическими уравнениями, устанавливающими связь первых производных по времени углов Крылова с проекциями вектора угловых скоростей на связанные оси с , с , с :
а>х =p +у/ sin в + ®0 cos в sin у,
ау =уcosвcosp + в sinp-0o(cosysinp + sinysinв cosp), (Oz =в cosp-у/ cosвsinp-0o(cosycosp-sinysinв sinp),
(2)
где с0 - орбитальная скорость НС.
Построим модель движения второго НС в проекции на СКК.
Рассмотрим некоторую точку г на поверхности второго НС, радиус-вектор которой имеет вид Г21 = [х21,у2а, 2'21]Т в
ССК 2. В ПСК эта точка имеет координаты Т\г = [ х1\, у[х, 2'и]Т .
Координаты точки г в ПСК могут быть записаны через координаты в ССК 2 следующим образом:
Г12 = OA + A • r21-
(3)
Точка г, согласно проекционной геометрии и уравнениям (3), будет иметь на снимке координаты:
X!. =
Yi = -
У1
1 - z / f к 1 - z; / f
(4)
где / - фокусное расстояние камеры; XК, У[ - пиксельные координаты г точки.
Соотношения (4) составляют математическую модель камеры, установленной на первом НС.
Для определения относительной ориентации и положения второго НС будем использовать подход, включающий в себя алгоритм обработки изображений [5], генетический алгоритм дифференциаль-
ной эволюции [6] и модель движения относительно центра масс (1), (2).
Подход включает в себя следующие этапы.
1. На сделанном оптической камерой снимке при помощи обработчика изображений [5] выделяются пиксельные координаты особых точек на поверхности второго НС - Х'к, Угк (г > 3). Большее количество особых точек увеличивает точность работы алгоритма и время обработки каждого снимка. Необходимым для решения задачи является наличие не менее трёх особых точек.
2. Производится генерация векторов ориентации, каждый из которых содержит значения в, у, р. Генерация проводится в рамках доверительного интервала, определённого из рекомендаций по настройке генетического алгоритма [6].
3. Смоделированные значения подставляются в соотношения (4), откуда находятся Xк.той, Угк той для каждой тройки значений в, у, р.
4. Проводится оценка вектора ориентации при помощи функции рассогласования:
Ф( X,
Y'
tf.mod' tf.mod
) =
^ ((Хк - Xlmod)2 + (Y - Ylmod )2).
(5)
5. Проводится фильтрация созданных значений в, у, р из условия минимума полученной оценки (5) и создание новых векторов ориентации по методике, предложенной в [6].
6. Проверяется условие
Ф( X к .mod, ^x.mod) < Sзад. .
В случае невыполнения условия осуществляется переход к пункту 5.
7. Вычисляются координаты центра масс второго НС по соотношениям:
Xc =
Y = z =
X1 (a31l1 + a32l2 + a33l3) + f (ai1g1 + ai2 S 2 + $13 S3)
П
(^31^1 + ^32/2 + $33/3) + f (^21 $1 + $22^2 + a23^3 )
f • e - (a31m1 + a32m2 + a33m3) - f (a11/1 + a12/2 + a13/3)
+ ,
e
где а^, (г, ] = 1,3) - элементы матрицы перехода от ССК 1 к ССК 2; коэффициенты имеют вид:
т1 = Х' ■ Х22 - Х! ■ Х21, т2 = Х' ■ У22 - Х! ■ У21, Ш3 = Х1 ' 222 - Х! ' Z21,
= Х1 - = Х1 - = Х1 -
§1 = „2 Х22 Х21, §2 = т^2 У22 У21, §3 = „2 222 2 21, Х 1 Х 1 Х 1
У1 У1 У1
/1—1 /1—1 /1—1
а\ = У2 Х22 — Х21, а2 = У2 у22 — у21, й3 = У2 222 — 2 21, У1 У1 У1
11 = Х22 — Х21, 12 = У22 — у21, 13 = 222 — 221,
П1=/ (1 - Х^), П2=/ (1 - У2), Х1 У1
е = Х 2 - Х1.
Соотношения (6) получены следующим образом: подставив уравнения (3) в уравнения (4) и разрешая полученную систему уравнений относительно координат центра масс, получаем искомые зависимости.
8. Рассчитывается начальное приближение вектора ориентации для следующего кадра по уравнениям (1 ), (2).
В качестве примера, на котором рассмотрен метод решения, взят численный эксперимент по определению относительного положения и ориентации одного из НС при их взаимном разделении. НС имеют формат СиЬеБа1 3и. Разделение происходит по продольной оси НС. В табл. 1 приведены высота орбиты разделения, угловые скорости, сообщаемые при разделении, массоинерционные и габаритные характеристики НС.
Решение задачи производится в интервале от 0 до 10 с после отделения на расстоянии до 10 м. На рис. 3 изображено изменение углов ориентации в зависимости от времени, на рис. 4 - изменение координат центра масс в зависимости от
времени. Точность решения поставленной задачи приводится на рис. 5, 6.
Таблица 1. Параметры орбиты и разделения, массо-инерционнные и габаритные характеристики
Параметры орбиты
Высота, км 380
Параметры разделения
Угловые скорости, град./с
Ох 0
о у 4
о 2 4
Массо-инерционные и габаритные характеристики
Моменты инерции, м2
1х 0,00405
1у, 12 0,0146
Длина, м 0,3
Масса, кг 2
Рис. 3. Изменение углов ориентации: 1 - исходный угол р; 2 - восстановленный угол р ; 3 - исходный угол у; 4 - восстановленный угол у/; 5 - исходный угол 6; 6 - восстановленный угол 6
6000
4000
| &
а 2000
I
£
:1
2
3
5 ! 10 6
Время, с
Рис. 4. Изменение координат центра масс: 1 - исходная координата X ; 2 - восстановленная координата Xс
3 - исходная координата Ус ; 4 - восстановленная координата Ус
5 - исходная координата Хс ; 6 - восстановленная координата Хс
Рис. 5. Ошибки углов ориентации: 1 - угол р; 2 - угол у; 3 - угол в
1
2/
■
8 I
Я 40 <1
Время, с
Рис. 6. Ошибки координат центра масс: 1 - координата Х ; 2 - координата У ; 3 - координата X
По результатам, приведённым на рис. 5, 6, можно сделать вывод, что точность решения значительно падает с отдалением камеры от рассматриваемого объекта. Данный пример показывает, что разработанный подход определения относительного положения и ориентации применим для небольших взаимных расстояний, когда отчётливо видна геометрия второго НС и можно с хорошей точностью определить положение точек-маркеров.
Дальнейшим развитием работы является повышение точности подхода на больших взаимных расстояниях за счёт усложнения генетического алгоритма.
Исследование выполнено при финансовой поддержке Министерства образования и науки Российской Федерации в рамках проектной части госзадания (проект № 9.1421.2014/К).
Библиографический список
1. PRISMA (Prototype Research Instruments and Space Mission technology Advancement).
https://direct0ry.e0p0rtal.0rg/web/e0p0rtal/satellite-missi0ns/p/prisma-pr0t0type.
2. Karlsson T., Larsson R., Jackobsson B., Bodin P., Larsson B. Prisma irides: Performance at the end of the drift phase and planned rendezvous experiments // GNC 2014: 9th International ESA Conference on Guidance, Navigation & Control Systems, 2014.
3. Иванов Д.С., Карпенко С.О., Овчинников М.Ю. Определение относительного движения спутников при их разделении по результатам обработки видеоизображения. М.: ИПМ им. М.В. Келдыша РАН, 2012. 24 с.
4. Попов В.И. Системы ориентации и стабилизации космических аппаратов. М.: Машиностроение, 1986. 184 с.
5. Басараб М.А., Волосюк В.К., Горячкин О.В., Зеленский А.А. Цифровая обработка сигналов и изображений в радиофизических приложениях. М.: Физматлит, 2007. 544 с.
6. Storn R., Price K. Differential Evolution - A Simple and Efficient Heuristic for Global Optimization over Continuous Spaces // Journal of Global Optimization. 1997. V. 11, Iss. 4. P. 341-359.
Информация об авторах
Симаков Сергей Петрович, магистрант, Самарский государственный аэрокосмический университет имени академика С.П. Королева (национальный исследовательский университет). E-mail: [email protected]. Область научных интересов: навигация и управление в космосе.
Устюгов Ефим Владимирович, аспирант, Самарский государственный аэрокосмический университет имени академика С.П. Королева (национальный исследовательский университет). E-mail: [email protected]. Область научных интересов: навигация и управление в космосе.
DETERMINATION OF RELATIVE POSITION AND ORIENTATION OF NANOSATELLITES BY VIDEO IMAGE ANALYSIS
© 2016 S. P. Simakov, E. V. Ustyugov Samara State Aerospace University, Samara, Russian Federation
The article discusses the option of using video images to determine the orientation and the position of the second nanosatellite relative to the first one by a series of snapshots made by the first nanosatellite. Optical cameras installed on the first nanosatellite are used as measuring devices. A new approach has been developed to solve the task set. The approach includes an image processing algorithm, a genetic algorithm of differential evolution and a model of motion relative to the center of mass. The approach takes into account the requirements imposed on the nanosatellite hardware that sets limitations on the computational resource of the airborne digital computer and on the quality of images obtained from the optical camera. The developed approach is more economic than similar algorithms. The approach was verified by the benchmark problem of separating two nanosat-ellites in a short time interval. The dependence of the coordinates of the center of mass of the second satellite on the current orientation and pixel orientation target coordinates in the shot is revealed. The paper includes graphs of the error of determining orientation and position of the center of mass of the second satellite relative to the first one. The approach demonstrates acceptable accuracy in the range of up to 10 seconds for the problem under consideration. The accuracy decreases dramatically as the distance between the two nanosatellites increases.
Nanosatellite, video navigation, genetic algorithm, image processing algorithm, model of motion, relative motion parameters.
References
1. PRISMA (Prototype Research Instruments and Space Mission technology Advancement). Available at:
https://directory.eoportal.org/web/eoportal/satellite-missions/p/prisma-prototype.
2. Karlsson T., Larsson R., Jackobsson B., Bodin P., Larsson B. Prisma irides: Performance at the end of the drift phase and planned rendezvous experiments. GNC 2014: 9th International ESA Conference on Guidance, Navigation & Control Systems, 2014.
3. Ivanov D.S., Karpenko S.O., Ovchinnikov M.Yu. Opredelenie otnositel'nogo dvizheniya sputnikov pri ikh razdelenii po rezul'tatam obrabotki videoizobrazheniya [Determination of separating satellites' relative motion based on the results of video image processing]. Moscow: Keldysh Institute of Applied Mathematics Russian Academy of Sciences Publ., 2012. 24 p.
4. Popov V.I. Sistemy orientatsii i stabilizatsii kosmicheskikh apparatov [Spacecraft orientation and stabilization systems]. Moscow: Mashinostroenie Publ., 1986. 184 p.
5. Basarab M.A., Volosyuk V.K., Goryachkin O.V., Zelenskiy A.A. Tsifrovaya obrabotka signalov i izobrazheniy v radiofizicheskikh prilozheniyakh [Digital signal and image processing in radio physical applications]. Moscow: Fizmatlit Publ., 2007. 544 p.
6. Storn R., Price K. Differential Evolution - A Simple and Efficient Heuristic for Global Optimization over Continuous Spaces. Journal of Global Optimization. 1997. V. 11, Iss. 4. P. 341-359.
Citation: Simakov S.P., Ustyugov E.V. Determination of relative position and orientation of nanosatellites by video image analysis. Vestnik of the Samara State Aerospace University. 2016. V. 15, no. 1. P. 122-131. DOI: 10.18287/2412-73292016-15-1-122-131
About the authors
Simakov Sergey Petrovich, master student, Samara State Aerospace University, Samara, Russian Federation. E-mail: [email protected]. Area of Research: navigation and guidance in space.
Ustyugov Efim Vladimirovich, post-graduate student, Samara State Aerospace University, Samara, Russian Federation. E-mail: [email protected]. Area of Research: navigation and guidance in space.
