Stap 5: Servo's en gezicht expressies
Voor de wenkbrauw en nick, we omgaan met 3 servo's die op pinnen aangesloten: 3,5,6 in Arduino en gebruikt een eenvoudige code die de servo's hoeken volgens een specifieke inbreng draait:
void moveServo(char c){ if(c== 'm'){ // upset EeyebrowSL.write(120); EeyebrowSR.write(60); }else if(c == 'n'){ //normal EeyebrowSL.write(90); EeyebrowSR.write(90); }else if (c == 'a' ){ //anger EeyebrowSL.write(60); EeyebrowSR.write(120); moveNick(); } delay(200); }
Ook moest de verhuizing nick code, draaien de nick te gedragen als het 'Nee' zeggen. De centrum-hoek was 140 graden dus we 110 en 180 vanuit het middelpunt gedraaid. (draaien van center tot 110, 110 € tot 180 vervolgens terug naar het centrum)
void moveNick(){ delay(1000); for(int k =0; k<2 ; k++){ //say 'NO' twice for(int i =140; i>= 110 ; i--){ nickS.write(i); delay(5); } for(int i =110; i<= 180 ; i++){ nickS.write(i); delay(5); } for(int i =180; i>= 140 ; i--){ nickS.write(i); delay(5); } } }