STRUCTUREцифровые системыОбсудить проект
НОВОСТЬ · Engineering

Почему робот строил огромный объезд: инженер сравнил полную стоимость двух маршрутов

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

Главное

Инженер Лев Ларин описал тест на платформе UNIBOT Fleet, соединённой с навигацией Alfa Robotics SpeedyBot. На ARM-устройстве используются ROS1, move_base и штатный GlobalPlanner. В этой системе путь можно искать по сетке стоимости поверхности либо с заходом на заранее заданный граф дорожек. Проблема возникла не в отсутствии достижимого пути, а в способе выбора между двумя допустимыми вариантами.

На специально построенной карте свободный маршрут получился длиной 12,75 см, тогда как путь через граф растянулся до 20,10 м. Сам граф находился в стороне от точки назначения: до его полезного участка приходилось долго ехать, а потом возвращаться. Если оценивать преимущество только движения по размеченной дорожке, не суммируя подъезд и выезд, планировщик может предпочесть такой объезд очевидно короткому проезду.

Подробности

В исправленной схеме сначала строятся оба полных кандидата: от старта к цели напрямую по сетке и с переходами от сетки к графу и обратно. Затем стоимость складывается из пройденной длины и цены пересечённых клеток карты. Разработчик использовал проход границ клеток по алгоритму DDA. Так результат не зависит от того, насколько густо расставлены промежуточные точки маршрута, а занятые клетки и выход за карту делают кандидат недопустимым.

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

Что это меняет

Автор дополнительно проверил препятствия и углы клеток. Соединительные отрезки к дорожке не должны срезать занятый угол, даже если крайние точки сами по себе свободны. Слишком грубая разметка мягкой стоимости тоже приводит к неожиданным объездам: алгоритм выбирает дешёвую неразмеченную поверхность, а не ту дорожку, которую человек считал предпочтительной. Полностью заблокированная карта, как и прежде, должна возвращать отсутствие пути.

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

Первоисточник

Материал подготовлен STRUCTURE по открытой публикации Habr. Текст и иллюстрации первоисточника не воспроизводятся целиком.

Читать исходную новость целиком ↗