Velocity control basework.

Created a class to calculate velocity of the arm. Added to normal shot
state to log velocity. Won't be sure how to implement velocity control
until test data is attained. See my email for further information.