added the kinematics vectors, using a direct aproach for calculating velocity and displacement