Code:
package org.usfirst.frc2557.SOTABots2015.commands;
import edu.wpi.first.wpilibj.command.CommandGroup;
/**
*
*/
public class Autonomous extends CommandGroup {
public Autonomous() {
// Add Commands here:
// e.g. addSequential(new Command1());
// addSequential(new Command2());
// these will run in order.
// To run multiple commands at the same time,
// use addParallel()
// e.g. addParallel(new Command1());
// addSequential(new Command2());
// Command1 and Command2 will run in parallel.
// A command group will require all of the subsystems that each member
// would require.
// e.g. if Command1 requires chassis, and Command2 requires arm,
// a CommandGroup containing them would require both the chassis and the
// arm.
// addSequential(new BackHook());
addSequential(new AutoDrive(.2)); //has to change
addSequential(new AutoDrive(-.2));
}
}
^^^^Mainly focusing on the second and third sequentials (AutoDrive)^^^^
Code:
package org.usfirst.frc2557.SOTABots2015.commands;
import org.usfirst.frc2557.SOTABots2015.Robot;
import org.usfirst.frc2557.SOTABots2015.RobotMap;
import edu.wpi.first.wpilibj.command.Command;
/**
*
*/
public class AutoDrive extends Command {
public AutoDrive(double x) {
// Use requires() here to declare subsystem dependencies
// eg. requires(chassis);
}
// Called just before this Command runs the first time
protected void initialize() {
RobotMap.frontLeftEnc.reset();
RobotMap.frontRightEnc.reset();
RobotMap.rearLeftEnc.reset();
RobotMap.rearRightEnc.reset();
}
// Called repeatedly when this Command is scheduled to run
protected void execute() {
while(RobotMap.frontLeftEnc.get() < 1500 & RobotMap.frontRightEnc.get() < 1500){
Robot.driveWithJoystick.mecanumDrive_Cartesian123(0,0,0,0);
}
}
// Make this return true when this Command no longer needs to run execute()
protected boolean isFinished() {
return true;
}
// Called once after isFinished returns true
protected void end() {
Robot.driveWithJoystick.mecanumDrive_Cartesian123(0,0,0,0);
}
// Called when another command which requires one or more of the same
// subsystems is scheduled to run
protected void interrupted() {
}
}
^^^This is the command that I am trying to call.^^^