Team4388/2023WayOfTheRobot
1
0
Fork 0
mirror of https://github.com/Team4388/2023WayOfTheRobot.git synced 2026-06-09 00:37:59 -06:00
Code Issues Packages Projects Releases Wiki Activity

fix auto chooser

Browse Source
This commit is contained in:
66945
2023-02-25 20:33:24 -07:00
parent d09c7e464b
commit 2f35e591e8
2 changed files with 11 additions and 10 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/main/java/frc4388/robot/commands/PlaybackChooser.java
+11 -7
View File
@@ -15,8 +15,7 @@ public class PlaybackChooser {
private SendableChooser<Command> m_playback = new SendableChooser<>();
private HashMap<String, Command> m_commandPool = new HashMap<>();
private File m_dir = new File("/home/lvuser/autos/");
private File m_dir = new File("/home/lvuser/autos/");
private SwerveDrive m_swerve;
// commands
@@ -26,16 +25,17 @@ public class PlaybackChooser {
m_swerve = swerve;
for (int i = 0; i < pool.length; i += 2) {
if (!(pool[i] instanceof String)) throw new RuntimeException("Need (string, command)");
if (!(pool[i + 1] instanceof Command)) throw new RuntimeException("Need (string, command)");
if (!(pool[i] instanceof String) || !(pool[i + 1] instanceof Command)) {
throw new RuntimeException("Need (string, command)");
}
m_commandPool.put((String) pool[i], (Command) pool[i + 1]);
}
m_playback.addOption("No Auto", m_noAuto);
for (String auto : m_dir.list()) {
m_playback.addOption(auto, new JoystickPlayback(m_swerve, auto));
}
m_playback.addOption("No Auto", m_noAuto);
m_choosers.add(m_playback);
SmartDashboard.putData("Command: 0", m_playback);
@@ -66,11 +66,15 @@ public class PlaybackChooser {
}
public Command getCommand() {
Command command = m_playback.getSelected().asProxy();
Command command = m_playback.getSelected();
command = command == null ? m_noAuto : command.asProxy();
Command[] commands = new Command[m_choosers.size() - 1];
for (int i = 0; i < m_choosers.size()-1; i++) {
commands[i] = m_choosers.get(i + 1).getSelected().asProxy();
Command command2 = m_choosers.get(i + 1).getSelected();
command2 = command2 == null ? m_noAuto : command2.asProxy();
commands[i] = command2.asProxy();
}
return command.andThen(commands);