Added position, velocity and acceleration update functions