Add function to time step velocity
Add function to calculate position one time step in the future