Научная статья на тему 'МЕТОД ФИЛЬТРАЦИИ ШУМОВ В СИГНАЛЕ ГИРОСКОПИЧЕСКОГО ДАТЧИКА НА ОСНОВЕ АДАПТИВНОГО АЛЬФА-БЕТА-ФИЛЬТРА КАЛМАНА'

МЕТОД ФИЛЬТРАЦИИ ШУМОВ В СИГНАЛЕ ГИРОСКОПИЧЕСКОГО ДАТЧИКА НА ОСНОВЕ АДАПТИВНОГО АЛЬФА-БЕТА-ФИЛЬТРА КАЛМАНА Текст научной статьи по специальности «Электротехника, электронная техника, информационные технологии»

CC BY
0
0
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
фильтрация данных / гироскопический датчик / беспилот-ные летательные аппараты / альфа-бета-фильтр Калмана / data filtering / gyroscopic sensor / unmanned aerial vehicles / Kalman alpha-beta filter

Аннотация научной статьи по электротехнике, электронной технике, информационным технологиям, автор научной работы — Волков Данила Михайлович, Савельев Антон Игоревич

Для обеспечения стабилизации полета беспилотного лета-тельного аппарата (БпЛА) мультироторного типа необходимо обрабаты-вать данные с микромеханических датчиков, установленных на борту, и преобразовывать их в управляющие сигналы. В процессе эксплуатации на БпЛА действует множество внешних и внутренних факторов, что приводит к возникновению шумов в данных типах датчиков. Шумы негативно ска-зываются на работе системы управления аппаратом. Особенно подвержены шумам сигналы гироскопа, на основе которых рассчитываются угловые скорости и углы наклона аппарата относительно оси ординат. Для решения данной проблемы в работе представлен метод фильтрации шумов в сигнале гироскопического датчика для дифференциальной составляющей пропор-ционально-интегрально-дифференцирующего регулятора (ПИД). Разрабо-танный метод реализован в виде взаимосвязанной адаптивной системы из двух фильтров и позволяет отфильтровать в исходном сигнале гироскопи-ческого датчика высокочастотные электрические шумы, вибрации, вызы-ваемые моторами и резонансными колебаниями рамы БпЛА. В ходе прове-денных натурных экспериментов метрика сигнал/шум для обработанных данных достигла максимального значения в 8,40 дБ, что значительно луч-ше по сравнению с другими научными подходами.

i Надоели баннеры? Вы всегда можете отключить рекламу.

Похожие темы научных работ по электротехнике, электронной технике, информационным технологиям , автор научной работы — Волков Данила Михайлович, Савельев Антон Игоревич

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.
i Надоели баннеры? Вы всегда можете отключить рекламу.

METHOD OF NOISE FILTERING IN GYROSCOPIC SENSOR SIGNAL BASED ON ADAPTIVE ALPHA-BETA KALMAN FILTER

To ensure flight stabilization of a multirotor UAV, it is necessary to process data from mi-cromechanical sensors installed on board and convert them into control signals. During operation, the UAV is affected by many external and internal factors, which leads to the occurrence of noise in these types of sensors. Noise has a negative impact on the operation of the device control system. The gyro-scope signals, which are used to calculate the angular velocities and tilt angles of the vehicle, are partic-ularly susceptible to noise. To solve this problem, the paper presents a method for cleaning the signal from a gyroscopic sensor for the differential component of the PID controller. The developed method is implemented as an interconnected adaptive system of two filters and allows for cleaning the original signal from the gyroscopic sensor from high-frequency electrical noise, vibrations caused by motors and resonant oscillations of the UAV frame. During the conducted field experiments, the signal/noise metric for the processed data reached a maximum value of 8,40 dB, which is significantly better compared to the 2 dB figure found in other scientific papers.

Текст научной работы на тему «МЕТОД ФИЛЬТРАЦИИ ШУМОВ В СИГНАЛЕ ГИРОСКОПИЧЕСКОГО ДАТЧИКА НА ОСНОВЕ АДАПТИВНОГО АЛЬФА-БЕТА-ФИЛЬТРА КАЛМАНА»

УДК 004.67

DOI: 10.14529/mmph240402

