added function to test integration of velocity to derive position