Moved lots of stuff to robot.cs from form1.cs

Also started adding a few new commands for arduino
UNFINISHED