Scheduler.getInstance().run();
}
public void testInit() {
LiveWindow.addActuator("DRIVE", "leftMotorUno", new PWM(RobotMap.leftMotorUno));
LiveWindow.addActuator("DRIVE", "leftMotorDue", new PWM(RobotMap.leftMotorDue));
LiveWindow.addActuator("DRIVE", "rightMotorUno", new PWM(RobotMap.rightMotorUno));
LiveWindow.addActuator("DRIVE", "rightMotorDue", new PWM(RobotMap.rightMotorDue));
LiveWindow.addActuator("COLLECTOR", "leftCollector", new PWM(RobotMap.leftCollector));
LiveWindow.addActuator("COLLECTOR", "rightCollector", new PWM(RobotMap.rightCollector));
LiveWindow.addActuator("CATAPULT", "winchMotor", new PWM(RobotMap.winchMotor));
LiveWindow.addActuator("CATAPULT", "latchServo", new PWM(RobotMap.latchServo));
//sensors
LiveWindow.addSensor("CATAPULT", "winchEncoder", new Encoder(RobotMap.winchEncoderA, RobotMap.winchEncoderB, false));
LiveWindow.addSensor("CATAPULT", "limitSwitch", new DigitalInput(RobotMap.limitSwitch));