Edited with new code from my working spike code
Made it custom to this robot
Added states for the arm and smart dashboard arm code