Add robot setup and init as separate methods to allow for multiple teleop modes

[GarrettBurroughs]

Currently the only teleop mode is default the robot class. This can be worked around but there is no easy way to do it. Add an abstract robot setup class that is separate from the teleop init so that different teleops can extend the robot class.