SequentialGroup.java

// Copyright (c) FIRST and other WPILib contributors.
// Open Source Software; you can modify and/or share it under the terms of
// the WPILib BSD license file in the root directory of this project.
 
package org.wpilib.command3;
 
import static org.wpilib.util.ErrorMessages.requireNonNullParam;
 
import java.util.ArrayList;
import java.util.HashSet;
import java.util.List;
import java.util.Set;

public final class SequentialGroup implements Command {
  private final String m_name;
  private final List<Command> m_commands = new ArrayList<>();
  private final Set<Mechanism> m_requirements = new HashSet<>();
  private final int m_priority;

  SequentialGroup(String name, List<Command> commands) {
    requireNonNullParam(name, "name", "SequentialGroup");
    requireNonNullParam(commands, "commands", "SequentialGroup");
    for (int i = 0; i < commands.size(); i++) {
      requireNonNullParam(commands.get(i), "commands[" + i + "]", "SequentialGroup");
    }
 
    m_name = name;
    m_commands.addAll(commands);
 
    for (var command : commands) {
      m_requirements.addAll(command.requirements());
    }
 
    m_priority =
        commands.stream().mapToInt(Command::priority).max().orElse(Command.DEFAULT_PRIORITY);
  }
 
  @Override
  public void run(Coroutine coroutine) {
    for (var command : m_commands) {
      coroutine.await(command);
    }
  }
 
  @Override
  public String name() {
    return m_name;
  }
 
  @Override
  public Set<Mechanism> requirements() {
    return m_requirements;
  }
 
  @Override
  public int priority() {
    return m_priority;
  }
 
  @Override
  public String toString() {
    return "SequentialGroup[name=" + m_name + "]";
  }
 
  // package-private for testing
  List<Command> getCommands() {
    return m_commands;
  }
}