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();
}