Sunday, 3 January 2016

CODE For H-Bridge Shield

#define ENA 5;
#define ENB 3;
#define IN1 2;
#define IN2 4;
#define IN3 6;
#define IN4 7;

void setup() {
 pinMode(ENA,OUTPUT);
pinMode(ENB,OUTPUT);
pinMode(IN1,OUTPUT);
pinMode(IN2,OUTPUT);
pinMode(IN3,OUTPUT);
pinMode(IN4,OUTPUT);
}

void loop()
{
motorA(1,15);
delay(5000);
motorA(3,100);
motorB(1,15);
delay(5000);
motorB(3,50);
motorA(0,100);
delay(5000);

}
void motorA(int mode,int percent)
{
  int duty=map(percent,0,100,0,255);
  switch(mode)
  {
    case 0:
    digitalWrite(ENA,LOW);
    break;
   
    case 1:
    digitalWrite(IN1,HIGH);
    digitalWrite(IN2,LOW);
    analogWrite(ENA,duty);
    break;
   
    case 2:
    digitalWrite(IN1,LOW);
    digitalWrite(IN2,HIGH);
    analogWrite(ENA,duty);
    break;
   
    case 3:
    digitalWrite(IN1,LOW);
    digitalWrite(IN2,LOW);
    analogWrite(ENA,duty);
    break;
  }
}


void motorB(int mode,int percent)
{
  int duty=map(percent,0,100,0,255);
  switch(mode)
  {
    case 0:
    digitalWrite(ENB,LOW);
    break;
   
    case 1:
    digitalWrite(IN3,HIGH);
    digitalWrite(IN4,LOW);
    analogWrite(ENB,duty);
    break;
   
    case 2:
    digitalWrite(IN3,LOW);
    digitalWrite(IN4,HIGH);
    analogWrite(ENB,duty);
    break;
   
    case 3:
    digitalWrite(IN3,LOW);
    digitalWrite(IN4,LOW);
    analogWrite(ENB,duty);
    break;
  }
}

No comments:

Post a Comment