Distance + tests

Working on bearing + add distance between coordinates