Påbörjad avståndsberäkning

Inte helt klara