Навигация БПС: Новый Подход к Повышению Точности

Автор: Денис Аветисян


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

☕️

Читаем отчёты, пьём кофе, ждём дивиденды. Если тебе надоел хайп и ты ищешь скучную, но стабильную гавань — добро пожаловать.

Телеграм канал
Предлагаемый алгоритм ANPMN-UKF, реализованный в системе слияния данных GNSS/INS, обеспечивает навигацию беспилотных наземных транспортных средств.
Предлагаемый алгоритм ANPMN-UKF, реализованный в системе слияния данных GNSS/INS, обеспечивает навигацию беспилотных наземных транспортных средств.

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

Постоянные ковариационные матрицы шумов часто оказываются неадекватными для учета динамических условий реального мира в задачах автономной навигации беспилотных наземных транспортных средств. В данной работе, посвященной разработке ‘A Hybrid Neural-Assisted Unscented Kalman Filter for Unmanned Ground Vehicle Navigation’, предложен гибридный подход, объединяющий классические методы оценки состояния с современными алгоритмами глубокого обучения. Ключевой особенностью является адаптивная оценка ковариаций шумов процессов и измерений с помощью нейронной сети, обученной исключительно на симулированных данных, что позволяет добиться повышения точности позиционирования на 12.7% по сравнению с адаптивными моделями. Сможет ли предложенный подход обеспечить надежную и масштабируемую навигацию беспилотных транспортных средств в различных условиях эксплуатации?


Вызовы точной навигации

Автономные наземные транспортные средства предъявляют высокие требования к точности позиционирования, однако существующие методы часто сталкиваются с трудностями в динамичных условиях и при ограничениях датчиков. Традиционные подходы, такие как использование GPS или одометрии, подвержены ошибкам, вызванным помехами сигнала, скольжением колес или изменениями окружающей среды. В сложных ситуациях, например, в городских условиях с плотной застройкой или при движении по бездорожью, надежность этих методов существенно снижается. Более того, ограничения в дальности и точности работы датчиков, таких как лидары и камеры, также вносят свой вклад в общую погрешность определения местоположения. В результате, для обеспечения безопасной и эффективной работы автономных систем необходимы более совершенные методы, способные адаптироваться к меняющимся условиям и компенсировать недостатки традиционных подходов.

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

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

Предложенная глубокая нейронная сеть одновременно оценивает стандартные отклонения измерений инерциального датчика (голубым) и положения (розовым), обеспечивая двойное использование модели.
Предложенная глубокая нейронная сеть одновременно оценивает стандартные отклонения измерений инерциального датчика (голубым) и положения (розовым), обеспечивая двойное использование модели.

Фильтр Калмана без запаха: шаг вперед

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

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

Эффективность фильтра Калмана без запаха (UKF) напрямую зависит от адекватного моделирования шумов процесса и измерений — величин, характеризующих неопределенность в системе. Точность оценки состояния системы критически зависит от правильной оценки ковариационных матриц Q (шум процесса) и R (шум измерений). Некорректная оценка этих матриц приводит к смещению оценок или к их чрезмерной или недостаточной уверенности, что может значительно ухудшить работу фильтра, даже при использовании более точного алгоритма, такого как UKF. Важно отметить, что эти шумы могут быть результатом как случайных факторов, так и систематических ошибок в модели или сенсорах.

Сравнение времени работы алгоритмов UKF, MB-AUKF, ANPN-UKF и ANPMN-UKF на различных наборах данных показывает, что среднее время работы отображается в виде прямоугольников, а минимальные и максимальные значения - в виде отрезков погрешностей.
Сравнение времени работы алгоритмов UKF, MB-AUKF, ANPN-UKF и ANPMN-UKF на различных наборах данных показывает, что среднее время работы отображается в виде прямоугольников, а минимальные и максимальные значения — в виде отрезков погрешностей.

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

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

