Так у тебя только в помещении работает, насколько я помню?
А этот алгоритм прелестен тем, что при доработке он может привязываться к существующей карте местности.
Никакой гпс/глонасс не нужен. Как я понял, можно замыкать контур не только на разведанные точки, но и на имеющуюся карту местности.