Got rid of timestep function, now always recalculate position on every accel. update.