basic robot logic

Also to be serious we need to unify the robot instructions on the actual arduino with what we have in the robot model so I can flesh this out accordingly.