Saltar la navegación

Dos motores servos misma velocidad

Dos motores servos misma velocidad

//Modificaciones by www.sacosta.org a partir de Sweep
//dos motores servo misma velocidad

#include <Servo.h>

Servo myservo1; // creamos objeto Servo1
Servo myservo2; // creamos Servo2
int pos = 0; // variable donde almacenamos la posición
int angulo_paso=1; //variable donde almacenamos el número de grados de cada paso, susceptible de ser modificada por bluetooth u otros mecanismos.
int espera_paso=25;//variable donde almacenamos el tiempo, en milisegundos, que transcurre entre paso y paso
void setup()
{
myservo1.attach(9); // número del pin de arduino donde conectamos el cable de control del servo
myservo2.attach(10);
}


void loop()
{
for(pos = 0; pos < 180; pos += angulo_paso) { // va de 0 a 180º, la variable angulo_paso marca los grados de cada salto
myservo1.write(pos); // indica a myservo1 que vaya a la posición marcada por la variable 'pos'
myservo2.write(pos); // indica al myservo2 que vaya a la posición marcada por la variable 'pos'
delay(espera_paso); // espera los milisegundos que le indica la variable "espera_paso"
}
for(pos = 180; pos>=1; pos-=angulo_paso) { // va de 180º a 0º
myservo1.write(pos);
myservo2.write(pos);
delay(espera_paso);
}
}