Vibration fix

Var avrundningsfel, fixade det genom att skapa en egen funktion för
avrundning.