add precondition and Timeout to Expel and Intake commands

[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / commands / RetractDefenseArm.java

package org.usfirst.frc.team3501.robot.commands;

import org.usfirst.frc.team3501.robot.Robot;

import edu.wpi.first.wpilibj.command.CommandGroup;

/***
 * This command group simultaneously move arm and hand to retracted position.
 *
 * @author shaina
 *
 */
public class RetractDefenseArm extends CommandGroup {
  static final double ARM_FULLY_RETRACTED_ANGLE = 0; // change value once tested
  static final double HAND_FULLY_RETRACTED_ANGLE = 0; // change value once
                                                      // tested

  public RetractDefenseArm(double speed) {
    requires(Robot.defenseArm);

    addParallel(new SetArmToAngle(speed, ARM_FULLY_RETRACTED_ANGLE));
    addParallel(new SetHandToAngle(speed, HAND_FULLY_RETRACTED_ANGLE));
  }
}