#include "Arduino.h"

// Definir pines
const int servoPin1 = 0;  // Servo 1
const int servoPin2 = 1;  // Servo 2

const int potPin1 = 2;  // Potenciómetro 1
const int potPin2 = 5;  // Potenciómetro 2

void setup() {
    pinMode(servoPin1, OUTPUT);
    pinMode(servoPin2, OUTPUT);
}

void loop() {
    // Leer valores de los potenciómetros
    int potValue1 = analogRead(potPin1);
    int potValue2 = analogRead(potPin2);

    // Convertir valores de los potenciómetros a ángulos (0° a 180°)
    int angle1 = map(potValue1, 0, 1023, 0, 180);
    int angle2 = map(potValue2, 0, 1023, 0, 180);

    // Definir la señal PWM para los servos
    int pulseWidth1 = map(angle1, 0, 180, 500, 2400);
    int pulseWidth2 = map(angle2, 0, 180, 500, 2400);

    // Enviar señal PWM manualmente a los servos
    moveServo(servoPin1, pulseWidth1);
    moveServo(servoPin2, pulseWidth2);

    delay(20);
}

// Generar señal PWM manualmente para los servos
void moveServo(int pin, int pulseWidth) {
    digitalWrite(pin, HIGH);
    delayMicroseconds(pulseWidth);
    digitalWrite(pin, LOW);
    delayMicroseconds(20000 - pulseWidth); // Periodo de 20ms
}