P4: GIRASOL

// P4: Girasol Robot - EigenRobotics

#include <Servo.h>

const int LDR_IZQ = A0;
const int LDR_DER = A1;
const int SERVO_PIN = 9;

const int UMBRAL = 50;      // Diferencia minima para moverse
const int VELOCIDAD = 1;    // Grados por paso

Servo servo;
int posicion = 90;  // Empezar en el centro

void setup() {
  servo.attach(SERVO_PIN);
  servo.write(posicion);

  Serial.begin(9600);
  Serial.println("Girasol Robot activado!");

  delay(500);
}

void loop() {
  // Leer ambos sensores
  int luzIzq = analogRead(LDR_IZQ);
  int luzDer = analogRead(LDR_DER);
  int diferencia = luzIzq - luzDer;

  // Mostrar valores
  Serial.print("Izq: ");
  Serial.print(luzIzq);
  Serial.print(" | Der: ");
  Serial.print(luzDer);
  Serial.print(" | Pos: ");
  Serial.println(posicion);

  // Decidir movimiento
  if (diferencia > UMBRAL && posicion > 0) {
    posicion -= VELOCIDAD;  // Girar izquierda
  }
  else if (diferencia < -UMBRAL && posicion < 180) {
    posicion += VELOCIDAD;  // Girar derecha
  }

  servo.write(posicion);
  delay(20);
}