package org.robockets.stronghold.robot.intake;

import org.robockets.stronghold.robot.Robot;

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

/**
 *
 */
public class IntakesUp extends Command {
	
    public IntakesUp() {
    	
    }

    protected void initialize() {
    	Robot.intakeFront.setIntakeAngle(90); //TEMP
    	Robot.intakeBack.setIntakeAngle(90); //TEMP
    }

    protected void execute() {
    	
    }

    protected boolean isFinished() {
        return false;
    }

    protected void end() {
    	
    }

    protected void interrupted() {
    	end();
    }
}

@@ -85,16 +85,64 @@
 t.Robot;
+%0Aimport org.robockets.stronghold.robot.RobotMap;
 %0A%0Aimport
@@ -236,16 +236,32 @@
 and %7B%0A%09%0A
+%09boolean end;%0A%09%0A
     publ
@@ -274,32 +274,44 @@
 akesUp() %7B%0A    %09
+end = false;
 %0A    %7D%0A%0A    prot
@@ -470,32 +470,224 @@
 xecute() %7B%0A    %09
+if (RobotMap.intakeEncoderFront.get() == Robot.intakeFront.encoderPID.getSetpoint() && RobotMap.intakeEncoderBack.get() == Robot.intakeBack.encoderPID.getSetpoint()) %7B%0A    %09%09end = true;%0A    %09%7D
 %0A    %7D%0A%0A    prot
@@ -723,24 +723,19 @@
     
-    
+%09
 return 
-false
+end
 ;%0A  

Fix IntakesUp class-ends when reaches setpoint