import frc.robot.controls.BaseDriverConfig;
import frc.robot.controls.Operator;
import frc.robot.controls.PS5ControllerDriverConfig;
+import frc.robot.subsystems.Climb.LinearClimb;
+ import frc.robot.subsystems.Intake.Intake;
import frc.robot.subsystems.drivetrain.Drivetrain;
import frc.robot.subsystems.drivetrain.GyroIOPigeon2;
import frc.robot.util.PathGroupLoader;
// Controllers are defined here
private BaseDriverConfig driver = null;
private Operator operator = null;
+ private LinearClimb linearClimb = null;
+ private Intake intake = null;
// Auto Command selection
private final SendableChooser<Command> autoChooser = new SendableChooser<>();
drive = new Drivetrain(vision, new GyroIOPigeon2());
driver = new PS5ControllerDriverConfig(drive);
operator = new Operator(drive);
-
+ // added indexer here for now
// Detected objects need access to the drivetrain
DetectedObject.setDrive(drive);
// LEDs
public static final int CANDLE_ID = 1;
- public static final int CLIMB_MOTOR_ID = 8;
+ // Climb
- // roller motor CAN ID
++ public static final int CLIMB_MOTOR_ID = 8;
++
+ // Intake
+ // extender right and left motor CAN ID
+ public static final int RIGHT_MOTOR_ID = 1;
+ public static final int LEFT_MOTOR_ID = 2;
++ // roller motor CAN ID
+ public static final int ROLLER_MOTOR_ID = 3;
}