Implemented simple move to function for robot.
Changed vps heading util function to return values in degrees.
VPS test continously prints received location and heading over serial.
Max speed constant added to give the PID some headroom.
More bare-bones VPS test directly printing the received objects.
Well, we gave it Parkinsons.