Behaviors Driven Robotics (#178)

* adding avoid crash behavior

* more implementation

* add another simple behavior

* fixed synched motors

* bump common packages

libs/behaviors/_locales/behaviors-jsdoc-strings.json

@@ -0,0 +1,14 @@
+{
+  "behaviors": "Behavior drive blocks",
+  "behaviors.Behavior": "A behavior",
+  "behaviors.BehaviorManager": "A manager for behaviors",
+  "behaviors.BehaviorManager.add": "Adds a new behavior to the behavior manager",
+  "behaviors.BehaviorManager.add|param|behavior": "the behavior to add",
+  "behaviors.BehaviorManager.start": "Starts the behavior control loop",
+  "behaviors.BehaviorManager.stop": "Stops the execution loop",
+  "behaviors.addBehavior": "Adds the behavior and starts it",
+  "behaviors.addBehavior|param|behavior": "a behavior",
+  "behaviors.avoidCrash": "A behavior that stops all motors if the sensor distance get too short",
+  "behaviors.driveForward": "A behavior that turns on the motors to the specified speed",
+  "behaviors.driveForward|param|motors": "@param speed the desired speed, eg: 50"
+}

libs/behaviors/_locales/behaviors-strings.json

@@ -0,0 +1,7 @@
+{
+  "behaviors.addBehavior|block": "add behavior %behavior",
+  "behaviors.avoidCrash|block": "avoid crash using %ultrasonic",
+  "behaviors.driveForward|block": "drive %motors|forward at %speed|%",
+  "behaviors|block": "behaviors",
+  "{id:category}Behaviors": "Behaviors"
+}

libs/behaviors/pxt.json

@@ -0,0 +1,6 @@
+{
+    "additionalFilePath": "../../node_modules/pxt-common-packages/libs/behaviors",
+    "dependencies": {
+        "core": "file:../ev3"
+    }
+}

libs/behaviors/targetoverrides.ts

@@ -0,0 +1,56 @@
+namespace behaviors {
+    class AvoidCrashBehavior extends behaviors.Behavior {
+        private ultrasonic: sensors.UltraSonicSensor;
+        constructor(ultrasonic: sensors.UltraSonicSensor) {
+            super();
+            this.ultrasonic = ultrasonic;
+        }
+
+        shouldRun(): boolean {
+            return this.ultrasonic.distance() < 5;
+        }
+
+        run(): void {
+            motors.stopAllMotors();
+            this.active = false;
+        }
+    }
+
+    /**
+     * A behavior that stops all motors if the sensor distance get too short
+     */
+    //% blockId=behaviorsAvoidCrash block="avoid crash using %ultrasonic"
+    export function avoidCrash(ultrasonic: sensors.UltraSonicSensor) : behaviors.Behavior {
+        return new AvoidCrashBehavior(ultrasonic);
+    }
+
+    class DriveForwardBehavior extends behaviors.Behavior {
+        private motors: motors.MotorBase;
+        private speed: number;
+        constructor(motors: motors.MotorBase, speed: number) {
+            super();
+            this.motors = motors;
+            this.speed = speed;
+        }
+
+        shouldRun(): boolean { 
+            return true;
+        }
+
+        run(): void {
+            this.motors.setSpeed(this.speed);
+            pauseUntil(() => !this.active);
+            this.motors.setSpeed(0);
+        }
+    }
+
+    /**
+     * A behavior that turns on the motors to the specified speed
+     * @param motors 
+     * @param speed the desired speed, eg: 50
+     */
+    //% blockId=behaviorsDriveForward block="drive %motors|forward at %speed|%"
+    export function driveForward(motors: motors.MotorBase, speed: number): behaviors.Behavior {
+        return new DriveForwardBehavior(motors, speed);
+    }
+}