Системы управления,связи и безопасности №3. 2022
Systems of Control, Communication and Security ISSN 2410-9916
УДК 629.7.054.07
Метод вычисления параметров линейного движения беспилотного летательного аппарата в условиях отсутствия сигналов спутниковых радионавигационных систем на этапе посадки
Исаев М. А., Исаев А. М., Линец Г. И.
Актуальность: беспилотные летательные аппараты (БЛА) мультироторного типа используются как элемент комплексов охраны и мониторинга удалённых стационарных объектов. Ключевой особенностью данных БЛА является их высокая автономность, которая достигается за счёт автоматизации всех этапов полётного задания, таких как взлёт, полет по маршруту и посадка. Наиболее сложным и ответственным этапом является посадка в контейнер автономного базирования, что требует высокой точности оценки параметров линейного движения БЛА. Однако, эксплуатируемые системы охраны и мониторинга не обеспечивают требуемой точности оценки местоположения БЛА на этапе посадки в условиях отсутствия сигналов спутниковых радионавигационных систем (СРНС), что не позволяет размещать контейнеры автономного базирования БЛА вблизи индустриальных или природных объектов, затеняющих или искажающих сигналы навигационных спутников. Целью работы является повышение точности позиционирования БЛА мультиро-торного типа на этапе посадки в контейнер автономного базирования в условиях отсутствия сигналов навигационных спутников за счёт использования предложенной системы локального позиционирования для замены данных бортового приёмника СРНС в контуре коррекции параметров линейного движения БЛА. Используемые методы: для мультиплексирования данных инерциальных измерителей и данных бортового приёмника СРНС или локальной системы позиционирования использован фильтр Калмана. Вычисление координат БЛА относительно посадочной площадки в условиях отсутствия достоверных сигналов СРНС выполняется с применением алгебры кватернионов. Новизна: впервые для определения координат БЛА мультироторного типа относительно посадочной площадки использован квадрантный датчик, установленный на 3-х осевом гиростабилизированном подвесе. Предложен способ сканирования области предполагаемого нахождения инфракрасного маяка, а также его сопровождения в режиме реального времени по сигналам 4-х фоточувствительных элементов квадрантного датчика. В отличие от известных методов оценки местоположения мультироторного БЛА относительно посадочной площадки, применена алгебра кватернионов и предложен метод коррекции навигационной системы БЛА с бесшовным переключением между различными источниками корректирующей информации. Результат: использование предложенного метода позволяет обеспечить погрешность оценки местоположения БЛА мультироторного типа на этапе посадки не хуже 0,19 м в условиях отсутствия достоверных сигналов СРНС. Практическая значимость: решение задачи посадки БЛА мультироторного типа на ограниченную площадку в условиях отсутствия достоверных сигналов навигационных спутников позволяет удовлетворить требования практики к размещению контейнеров автономного базирования БЛА и повысить оперативность реагирования комплекса на сигнал тревоги.
Ключевые слова: беспилотный летательный аппарат, инерциальная навигационная система, локальная системы позиционирования БЛА, спутниковые радионавигационные системы.
Библиографическая ссылка на статью:
Исаев М. А., Исаев А. М., Линец Г. И. Метод вычисления параметров линейного движения беспилотного летательного аппарата в условиях отсутствия сигналов спутниковых радионавигационных систем на этапе посадки // Системы управления, связи и безопасности. 2022. № 3. С. 67-89. DOI: 10.24412/2410-9916-2022-3-67-89. Reference for citation:
Isaev M. A., Isaev A. M., Linets G. I. Method for calculating the parameters of linear motion of an unmanned aerial vehicle in the absence of signals from satellite radio navigation systems at the landing stage. Systems of Control, Communication and Security, 2022, no. 3, pp. 67-89 (in Russian). DOI: 10.24412/24109916-2022-3-67-89.
DOI: 10.24412/2410-9916-2022-3-67-89
Системы управления,связи и безопасности №3. 2022
Systems of Control, Communication and Security ISSN 2410-9916
Введение
В настоящее время мультироторные беспилотные летательные аппараты (БЛА) все чаще используются в качестве подсистемы комплекса охраны и мониторинга удалённых стационарных объектов [1-4].
Задачи мониторинга и реагирования на сигнал тревоги требуют минимального времени подлёта к зоне наблюдения и поиска, что достигается за счёт размещения БЛА внутри контейнера автономного базирования, установленного на охраняемой территории. Контейнер базирования обеспечивает постоянную готовность БЛА к вылету и защиту от воздействий неблагоприятных факторов внешней среды.
Фактическое размещение контейнера базирования БЛА должно выбираться исходя из анализа инфраструктуры охраняемого объекта таким образом, чтобы уменьшить издержки эксплуатации комплекса, а также минимизировать время подлёта БЛА к наиболее вероятным зонам проникновения нарушителя.
Практика использования БЛА для охраны и мониторинга удалённых объектов предъявляет высокие требования к автоматизации процессов взлёта, посадки, заряда или замены аккумуляторной батареи. Самым сложным этапом полёта является автоматическая посадка БЛА на площадку контейнера базирования, которая должна быть обеспечена в любое время суток в широком диапазоне погодных условий.
Существующие комплексы с базированием БЛА в контейнере, такие как: Nightingale, Dronehub, SENSYN Drone Hub, COEX Пеликан, Smart Aerial Monitoring Systems SAMS, Percepto Air Mobile и др. [5-17] обеспечивают необходимую для этапа посадки точность позиционирования в условиях хорошей освещённости, минимальном уровне дождя, а также при наличии достоверных сигналов спутниковых радионавигационных систем (СРНС). Однако, при их затенении, искажении или переотражении не обеспечивается требуемая точность позиционирования при посадке на ограниченную площадку, что накладывает существенные ограничения на место размещения контейнера базирования БЛА.
Таким образом, известные эксплуатируемые системы не позволяют размещать контейнер базирования вблизи сооружений, затеняющих сигналы СРНС и требуют хороших условий освещённости посадочной площадки.
Исходя из анализа существующих систем БЛА контейнерного базирования можно сделать вывод о том, что актуальной задачей является разработка локальной системы позиционирования БЛА на этапе посадки, обеспечивающей требуемую точность посадки в условиях отсутствия достоверных сигналов СРНС, а также в широком диапазоне погодных условий и освещённости посадочной площадки.
Анализ предыдущих работ в исследуемой предметной области
Существующие алгоритмы выработки навигационного решения, применяемые в системах управления БЛА мультироторного типа, комплексируют сигналы инерциальных измерителей и СРНС, обеспечивая точность, достаточную для взлёта и выполнения полётного задания. При комплексировании дан-
DOI: 10.24412/2410-9916-2022-3-67-89
Systems of Control, Communication and Security
ISSN 2410-9916
ных в качестве основного источника используется информация от бортовых инерциальных измерителей в соответствии с основным уравнением инерциаль-ной навигации [18]:
где: р - вектор местоположения; а - вектор линейных ускорений.
Возникающую при этом погрешность определения фактического местоположения БЛА периодически корректируют с использованием сигналов бортового приёмника СРНС, обеспечивая погрешность позиционирования до 5 м. Однако, для посадки на площадку контейнера базирования БЛА требуется более точное навигационное решение, погрешность которого не должна превышать 0,35-0,4 м относительно центра посадочной площадки.
Для увеличения точности позиционирования БЛА на этапе посадки применяется ряд методов [19-27].
Использование режима Real Time Kinematic (RTK) в бортовом приёмнике СРНС улучшает точность оценки координат до сантиметровых значений за счёт использования дополнительной информации от базовой станции коррекции. Однако, точность определения координат уменьшается с увеличением расстояния между БЛА и базовой станцией коррекции [19]. На практике использование локальной станции коррекции возможно только в том случае, когда она расположена в непосредственной близости от контейнера базирования. Для получения заявленной точности позиционирования БЛА при посадке требуется угол обзора до 30° над горизонтом и отсутствие препятствий на пути распространения сигналов навигационных спутников. Кроме того, на точность вычисления поправок RTK влияют различного рода помехи, создаваемые базовыми станциями мобильной связи, высоковольтными трансформаторами
В реальных условиях здания и другие препятствия мешают приёму сигналов СРНС и могут привести к их потере (эффект многолучевого распространения, электромагнитный шум, создаваемый активными излучателями). Переотражённый сигнал СРНС от металлических крыш строений, находящихся вблизи контейнера базирования, приводит к скачкообразному изменению определяемых координат и высоты полёта БЛА.
Таким образом, использование режима RTK обеспечивает требуемую для посадки точность позиционирования БЛА только в условиях отсутствия помех распространению сигналов СРНС и обеспечения условий угла обзора над горизонтом до 30°, что при эксплуатации БЛА контейнерного типа в определенных условиях может не выполняться.
Известен способ коррекции оценки местоположения БЛА на этапе посадки с применением системы IR-Lock [21], которая использует инфракрасный (ИК) маяк на посадочной площадке, размещённую на борту БЛА специализированную видеокамеру PIXY [22] с матрицей 1280 х 800 пикселей, углом зрения 75° по горизонтали и 47° по вертикали. Методы обработки изображения используют алгоритмы фильтрации по цвету, оптимизированные для распозна-
0 0
и т.д. [20].
DOI: 10.24412/2410-9916-2022-3-67-89
Системы управления,связи и безопасности №3. 2022
Systems of Control, Communication and Security ISSN 2410-9916
вания ИК маяка и вычисления его координат по осям XY относительно центра кадра. Полученные координаты используются в алгоритме вычисления параметров движения в качестве корректирующей информации, что позволяет повысить точность определения местоположения БЛА относительно посадочной площадки до требуемых значений. Однако, в условиях отсутствия сигналов СРНС данная система обеспечивает отклонение БЛА более 1 м от точки размещения ИК маяка при высоте полёта 5 м [23], что недостаточно для выполнения точной посадки БЛА в контейнер базирования. Видимость ИК маяка ограничена углом обзора камеры и требует достаточно точного выхода БЛА в зону посадки. Жёсткое крепление видеокамеры к корпусу БЛА приводит к увеличению ошибки позиционирования при усилении ветровой нагрузки.
В работах [11-17] представлены способы, использующие системы технического зрения (СТЗ) в качестве источника корректирующей информации на этапе посадки БЛА в контейнер базирования. На посадочную площадку наносятся специализированные маркеры ArUco и AprilTag. При помощи штатной, стабилизированной по трём осям бортовой видеокамеры происходит отслеживание маркеров на этапе посадки. В наземном или бортовом вычислителе производится распознавание и оценка положения маркера в кадре, определения высоты и курсового угла относительно посадочной площадки [24]. Полученная информация используется для коррекции оценки местоположения БЛА. Однако, обработка видеопотока требует наличия высокопроизводительного компьютера на борту БЛА, что является трудно реализуемым. В случае выполнения обработки изображения наземным оборудованием, в контуре системы управления БЛА появляется дополнительная транспортная задержка, что не позволяет обеспечить требуемую точность в условиях ветровой нагрузки и отсутствия достоверных данных от СРНС. Системы, использующие методы распознавания образов, чувствительны к уровню освещённости и оптическим помехам в виде теней, лёгкого тумана, снегопада слабой интенсивности.
Для повышения точности позиционирования в [25] используется информация от СТЗ, которая применяется в расширенном векторе пространства состояний фильтра Калмана (ФК). Однако, заявленная точность обеспечивается только при наличии достоверных сигналов навигационных спутников, что не позволяет применять данный метод для эксплуатации БЛА контейнерного типа в условиях недостоверных сигналов СРНС.
В патенте [26] информация о положении БЛА относительно центра кадра применяется для формирования корректирующих команд в контуре системы управления, обеспечивая наведение на центр посадочной площадки с помощью «виртуального пилота». При таком подходе повышение точности позиционирования БЛА достигается только в условиях достоверных сигналов СРНС, но при их искажении или отсутствии требуемая точность не обеспечивается.
В работе [27] авторы используют инерциальные измерители и СТЗ для оценки местоположения, однако предложенный способ не обеспечивает вычисление навигационного решения вне зоны видимости посадочной площадки и не позволяет выполнять полет по заданному маршруту в автоматическом режиме.
DOI: 10.24412/2410-9916-2022-3-67-89
Системы управления,связи и безопасности №3. 2022
Systems of Control, Communication and Security ISSN 2410-9916
Таким образом, основным недостатком известного научно-методического аппарата является невозможность обеспечения требуемой точности позиционирования БЛА в условиях отсутствия достоверных сигналов СРНС для выполнения посадки на площадку контейнера базирования.
Необходимо разработать метод, обеспечивающий требуемую точность позиционирования БЛА для посадки в контейнер базирования в условиях отсутствия достоверных сигналов СРНС в широком диапазоне погодных условий в любое время суток.
Постановка задачи
Будем считать, что для решения задачи вычисления местоположения с использованием модели плоской Земли используются следующие системы координат:
- земная система координат Г - начало которой совпадает с опорной точкой, заданной при формировании полётного задания. Ось ОХ направлена на географический Север, ось ОУ - на Восток, ось ОХ -вниз по местной вертикали.
- подвижная земная система координат БЛА Ги - начало расположено в центре масс БЛА, оси совпадают по направлению с осями земной системы координат Г;
- связанная с БЛА система координат Гь - начало расположено в центре масс БЛА, ось ОХ - расположена в плоскости симметрии БЛА и направлена к носовой его части. Ось ОУ - перпендикулярна плоскости симметрии БЛА и направлена к правой его части. Ось ОХ - расположена в плоскости симметрии и направлена к нижней части БЛА.
Требуется разработать метод, обеспечивающий вычисление параметров линейного движения БЛА контейнерного базирования в следующих условиях:
- наличия достоверных сигналов СРНС;
- отсутствия достоверных сигналов СРНС;
- отсутствия достоверных сигналов СРНС при использовании данных от локальной системы позиционирования контейнера базирования.
В качестве ограничения при решении задачи будем использовать погрешность позиционирования БЛА на этапе посадки, которая не должна превышать
= Папа - Гёеаг , ^ Г1аМ - рЗД^ вписанной в посЗД°чную пл°ЩЗДку °ВДж-
ности; г§еаг - радиус окружности описанной вокруг посадочного шасси БЛА.
Для уменьшения погрешности перепроектирования географических координат в плоские координаты предлагается использовать в качестве опорной координаты целевую навигационную точку полётного задания.
Решение
Для управления полётом мультироторного БЛА его навигационная система должна выполнять оценку параметров вращательного и линейного движения. В работах [28] данная задача решается в едином алгоритме, что увели-
DOI: 10.24412/2410-9916-2022-3-67-89
Systems of Control, Communication and Security
ISSN 2410-9916
чивает точность оценки параметров вращательного и линеиного движения за счёт использования большого объёма данных от бортовых датчиков и учёта их перекрёстных связеИ. Однако, в случае искажения сигналов СРНС возрастает погрешность оценки углов ориентации, что снижает адекватность управляющего воздействия. В случае раздельного решения задач вычисления параметров вращательного и линеиного движения недостоверные данные СРНС не влияют на определение пространственной ориентации БЛА.
Для описания пространственной ориентации БЛА по измерениям датчиков угловой скорости, линейных ускорений и напряжённости магнитного поля Земли предлагается использовать подход, описанный в [29].
Ориентация связанной с БЛА системы координат Рь относительно подвижной Земной системы координат Ри описывается кватернионом Л, который используется для отображения измерений датчика линейных ускорений из Рь в Ри.
Основным режимом работы навигационной системы является использование сигналов СРНС для коррекции оценки скорости и местоположения БЛА. При попадании БЛА в зону подавления или искажения сигналов СРНС используется только инерциальный метод счисления пути. Для выполнения посадки в контейнер базирования вместо данных бортового приёмника СРНС используется локальная система позиционирования.
Для вычисления параметров линейного движения требуется осуществлять их прогноз [30]:
х = Р х + В и
к|к 1 к к |к 1 к к^ /" 1 \
Р = РР Рт + О (1)
1 к|к-1 1 к1 к-1|к-11 к ^Ок,
где: хк|к-1 - вектор пространства состояний, содержащий оценку параметров движения инерциальным методом; Рк - матрица перехода состояний, которая применяется к состоянию за предыдущий квант времени хкНк-1; ик - вектор управления; Вк - матрица перехода вектора управления в вектор пространства состояний; Рк|к-1 - априорная ковариационная матрица; Ок - матрица шумов шага прогноза.
При наличии достоверных данных от СРНС используем шаг коррекции [30]:
У к = 2к ~Нкхцк-\> 8к=НкРщ_хНт+Rk■
Kk=Pщ_lHтSll■ (2)
хцк = хк\к-1 +Ккук', Рщ=(1-КкНк)РЦк__19
где: ук - вектор невязки измерений; гк - вектор, содержащий измерения бортового модуля СРНС; Нк - матрица приведения вектора хк|к-1 к
DOI: 10.24412/2410-9916-2022-3-67-89
Systems of Control, Communication and Security
ISSN 2410-9916
размерностям вектора 2к; Бк - ковариационная матрица вектора ошибки; Як -матрица шумов измерителя; Кк - оптимальная по Калману матрица коэффициентов усиления.
На шаге прогноза (1) используется основное уравнение инерциальной навигации для обновления оценки вектора скорости и местоположения БЛА [31]. Для шага коррекции необходимо обеспечить согласование измерений бортового приёмника и инерциального метода счисления пути в модели плоской Земли. С этой целью выполним проекцию географических координат, полученных от бортового приёмника СРНС в модель плоской Земли [31]:
V т = т-т0; d 1 = 1-1„
ь0 5
R
R
n
H
2\ • 2 с ) sin m
R.^ = R
VM
n
2с
1-(2с - с2)
2\ • 2 : с ) sin m
p =
1 - (2с d m
(3)
/
arctan
1
л '
p=
è rm d i
/
arctan
1
rn cos(mo)
где: m0 и i0 -
^roi 0 опорные значения долготы
и широты соответственно;
т и I - значения долготы и широты, проекцию которых необходимо выполнить в модель плоской Земли; с - коэффициент «сплющивания» планеты; Я - экваториальный радиус Земли; и Ям - вспомогательные коэффициенты для выполнения проекции; Рх и Ру - проекция долготы и широты в модель плоской Земли относительно опорных координат т0, V
Полученные координаты Рх и Ру используются в (2) как измерения местоположения БЛА в векторе 2к. Выполнение проекции географических координат в плоские координаты за пределами фильтра Калмана позволяет упростить его реализацию, а также использовать другие источники информации о местоположении для уточнения параметров линейного движения.
Погрешность проекции при переходе из географических координат в плоские увеличивается с удалением БЛА от опорной точки. Для минимизации погрешности перехода из географических координат в плоские, координаты целевой точки полётного задания используются в качестве опорной.
DOI: 10.24412/2410-9916-2022-3-67-89
Systems of Control, Communication and Security
ISSN 2410-9916
Для обновления координат опорной точки, необходимо выполнить переход от плоских координат в географические [31]:
/ 1 Л
оЫ М"иау
. о1Ы
Pf arctan
1
è RM
old
+mo ;
Pyold arctan
è Rn cos
(mo )
+i
о1Ы
Далее вычислим значения опорных координат т™
(4)
и выполним про-
екцию географических координат mUd, X°HV в плоские координаты относительно
значений координат новой опорной точки:
о1Ы , ^ыау'
7 new new <
d m =mo -m;
j new _ new old .
d 0 uav;
P new =
dmn
arctan
Л '
new
y =
R
è RM
d i"
(5)
/
arctan
1
è rn cos (mo )
y
где:
по оси Х;
pnew У
рты _ оценка местоположения в плоских координатах - оценка местоположения в плоских координатах по оси У.
Обновление оценки параметров линейного движения происходит с частотой дискретизации инерциального измерителя согласно уравнению (1). При наличии достоверных данных для коррекции от бортового приёмника СРНС используется уравнение (3) для перехода из географических в плоские координаты и, затем, уравнение (2) для уточнения оценки параметров линейного движения БЛА.
В случае отсутствия достоверных данных СРНС (искажение, затенение, глушение и т.д.), навигационное решение обновляется в штатном режиме с нарастающей во времени ошибкой определения местоположения из-за погрешностей измерений датчиков угловой скорости и линейных ускорений. При появлении достоверных данных СРНС, возобновляется вычисление шага коррекции с использованием фильтра Калмана, что обеспечивает минимизацию ошибки оценки параметров линейного движения БЛА.
На этапе посадки БЛА в качестве опорной точки используются географические координаты центра посадочной площадки. Поскольку в фильтре Калма-на коррекция параметров линейного движения выполняется в плоских координатах относительно опорной точки, возможно выполнить замену данных бортового приёмника СРНС данными локальной системы позиционирования, которая определяет координаты относительно центра посадочной площадки. С этой целью введём локальную систему позиционирования, обеспечивающую
1
o
uav
I
0
1
DOI: 10.24412/2410-9916-2022-3-67-89
Systems of Control, Communication and Security
ISSN 2410-9916
вычисление местоположения БЛА относительно центра посадочной площадки. Для посадки БЛА в контейнер автономного базирования необходимо знать кратчайшее расстояние от центра БЛА до центра посадочной площадки (линия визирования), а также её проекцию на оси СК Еи.
Пусть ориентация связанной с линией визирования правосторонней системы координат ^ относительно подвижной Земной системы координат ¥и описывается кватернионом М. Начало ^ совпадает с центром масс БЛА, ось X совпадает с линией визирования (рис. 1).
Рис. 1. Определение координат БЛА относительно посадочной площадки
Кратчайшее расстояние в проекции на оси Т71 выражается вектором:
=(/,0,0), (6)
где: I - расстояние от центра БЛА до центра посадочной площадки.
Определим проекцию линии визирования на оси подвижной Земной СК: яи = моЯх' оМ, (7)
где: Яи - искомые координаты БЛА относительно посадочной площадки; о - символ, обозначающий операцию умножения кватернионов [28, 29];
Однако, в условиях реальной эксплуатации БЛА параметр / неизвестен.
Поэтому необходимо по косвенным измерениям оценить вектор Яи . Для этого выполним проекцию единичного вектора на оси подвижной Земной СК:
>М,
(8)
г" = М о г о
где г1'=(1,0,0).
Осуществим переход от проекции единичного вектора г" на оси к искомым координатам относительно посадочной площадки к :
Йи=г"'Ь, (9)
DOI: 10.24412/2410-9916-2022-3-67-89
Системы управления,связи и безопасности №3. 2022
Systems of Control, Communication and Security ISSN 2410-9916
где: Ь - масштабный коэффициент.
Зная значение любой из компонент вектора к можно вычислить коэффициент Ь. Вертикальную компоненту вектора Яи определим с помощью высотомера (барометрического, лазерного, ультразвукового). Тогда:
b = RU / r
U
(10)
где: Г - высота БЛА над посадочной площадкой.
Таким образом, уравнение (8) используется для проекции единичного вектора на оси подвижной Земной СК, уравнение (10) - для нахождения масштабного коэффициента Ь, уравнение (9) - для вычисления координат БЛА относительно центра посадочной площадки.
Для реализации предложенного метода на практике, предлагается использовать:
- ИК маяк, размещённый в центре посадочной площадки;
- размещённый на БЛА гиростабилизированный подвес (ГСП), имеющий 3 вращательные степени свободы;
- квадрантный датчик.
Квадрантный датчик состоит из 4-х фоточувствительных элементов с взаимно перекрывающимися диаграммами направленности (рис. 2), что позволяет выполнить его наведение на источник инфракрасного излучения по сигналам фоточувствительных элементов.
Рис. 2. Диаграмма направленности квадратного датчика в горизонтальной и вертикальной плоскостях
Гиростабилизированный подвес является электромеханическим устройством, выполняющим удержание заданного углового положения независимо от перемещений БЛА. С целью определения ориентации линии визирования на ИК маяк в режиме реального времени, установим квадрантный датчик на ГСП.
При выходе БЛА в зону посадки на заданной высоте необходимо выполнить поиск ИК маяка и его сопровождение для обеспечения вычисления место-
DOI: 10.24412/2410-9916-2022-3-67-89
Systems of Control, Communication and Security
ISSN 2410-9916
положения относительно центра посадочной площадки без использования сигналов СРНС.
Задача поиска посадочной площадки гиростабилизированным подвесом сводится к формированию его движения способом, обеспечивающим сканирование области предполагаемого нахождения ИК маяка.
Чтобы обеспечить полное перекрытие зоны предполагаемого нахождения ИК маяка, необходимо изменять заданные углы тангажа $ и азимута у гиро-стабилизированного подвеса. Значения углов $тАп,^^ и ут;п,ушах, а также скорости их изменения с$ и юу зависят от диаграммы направленности квадрантного датчика, высоты БЛА над сканируемой поверхностью и диаграммы направленности ИК маяка (рис. 2).
Углы $ и у задаются в земной подвижной системе координат БЛА ^ следующим образом:
U
J=J-1 -Dtx ;
jn
Уп
J U
jn-1 +W
U
Уп-1 + Wy
Dt s ; 'Dts,
(11)
где: $п Vп
и Vй - _
V У
ветственно; Д^ - период вычисления заданных углов тангажа и азимута.
и уп - заданные углы тангажа, крена и азимута соответственно; с$ ,ст и Су - заданные угловые скорости по тангажу, крену и азимуту соот-
В режиме поиска угол крена фп и угловая скорость с^ равны 0.
В системе стабилизации полезной нагрузки используется управление по компонентам кватерниона рассогласования, вычисленного в Земной подвижной системе координат Ри [32,33]:
Меп=МоМа, (12)
где: М - кватернион текущей пространственной ориентации полезной нагрузки; М, - сопряжённый кватернион заданной пространственной ориентации;
Тогда, для формирования заданного кватерниона пространственной ориентации используем [33]: М, =ЯоРоУ:
R = (1,0,0,0);
P =
Y =
J
J
cos —— ,0,sin — ,0 2 2
(13)
СОБ
,0,0.
Уп
2 ^ ' 2
V ^ '
где: Я, Р и У - кватернионы, описывающие поворот на угол крена, тангажа и азимута соответственно, $п и уп - заданные углы тангажа и азимута.
DOI: 10.24412/2410-9916-2022-3-67-89
Systems of Control, Communication and Security
ISSN 2410-9916
Критерием завершения сканирования и перехода в режим сопровождения является идентификация ИК маяка, осуществляемая по сигналам 4-х фотоприёмников квадрантного датчика.
Режим сопровождения обеспечивает совмещение оптической оси квадрантного датчика с прямой, проходящей через начало связанной с ГСП системой координат Г* и началом системы координат Г1, связанной с посадочной площадкой (рис. 1).
Заданная ориентация ГСП формируется таким образом, чтобы уровни сигналов 1 фоточувствительных элементов квадрантного датчика I £ [1;4] оказались равны. Определим сигналы рассогласования в связанной с ГСП системе :
если (Л )>(1 +1),то уу = 1 + Л;
1+1,2
если (л+1 )<(1+Л4 ),то g y =-1+1 ;
1 +14
если (Л1 +1 )>(1+14 ) ,то gz =
1+14. 1 + 1
(1 4)
если (^2 +1 )<(Л +Л4 ) ,то Г, =~1+14 ,
1 + Л
где: Л,Л2,Л,Л4 - амплитуды сигналов 4-х фоточувствительных датчиков; уу - сигнал рассогласования по тангажу; уг - сигнал рассогласования по азимуту.
Для формирования угловой скорости в режиме сопровождения ИК маяка воспользуемся функцией наведения [34]:
О = 0;
= f • g(gy-|gyI) ;
W = f • sgn (gz )( 1-\gz\)k,
(1 5)
где: а>1 и о)^ - заданная с помощью функции наведения угловая скорость по
тангажу и азимуту соответственно в связанной с ГСП СК Г*; к - показатель степени в диапазоне 0,5 < к < 1; / - положительный коэффициент; sgn (•) - кусочно-постоянная функция, возвращающая -1 при отрицательном значении аргумента, 0 при нулевом значении аргумента, +1 при положительном значении аргумента.
Для применения полученных значений угловой скорости в (11) необходимо выполнить проекцию вектора ох' ={со^,со1,со^ из /,м в Земную ПОДВИЖ-
т^и
ную систему координат Ь :
ОУ = МойГ о м. (16)
DOI: 10.24412/2410-9916-2022-3-67-89
Системы управления,связи и безопасности №3. 2022
Systems of Control, Communication and Security ISSN 2410-9916
Уравнения (11-13) используются для управления гиростабилизированным подвесом. В режиме сопровождения ИК маяка угловые скорости движения ги-ростабилизированного подвеса вычисляются с использованием уравнений (14-16).
В режиме сопровождения кватернион, описывающий ориентацию ГСП, соответствует кватерниону М, который используется в уравнении (7). Таким образом, зная высоту БЛА над посадочной площадкой, возможно вычислить местоположение БЛА относительно ИК маяка с использованием уравнений (8-10).
Данные, полученные от предложенной системы позиционирования, используются в фильтре Калмана в уравнении (2) для выполнения коррекции инерциального метода счисления пути. С целью повышения точности оценки местоположения БЛА, необходимо в фильтре Калмана использовать измеренную скорость, для получения которой применяется численное дифференцирование местоположения Яи.
Пример
Для апробации разработанного метода проведено полунатурное моделирование с использованием бесплатформенной инерциальной навигационной системы БЛА мультироторного типа «Альбатрос СКФУ».
На первом этапе коррекция инерциального метода счисления пути выполнялась по сигналам бортового приёмника СРНС в условиях отсутствия препятствий на пути распространения сигналов навигационных спутников. Максимальная погрешность оценки местоположения БЛА составила 1,93 м рис. 3.
1.92
1.82 1.8
0 10 20 30 40 50 60 70 80 90
Время, с
Рис. 3. Погрешность оценки местоположения бортовой навигационной системой БЛА в условиях достоверных сигналов СРНС
На втором этапе, бортовой модуль навигационной системы с приёмником СРНС размещался между промышленными зданиями с металлическими скатными крышами, что явилось причиной появления эффекта многолучевого распространения сигналов навигационных спутников. Максимальная погрешность оценки местоположения составила 13,85 м рис. 4.
DOI: 10.24412/2410-9916-2022-3-67-89
Systems of Control, Communication and Security
ISSN 2410-9916
0 10 20 30 40 50 60 70 80 90
Время, с
Рис. 4. Погрешность оценки местоположения бортовой навигационной системой БЛА в условиях искажения сигналов СРНС
На третьем этапе полунатурного моделирования в качестве корректирующего источника информации использовались данные системы локального позиционирования с установленным на ГСП квадрантным датчиком. Максимальная погрешность оценки местоположения БЛА составила не более 0,19 м (рис. 5).
40 50 Время, с
Рис. 5. Погрешность оценки местоположения бортовой навигационной системой БЛА при использовании предложенного метода без использования сигналов СРНС
Анализ полученных данных показал, что предложенная система обеспечивает точность позиционирования на этапе посадки без использования сигналов СРНС не хуже 0,19 м, что для практики эксплуатации БЛА является приемлемым решением.
Таким образом, повышение точности позиционирования БЛА мультиро-торного типа с использованием предложенного метода составило 1,74 м относительно случая коррекции по сигналам СРНС без препятствий на пути распространения сигналов навигационных спутников и 13,66 м относительно случая коррекции по сигналам СРНС в условиях многолучевого распространения. Сравнительная оценка погрешностей определения местоположения БЛА для
DOI: 10.24412/2410-9916-2022-3-67-89
Systems of Control, Communication and Security
ISSN 2410-9916
различных условий функционирования навигационной системы представлена на рис. 6.
s
bS X
<L>
а
о
-а н
о о
X □
о С-С о С
16
14
г 12 of s
X 10
и S
О 8
П
О
g 6
н о
tu 4
s
Искажение СРНС 13,85 м
Беч искажений
СРНС 1,93 м Предложенная
система 0,19 м
Рис. 6. Сравнительная оценка погрешностей определения местоположения БЛА
Выводы
Предложен метод, позволяющий обеспечить посадку мультироторного БЛА в контейнер автономного базирования в условиях отсутствия сигналов СРНС.
Впервые для определения местоположения БЛА мультироторного типа относительно посадочной площадки использован квадрантный датчик, размещённый на гиростабилизированном подвесе. Введена дополнительная система координат (рис. 1) и разработан способ формирования заданной пространственной ориентации гиростабилизированного подвеса для сканирования области предполагаемого нахождения ИК маяка на посадочной площадке, а также его сопровождения по сигналам квадрантного датчика в режиме реального времени. В отличие от известных методов вычисления локальных координат [5-11, 21-25], применена алгебра кватернионов для определения местоположения БЛА относительно ИК маяка, расположенного на посадочной площадке. Особенностью предложенного метода является обеспечение 3-х режимов работы бортовой навигационной системы с бесшовным переключением между ними: без коррекции по сигналам СРНС; с использованием коррекции по сигналам СРНС; с использованием коррекции данных на этапе посадки БЛА от локальной системы позиционирования. Бесшовное переключение позволяет в рамках одного полетного задания выполнять навигацию как при наличии полного приборного обеспечения, так и в условиях отсутствия достоверных сигналов навигационных спутников. При этом, в отличие от методов [21-25], не накладываются ограничения на последовательность переключения режимов что позволяет:
а) избежать ввода дополнительных состояний в системе управления БЛА и, тем самым, повысить надежность эксплуатируемого комплекса;
DOI: 10.24412/2410-9916-2022-3-67-89
Системы управления,связи и безопасности №3. 2022
Systems of Control, Communication and Security ISSN 2410-9916
б) уменьшить сложность интеграции предложенного метода в существующие навигационные системы.
Для апробации метода использована навигационная система БЛА «Альбатрос СКФУ». Анализ полученных результатов показал, что данные локальной системы позиционирования на этапе посадки для коррекции инерциального метода счисления пути позволяют обеспечить точность оценки местоположения БЛА не хуже 0,19 м. Полученный результат удовлетворяет практическим требованиям эксплуатации БЛА мультироторного типа, предназначенных для размещения в контейнерах автономного базирования.
Применение предложенного метода возможно в навигационных системах малых БЛА мультироторного типа с установленным 3-х осевым гиростабили-зированным подвесом. Зная географические координаты ИК маяка на посадочной площадке, возможно выполнить проекцию данных локальной системы позиционирования из плоских координат в географические, что позволяет интегрировать данное решение в различные навигационные системы аналогичных БЛА.
В дальнейшем, целесообразно разработать метод, обеспечивающий полет БЛА внутри охраняемого периметра без использования сигналов СРНС на всех этапах полётного задания.
Исследование выполнено при финансовой поддержке РФФИ в рамках научного проекта № 20-37-90010.
Литература
1. Федосеева Н. А., Загвоздкин М. В. Перспективные области применения беспилотных летательных аппаратов // Научный журнал. 2017. № 9 (22). С. 26-29.
2. Анализ компании рынка Аэронет - производителей и эксплуатантов беспилотных авиационных систем // Официальный сайт рабочей группы Аэронет [Электронный ресурс]. 20.02.2022. - URL: http://nti-aeronet.ru/wp-content/uploads/2020/03/AnaHz-kompanij-rynka-Ajeronet-proizvoditelej-i-jekspluatantov-bespilotnyh-aviacionnyh-sistem.pdf (дата обращения: 20.02.2022).
3. Жаринов Д. А. О возможности применения беспилотных летательных аппаратов для охраны военных аэродромов // Воздушно-космические силы. Теория и практика. 2018. № 5. С. 54-59.
4. Стоянов Ю. П., Евдокимов А. Н. Применение БЛА для охраны объектов // Перспективы развития и применения комплексов с беспилотными летательными аппаратами: Сборник докладов и статей по материалам II научно-практической конференции «Перспективы развития и применения комплексов с беспилотными летательными аппаратами». - Коломна: 924 ГЦ БпА МО РФ, 2017. - С. 311-315.
5. Nightingale // Nightingale security [Электронный ресурс]. 20.03.2022 -URL: https://www.nightingalesecurity.com/defense (дата обращения: 20.03.2022).
6. Dronehub is the autonomous game-changer for inspection and monitoring [Электронный ресурс]. 20 03 2022. - URL: https://dronehub.ai (дата обращения: 20 03 2022).
DOI: 10.24412/2410-9916-2022-3-67-89
Системы управления,связи и безопасности №3. 2022
Systems of Control, Communication and Security ISSN 2410-9916
7. SENSYN Drone Hub // SENSYN ROBTOICS [Электронный ресурс]. 22.03.2022. - URL: https://www.sensyn-robotics.com/en/product/drone-hub (дата обращения: 22.03.2022).
8. Квадрокоптер COEX Пеликан // Коптер Экспресс [Электронный ресурс]. 22.03.2022. - URL: https://ru.coex.tech/pelican (дата обращения: 22.03.2022).
9. Smart Aerial Monitoring Systems SAMS // Easy Aerial [Электронный ресурс]. 22.03.2022. - URL: https://www.easyaerial.com (дата обращения: 22.03.2022).
10. Percepto Air Mobile // Percepto [Электронный ресурс]. 22.03.2022. -URL: https://percepto.co/air-mobile/ (дата обращения 22.03.2022).
11. All-in-One Automation Software for Drone Docking Stations // Flytnow [Электронный ресурс]. 23.03.2022. - URL: https://flytnow.com/auto (дата обращения: 23.03.2022).
12. Skyport DP5 drone box hangar Autonomous charging for unattended drone deployments // Skycharge [Электронный ресурс]. 23.03.2022. - URL: https://www.skycharge.de/drone-box-hangar (дата обращения: 23.03.2022).
13. Полностью автоматизированные дронопорты для регулярного мониторинга // Компания HIVE [Электронный ресурс]. 23.03.2022. - URL: https://hive.aero (дата обращения: 23.03.2022).
14. FOXIT RESPONSE Autonomous Drone Base Station // Foxit [Электронный ресурс]. 23.03.2022. - URL: https://foxit.co.za/foxit-mini (дата обращения: 23.03.2022).
15. HEISHA DNEST2 // Heisha Technology [Электронный ресурс]. 23.03.2022. - URL: https://www.heishatech.com/dnest-hardware-for-drone-in-a-box-solution (дата обращения: 23.03.2022).
16. Hextronics Global Advanced:The Drone Station for All // Hextronics [Электронный ресурс]. 23.03.2022. - URL:// https://www.hextronics.tech (дата обращения: 23.03.2022).
17. Комплекс контроля прилегающей территории на основе беспилотного летательного аппарата «Скайрон П2» // Компания Стилсофт [Электронный ресурс]. 23.03.2022. - URL: https://stilsoft.ru/products/skyron-p2 (дата обращения: 23.03.2022).
18. Селиванова Л. М., Шевцова Е. В. Инерциальные навигационные системы. Часть 1. Одноканальные инерциальные навигационные системы: учебное пособие. - М.: Изд-во МГТУ им. Н. Э. Баумана, 2012. - 46 с.
19. ZED-F9P module u-blox F9 high precision GNSS module // u-blox [Электронный ресурс]. 26.03.2022. - URL: https://www.u-blox.com/en/product/zed-f9p-module (Дата обращения 26.03.2022).
20. The Here3 GPS is a high precision GNSS system // CubePilot [Электронный ресурс]. 26.03.2022. - URL: https://docs.cubepilot.org/user-guides/here-3/here-3-manual (дата обращения: 26.03.2022).
21. IR-LOCK Precision Landing Tutorial // IR-LOCK [Электронный ресурс]. 20.03.2022. - URL: https://irlock.readme.io/v2.0/docs (дата обращения: 20.03.2022).
DOI: 10.24412/2410-9916-2022-3-67-89
Системы управления,связи и безопасности №3. 2022
Systems of Control, Communication and Security ISSN 2410-9916
22. Introducing Pixy2 // Pixy [Электронный ресурс]. 26.03.2022. - URL: https://pixycam.com/ (дата обращения: 26.03.2022).
23. GPS-denied Position-hold 3DR Solo // You Tube [Электронный ресурс]. 26.03.2022. - URL: https://www.youtube.com/watch?v=R1WV7Gu-DW0 (дата обращения: 26.03.2022).
24. Закиев А. А., Шабалина К. С., Цой Т. Г., Магид Е. А. Пилотные виртуальные эксперименты по сравнению систем координатных меток AruCo и AprilTag на устойчивость к вращению // Пятый Всероссийский научно-практический семинар «Беспилотные транспортные средства с элементами искусственного интеллекта» (БТС-ИИ-2019): Труды семинара (Санкт-Петербург, 22-24 мая 2019 г.). - Переславль-Залесский: Общероссийская общественная организация «Российская ассоциация искусственного интеллекта», 2019. - С. 210-220.
25. Kolosov K., Miller A., Miller B. Robust Data Fusion of UAV Navigation Measurements with Application to the Landing System // Remote Sensing. 2020. Vol. 12. No. 23. doi: 10.3390/rs12233849.
26. Стоянов Ю. П., Исаев А. М., Фоминов Е. И., Сазанов А. А. Способ точной посадки беспилотного летательного аппарата на посадочную платформу // Патент на изобретение RU 272252 C1, опубл. 01.06.2020, бюл. № 16. - URL: https://www1 .fips.ru/fips_servl/fips_servlet?DB=RUPAT&rn=8176&DocNumber=0 2722521&TypeFile=html (дата обращения 26.03.2022).
27. Wu Y., Niu X., Du J., Chang L., Tang H., Zhang H. Artificial Marker and MEMS IMU-Based Pose Estimation Method to Meet Multirotor UAV Landing Requirements // Sensors. 2019. Vol. 19. No. 24. doi: 10.3390/s19245428.
28. Shin E. H., EL-Sheimy N. An Unscented Kalman Filter for In-motion Alignment of Low-cost IMUs // Records - IEEE PLANS, Position Location and Navigation Symposium. 2004. P. 273-279. doi: 10.1109/PLANS.2004.1309005.
29. Исаев М. А., Исаев А. М., Кудинов Н. В., Мироненко Р. С. Алгоритм начальной инициализации кватерниона пространственной ориентации в параметрах Родрига-Гамильтона // Вестник Донского государственного технического университета. 2018. № 18 (2). С. 238-245. doi: 10.23947/1992-59802018-18-2-238-245.
30. Raitoharju M., Nurminen H., Piché R. Kalman filter with a linear state model for PDR+WLAN positioning and its application to assisting a particle filter // EURASIP Journal on Advances in Signal Processing. 2015. doi: 10.1186/s13634-015-0216-z.
31. Isaev M. A., Linets G.I., Nikulin V. I., Melnikov S. V., Isaev A. M. Increasing fast estimation of assessment of navigation parameters for the UAV based on a linear Kalman filter // AIP Conference Proceedings. 2021. Vol. 2318. P. 1-8. doi: 10.1063/5.0035917.
32. Isaev A. M., Isaev M. A., Adamchuk A. S., Amirokov S. R., Grazhdankin M. A. Mathematical modelling of the stabilization system for a mobile base video camera using quaternions // CEUR Workshop Proceedings. 2018. Vol. 2254. P. 51-62.
DOI: 10.24412/2410-9916-2022-3-67-89
Системы управления,связи и безопасности №3. 2022
Systems of Control, Communication and Security ISSN 2410-9916
33. Бранец В. Н., Шмыглевский И. П. Применение кватернионов в задачах ориентации твердого тела. - М.: Наука, 1973. - 319 с.
34. Бесекерский В. А., Попов Е. П. Теория систем автоматического регулирования. Монография / под общ. ред. В. А. Бесекерского. - М.: Наука, 1975. - 768 с.
References
1. Fedoseeva N. A., Zagvozdkin M. V. Perspektivnye oblasti primeneniia bespilotnykh letatel'nykh apparatov [Promising areas of application for unmanned aerial vehicles]. Nauchnyi zhurnal, 2017, vol. 9, no. 22, pp. 26-29 (in Russian).
2. Analysis of Aeronet market companies, manufacturers and operators of unmanned aerial systems. Official website of the working group Aeronet, 20 march 2022. Available at: http://nti-aeronet.ru/wp-content/uploads/2020/03/Analiz-kompanij -rynka-Aj eronet-proizvoditelej -i-j ekspluatantov-bespilotnyh-aviacionnyh-sistem.pdf (accessed 20 march 2022) (in Russian).
3. Zharinov D. A. O vozmozhnosti primeneniia bespilotnykh letatel'nykh apparatov dlia okhrany voennykh aerodromov [On the possibility of using unmanned aerial vehicles to protect military airfields]. Vozdushno-kosmicheskie sily. Teoriia i praktika, 2018, vol. 5, pp. 54-59 (in Russian).
4. Stoianov Iu. P., Evdokimov A. N. Primenenie BLA dlia okhrany ob"ektov [The use of UAVs for the protection of objects] Perspektivy razvitiia i primeneniia kompleksov s bespilotnymi letatel'nymi apparatami: Sbornik dokladov i statei po materialam II nauchno-prakticheskoi konferentsii. [Collection of reports and articles based on the materials of the II scientific and practical conference "Prospects for the development and application of complexes with unmanned aerial vehicles"]. Kolomna, State Center of Unmanned Aviation of the Ministry of Defense of the Russian Federation, 2017, pp. 311-315 (in Russian).
5. Nightingale. Nightingale security, 20 march 2022. Available at: https://www.nightingalesecurity.com/defense/ (accessed 20 march 2022).
6. Dronehub is the autonomous game-changer for inspection and monitoring, 20 march 2022. Available at: https://dronehub.ai/ (accessed 20 march 2022).
7. SENSYN Drone Hub. SENSYN ROBTOICS, 22 march 2022. Available at: https://www.sensyn-robotics.com/en/product/drone-hub (accessed 22 march 2022).
8. Quadcopter COEX Pelican. Copter Express official website, 22 march 2022. Available at: https://ru.coex.tech/pelican (accessed 22 march 2022) (in Russian).
9. Smart Aerial Monitoring Systems SAMS, Easy Aerial, 22 march 2022. Available at: https://www.easyaerial.com (accessed 22 march 2022).
10. Percepto Air Mobile, Percepto, 22 march 2022. Available at: https://percepto.co/air-mobile/ (accessed 22 march 2022).
11. All-in-One Automation Software for Drone Docking Stations. Flytnow, 23 march 2022. Available at: https://flytnow.com/auto/ (accessed 23 march 2022).
12. Skyport DP5 drone box hangar Autonomous charging for unattended drone deployments. Skycharge, 23 march 2022. Available at: https://www.skycharge.de/drone-box-hangar (accessed 23 march 2022).
DOI: 10.24412/2410-9916-2022-3-67-89
Системы управления,связи и безопасности №3. 2022
Systems of Control, Communication and Security ISSN 2410-9916
13. Fully automated drone ports for regular monitoring. Official website of the company HIVE, 23 march 2022. Available at: https://hive.aero (accessed 23 march 2022) (in Russian).
14. FOXIT RESPONSE Autonomous Drone Base Station, Foxit, 23 march 2022. Available at: https://foxit.co.za/foxit-mini (accessed 23 march 2022).
15. HEISHA DNEST2. Heisha Technology, 23 march 2022. Available at: https://www.heishatech.com/dnest-hardware-for-drone-in-a-box-solution/ (accessed 23 march 2022).
16. Hextronics Global Advanced:The Drone Station for All. Hextronics, 23 march 2022. Available at: https://www.hextronics.tech (accessed 23 march 2022).
17. Complex for monitoring the adjacent territory based on the Skyron P2 unmanned aerial vehicle. Official website of Stilsoft company, 23 march 2022. Available at: https://stilsoft.ru/products/skyron-p2 (accessed 23 march 2022) (in Russian).
18. Selivanova L. M., Shevcova E. V. Odnokanal'nye inercial'nye navigacionnye sistemy [Single channel inertial navigation systems]. Moscow, Bauman Moscow State Technical University Publ., 2012. 46 p. (in Russian).
19. ZED-F9P module u-blox F9 high precision GNSS module. U-blox, 26 march 2022. Available at: URL: https://www.u-blox.com/en/product/zed-f9p-module (accessed 26 march 2022).
20. The Here3 GPS is a high precision GNSS system. CubePilot, 26 march 2022. Available at: URL: https://docs.cubepilot.org/user-guides/here-3/here-3-manual (accessed 26 march 2022).
21. IR-LOCK Precision Landing Tutorial. IR-LOCK, 26 march 2022. Available at: https://irlock.readme.io/v2.0/docs (accessed 26 march 2022).
22. Introducing Pixy2. Pixy, 26 march 2022. Available at: https://pixycam.com (accessed 26 march 2022).
23. GPS-denied Position-hold 3DR Solo. You Tube, 26 march 2022. Available at: https://www.youtube.com/watch?v=R1WV7Gu-DW0 (accessed 26 march 2022).
24. Zakiev A. A., Shabalina K. S., Tsoi T. G., Magid E. A. Pilotnye virtual'nye eksperimenty po sravneniiu sistem koordinatnykh metok AruCo i AprilTag na ustoichivost' k vrashcheniiu [Pilot virtual experiments comparing AruCo and AprilTag fiducial systems for rotation stability]. Piatyi Vserossiiskii nauchno-prakticheskii seminar "Bespilotnye transportnye sredstva s elementami iskusstvennogo intellekta" ("BTS-II-2019"): Trudy seminara. [Fifth All-Russian scientific and practical seminar "Unmanned vehicles with elements of artificial intelligence" ("UV-AI-2019")]. Pereslavl-Zalessky, Russian Association for Artificial Intelligence, 2019, pp. 210-220 (in Russian).
25. Kolosov K., Miller A., Miller B. Robust Data Fusion of UAV Navigation Measurement with Application to the Landing System. Remote Sensing, 2020. doi: 10.3390/rs12233849.
26. Stoianov Ju. P., Isaev A. M., Fominov E. I., Sazanov A. A. Sposob tochnoi posadki bespilotnogo letatel'nogo apparata na posadochnuiu platformu [Method for precise landing of an unmanned aerial vehicle on a landing platform]. Patent Russia, no. RU 2722521 C1. Publish. 01.06.2020, bul. no. 16. Available at: URL:
DOI: 10.24412/2410-9916-2022-3-67-89
Системы управления,связи и безопасности №3. 2022
Systems of Control, Communication and Security ISSN 2410-9916
https://www1.fips.ru/fips_servl/fips_servlet?DB=RUPAT&rn=8176&DocNumber=0 2722521&TypeFile=html (accessed 26 march 2022) (In Russian).
27. Wu Y., Niu X., Du J., Chang L., Tang H., Zhang H. Artificial Marker and MEMS IMU-Based Pose Estimation Method to Meet Multirotor UAV Landing Requirements. Sensors, 2019, vol. 19, no. 24. doi: 10.3390/s19245428.
28. Shin E. H., El-Sheimy N. An Unscented Kalman Filter for In-motion Alignment of Low-cost IMUs. Record - IEEE PLANS, Position Location and Navigation Symposium, 2004, pp. 273-279. doi: 10.1109/PLANS.2004.1309005.
29. Isaev M. A., Isaev A. M., Kudinov N. V., Mironenko R. S. Algoritm nachal'noi initsializatsii kvaterniona prostranstvennoi orientatsii v parametrakh Rodriga-Gamil'tona [Algorithm for initialization of spatial orientation quaternion in Rodrigues-Hamilton parameters] Vestnik Donskogo gosudarstvennogo tekhnicheskogo universiteta, 2018, vol. 18, no. 2, pp. 238-245. doi: 10.23947/19925980-2018-18-2-238-245 (in Russian).
30. Raitoharju M., Nurminen H., Piché R. Kalman filter with a linear state model for PDR+WLAN positioning and its application to assisting a particle filter. EURASIP Journal on Advances in Signal Processing, 2015. doi: 10.1186/s13634-015-0216-z.
31. Isaev M. A., Linets G. I., Nikulin V. I., Melnikov S. V., Isaev A. M. Increasing fast estimation of assessment of navigation parameters for the UAV based on a linear Kalman filter. AIP Conference Proceedings, 2021, vol. 2318, pp. 1-8. doi: 10.1063/5.0035917.
32. Isaev A. M., Isaev M. A., Adamchuk A. S., Amirokov S. R., Grazhdankin M. A. Mathematical modelling of the stabilization system for a mobile base video camera using quaternions. CEUR Workshop Proceedings, 2018, vol. 2254, pp. 51-62.
33. Branets V. N., Shmyglevsky I. P. Primenenie kvaternionov v zadachakh orientatsii tverdogo tela. [Application of quaternions in solid orientation problems]. Moscow, Nauka Publ., 1973. 320 p. (in Russian).
34. Besekerskii V. A., Popov E. P. Teoriia sistem avtomaticheskogo regulirovaniia [Theory of automatic control systems]. Moscow, Nauka Publ., 1975. 768 p. (in Russian).
Статья поступила: 24.06.2022 г.
Информация об авторах
Исаев Михаил Александрович - аспирант кафедры инфокоммуникаций. Северо-Кавказский федеральный университет. Область научных интересов: системы навигации малых беспилотных летательных аппаратов, системы управления малых беспилотных летательных аппаратов, имитационное моделирование. E-mail: mrraptor26@gmail.com
Исаев Александр Михайлович - кандидат технических наук. Руководитель опытно-конструкторского бюро БЛА. ООО «Стилсофт». Область научных интересов: автономные системы навигации малых беспилотных летательных ап-
DOI: 10.24412/2410-9916-2022-3-67-89
Системы управления,связи и безопасности №3. 2022
Systems of Control, Communication and Security ISSN 2410-9916
паратов, имитационное моделирование, системы управления следящими устройствами. E-mail: quaternion77@gmail.com
Липец Геннадий Иванович - доктор технических наук, доцент. Заведующий кафедрой инфокоммуникаций. Северо-Кавказский федеральный университет. Область научных интересов: синтез мультисервисных сетей; исследование влияния свойств самоподобного трафика на количественные и качественные показатели современных сетей; повышение эффективности функционирования беспилотных летательных аппаратов мультироторного типа. E-mail: kbytw@mail.ru
Адрес: 355017, Россия, г. Ставрополь, ул. Пушкина, д. 1.
Method for calculating the parameters of linear motion of an unmanned aerial vehicle in the absence of signals from satellite radio navigation systems at the landing stage
M. A. Isaev, A. M. Isaev, G. I. Linets
Relevance: unmanned aerial vehicles (UAVs) of a multi-rotor type are used as an element of a complex for the protection and monitoring of remote stationary objects. The key feature of these systems is their high autonomy, which is achieved by automating all stages of the flight task, such as takeoff, en route flight and landing. The most difficult and critical stage is landing in an autonomous container, which requires high accuracy in estimating the UAV linear motion parameters. However, the security and monitoring systems in operation do not provide the required accuracy in estimating the location of the UAV at the landing stage in the absence of reliable signals from global navigation satellites system (GNSS), which does not allow placing autonomous UAV containers near industrial or natural objects that obscure or distort the signals of navigation satellites. The aim of the work is improving the positioning accuracy of a multi-rotor UAV at the stage of landing in an autonomous-based container in the absence of reliable signals from navigation satellites by using the proposed local positioning system to replace the data of the onboard GNSS receiver in the UAV linear motion parameters correction loop. Methods: A Kalman filter is used to multiplex inertial meter data and data from an onboard GNSS or local positioning system receiver. The calculation of the UA V coordinates relative to the landing site in the absence of reliable GNSS signals is performed using the quaternion algebra. Novelty: for the first time, a quadrant sensor mounted on a 3-axis gyro-stabilized suspension was used to determine the coordinates of a multi-rotor UAV relative to the landing site. A method is proposed for scanning the area of the supposed location of the IR beacon, as well as its tracking in real time according to the signals of 4 photosensitive elements of the quadrant sensor. In contrast to the known methods for estimating the location of a multi-rotor UA V relative to the landing site, quaternion algebra is applied and a method for correcting the UAV navigation system with seamless switching between different sources of corrective information is proposed. Result: the use of the proposed method makes it possible to provide an error in estimating the location of a multi-rotor UAV at the landing stage no worse than 0.19 m in the absence of reliable GNSS signals. Practical significance: solving the problem of landing a multi-rotor UAV on a limited area in the absence of reliable signals from navigation satellites makes it possible to satisfy the practical requirements for the placement of UAV autonomous-based containers and increase the speed of the complex's response to an alarm signal.
Keywords: unmanned aerial vehicle, inertial navigation system, UAV local positioning system, satellite navigation systems.
Acknowledgments: The reported study was funded by RFBR, project number № 20-37-90010.
DOI: 10.24412/2410-9916-2022-3-67-89
Системы управления,связи и безопасности №3. 2022
Systems of Control, Communication and Security ISSN 2410-9916
Information about Authors
Mikhail Alexandrovich Isaev - Doctoral Student. The postgraduate student of the North Caucasus Federal University of Infocommunications Department. Field of research: UAV navigation system, UAV control system, hardware in the loop modeling. E-mail: mrraptor26@gmail.com
Alexander Mikhailovich Isaev - Ph.D. of Engineering Sciences. Head of experimental design bureau of UAV. Limited Liability Company «Stilsoft». Field of research: autonomous navigation systems for small unmanned aerial vehicles, hardware in the loop modeling, control systems for tracking devices. E-mail: quaternion? 7 @gmail .com
Gennadiy Ivanovich Linets - Doctor of Engineering Sciences, Associate Professor. Head of Infocommunications Department. Field of research: synthesis of multiservice networks; study of the influence of the properties of self-similar traffic on the quantitative and qualitative indicators of modern networks; improving the efficiency of multi-rotor unmanned aerial vehicles. E-mail: kbytw@mail.ru Address: Russia, 355017, Stavropol, Pushkin Street, 1.
DOI: 10.24412/2410-9916-2022-3-67-89