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