NCP Java Demo (Commands)

MoveLeftCommand.java

public class MoveLeftCommand extends RobotCommand {
  public MoveLeftCommand(String button) {
    super(button);
  }

  protected void logic() {
    // Set up the motors
    // Move the robot
    // Make sure robot is in the right position
    System.out.println("move left!");
  }
}

PickUpBallCommand.java

public class PickUpBallCommand extends RobotCommand {
  public PickUpBallCommand(String button) {
    super(button);
  }

  protected void logic() {
    // Set up the motors
    // Move the arm
    // Open the claw
    // Close the claw
    System.out.println("pick up ball!");
  }
}

RobotButtonDemo.java

class RobotButtonDemo {
  public RobotButtonDemo() {
    // Nothing to set up.
  }

  public void run() {
    RobotCommand moveLeft = new MoveLeftCommand("X");
    moveLeft.runTheCommand();

    RobotCommand pickUpBallCommand = new PickUpBallCommand("A");
    pickUpBallCommand.runTheCommand();
  }
}

RobotCommand.java

public abstract class RobotCommand {
  private final String button;

  protected abstract void logic();

  public RobotCommand(String button) {
    this.button = button;

    this.setup();
  }

  private void setup() {
    /*
      Magic where we configure the button.
    */
  }

  private void doCommonButtonMagic() {
    /*
      Lots of magic here
    */
  }

  public void runTheCommand() {
    System.out.printf("'%s' button was pressed!\n", this.button);
    this.doCommonButtonMagic();
    this.setup();
    this.logic();
  }
}