#define trigPin1 3
#define echoPin1 2
#define trigPin2 4
#define echoPin2 5
#define trigPin3 7
#define echoPin3 8
#define trigPin4 10
#define echoPin4 6
#define trigPin5 12
#define echoPin5 9
#define LEDGreen1 A0
#define LEDYellow1 A1
#define LEDRed1 A2
#define LEDGreen2 A3
#define LEDYellow2 A4
#define LEDRed2 A5
#define buzzer1 13
#define buzzer2 11


long duration, distance, RightSensor, BackSensor, FrontSensor, LeftSensor, Up1Sensor, Up2Sensor;

void setup() 
{
  // put your setup code here, to run once:
Serial.begin(9600);
pinMode(trigPin1, OUTPUT);
pinMode(echoPin1, INPUT);
pinMode(trigPin2, OUTPUT);
pinMode(echoPin2, INPUT);
pinMode(trigPin3, OUTPUT);
pinMode(echoPin3, INPUT);
pinMode(trigPin4, OUTPUT);
pinMode(echoPin4, INPUT);
pinMode(trigPin5, OUTPUT);
pinMode(echoPin5, INPUT);

}

void loop() {
  // put your main code here, to run repeatedly:
SonarSensor(trigPin1,echoPin1);
RightSensor = distance;
SonarSensor(trigPin2,echoPin2);
LeftSensor = distance;
SonarSensor(trigPin3,echoPin3);
FrontSensor = distance;
SonarSensor(trigPin4,echoPin4);
Up1Sensor = distance;
SonarSensor(trigPin5,echoPin5);
Up2Sensor = distance;

Serial.print(LeftSensor);
Serial.print("-");
Serial.print(FrontSensor);
Serial.print("-");
Serial.print(RightSensor);
Serial.print("-");
Serial.print(Up1Sensor);
Serial.print("-");
Serial.println(Up2Sensor);

}


void SonarSensor(int trigPin,int echoPin)
{

digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
duration = pulseIn(echoPin, HIGH);
distance = (duration/2/29.1);

 if (duration < 200) {
    digitalWrite(LEDGreen1, HIGH);
    tone(11, 1200, 200);

}
  else
    digitalWrite(LEDRed1, LOW);}