МЕТОД ФИЛЬТРАЦИИ ШУМОВ В СИГНАЛЕ ГИРОСКОПИЧЕСКОГО ДАТЧИКА НА ОСНОВЕ АДАПТИВНОГО АЛЬФА-БЕТА-ФИЛЬТРА КАЛМАНА

Д.М. Волков, А.И. Савельев

Санкт-Петербургский Федеральный исследовательский центр Российской академии наук, г. Санкт-Петербург, Российская Федерация E-mail: [email protected]

Аннотация. Для обеспечения стабилизации полета беспилотного летательного аппарата (БпЛА) мультироторного типа необходимо обрабатывать данные с микромеханических датчиков, установленных на борту, и преобразовывать их в управляющие сигналы. В процессе эксплуатации на БпЛА действует множество внешних и внутренних факторов, что приводит к возникновению шумов в данных типах датчиков. Шумы негативно сказываются на работе системы управления аппаратом. Особенно подвержены шумам сигналы гироскопа, на основе которых рассчитываются угловые скорости и углы наклона аппарата относительно оси ординат. Для решения данной проблемы в работе представлен метод фильтрации шумов в сигнале гироскопического датчика для дифференциальной составляющей пропорционально-интегрально-дифференцирующего регулятора (ПИД). Разработанный метод реализован в виде взаимосвязанной адаптивной системы из двух фильтров и позволяет отфильтровать в исходном сигнале гироскопического датчика высокочастотные электрические шумы, вибрации, вызываемые моторами и резонансными колебаниями рамы БпЛА. В ходе проведенных натурных экспериментов метрика сигнал/шум для обработанных данных достигла максимального значения в 8,40 дБ, что значительно лучше по сравнению с другими научными подходами.

Ключевые слова: фильтрация данных, гироскопический датчик, беспилотные летательные аппараты, альфа-бета-фильтр Калмана.

Введение

Актуальность разработки и эксплуатации беспилотных летательных аппаратов (БпЛА) мультироторного типа активно растет в последние годы в связи с появлением коммерчески доступных и удобных в использовании аппаратов, а также доказанной эффективностью применения БпЛА как в гражданской, так и в других сферах.

Системы управления БпЛА чаще всего разрабатываются с использованием ПИД-регулятора ввиду его эффективности и простоты реализации. В данном регуляторе наиболее важную функцию в задаче управления БпЛА выполняет дифференциальная составляющая (Д-составляющая), поскольку именно она уменьшает влияние перерегулирования, корректирует положение аппарата при низкоамплитудных (относительно амплитуд необработанного сигнала) скачкообразных отклонениях. Также данная составляющая увеличивает скорость реакции системы с ПИД-регулятором на быстро нарастающие отклонения. Д-составляющая является наиболее чувствительным к шумовым колебаниям элементом ПИД-регулятора, поскольку реагирует на низкоамплитудные всплески сигнала, которые и представляет чаще всего шум. Поэтому входной сигнал для дифференциальной составляющей необходимо подвергать предварительной обработке от шумового загрязнения.

В ряде случаев для осуществления фильтрации сигнала применяют один из усредняющих фильтров, представленных в работах [1-3]. Однако данные фильтры должны иметь достаточно большой порядок для приемлемого качества фильтрации, что ведет к существенной задержке сигнала.

Приемлемым вариантом фильтрации по критерию задержки сигнала мог бы являться фильтр нижних частот [4-8] в последовательной связке с режекторным [9] или полосно-заграждающим фильтром [10]. Однако в задаче фильтрации для дифференциальной составляющей ПИД-

Волков Д.М., Метод фильтрации шумов в сигнале гироскопического датчика

Савельев А.И. на основе адаптивного альфа-бета-фильтра Калмана

регулятора они не подходят, поскольку подавляют амплитуды колебаний шума в сигнале, но не

уменьшают частоты колебаний этих амплитуд.

Наиболее подходящим для обработки сигнала гироскопического датчика для формирования Д-составляющей является альфа-бета-фильтра Калмана [11, 12] благодаря зависимости его коэффициентов альфа и бета от выходного значения фильтра, предварительно обработанного экспоненциальным фильтром. Поэтому далее в основу разработанного метода был выбран именно данный фильтр.

1. Постановка задачи

