Har gjort om funktionen för att beräkna ny fart i sidled utifrån att det beräknas på translationshastighet i punkter längs randen av stenen. Curlar lite mer.
Merge branch 'master' of github.com:LinneaMalcherek/MoS_Projekt