Stap 3: Software
Analoge spanning input (de camera heeft een glimlach detectie) wordt ontvangen op de pin 20. PIN 26 (Santa's ogen en LED1 op de processormodule) wordt geactiveerd gedurende twee seconden na detectie van een glimlach. Pinnen 21 en 22 zijn gebruikt om de servomotoren waarmee de glimlach/niet-smile gezicht. Het is gemakkelijk in software voor het aanpassen van de positie (glimlach en niet-glimlach) van elke zijde van de glimlachen "lip" alsmede de duur van de glimlach.#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 inschakelen (int StartPos, int periode);
int main () {servo1. Enable(1500,20000);
servo2. Enable(1500,20000);
terwijl (1) {}
Als (ain <.2) {}
geleid = 0; relay = 0;
servo1. SetPosition (1000); //rt glimlach naar beneden
servo2. SetPosition (1200); //lft glimlach naar beneden
wait(.5); } else {}
geleid = 1; relay = 1;
servo1. SetPosition(2000);
servo2. SetPosition(500);
wait(2);} }
}