Fixade rörelsebuggar. Orsaken verkar vara oregelbunden dt, som Lolirofle
trodde. Finns matematisk förklaring, sök på Euler integration
Disregard. Last commit didn't work as expected. TODO: Implement R4K
derivation.