hitwall.java

来自「专业汽车级嵌入式操作系统OSEK的源代码」· Java 代码 · 共 35 行

import lejos.nxt.*;
import lejos.subsumption.*;

public class HitWall implements Behavior {
	
   TouchSensor touch;
   
   public HitWall()
   {
	   touch = new TouchSensor(SensorPort.S2);
   }
   
   public boolean takeControl() {
      return touch.isPressed();
   }

   public void suppress() {
      Motor.A.stop();
      Motor.C.stop();
   }

   public void action() {
      // Back up:
      Motor.A.backward();
      Motor.C.backward();
      try{Thread.sleep(1000);}catch(Exception e) {}
      // Rotate by causing only one wheel to stop:
      Motor.A.stop();
      try{Thread.sleep(300);}catch(Exception e) {}
      Motor.C.stop();
   }
}