Initial checkin of robot code.  Drive and shift have been tested and work.