package storm2014.commands;

import edu.wpi.first.wpilibj.DriverStation;
import edu.wpi.first.wpilibj.command.Command;
import storm2014.Robot;
import storm2014.subsystems.LEDStrip;

public class SetLEDMode extends Command {
    private int _mode;
    
    private byte _r, _g, _b;
    
    public SetLEDMode(int mode){
        _mode = mode;
        _r = 0;
        _g = 0;
        _b = 0;
    }
    public SetLEDMode(int mode, byte r, byte g, byte b){
        _r = r;
        _g = g;
        _b = b;
    }
    //Back to default
    public SetLEDMode(){
        if (DriverStation.getInstance().isAutonomous()){
            _mode = LEDStrip.USAMode;
        } else if (DriverStation.getInstance().isOperatorControl()) {
            _mode = LEDStrip.TeleopMode;
        } else {
            _mode = LEDStrip.AutonomousMode; //Shouldn't be possible, but just in case
        }
    }
    protected void initialize() {
        Robot.leds.setMode(_mode, _r, _g, _b);
    }
    protected void execute() {}
    protected boolean isFinished() {
        return true;
    }
    protected void end() {}
    protected void interrupted() {}
    
    public int getMode(){
        return _mode;
    }
    public int getR(){
        return _r;
    }
    public int getG(){
        return _g;
    }
    public int getB(){
        return _b;
    }
}


package storm2014.commands;

import edu.wpi.first.wpilibj.DriverStation;
import edu.wpi.first.wpilibj.command.Command;
import storm2014.Robot;
import storm2014.subsystems.LEDStrip;

public class SetLEDMode extends Command {
    private int _mode;
    
    private byte _r, _g, _b;
    
    public SetLEDMode(int mode){
        _mode = mode;
        _r = 0;
        _g = 0;
        _b = 0;
    }
    public SetLEDMode(int mode, byte r, byte g, byte b){
        _r = r;
        _g = g;
        _b = b;
    }
    //Back to default
    public SetLEDMode(){
        if (DriverStation.getInstance().isAutonomous()){
            _mode = LEDStrip.AutonomousMode;
        } else if (DriverStation.getInstance().isOperatorControl()) {
            _mode = LEDStrip.TeleopMode;
        } else {
            _mode = LEDStrip.DisabledMode; //Shouldn't be possible, but just in case
        }
    }
    protected void initialize() {
        Robot.leds.setMode(_mode, _r, _g, _b);
    }
    protected void execute() {}
    protected boolean isFinished() {
        return true;
    }
    protected void end() {}
    protected void interrupted() {}
    
    public int getMode(){
        return _mode;
    }
    public int getR(){
        return _r;
    }
    public int getG(){
        return _g;
    }
    public int getB(){
        return _b;
    }
}


Fix typo