jueves, 5 de julio de 2018

Encendido de un motor DC con Arduino

Aqui te dejo el codigo de Arduino para el proyecto del autito de velocidad.

#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