Paso 3: Software
Voltaje analógico de entrada (la cámara detectó una sonrisa) se recibe en el pin 20. PIN 26 (ojos de Santa Claus y LED1 en el módulo de procesador) se activa durante dos segundos tras la detección de una sonrisa. Pins 21 y 22 se utilizan para controlar los servomotores que crean la cara de sonrisa, no-sonrisa. Es fácil en software para ajustar la posición (sonrisa y sin sonrisa) de cada lado de la sonrisa "labio" así como la duración de la sonrisa.#include "mbed.h"
#include "Servo.h"
AnalogIn ain(p20);
DigitalOut led(LED1);
DigitalOut relay(p26);
Servo servo1(p21);
Servo servo2(p22);
void SetPosition (int NewPos);
void activar (int Pos_inicio, int período);
int principal () {servo1. Enable(1500,20000);
servo2. Enable(1500,20000);
mientras que {} (1)
Si {} (ain <.2)
LED = 0; Relay = 0;
servo1. SetPosition (1000); //rt sonrisa hacia abajo
servo2. SetPosition (1200), sonrisa de //lft abajo
Wait(.5); } else {}
LED = 1; Relay = 1;
servo1. SetPosition(2000);
servo2. SetPosition(500);
Wait(2);} }
}
