#define SERVO1_PIN 18 #define SERVO2_PIN 21 void setup() { pinMode(SERVO1_PIN, OUTPUT); pinMode(SERVO2_PIN, OUTPUT); } void writeServo(int pin, int angle) { // Convert angle to pulse width int pulseWidth = map(angle, 0, 180, 500, 2500); digitalWrite(pin, HIGH); delayMicroseconds(pulseWidth); digitalWrite(pin, LOW); delay(20); } void loop() { // ===================== // CALM // ===================== for (int i = 0; i < 30; i++) { writeServo(SERVO1_PIN, 80); writeServo(SERVO2_PIN, 100); delay(200); writeServo(SERVO1_PIN, 100); writeServo(SERVO2_PIN, 80); delay(200); } // ===================== // HAPPY // ===================== for (int i = 0; i < 40; i++) { writeServo(SERVO1_PIN, random(60,120)); writeServo(SERVO2_PIN, random(60,120)); delay(100); } // ===================== // ANGRY // ===================== for (int i = 0; i < 50; i++) { writeServo(SERVO1_PIN, 40); writeServo(SERVO2_PIN, 140); delay(50); writeServo(SERVO1_PIN, 140); writeServo(SERVO2_PIN, 40); delay(50); } }