package org.texastorque.texastorque20145.subsystem;

import edu.wpi.first.wpilibj.Victor;
import org.texastorque.texastorque20145.constants.Constants;
import org.texastorque.texastorque20145.torquelib.Motor;

public class FrontIntake extends Subsystem {
    
    public final static int DOWN = 0;
    public final static int INTAKE = 1;
    public final static int OUTTAKE = 2;
    public final static int UP = 3;
    public final static int MANUAL = 4;
    
    private Motor angleMotor;
    private Motor rollerMotor;
    
    public FrontIntake()
    {
        angleMotor = new Motor(new Victor(Constants.frontIntakeAnglePort.getInt()), false);
        rollerMotor = new Motor(new Victor(Constants.frontIntakeRollerPort.getInt()), false);
    }
    
    public void update()
    {
        state = input.getFrontIntakeState();
    }
}

@@ -448,24 +448,94 @@
 L = 4;%0A    %0A
+    private double targetAngle;%0A    private double currentAngle;%0A    %0A
     private 
@@ -892,16 +892,627 @@
 tate();%0A
+        %0A        switch (state)%0A        %7B%0A            case DOWN:%0A                targetAngle = Constants.downAngle.getDouble();%0A                break;%0A            case INTAKE:%0A                targetAngle = Constants.intakeFrontAngle.getDouble();%0A                break;%0A            case OUTTAKE:%0A                targetAngle = Constants.outtakeFrontAngle.getDouble();%0A                break;%0A            case UP:%0A                targetAngle = Constants.upAngle.getDouble();%0A                break;%0A            default:%0A                targetAngle = Constants.downAngle.getDouble();%0A                break;%0A        %7D%0A
     %7D%0A%7D%0A

Add states to front intake