SAM m made a velocity class that will track the x and y velocity of the robot.
It has methods getXVelocity and getYVelocity.