В качестве технической системы, являющейся объектом исследования, рассматривается система обработки данных (СОД) инерциального датчика в рамках системы управления беспилотным летательным аппаратом (СУ БпЛА), представляющая собой совокупность элементов, оснащенных вычислительными средствами для приёма и обработки информации, объединенных каналом передачи данных, и функционирующая в динамически меняющихся условиях, где присутствуют различного рода шумы.

Структура СОД задана множеством последовательно соединенных узлов V = { } \ = 1,2, . . ., I, каждый из которых соответствует определенному элементу в СОД. Задан вектор характеристик Е1 вычислительных средств для каждого элемента , включающий частоту дискретизации, уровень вносимой элементом задержки сигнала. Обработка информации в СОД происходит в циклическом режиме за время Тц . Узел рассматриваемой системы - гироскопический датчик ( у1 подвержен шумам, представленным в виде множества = {г, /}, каждый элемент которого включает в себя источник шума {г} и уровень вносимого искажения в сигнал {/}. В результате искажения сигнала в СОД происходит снижение эффективности функционирования СУ БпЛА в целом.

Для обеспечения снижения воздействия искажений сигнала на функционирование СОД имеется множество методов фильтрации данных Мё = {^}, каждый из которых характеризуется типом фильтра g = 1,2, . . ., О и вектором характеристик , таких как коэффициент сглаживания,

КМ8Е шума, КМ8Е полезного сигнала. Применение в СОД методов фильтрации g-го типа требует затрат вычислительных ресурсов Сё . За счет применения методов фильтрации происходит

прирост показателя эффективности функционирования СУ БпЛА в целом. Суммарная стоимость (С ) метода фильтрации в СОД составляет:

о

С = IС . (1)

В=1

Поскольку целью данной работы является устранение шумовых искажений в рамках системы управления летательным аппаратом мультироторного типа, то критерием качества решения данной задачи будет являться коэффициент шума ^К). Как функция от параметров исходных данных он определяется следующим образом:

ЯЖ \У, Е, ^ ]

Ш = 10 X 1о&0--^-=гг = 1,2,...,I, (2)

8ЖоШ \ У, Е,, Ег/, М§, ]

где и БЫЯ^ - это соотношение сигнал (8) / шум (К) на входе и выходе системы фильтра-

ции, которые могут быть представлены как

я\у , Е, ]

ЗНЯ =-1-14:г = 1,2,...,I, (3)

N\У, Е, ^ ]

я \ У, Е, , М , 2 ] ЯЖоШ -1-г = 1,2,...,I. (4)

N \ У, Е,, Ег/, М§, ]

Постановка задачи по критерию оптимальности формулируется следующим образом: требуется определить состав комплекса фильтров M , обеспечивающий максимальный NF в условиях

воздействия внешних факторов F в соответствии с требуемой частотой дискретизации устройства SR и не превышающий допустимую стоимость Cóon . Математическая постановка задачи по критерию оптимальности выглядит следующим образом:

M* = max NF Г V, Et, F,M., Z. 1 g e М, i = 1,2,..., I, (5)

s 0< NF <+» L s s J

при ограничениях Cz < Сдоп .

Решением поставленной задачи является выбор состава методов фильтрации Mg , обеспечивающего максимальное значения NF в условиях воздействия внешних факторов F. При использовании данного критерия решение является единственным - выбирается наилучший состав комплекса фильтров Mg .

2. Метод фильтрации шумов в сигнале гироскопического датчика при формировании дифференциальной составляющей ПИД-регулятора

Разработанный метод фильтрации шумов при формировании Д-составляющей ПИД-регулятора функционирует по следующей схеме, состоящей из трех частей:

1. Альфа-бета-фильтр Калмана принимает входное значение и приводит его к значению, близкому к 0, поскольку предполагается, что включение полетного контроллера БпЛА производится из состояния покоя. Корень квадратный из среднеквадратичной ошибки (RMSE) шума предварительно рассчитывается на основе замеров амплитуд вибраций корпуса БпЛА, вызванных вращением двигателей, на всем диапазоне скоростей вращения моторов.

2. Затем сигнал после альфа-бета-фильтра Калмана поступает на вход экспоненциального фильтра, который обратно передает отфильтрованное значение как RMSE сигнала.

3. На последнем этапе рассматриваемый фильтр использует полученные значения RMSE сигнала по обратной связи с экспоненциальным фильтром.

