Хорошие результаты, поздравляю! Как только руки дотянутся до робота, который гоняет до 2мс, тоже будем прикручивать коррекцию для скана, которая будет исправлять искажения от перемещения робота.
Зеркала, по нашим наблюдениям, никак не портят работу SLAM. Разве что проблема в поиске пути, который не против сгонять в зазеркалье.
A от hector_slam, как я и говорил, много не следует ждать, как из любых алгоритмов класса scanmatching/mapmatching. Они, увы, фундаментально не способны долго бороться с накоплением ошибки.
Вы, кстати, Karto SLAM не пробовали? У них есть опенсорсная версия. (Да простит меня начальство за упоминание конкурентов ))) )