Page 419 - 2
P. 419
char cmd = bluetoothSerial.read();
int flag1, flag2, flag3;
float distance1, distance2, distance3;
digitalWrite(trig1,HIGH);
delay(2);
digitalWrite(trig1,LOW);
distance1 = pulseIn(echo1, HIGH)*17/1000;
digitalWrite(trig2,HIGH);
delay(2);
digitalWrite(trig2,LOW);
distance2 = pulseIn(echo2, HIGH)*17/1000;
digitalWrite(trig3,HIGH);
delay(2);
digitalWrite(trig3,LOW);
distance3 = pulseIn(echo3, HIGH)*17/1000;
Serial.print(distance1);
Serial.println();
Serial.print(distance2);
Serial.println();
Serial.print(distance3);
Serial.println();
if(cmd == 'a') digitalWrite(out1,HIGH);
if(cmd == 'A') digitalWrite(out1,LOW);
if(cmd == 'b') digitalWrite(out2,HIGH);
if(cmd == 'B') digitalWrite(out2,LOW);
if(cmd == 'c') digitalWrite(out3,HIGH);
if(cmd == 'C') digitalWrite(out3,LOW);
if(distance1 > 13 && distance1 < 20)
flag1 = 1;
if(distance1 > 20 || distance1 < 13)
flag1 = 0;
if(distance2 > 13 && distance2 < 20)
flag2 = 1;
if(distance2 > 20 || distance2 < 13)
flag2 = 0;
if(distance3 > 13 && distance3 < 20)
flag3 = 1;
- 419 -