Альфа-бета-фильтр предполагает, что система адекватно аппроксимируется моделью, имеющей два внутренних состояния, где первое состояние получается путем интегрирования значения второго состояния во времени. Измеренные выходные значения системы соответствуют наблюдениям за первым состоянием модели плюс возмущения. Это приближение очень низкого порядка подходит для многих простых систем, например механических систем, в которых положение определяется как интеграл скорости от времени. Основываясь на аналогии с механической системой, эти два состояния можно назвать положением x и скоростью v. Предполагая, что скорость остается примерно постоянной в течение небольшого интервала времени AT между измерениями, состояние положения проецируется вперед для прогнозирования его значения в следующий момент выборки с использованием следующего уравнения:

xk ^ Vi +ATvk-i. (6)

Поскольку переменная скорости v считается постоянной, ее прогнозируемое значение в следующее время выборки равно текущему значению:

vk ^ Vk-1 . (7)

Ожидается, что выходное измерение будет отклоняться от прогноза из-за шума и динамических эффектов, не включенных в упрощенную динамическую модель. Эта ошибка прогнозирования (г) также называется остатком или нововведением на основе статистической интерпретации или интерпретации фильтрации Калмана:

К ^ xk- xk. (8)

Альфа-бета-фильтр принимает выбранные альфа- и бета-константы (из которых фильтр получил свое название), использует значение альфа, умноженное на отклонение r, для корректировки оценки положения и использует значение коэффициента бета, умноженное на отклонение r, для корректировки оценки скорости. Дополнительный коэффициент AT обычно служит для нормализации величин множителей:

Волков Д.М., Савельев А.И.

Метод фильтрации шумов в сигнале гироскопического датчика на основе адаптивного альфа-бета-фильтра Калмана

ч ^ (а) 4,

' Р Л

[АТ ]

(9) (10)

Параметры альфа-бета-фильтра Калмана можно вычислить из интервала выборки, среднеквадратичного отклонения (RMSE) процесса от и среднеквадратичного отклонения (RMSE) шума :

(11)

4 + Я — ^ 8Л + Л2 г =-, 4 (12)

а = 1 — г2 , (13)

Р = 2(2 — а) — 4л/1 — а . (14)

Такой выбор параметров фильтра сводит к минимуму среднеквадратическую ошибку.

Альфа-бета-фильтр Калмана хорошо подходит для предсказуемых систем, где заранее известна дисперсия шума и дисперсия чистого сигнала, что позволяет использовать данное решение в рамках системы управления беспилотного летательного аппарата. Поэтому в данной исследовательской работе коэффициенты альфа и бета выражены через среднеквадратичное отклонение шума и чистого сигнала, которые, в свою очередь, изменяются в зависимости от условий полета.

Экспоненциальный фильтр - это авторегрессионный фильтр скользящего среднего первого порядка, определяемый следующим уравнением:

у (кИ) = ах у [(к —1)к] + (1 — а) х у (кк) . (15)

Отфильтрованное значение у (кк) вычисляется суммированием предыдущего значения отфильтрованного сигнала у[(к — 1)к] и последнего значения у(кИ) измерительного сигнала с весовыми коэффициентами. Коэффициент а лежит в интервале между 0 и 1.

Экспоненциальный фильтр содержит также динамический коэффициент кехр , который изменяется в зависимости от скорости изменения фильтруемой величины. Полный вид экспоненциального фильтра можно представить в виде следующих выражений:

у (кк) = (у (кк) — у [(к — 1)к])х кехр , (16)

кехр = |кх(у(кк) — у[(к — 1)к]) , (17)

где к - коэффициент сглаживания, который подбирается экспериментально, исходя из величины приемлемой задержки при средних рабочих скоростях изменения фильтруемой величины.

Экспоненциальный фильтр в данном исследовании используется с адаптивным коэффициентом сглаживания, который зависит от скорости изменения принимаемых значений. При увеличении разности между значениями коэффициент увеличивается, а в обратном случае уменьшается. Такое решение позволяет минимизировать задержку сигнала данного фильтра и улучшает сглаживания высокочастотных шумов.

На рисунке представлен реализованный метод в виде каскада фильтров.

скорость АВ -фшшгр Эксп оненциальный фильтр Д-составляющая ПИ Д-регулятор

Среднеквадратичная ошибка

