ultrasonidos test

webserver.js

@@ -18,16 +18,45 @@ var RED = new Gpio(4, { mode: Gpio.OUTPUT });
 var GREEN = new Gpio(17, { mode: Gpio.OUTPUT });
 var BLUE = new Gpio(27, { mode: Gpio.OUTPUT });
 var motor = new Gpio(13, { mode: Gpio.OUTPUT });
+var trigger = new Gpio(23, {mode: Gpio.OUTPUT}),
+var echo = new Gpio(24, {mode: Gpio.INPUT, alert: true});
+
+var MICROSECDONDS_PER_CM = 1e6/34321;
 
 var pulseWidth = 1850;
 motor.servoWrite(pulseWidth);
 RED.pwmWrite(255);
 GREEN.pwmWrite(0);
 BLUE.pwmWrite(0);
+trigger.digitalWrite(0);
+
+// Ultrasonidos
+(function () {
+  var startTick;
+
+  echo.on('alert', function (level, tick) {
+    var endTick,
+      diff;
+
+    if (level == 1) {
+      startTick = tick;
+    } else {
+      endTick = tick;
+      diff = (endTick >> 0) - (startTick >> 0); // Unsigned 32 bit arithmetic
+      console.log(diff / 2 / MICROSECDONDS_PER_CM);
+    }
+  });
+}());
+
+// Trigger a distance measurement once per second
+setInterval(function () {
+  trigger.trigger(10, 1); // Set trigger high for 10 microseconds
+}, 1000);
 
 // Abrir puerta
 function abrirPuerta(){
 
+    RED.pwmWrite(0);
     GREEN.pwmWrite(255);
 
     var increment = -10;
@@ -48,6 +77,7 @@ function abrirPuerta(){
 // Cerrar puerta
 function cerrarPuerta(){
 
+    GREEN.pwmWrite(0);
     RED.pwmWrite(255);
 
     var increment = 10;