Robertop
#include <Servo.h>
Servo servo1; // Ojo 1
Servo servo2; // Ceja 1
Servo servo3; // Ceja 2
Servo servo4; // Mandíbula
Servo servo6; // Ojo 2
const int potPin = A0; // Pin analógico para el primer servo (ojo 1)
const int potPina = A1; // Pin analógico para el segundo servo (ceja 1)
const int potPinb = A2; // Pin analógico para el tercer servo (mandíbula)
const int potPinc = A3; // Pin analógico para el cuarto servo (ceja 2)
const int potPind = A4; // Pin analógico para el quinto servo (ojo 2)
const int led = 9; // Pin digital para el LED rojo
int valorPot;
int angulo;
void setup() {
servo1.attach(3);
servo2.attach(4);
servo3.attach(5);
servo4.attach(6);
servo6.attach(8);
pinMode(led, OUTPUT); // Configura el pin del LED rojo como salida
}
void loop() {
// Lee el valor del potenciómetro y mapea el rango a un ángulo entre 0 y 180 grados
valorPot = analogRead(potPin);
angulo = map(valorPot, 0, 1023, 0, 180);
servo1.write(angulo); // Controla el servo del ojo 1
valorPot = analogRead(potPina);
angulo = map(valorPot, 0, 1023, 0, 80);
servo2.write(angulo); // Controla el servo de la ceja 1
valorPot = analogRead(potPinb);
angulo = map(valorPot, 0, 1023, 0, 80);
servo3.write(angulo); // Controla el servo de la ceja 2
valorPot = analogRead(potPinc);
angulo = map(valorPot, 0, 1023, 0, 90);
servo4.write(angulo); // Controla el servo de la mandíbula
valorPot = analogRead(potPind);
angulo = map(valorPot, 0, 1023, 0, 180);
servo6.write(angulo); // Controla el servo del ojo 2
delay(15); // Pequeña pausa para suavizar el movimiento de los servos
}
Comments
Post a Comment