Структурная схема метода адаптивной фильтрации при формировании Д-составляющей ПИД-регулятора

к

Представленная на рисунке схема отображает обработку угловых скоростей БпЛА относительно одной из осей XYZ. Вся схема системы управления аппаратом будет иметь вид трех, никак не связанных друг с другом цепей фильтрации для каждой из осей XYZ.

Следует также отметить, что адаптивный альфа-бета-фильтр, представленный в данном исследовании, является новым решением, поскольку в ходе анализа статей не было найдено полностью аналогичного решения, в ходе которого была бы реализована система с обратной связью с ее же выходными значениями.

3. Постановка и анализ экспериментов

Для проверки разработанного метода фильтрации шумов в сигнале гироскопического датчика была проведена серия экспериментов. Управляющая программа в ходе эксперимента включала четыре параллельно работающих потока:

1) поток приема данных с передатчика с частотой вызова 1000 Гц;

2) главный поток, где реализована фильтрация данных по ранее выбранным алгоритмам и расчет значений ШИМ-сигнала на моторы через математическую функцию ПИД-регулятора. Частота приема данных с микромеханических датчиков 4000 Гц;

3) поток вывода данных в последовательный UART-порт с частотой вызова 100 Гц.

Управление квадрокоптером осуществлялось посредством изменения угловых скоростей по

осям крена, тангажа и рысканья. Было реализовано три различных сценария:

1) квадрокоптер был поднят на высоту 4-5 метров над землей. При помощи команд с пульта управления осуществлял движения по оси угла крена в течение 30 с;

2) квадрокоптер был поднят на высоту 4-5 метров над землей. При помощи команд с пульта управления совершал движения по оси угла тангажа в течение 30 с;

3) квадрокоптер был поднят на высоту 4-5 метров над землей. При помощи команд с пульта управления совершал вращения по оси угла рысканья в течение 30 с.

Все эксперименты производились на открытой местности в безветренную погоду при отсутствии осадков и других внешних явлений. Температура окружающей среды во время проведения эксперимента составляла 21 °С

В результате экспериментов были получены сигналы гироскопического датчика по всем трем осям на каждом этапе фильтрации. Эти данные представлены в таблице.

Результаты экспериментов для целевых осей

Сигнал/Шум (дБ) Коэффициент Пирсона

Крен Тангаж Рысканье Крен Тангаж Рысканье

Исходный сигнал 2,34 4,47 7,65 0,65 0,80 0,91

Альфа-бета-фильтр Калмана 3,55 4,53 8,40 0,74 0,80 0,92

Экспоненциальный фильтр 3,35 4,35 8,084 0,73 0,79 0,92

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

Исходя из представленных в таблице данных, можно сделать вывод, что по двум представленным метрикам наилучших показаний достигают выходные данные со звена альфа-бета-фильтра Калмана. По метрике сигнал/шум наблюдается существенный прирост после прохождения альфа-бета-фильтра. Показатели же коэффициента Пирсона сохраняют свою величину с незначительным снижением для значений сигнала после обработки их экспоненциальным фильтром, что свидетельствует об отсутствии искажений сигнала, вызванных обработкой представленным методом.

Заключение

Из проведенного анализа результатов экспериментов можно сделать вывод, что по всем метрикам альфа-бета-фильтр Калмана обеспечивает наилучшие соотношение сигнал/шум и коэффициент корреляции. А если рассмотреть тот факт, что метрика сигнал/шум имеет значение вплоть до 8,40 дБ по рысканью (т. е. чистый сигнал превосходит все показатели входящих в шум на 8,40

Волков Д.М., Метод фильтрации шумов в сигнале гироскопического датчика

Савельев А.И. на основе адаптивного альфа-бета-фильтра Калмана

дБ), а в среднем достигает 4 дБ для остальных осей, то можно заключить, что предложенный метод эффективен для фильтрации шумов в сигнале гироскопического датчика по всем осям.

Ухудшение показателей обработки после экспоненциального фильтра объясняется достаточно большой задержкой данного фильтра (20 мс в среднем), которая вносит заметное расхождение между реальными показателями и показателя после обработки фильтром. Однако экспоненциальный фильтр хорошо показывает себя при использовании его для дифференциальной составляющей ПИД-регулятора, поскольку сглаживает амплитуды шумов, делая их более пологими.

