Here is my current code that is not working for some reason.
Code:
package org.usfirst.frc.team4076.robot;
import edu.wpi.first.wpilibj.Joystick;
import edu.wpi.first.wpilibj.RobotDrive;
import edu.wpi.first.wpilibj.SampleRobot;
import edu.wpi.first.wpilibj.Timer;
import edu.wpi.first.wpilibj.Ultrasonic;
public class Robot extends SampleRobot {
RobotDrive myRobot;
Joystick stick;
Ultrasonic ultra;
public void robotInit() {
myRobot = new RobotDrive(0, 1);
myRobot.setExpiration(0.1);
stick = new Joystick(0);
ultra = new Ultrasonic(0, 1);
ultra.setAutomaticMode(isEnabled());
ultra.setEnabled(isEnabled());
}
public void operatorControl() {
while (isOperatorControl() && isEnabled()) {
myRobot.arcadeDrive(stick);
while (stick.getRawButton(4)) {
myRobot.tankDrive(1, -1);
Timer.delay(0.005);
}
while (stick.getRawButton(5)) {
myRobot.tankDrive(-1, 1);
Timer.delay(0.005);
}
Timer.delay(0.005);
}
}
public void Test() {
ultra.getTable();
while (isTest() && isEnabled()) {
myRobot.arcadeDrive(stick);
ultra.updateTable();
}
}
}