public override void RobotInit()
        {
            RobotRepository.InitializeRobotComponents();

            DriveConfigurator.Configure();
            ElevatorConfigurator.Configure();
            AutonomousConfigurator.Configure();
            CameraConfigurator.Configure();

            Drive = DriveConfigurator.MecanumDrive;
            Elevator = ElevatorConfigurator.ElevatorController;
            Auto = AutonomousConfigurator.Auto;

            SmartDashboardUpdater.StartUpdating();
        }
 public AutoRoutines(MecanumDrive drive, ElevatorController ec)
 {
     Drive = drive;
     Elevator = ec;
 }
        public static void Configure()
        {
            ElevatorController = new ElevatorController();

            ElevatorHealthMonitor.Start();
        }