#define SW1 3
#define SW2 2
#define Motor_F 5
#define Motor_R 6
int PWM = 0;
int Speed = 0;
int ModeF = 0;
int ModeR = 0;
void setup() {
pinMode(SW1, INPUT_PULLUP);
pinMode(SW2, INPUT_PULLUP);
pinMode(Motor_F, OUTPUT);
pinMode(Motor_R, OUTPUT);
Serial.begin(9600);
}
void loop() {
PWM = analogRead(A0);
Speed = map(PWM,0,1023,0,255);
if(digitalRead(SW1)==0) { ModeF++; ModeR=0; while(digitalRead(SW1)==0) { delay(10); }
analogWrite(Motor_F, 0);
analogWrite(Motor_R, 0);
delay(500);
}
if(digitalRead(SW2)==0) { ModeR++; ModeF=0; while(digitalRead(SW2)==0) { delay(10); }
analogWrite(Motor_F, 0);
analogWrite(Motor_R, 0);
delay(500);
}
if(ModeF%2==1)
{
Serial.println("MotorF ON || MotorR OFF");
analogWrite(Motor_F, Speed);
analogWrite(Motor_R, 0);
}
else if(ModeR%2==1)
{
Serial.println("MotorF OFF || MotorR ON");
analogWrite(Motor_F, 0);
analogWrite(Motor_R, Speed);
}
else
{
Serial.println("MotorF OFF || MotorR OFF");
analogWrite(Motor_F, 0);
analogWrite(Motor_R, 0);
}
delay(30);
}