Comments 2
А как у вас устроена локализация по лидару?
По правилам Евробот команда в праве устанавливать на "своих" краях карты лидарные маяки - стойки с цилиндром на уровне лидарного скана.
Вкратце алгоритм локализации по лидару:
1) https://github.com/giuschio/obstacle\_detector\_2 Данный ROS2 пакет обрабатывает лидарные сканы и выделяет группы точек, которые расположены близко друг к другу в препятствия.
2) Далее массив этих препятствий поступает на вход нашей ноды.
3) Поскольку мы заранее знаем, где должны располагаться лидарные маяки на поле, то сортируем полученные сканы сначала каждый по отдельности. Так мы получаем массив из препятствий, которые с наибольшей вероятностью являются маяками.
4) На следующем шаге мы рассматривали уже группу из трёх препятствий, выбранных на предыдущем этапе. Наиболее вероятная группа - это три точки координаты которых мы знаем относительно карты и относительно робота.
5) Далее решается задача триангуляции - нахождение положения робота по трем точкам.
МИФИсты создали Рокхлю или Eurobot must go on