final push

[des2015.git] / dsl / runtime / src / nl / ru / des / BasicBehaviour.java

diff --git a/dsl/runtime/src/nl/ru/des/BasicBehaviour.java b/dsl/runtime/src/nl/ru/des/BasicBehaviour.java
index b5d4bc1..945a709 100644 (file)
--- a/dsl/runtime/src/nl/ru/des/BasicBehaviour.java
+++ b/dsl/runtime/src/nl/ru/des/BasicBehaviour.java
@@ -45,32 +45,38 @@ public abstract class BasicBehaviour implements Behavior{
                rightMotor.setSpeed(25);
                leftMotor.setSpeed(25);
                if(sensors.leftLight() && !sensors.rightLight()){
-                       leftTurn(15);
+                       leftTurn(10);
                } else if (sensors.rightLight() && !sensors.leftLight()){
-                       rightTurn(15);
+                       rightTurn(10);
                }
                
                rightMotor.stop(true);
                leftMotor.stop(true);
                
-               measMotor.backward();
-               while(!suppressed && !measMotor.isStalled()){
+               measMotor.rotate(-100, true);
+               while(!suppressed && !measMotor.isStalled() && measMotor.isMoving()){
                        Thread.yield();
                }
-               measMotor.forward();
-               while(!suppressed && !measMotor.isStalled()){
+               measMotor.rotate(100, true);
+               while(!suppressed && !measMotor.isStalled() && measMotor.isMoving()){
                        Thread.yield();
                }
                measMotor.stop(true);
                
-               turnRandom(30, 45);
+               reset();
+               rightMotor.backward();
+               leftMotor.backward();
+               while(System.currentTimeMillis()-time < 250){
+                       Thread.yield();
+               }
+               turnRandom(45, 60);
        }
        
        protected void measureRock(){
                long time = System.currentTimeMillis();
                rightMotor.forward();
                leftMotor.forward();
-               while(System.currentTimeMillis()-time<1500){
+               while(System.currentTimeMillis()-time<1000){
                        Thread.yield();
                }
                
@@ -87,6 +93,11 @@ public abstract class BasicBehaviour implements Behavior{
                }
                measMotor.stop(true);
                
+               rightMotor.backward();
+               leftMotor.backward();
+               while(System.currentTimeMillis()-time<1000){
+                       Thread.yield();
+               }
                turnRandom(30, 45);
        }