+ 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();
+ }
+