Вопросы управления роботами и БпЛА в сложных погодно-климатических условиях и недетерминированной среде тщательно рассматриваются в работах ведущей научной школы профессора Р.В. Мещерякова [13-18] Авторы считают своим приятным долгом поздравить Романа Валерьевича с юбилеем и выражают признательность за плодотворные дискуссии.

Литература

1. Brownrigg, D.R.K. The Weighted Median Filter / D.R.K. Brownrigg // Communications of the ACM. - 1984. - Vol. 27, no. 8. - pp. 807-818.

2. Moving Average Filter Based Phase-Locked Loops: Performance Analysis and Design Guidelines / S. Golestan, M. Ramezani, J.M. Guerrero ee al. // IEEE transactions on power electronics. -2013. - Vol. 29, no. 6. - P. 2750-2763.

3. Greene, N. Creating Raster Omnimax Images From Multiple Perspective Views Using the Elliptical Weighted Average Filter / N. Greene, P.S. Heckbert // IEEE Computer Graphics and Applications. - 1986. - Vol. 6, no. 6. - P. 21-27.

4. Design Strategy for Biquad-Based Continuous-Time Low-Pass Filters / P. Monsurro, S. Pennisi, G. Scotti, A. Trifiletti // 2011 20th European Conference on Circuit Theory and Design (ECCTD). -IEEE, 2011. - P. 385-388.

5. Matthaei, G.L. Tables of Chebyshev impedance-transforming networks of low-pass filter form / G.L. Matthaei // Proceedings of the IEEE. - 1964. - Vol. 52. - №. 8. - P. 939-963.

6. Roberts, J. Use of the Butterworth Low-Pass Filter for Oceanographic Data / J. Roberts, T.D. Roberts // Journal of Geophysical Research: Oceans. - 1978. - Vol. 83, Iss. C11. - P. 5510-5514.

7. Yang J., Wu W. Compact Elliptic-Function Low-Pass Filter Using Defected Ground Structure // IEEE Microwave and Wireless Components Letters. - 2008. - Т. 18, no. 9. - P. 578-580.

8. Сорокин Г. А. Фильтры нижних частот // Вестник Южно-Уральского государственного университета. Серия «Компьютерные технологии, управление, радиоэлектроника». - 2015. -Т. 15, № 1. - С. 100-107.

9. Hirano, K. Design of Digital Notch Filters / K. Hirano, S. Nishimura, S. Mitra // IEEE Transactions on Communications. - 1974. - Vol. 22, no. 7. - P. 964-970.

10. Smith, A.P. Agreement Level of Running Temporal Measurements, Kinetics, and Force-Time Curves Calculated from Inertial Measurement Units: PhD thesis / A.P. Smith. - East Tennessee State University, 2021.

11. Penoyer, R. The Alpha-Beta Filter / R. Penoyer // The C Users Journal archive. - 1993. -Vol. 11, Iss. 7. - P. 73-86.

12. Kaba A. Unscented Kalman filter based attitude estimation of a quadrotor. Journal of Aeronautics and Space Technologies. - 2021. - Vol. 14, no. 1. - P. 79-88.

13. Эффективное функционирование смешанной неоднородной команды в коллаборативной робототехнической системе / Р.Р. Галин, А.А. Широкий, Е.А. Магид и др. // Информатика и автоматизация. - 2021. - № 6 (20). - C. 1224-1253.

14. Мещеряков, Р.В. Интеллектуальные робототехнические системы / Р.В. Мещеряков // Датчики и системы. - 2024. - № 2 (274). - С. 12-17.

15. Мещеряков Р.В., Широков А.С. Постановка задачи гетерогенного группового взаимодействия роботов при решении задач умного сада // Вестник Южно-Уральского государственного университета. Серия «Математика. Механика. Физика». - 2024. - Т. 16, № 2. - С. 41-49.

16. Моделирование задач транспортировки грузов в беспилотной авиационной транспортной системе / А.А. Захарова, В.П. Кутахов, Р.В. Мещеряков и др. // Авиакосмическое приборостроение. - 2023. - № 3. - С. 3-15.

17. Galin R., Meshcheryakov R., Mamchenko M. Simple Task Allocation Algorithm in a Collaborative Robotic System / R. Galin, R. Meshcheryakov, M. Mamchenko // Frontiers in Robotics and Electromechanics. Smart Innovation, Systems and Technologies. - 2023. - no. 329. - P. 433-447.

