Initial import.
Just some house cleaning, at least it compiles now.
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