workson #25

distance measurement works, yet distances are not correct