#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;
}
}
Sunday, 3 January 2016
CODE For H-Bridge Shield
Subscribe to:
Post Comments (Atom)
No comments:
Post a Comment