Предложенный ANPMN-UKF (Adaptive Neural Network Parameterized Measurement Kalman Filter) повышает адаптивность за счет использования глубокой нейронной сети для оценки матриц ковариации шумов процесса и измерений. В отличие от традиционных методов, где эти параметры задаются статически или адаптируются с использованием эвристических правил, ANPMN-UKF динамически определяет значения ковариаций на основе входных данных, используя обученную нейронную сеть. Этот подход позволяет более точно моделировать изменяющиеся характеристики шумов, что приводит к улучшению точности оценки состояния системы. Обучение нейронной сети происходит на исторических данных или данных, сгенерированных в симуляции, что позволяет ей предсказывать оптимальные значения ковариаций в различных условиях эксплуатации.

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

Валидация и производительность в реальных условиях

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

Для оценки точности определения местоположения использовалась метрика среднеквадратичной ошибки положения (PRMSE), где в качестве эталонных данных выступали показания системы глобального спутникового позиционирования с кинематической коррекцией в реальном времени (RTK GNSS). Данный подход позволяет с высокой точностью определить истинное местоположение транспортного средства, что необходимо для объективной оценки эффективности предложенного алгоритма. Использование RTK GNSS в качестве “золотого стандарта” обеспечивает надежный и точный критерий для сравнения с результатами, полученными с помощью разрабатываемой системы позиционирования, особенно в сложных условиях, где традиционные методы могут давать значительные погрешности.

Проведенные испытания продемонстрировали значительное повышение точности позиционирования по сравнению с традиционными методами, особенно в сложных условиях окружающей среды. Достигнутая среднеквадратичная ошибка позиционирования (PRMSE) составила 2.56 метра, что на 22.7% выше, чем у стандартного фильтра Калмана (UKF). При оценке на наборе данных ROOAD, ANPMN-UKF показал PRMSE в 2.94 метра, превзойдя показатели UKF (4.69 м), MB-AUKF (3.55 м) и ANPN-UKF (3.45 м). Аналогичные результаты были получены на наборе данных из Гонконга, где ANPMN-UKF достиг PRMSE в 3.07 метра, опережая UKF (3.79 м), MB-AUKF (3.48 м) и ANPN-UKF (3.21 м). В частности, улучшение по сравнению с Model-Based Adaptive UKF (MB-AUKF) составило 12.72%, а по сравнению с Adaptive Neural Process Noise UKF (ANPN-UKF) — 8.03%, что подтверждает эффективность предложенного подхода.

Для обучения и тестирования алгоритмов использовались три набора данных: ROOAD, собранный с платформы Waterhod-UGV, собранный нами с помощью ROSbot и IMU EX-300, и Hong-Kong, записанный с автомобиля.
Для обучения и тестирования алгоритмов использовались три набора данных: ROOAD, собранный с платформы Waterhod-UGV, собранный нами с помощью ROSbot и IMU EX-300, и Hong-Kong, записанный с автомобиля.

Предложенный подход к навигации беспилотных наземных транспортных средств, сочетающий в себе фильтр Калмана и возможности глубокого обучения, стремится к упрощению сложной задачи оценки ковариаций шумов. Эта работа, по сути, представляет собой попытку отсечь избыточность в процессах оценки, чтобы достичь большей точности позиционирования. Как заметил Бертран Рассел: «Всякое счастье состоит в преодолении препятствий». В данном контексте, препятствием является разрыв между симуляцией и реальным миром, а преодолением — адаптивная оценка шумов, позволяющая фильтру Калмана более эффективно функционировать в реальных условиях. Ясность в определении этих ковариаций — минимальная форма любви к точности и надёжности системы.

Куда Далее?

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

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

В конечном итоге, задача состоит не в создании «идеального» фильтра, а в разработке системы, способной адекватно оценивать свои возможности и ограничения. Именно в этой скромности и заключается истинное совершенство.


Оригинал статьи: https://arxiv.org/pdf/2603.11649.pdf

Связаться с автором: https://www.linkedin.com/in/avetisyan/

Смотрите также:

2026-03-15 10:44