/*
https://forum.arduino.cc/t/arduino-uno-programming/1260837
*/
int IN1pin = 9;
int IN2pin = 8;
int ENApin = 6;
int Bubble_fc_sensorpin1 = 12;
int Bubble_fc_sensorpin2 = 13;
unsigned long lastMove;
unsigned long intervalMove = 500;
byte stateMove = 0;
void setup() {
pinMode(IN1pin, OUTPUT);
pinMode(IN2pin, OUTPUT);
pinMode(ENApin, OUTPUT);
pinMode(Bubble_fc_sensorpin1, INPUT);
pinMode(Bubble_fc_sensorpin2, INPUT);
Serial.begin(9600);
}
void loop() {
unsigned long now = millis();
if (digitalRead(Bubble_fc_sensorpin1) == HIGH && digitalRead(Bubble_fc_sensorpin2) == HIGH) {
if (now - lastMove >= intervalMove) {
lastMove = now;
switch (stateMove) {
case 0: digitalWrite(IN1pin, HIGH);
digitalWrite(IN2pin, LOW);
analogWrite(ENApin, 255);
intervalMove = 500;
stateMove = 1;
break;
case 1: digitalWrite(IN1pin, LOW);
digitalWrite(IN2pin, LOW);
analogWrite(ENApin, 0);
intervalMove = 1000;
stateMove = 0;
break;
}
}
} else { //one of the sensors are triggered..
//enter a stopped state..
digitalWrite(IN1pin, LOW);
digitalWrite(IN2pin, LOW);
analogWrite(ENApin, 0);
intervalMove = 1000;
stateMove = 0;
}
}