18. Evaluation of EEG data for zonal affiliation of brain waves by leads in a robot control task / D. Wolf, Y. Turovsky, A. Iskhakova, R. Meshcheryakov // Interactive Collaborative Robotics. ICR 2023. Lecture Notes in Computer Science. - 2023. - Vol. 14214. - P. 103-115. Springer, Cham.

Поступила в редакцию 3 сентября 2024 г.

Сведения об авторах

Волков Данила Михайлович - программист лаборатории автономных робототехнических систем, Санкт-Петербургский Федеральный исследовательский центр Российской академии наук, г. Санкт-Петербург, Российская Федерация, e-mail: [email protected].

Савельев Антон Игоревич - кандидат технических наук, старший научный сотрудник лаборатории автономных робототехнических систем, Санкт-Петербургский Федеральный исследовательский центр Российской академии наук, г. Санкт-Петербург, Российская Федерация, ORCID iD: https://orcid.org/ 0000-0003-1851-2699, e-mail: [email protected].

Bulletin of the South Ural State University Series "Mathematics. Mechanics. Physics" _2024, vol. 16, no. 4, pp. 16-23

DOI: 10.14529/mmph240402

METHOD OF NOISE FILTERING IN GYROSCOPIC SENSOR SIGNAL BASED ON ADAPTIVE ALPHA-BETA KALMAN FILTER

D.M. Volkov, A.N. Saveliev

St. Petersburg Federal Research Center of the Russian Academy of Sciences, Saint-Petersburg, Russian Federation E-mail: [email protected]

Abstract. To ensure flight stabilization of a multirotor UAV, it is necessary to process data from mi-cromechanical sensors installed on board and convert them into control signals. During operation, the UAV is affected by many external and internal factors, which leads to the occurrence of noise in these types of sensors. Noise has a negative impact on the operation of the device control system. The gyroscope signals, which are used to calculate the angular velocities and tilt angles of the vehicle, are particularly susceptible to noise. To solve this problem, the paper presents a method for cleaning the signal from a gyroscopic sensor for the differential component of the PID controller. The developed method is implemented as an interconnected adaptive system of two filters and allows for cleaning the original signal from the gyroscopic sensor from high-frequency electrical noise, vibrations caused by motors and resonant oscillations of the UAV frame. During the conducted field experiments, the signal/noise metric for the processed data reached a maximum value of 8,40 dB, which is significantly better compared to the 2 dB figure found in other scientific papers.

Keywords: data filtering, gyroscopic sensor, unmanned aerial vehicles, Kalman alpha-beta filter.

References

1. Brownrigg D.R.K. The Weighted Median Filter. Communications of the ACM, 1984, Vol. 27, Iss. 8, pp. 807-818. DOI: 10.1145/358198.358222

2. Golestan S., Ramezani M., Guerrero J.M., Freijedo F.D., Monfared M. Moving Average Filter Based Phase-Locked Loops: Performance Analysis and Design Guidelines. in IEEE Transactions on Power Electronics, 2014, vol. 29, no. 6, pp. 2750-2763, DOI: 10.1109/TPEL.2013.2273461.

3. Greene N., Heckbert P.S. Creating Raster Omnimax Images from Multiple Perspective Views Using the Elliptical Weighted Average Filter. in IEEE Computer Graphics and Applications, 1986, Vol. 6, no. 6, pp. 21-27. DOI: 10.1109/MCG.1986.276738.

Волков Д.М., Савельев А.И.

Метод фильтрации шумов в сигнале гироскопического датчика на основе адаптивного альфа-бета-фильтра Калмана

4. Monsurro P., Pennisi S., Scotti G., Trifiletti A. Design Strategy for Biquad-Based Continuous-Time Low-Pass Filters. 2011 20th European Conference on Circuit Theory and Design (ECCTD), Lin-koping, Sweden, 2011, pp. 385-388. DOI: 10.1109/ECCTD.2011.6043367.

5. Matthaei G.L. Tables of Chebyshev Impedance-Transforming Networks of Low-Pass Filter Form. Proc. IEEE, 1964, Vol. 52, no. 8, pp. 939-963. DOI: 10.1109/PR0C.1964.3185.

