ears.ino

#include <Servo.h>

Servo Roll_L;
Servo Pitch_L;  
Servo Roll_R;
Servo Pitch_R;

int pos = 0;    // variable to store the servo position

void setup() {
  // Attach servos to their respective pins
  Roll_L.attach(2);
  Pitch_L.attach(3);
  Roll_R.attach(4);
  Pitch_R.attach(5);
}

void loop() {  
  happyExpression();      // correct answer
  delay(1000);
  
  sadExpression();        // incorrect answer
  delay(1000);
  
  superHappyExpression(); // correct streak
  delay(1000);
  
  superUnhappyExpression(); // incorrect streak
  delay(1000);
}

void resetPosition() {
  Roll_L.write(90);Pitch_L.write(90); Roll_R.write(90);  Pitch_R.write(90);
}

// Function for happy expression (for correct answer)
void happyExpression() {
  for (pos = 0; pos <= 90; pos += 1) {  
    Roll_L.write(pos);
    Pitch_L.write(pos);
    Roll_R.write(pos);
    Pitch_R.write(pos);
    delay(15);
  }

  for (pos = 90; pos >= 0; pos -= 1) {  
    Roll_L.write(pos);
    Pitch_L.write(pos);
    Roll_R.write(pos);
    Pitch_R.write(pos);
    delay(15);
  }
  
  resetPosition(); //return ears to neutral position
}

// Function for sad expression (for incorrect answer)
void sadExpression() {
  for (pos = 0; pos <= 60; pos += 1) {  
    Pitch_L.write(180-pos); 
    Pitch_R.write(180-pos);  
    Roll_L.write(90+pos/2);
    Roll_R.write(90-pos/2);
    delay(20);
  }

  for (pos = 60; pos >= 0; pos -= 1) {  
    Pitch_L.write(120+pos);  
    Pitch_R.write(120+pos);  
    Roll_L.write(120-pos/2);  
    Roll_R.write(60+pos/2);
    delay(20);
  }
  
  resetPosition(); //return ears to neutral position
}

// Function for super happy expression (for correct streak)
void superHappyExpression() {
  for (int i=0; i<3; i++) {
    for (pos = 0; pos <= 90; pos += 1) {  
      Roll_L.write(pos);
      Pitch_L.write(pos);
      Roll_R.write(pos);
      Pitch_R.write(pos);
      delay(10);
    }
    for (pos = 90; pos >= 0; pos -= 1) {  
      Roll_L.write(pos);
      Pitch_L.write(pos);
      Roll_R.write(pos);
      Pitch_R.write(pos);
      delay(10);  
    }
  }

  for (pos = 0; pos <= 30; pos += 1) {  
    Roll_L.write(pos);
    Roll_R.write(180-pos);
    delay(15);  
  }

  for (pos = 30; pos >= 0; pos -= 1) {  
    Roll_L.write(pos);
    Roll_R.write(180-pos);
    delay(15);  
  }
  
  resetPosition(); //return ears to neutral position
}

// Function for super unhappy expression (for incorrect streak)
void superUnhappyExpression() {
  for (pos = 0; pos <= 60; pos += 1) {  
    Pitch_L.write(180-pos);
    Pitch_R.write(180-pos);  
    Roll_L.write(90+pos);
    Roll_R.write(90-pos);
    delay(30);
  }

  for (int i = 0; i < 2; i++) {
    Roll_L.write(60);  
    Roll_R.write(120);
    delay(100);
    Roll_L.write(90);
    Roll_R.write(90);
    delay(100);
  }

  for (pos = 60; pos >= 0; pos -= 1) {  
    Pitch_L.write(120+pos);  
    Pitch_R.write(120+pos);  
    Roll_L.write(120-pos);  
    Roll_R.write(60+pos);
    delay(20);
  }
  
  resetPosition(); //return ears to neutral position
}