#define pwm_i 6 //~
#define izq_1 3
#define izq_2 4
#define STBY 9
#define pwm_d 5 //~
#define der_1 8
#define der_2 7
void setup() {
delay(1000);
pinMode(izq_1,OUTPUT);
pinMode(izq_2,OUTPUT);
pinMode(der_1,OUTPUT);
pinMode(der_2,OUTPUT);
}
void loop() {
motores(-50,-50);
delay(5000);
motores(50,50);
delay(5000);
motores(-50,50);
delay(5000);
motores(50,-50);
delay(5000);
}
void motores(int izq, int der)
{
if(izq>=0)
{
digitalWrite(izq_1,HIGH);
digitalWrite(izq_2,LOW);
digitalWrite(STBY,HIGH);
analogWrite(pwm_i,izq);
}
if(izq<0)
{
digitalWrite(izq_1,LOW);
digitalWrite(izq_2,HIGH);
digitalWrite(STBY,HIGH);
izq=izq*-1;
analogWrite(pwm_i,izq);
}
if(der>=0)
{
digitalWrite(der_1,HIGH);
digitalWrite(der_2,LOW);
digitalWrite(STBY,HIGH);
analogWrite(pwm_d,der);
}
if(der<0)
{
digitalWrite(der_1,LOW);
digitalWrite(der_2,HIGH);
digitalWrite(STBY,HIGH);
der=der*-1;
analogWrite(pwm_d,der);
}
}
No hay comentarios:
Publicar un comentario