Added position of vehicle xv as a matrix.
Check to make sure everything looks okay, it prints out each x,y,z
coordinate of the vehicle.