gyroTime = System.currentTimeMillis();
}
- public void debug(){
- new Thread(){
- @Override public void run(){
- while(true){
- ultra.fetchSample(ultraSamples, 0);
- leftLight.fetchSample(leftLightSamples, 0);
- rightLight.fetchSample(rightLightSamples, 0);
- LCD.drawString("back: " + Float.toString(ultraSamples[0]), 0, 1);
- LCD.drawString("front: " + Float.toString(frontUltra), 0, 2);
- LCD.drawString("left: " + Float.toString(leftLightSamples[0]), 0, 3);
- LCD.drawString("right: " + Float.toString(rightLightSamples[0]), 0, 4);
- Delay.msDelay(250);
- }
- }
- }.run();
- }
-
//Local sensors
public boolean backDistance(){
if(System.currentTimeMillis()-ultraTime>DELAY){