Étape 3: logiciel
Entrée analogique de tension (la caméra a détecté un sourire) est reçue sur la broche 20. Broche 26 (les yeux du père Noël et LED1 sur le module processeur) est activé pendant deux secondes lors de la détection d’un sourire. Broches 21 et 22 sont utilisés pour contrôler les servomoteurs qui créent le visage sourire/non-sourire. Il est facile dans le logiciel pour régler la position (sourire et non-smile) de chaque côté de la souriante « lip » ainsi que la durée du sourire.#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 Enable (int StartPos, int période) ;
int main () {servo1. Enable(1500,20000) ;
Servo2. Enable(1500,20000) ;
tandis que (1) {}
Si {(ain <.2)
LED = 0 ; Relais = 0 ;
SERVO1. SetPosition (1000); //rt sourire vers le bas
Servo2. SetPosition (1200); //lft sourire vers le bas
Wait(.5) ; } else {}
a = 1 ; Relais = 1 ;
SERVO1. SetPosition(2000) ;
Servo2. SetPosition(500) ;
Wait (2);} }
}