Compare commits
2 Commits
7f9214ae58
...
e531c8e191
| Author | SHA1 | Date | |
|---|---|---|---|
|
|
e531c8e191 | ||
|
|
6a59518ad8 |
@@ -6,17 +6,29 @@ package frc.robot;
|
|||||||
|
|
||||||
import com.pathplanner.lib.auto.AutoBuilder;
|
import com.pathplanner.lib.auto.AutoBuilder;
|
||||||
|
|
||||||
|
import edu.wpi.first.wpilibj.shuffleboard.Shuffleboard;
|
||||||
|
import edu.wpi.first.wpilibj.shuffleboard.ShuffleboardTab;
|
||||||
|
import edu.wpi.first.wpilibj.shuffleboard.Shuffleboard;
|
||||||
|
import edu.wpi.first.wpilibj.DriverStation;
|
||||||
|
import edu.wpi.first.wpilibj.DriverStation.Alliance;
|
||||||
import edu.wpi.first.wpilibj.smartdashboard.SendableChooser;
|
import edu.wpi.first.wpilibj.smartdashboard.SendableChooser;
|
||||||
import edu.wpi.first.wpilibj2.command.Command;
|
import edu.wpi.first.wpilibj2.command.Command;
|
||||||
import edu.wpi.first.wpilibj2.command.PrintCommand;
|
import edu.wpi.first.wpilibj2.command.PrintCommand;
|
||||||
|
import edu.wpi.first.wpilibj.DriverStation;
|
||||||
import edu.wpi.first.wpilibj2.command.button.CommandXboxController;
|
import edu.wpi.first.wpilibj2.command.button.CommandXboxController;
|
||||||
import frc.robot.constants.AutoConstants;
|
import frc.robot.constants.AutoConstants;
|
||||||
import frc.robot.constants.OIConstants;
|
import frc.robot.constants.OIConstants;
|
||||||
import frc.robot.subsystems.Drivetrain;
|
import frc.robot.subsystems.Drivetrain;
|
||||||
|
import frc.robot.utilities.Utilities;
|
||||||
|
|
||||||
public class RobotContainer {
|
public class RobotContainer {
|
||||||
|
|
||||||
|
Boolean isRed;
|
||||||
|
|
||||||
private Drivetrain drivetrain;
|
private Drivetrain drivetrain;
|
||||||
|
|
||||||
|
private Utilities utilities;
|
||||||
|
|
||||||
private CommandXboxController driver;
|
private CommandXboxController driver;
|
||||||
|
|
||||||
private SendableChooser<Command> autoChooser;
|
private SendableChooser<Command> autoChooser;
|
||||||
@@ -26,11 +38,13 @@ public class RobotContainer {
|
|||||||
|
|
||||||
driver = new CommandXboxController(OIConstants.kDriverControllerPort);
|
driver = new CommandXboxController(OIConstants.kDriverControllerPort);
|
||||||
|
|
||||||
autoChooser = AutoBuilder.buildAutoChooser();
|
|
||||||
|
|
||||||
configureBindings();
|
configureBindings();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
private void configureBindings() {
|
private void configureBindings() {
|
||||||
drivetrain.setDefaultCommand(
|
drivetrain.setDefaultCommand(
|
||||||
drivetrain.drive(
|
drivetrain.drive(
|
||||||
@@ -40,8 +54,16 @@ public class RobotContainer {
|
|||||||
() -> true
|
() -> true
|
||||||
)
|
)
|
||||||
);
|
);
|
||||||
|
|
||||||
|
ShuffleboardTab tab = Shuffleboard.getTab("SideFirst");
|
||||||
|
|
||||||
|
if (Utilities.ShiftFirst() == Alliance.Red) {
|
||||||
|
tab.add("IsRed", isRed);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
public Command getAutonomousCommand() {
|
public Command getAutonomousCommand() {
|
||||||
if(AutoConstants.kAutoConfigOk) {
|
if(AutoConstants.kAutoConfigOk) {
|
||||||
return autoChooser.getSelected();
|
return autoChooser.getSelected();
|
||||||
|
|||||||
32
src/main/java/frc/robot/utilities/Utilities.java
Normal file
32
src/main/java/frc/robot/utilities/Utilities.java
Normal file
@@ -0,0 +1,32 @@
|
|||||||
|
package frc.robot.utilities;
|
||||||
|
|
||||||
|
import com.pathplanner.lib.auto.AutoBuilder;
|
||||||
|
|
||||||
|
import edu.wpi.first.wpilibj.DriverStation;
|
||||||
|
import edu.wpi.first.wpilibj.DriverStation.Alliance;
|
||||||
|
|
||||||
|
public class Utilities {
|
||||||
|
static String gameData;
|
||||||
|
|
||||||
|
static Boolean Blue = false;
|
||||||
|
|
||||||
|
static Boolean Red = false;
|
||||||
|
|
||||||
|
public static Alliance ShiftFirst() {
|
||||||
|
gameData = DriverStation.getGameSpecificMessage();
|
||||||
|
|
||||||
|
|
||||||
|
if(gameData.length() > 0) {
|
||||||
|
switch (gameData.charAt(0)) {
|
||||||
|
case 'B' :
|
||||||
|
return Alliance.Red;
|
||||||
|
case 'R' :
|
||||||
|
return Alliance.Blue;
|
||||||
|
default :
|
||||||
|
return null;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return null;
|
||||||
|
}
|
||||||
|
|
||||||
|
}
|
||||||
Reference in New Issue
Block a user