Refactor of all calculations (broken)
Worked on velocity, acceleration and force