6. Roberts J., Roberts T.D. Use of the Butterworth Low-Pass Filter for Oceanographic Data. Journal of Geophysical Research: Oceans, 1978, Vol. 83, Iss. C11, pp. 5510-5514. DOI: 10.1029/JC083iC11p05510

7. Yang J., Wu W. Compact Elliptic-Function Low-Pass Filter Using Defected Ground Structure. In IEEE Microwave and Wireless Components Letters, 2008, Vol. 18, no. 9, pp. 578-580. DOI: 10.1109/LMWC.2008.2002447.

8. Sorokin G. A. Filters of the Lower Frequencies // Bulletin of South Ural State University. Series "Computer Technologies, Automatic Control & Radioelectronics ", 2015, Vol. 15, no. 1, pp. 100-107.

9. Hirano K., Nishimura S., Mitra S. Design of Digital Notch Filters. In IEEE Transactions on Communications, 1974, Vol. 22, no. 7, pp. 964-970, DOI: 10.1109/TCOM.1974.1092311.

10. Smith A.P. Agreement Level of Running Temporal Measurements, Kinetics, and Force-Time Curves Calculated from Inertial Measurement Units: PhD thesis. - East Tennessee State University, 2021.

11. Penoyer R. The Alpha-Beta Filter. The C Users Journal archive, 1993, Vol. 11, Iss. 7, pp. 7386.

12. Kaba A. Unscented Kalman Filter Based Attitude Estimation of a Quadrotor. Journal of Aeronautics and Space Technologies, 2021, Vol. 14, no. 1, pp. 79-88.

13. Galin R., Shiroky A., Magid E., Meshcheryakov R., Mamchenko M. Effective Functioning of a Mixed Heterogeneous Team in a Collaborative Robotic System. Informatics and Automation, 2021, no. 20(6), pp. 1224-1253. DOI: 10.15622/ia.20.6.2

14. Meshcheryakov R.V. Intelligent Robotic Systems. Sensors and Systems, 2024, no. 2 (274), P. 12-17. DOI: 10.25728/datsys.2024.2.2

15. Meshcheryakov R.V., Shirokov A.S. Setting the Task of Heterogeneous Group Interaction of Robots in Solving Smart Garden Tasks. Bulletin of the South Ural State University. Series "Mathematics. Mechanics. Physics", 2024, Vol. 16, no. 2, pp. 41-49. DOI: 10.14529/mmph240204

16. Zakharova A.A., Kutakhov V.P., Meshcheryakov R.V., Podvesovskii A.G., Smolin A.L. Modeling Cargo Transportation Tasks in an Unmanned Air Transportation System. Aerospace Instrument-Making, 2023, no. 3, pp. 3-15. DOI: 10.25791/aviakosmos.3.2023.1326

17. Galin R., Meshcheryakov R., Mamchenko M. Simple Task Allocation Algorithm in a Collaborative Robotic System. In: Ronzhin, A., Pshikhopov, V. (eds) Frontiers in Robotics and Electromechanics. Smart Innovation, Systems and Technologies, 2023, Vol. 329, Springer, Singapore. DOI: 10.1007/978-981-19-7685-8_28

18. Wolf D., Turovsky Y., Iskhakova A., Meshcheryakov R. Evaluation of EEG Data for Zonal Affiliation of Brain Waves by Leads in a Robot Control Task. In: Ronzhin A., Sadigov A., Meshcheryakov R. (eds) Interactive Collaborative Robotics. ICR 2023. Lecture Notes in Computer Science, 2023, Vol. 14214. Springer, Cham. DOI: 10.1007/978-3-031-43111-1_10

Received September 3, 2024

Information about the authors

Volkov Danila Mikhailovich is Programmer, Laboratory of Autonomous Robotic Systems, St. Petersburg Federal Research Center of the Russian Academy of Sciences, Saint-Petersburg, Russian Federation, e-mail: [email protected].

Savelyev Anton Igorevich is Cand. Sc. (Engineering), Senior Researcher, Laboratory of Autonomous Robotic Systems, St. Petersburg Federal Research Center of the Russian Academy of Sciences, Saint-Petersburg, Russian Federation, e-mail: [email protected], ORCID iD: https://orcid.org/0000-0003-1851-2699.

i Надоели баннеры? Вы всегда можете отключить рекламу.