this is my testing program
package frc.robot;
import edu.wpi.first.wpilibj.Encoder;
import com.ctre.phoenix.motorcontrol.ControlMode;
import com.ctre.phoenix.motorcontrol.IMotorController;
import com.ctre.phoenix.motorcontrol.NeutralMode;
import com.ctre.phoenix.motorcontrol.can.VictorSPX;
import com.ctre.phoenix.motorcontrol.can.WPI_VictorSPX;
import java.lang.Object;
import edu.wpi.first.wpilibj.SendableBase;
import edu.wpi.first.wpilibj.PWM;
import edu.wpi.first.wpilibj.GenericHID;
import edu.wpi.first.wpilibj.buttons.Trigger;
import edu.wpi.first.wpilibj.buttons.POVButton;
import edu.wpi.first.wpilibj.PWMVictorSPX;
import edu.wpi.first.wpilibj.TimedRobot;
import edu.wpi.first.wpilibj.Timer;
import edu.wpi.first.wpilibj.Joystick;
import edu.wpi.first.wpilibj.GenericHID.Hand;
import edu.wpi.first.wpilibj.Joystick.AxisType;
import edu.wpi.first.wpilibj.Joystick.ButtonType;
import edu.wpi.first.wpilibj.drive.DifferentialDrive;
import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;
import edu.wpi.first.wpilibj.command.Subsystem;
import edu.wpi.cscore.CameraServerJNI;
import edu.wpi.first.wpilibj.CameraServer;
import edu.wpi.first.wpilibj.buttons.Trigger;
import edu.wpi.first.wpilibj.buttons.Button;
import edu.wpi.first.wpilibj.buttons.JoystickButton;
import edu.wpi.first.wpilibj.Compressor;
import edu.wpi.first.wpilibj.Solenoid;
import edu.wpi.first.wpilibj.XboxController;
import java.text.NumberFormat;
import edu.wpi.first.wpilibj.Servo;
import java.util.Date;
import java.util.concurrent.TimeUnit;
import edu.wpi.first.wpilibj.Counter;
import edu.wpi.first.wpilibj.DigitalInput;
import edu.wpi.first.wpilibj.AnalogTriggerOutput;
import edu.wpi.first.wpilibj.AnalogTrigger;
import edu.wpi.first.wpilibj.Counter;
public class Robot extends TimedRobot
{
private AnalogTrigger encoder;
public static Subsystem m_subsystem;
private Timer timer;
private WPI_VictorSPX MM;
private WPI_VictorSPX LMotor;
private WPI_VictorSPX RMotor;
private VictorSPX FLMotor;
private VictorSPX FRMotor;
private DifferentialDrive myRobot;
private Joystick stick;
private CameraServer camera;
private JoystickButton button;
private Compressor compressor;
private Solenoid sol1,sol2,sol3,sol4,sol5,sol0;
private CameraServer cam,cam1;
private XboxController stick1;
private WPI_VictorSPX hand;
private Servo ser;
int handtype=0;
private Counter counter;
private DigitalInput swich;
@Override
public void robotInit()
{
LMotor = new WPI_VictorSPX(7);
RMotor = new WPI_VictorSPX(5);
hand = new WPI_VictorSPX(6);
FLMotor = new VictorSPX(2);
FRMotor = new VictorSPX(3);
myRobot = new DifferentialDrive(LMotor, RMotor);
FLMotor.set(ControlMode.Follower,0);
FRMotor.set(ControlMode.Follower,1);
stick = new Joystick(0);
button = new JoystickButton(stick,3);
counter=new Counter(0);
compressor = new Compressor(1);
stick1 = new XboxController(1);
//swich= new DigitalInput(0);
LMotor.setInverted(true);
RMotor.setInverted(true);
LMotor.setNeutralMode(NeutralMode.Brake);
RMotor.setNeutralMode(NeutralMode.Brake);
FLMotor.setNeutralMode(NeutralMode.Brake);
FRMotor.setNeutralMode(NeutralMode.Brake);
timer=new Timer();
}
@Override
public void autonomousInit()
{
}
@Override
public void autonomousPeriodic()
{
}
@Override
public void teleopInit()
{
}
@Override
public void teleopPeriodic()
{
//dashboard
//=========================================//
double current = compressor.getCompressorCurrent();
String.valueOf(current);
NumberFormat cur = NumberFormat.getInstance();
cur.setGroupingUsed(false);
String cout = cur.format(current);
SmartDashboard.putString(“DB/String 0”, cout);
//=========================================//
//compressor
//=========================================//
if(compressor.getCompressorCurrent() == 115)
{
compressor.setClosedLoopControl(false);
compressor.close();
}
else
{
compressor.setClosedLoopControl(true);
compressor.start();
}
//=================================//
//SERVO
//=========================================//
ser.getAngle();
if(ser.getAngle() < 90)
ser.setAngle(90);
System.out.print(Math.round(ser.getAngle()));
if(stick.getRawButton(11))
{
ser.setAngle(0);
}
//=========================================//
//=========================================//
if(stick.getRawButton(6))
{
if(handtype==1)
{
hand.set(ControlMode.PercentOutput,1);
timer.delay(1);
handtype=0;
}
else
{
hand.set(ControlMode.PercentOutput,-1);
sol0.set(false);
timer.delay(1);
handtype=1;
}
}
else
{
hand.set(ControlMode.PercentOutput,0);
}
//Counter
//=======================================
System.out.print(counter.get());
//motor
//=========================================//
myRobot.arcadeDrive(stick.getAxis(AxisType.kY),stick.getAxis(AxisType.kZ));
//=======================================//
}
@Override
public void testPeriodic()
{
}
}