Проект: Устройство для определения направления движения подвижной платформы

1. Краткая аннотация

Данный проект представляет собой автономную систему для точного определения и контроля направления движения подвижной платформы (робота, тележки, AGV). В основе системы лежит технология сверхширокополосной связи (UWB), представленная модулями UWB1000, и микроконтроллер ESP32. Система использует стационарные "активные метки" (анкеры) для формирования системы координат и модуль на самой платформе (тег), который вычисляет не только свое положение, но и вектор направления движения. Это позволяет платформе точно ориентироваться в пространстве без использования данных с инерциальных датчиков (IMU) или энкодеров.

2. Решаемая проблема

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

• Не накапливает ошибку со временем.

• Работает в условиях отсутствия GPS-сигнала.

• Устойчиво к помехам и многолучевому распространению радиоволн.

• Позволяет однозначно определить не только местоположение, но и ориентацию платформы в реальном времени.

3. Архитектура системы

Система состоит из двух основных частей:

1. Стационарная инфраструктура (Анкеры):

• Несколько (минимум 3-4) модулей UWB1000, работающих в режиме анкера.

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

• Образуют сеть, с которой взаимодействует подвижный модуль для определения расстояний.

• Один или несколько модулей UWB1000, работающих в режиме тега.

• Микроконтроллер ESP32.

• Источник питания (например, Li-Ion аккумулятор).

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

4. Принцип работы и алгоритм

1. Инициализация и калибровка:

• Анкеры закрепляются, и их точные координаты вносятся в прошивку ESP32.

• Платформа включается, теги и анкеры устанавливают UWB-соединение.

• ESP32 поочередно активирует каждый из двух UWB-тегов.

• Каждый тег измеряет расстояние до всех "видимых" анкеров с помощью Two-Way Ranging (TWR) или Time Difference of Arrival (TDoA).

• На основе измеренных расстояний и известных координат анкеров ESP32 вычисляет координаты (X, Y) для каждого из двух тегов в реальном времени.

• Пусть (x1, y1) - координаты переднего тега, (x2, y2) - координаты заднего тега.

• Вектор направления (dx, dy) вычисляется как:
  dx = x1 - x2
  dy = y1 - y2

• Курс (угол направления) θ платформы относительно оси X вычисляется по формуле:
  θ = atan2(dy, dx)

• Для сглаживания шумов измерений может применяться фильтр (например, Комплиментарный фильтр или Фильтр Калмана).

• Система отслеживает изменение координат обоих тегов во времени.

• Если координаты изменяются за определенный порог, система фиксирует движение.

• Направление движения определяется знаком проекции вектора скорости на вычисленный вектор направления.

5. Аппаратная часть

• Микроконтроллер: ESP32 (например, ESP32-DevKitC). Отвечает за управление UWB-модулями, выполнение расчетов, коммуникацию.

• UWB-модули: 2x (или более) UWB1000 (или аналогичные, например, DWM1000). Обеспечивают высокоточное измерение расстояния.

• Соединение: UWB-модули подключаются к ESP32 через интерфейс SPI.

• Питание: Литиевый аккумулятор 3.7V с платой заряда (например, TP4056) и повышающим преобразователем до 5V/3.3V.

6. Программное обеспечение

• Среда разработки: PlatformIO или Arduino IDE.

• Основные библиотеки:

• Библиотеки для работы с UWB1000/DWM1000 (например, arduino-dw1000).

• Математические библиотеки для трилатерации и фильтрации.

• Многозадачность (используя FreeRTOS на ESP32) для параллельного опроса тегов и выполнения расчетов.

• Реализация алгоритма трилатерации (например, метод наименьших квадратов).

• Фильтрация сырых данных для увеличения стабильности и точности.

• Вывод результатов через UART (для отладки) или передача по Wi-Fi/Bluetooth.

7. Преимущества системы

• Высокая точность: UWB обеспечивает сантиметровую точность позиционирования.

• Низкая задержка: Определение направления происходит в реальном времени.

• Устойчивость: Помехоустойчивость технологии UWB.

• Автономность: ESP32 обладает низким энергопотреблением и может работать от аккумулятора.

• Масштабируемость: Легко добавить больше анкеров для увеличения зоны покрытия или точности.

8. Возможные области применения

• Автономные мобильные роботы (AMR) и тележки в логистических центрах.

• Навигация дронов внутри помещений.

• Системы позиционирования для виртуальной и дополненной реальности (VR/AR).

• Умные склады и "умное" производство (Индустрия 4.0).

• Автоматизированные системы инвентаризации.

На страницу проекта