#include <Otto.h>
Otto Otto;

#define LeftLeg 2 // left leg pin, servo[0]
#define RightLeg 3 // right leg pin, servo[1]
#define LeftFoot 4 // left foot pin, servo[2]
#define RightFoot 5 // right foot pin, servo[3]
#define Buzzer 13 //buzzer pin

 void Otto_moveLegs(int T, int posLegL, int posLegR, int posFootL, int posFootR) {   int posLegs[]={ posLegL,posLegR,posFootL,posFootR };   Otto._moveServos(T,posLegs); }

void setup() {
  Serial.begin(9600);

  Otto.init(LeftLeg, RightLeg, LeftFoot, RightFoot, true, Buzzer);
Otto.home();

  Otto_moveLegs(200,90,90,90,90);
    Otto_moveLegs(200,90,90,90,90);
}

void loop() {
    
    Otto.bendTones( 880,2093,1.02,18,1); // (float initFrequency, float finalFrequency, float prop, long noteDuration, int silentDuration)
if (Serial.available() > 0) {
    // Baca data dari serial dan tambahkan ke variabel command
    char incomingChar = Serial.read();
    
    // Jika karakter yang dibaca adalah newline atau carriage return,
    // anggap perintah selesai dan cetak
    if (incomingChar == '\n' || incomingChar == '\r') {
      Serial.print("Perintah diterima: ");
      //Serial.println(command);
      
      // Tambahkan logika untuk menangani perintah di sini
      // Misalnya, jika command adalah "LED ON", hidupkan LED
      if (incomingChar == 'N') {
        // Hidupkan LED (misalkan LED terhubung ke pin 13)
        //digitalWrite(13, HIGH);
        Otto.moonwalker(1, 1000, 25, 1);
      } else if (incomingChar == 'D') {
        // Matikan LED
        digitalWrite(13, LOW);
      }
    }
}
      
     
}