View Single Post
  #6   Spotlight this post!  
Unread 13-02-2015, 13:46
nfusselman1 nfusselman1 is offline
Registered User
FRC #4076
 
Join Date: Jan 2015
Location: Justin TX
Posts: 26
nfusselman1 is an unknown quantity at this point
Re: VEX Ultrasonic Sensor

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();
		}
	}
}
Reply With Quote