public static void Configure()
        {
            CANJaguarLoader.Init(RobotRepository.DriveTrain);

            MecanumDrive = new MecanumDrive();

            DriveHealthMonitor.Start();
        }
 public AutoRoutines(MecanumDrive drive, ElevatorController ec)
 {
     Drive = drive;
     Elevator = ec;
 }