BenchFinaleMechanism finaleMechanism;
public MainRobot() {
benchMechanism = new BenchDriveTrain(8, 10, 7, 9, true);
GRTDriverStation ds = new GRTDriverStation(1, 2, 3);
benchController = new BenchDriveController(ds, (BenchDriveTrain) benchMechanism);
teleopControllers.addElement(benchController);
kicker = new BenchKicker(2, 1, true);
kickerController = new BenchKickerController(kicker, ds);
teleopControllers.addElement(kickerController);