#define ECHO_PINZ 2
#define ECHO_PINA 4
#define TRIG_PINZ 3
#define TRIG_PINA 5
int ambient;
const int led=12;
int AA;
int BB;
int walioko;
int bleu;
void setup() {
Serial.begin(9600);
pinMode(led, OUTPUT);
pinMode(TRIG_PINA, OUTPUT);
pinMode(TRIG_PINZ,OUTPUT);
pinMode(ECHO_PINA, INPUT);
pinMode(ECHO_PINZ, INPUT);
}
float readDistanceCM() {
digitalWrite(TRIG_PINA, LOW);
delayMicroseconds(2);
digitalWrite(TRIG_PINA, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG_PINA, LOW);
int duration = pulseIn(ECHO_PINA, HIGH);
return duration * 0.034 / 2;
}
float readDistanceCMA() {
digitalWrite(TRIG_PINZ, LOW);
delayMicroseconds(2);
digitalWrite(TRIG_PINZ, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG_PINZ, LOW);
int duration = pulseIn(ECHO_PINZ, HIGH);
return duration * 0.034 / 2;
}
void loop() {
ambient = analogRead(A0)/4;
float distance = readDistanceCM();
float distancea = readDistanceCMA();
if (distance < 50) {AA = 1 ;}
if (distance > 50) {AA = 0 ;}
if (distancea < 50) {BB = 1 ;}
if (distancea > 50) {BB = 0 ;}
if (AA == 0 && BB == 1) {bleu = 178;}
if (AA == 1 && BB == 0) {bleu = 247;}
if (AA == 1 && BB == 1) {bleu = 90;}
if (AA == 0 && BB == 0 && bleu == 178) {walioko++;Serial.println(walioko);bleu = 90;}
if (AA == 0 && BB == 0 && bleu == 247 && walioko > 0) {walioko--;Serial.println(walioko);bleu = 90;}
if (walioko > 0) {analogWrite(led, ambient);}
if (walioko == 0) {analogWrite(led, 0);}
delay(10);
}