//pinconstants
const int tempPin = 0;
const int echoPin1 = 2;
const int trigPin1 = 3;
const int echoPin2 = 4;
const int trigPin2 = 5;
const int echoPin3 = 6;
const int trigPin3 = 7;
const int echoPin4 = 8;
const int trigPin4 = 9;
const int echoPin5 = 10;
const int trigPin5 = 11;
const int ledPin1 = 12;
const int ledPin2 = 13;
const int ledPin3 = 14;
const int ledPin4 = 15;
const int ledPin5 = 16;

//only one
float TEMP, vgeluidms, vgeluidcmus;
int readingTEMP;

//distance
long duration1, duration2, duration3, duration4, duration5;
int distance1, distance2, distance3, distance4, distance5; 
int distance_output1, distance_output2, distance_output3, distance_output4, distance_output5; 

//repeatsystem
int distanceI1, distanceII1, distanceIII1, distanceIV1;
int distanceI2, distanceII2, distanceIII2, distanceIV2;
int distanceI3, distanceII3, distanceIII3, distanceIV3;
int distanceI4, distanceII4, distanceIII4, distanceIV4;
int distanceI5, distanceII5, distanceIII5, distanceIV5;

void setup() {
//pinmodes
analogReference(INTERNAL1V1);

pinMode(echoPin1, INPUT);
pinMode(trigPin1, OUTPUT);
pinMode(ledPin1, OUTPUT);

pinMode(echoPin2, INPUT);
pinMode(trigPin2, OUTPUT);
pinMode(ledPin2, OUTPUT);

pinMode(echoPin3, INPUT);
pinMode(trigPin3, OUTPUT);
pinMode(ledPin3, OUTPUT);

pinMode(echoPin4, INPUT);
pinMode(trigPin4, OUTPUT);
pinMode(ledPin4, OUTPUT);

pinMode(echoPin5, INPUT);
pinMode(trigPin5, OUTPUT);
pinMode(ledPin5, OUTPUT);

//developer
Serial.begin(9600);
//developer
}

void loop() {
//tempPin loop
readingTEMP = analogRead(tempPin);
TEMP = readingTEMP / 9.31;
vgeluidms = 331 + (0.6*TEMP);
vgeluidcmus = ((vgeluidms*100)/1000000);

//echoPin1 loop
digitalWrite(trigPin1, LOW);
delayMicroseconds(2);
digitalWrite(trigPin1, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin1, LOW);
duration1 = pulseIn(echoPin1, HIGH);
distance_output1 = (duration1*vgeluidcmus)/2;

//echoPin2 loop
digitalWrite(trigPin2, LOW);
delayMicroseconds(2);
digitalWrite(trigPin2, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin2, LOW);
duration2 = pulseIn(echoPin2, HIGH);
distance_output2 = (duration2*vgeluidcmus)/2;

//echoPin3 loop
digitalWrite(trigPin3, LOW);
delayMicroseconds(2);
digitalWrite(trigPin3, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin3, LOW);
duration3 = pulseIn(echoPin3, HIGH);
distance_output3 = (duration3*vgeluidcmus)/2;

//echoPin4 loop
digitalWrite(trigPin4, LOW);
delayMicroseconds(2);
digitalWrite(trigPin4, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin4, LOW);
duration4 = pulseIn(echoPin4, HIGH);
distance_output4 = (duration4*vgeluidcmus)/2;

//echoPin5 loop
digitalWrite(trigPin5, LOW);
delayMicroseconds(2);
digitalWrite(trigPin5, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin5, LOW);
duration5 = pulseIn(echoPin5, HIGH);
distance_output5 = (duration5*vgeluidcmus)/2;


//filtersystem part.1_1
if (distance_output1 > 300 && distanceI1 != 0 && distanceII1 == 0 && distanceIII1 == 0 && distanceIV1 == 0){
  distance1 = distanceI1;
}
if (distance_output1 > 300 && distanceI1 != 0 && distanceII1 != 0 && distanceIII1 == 0 && distanceIV1 == 0){
  distance1 = distanceII1;
}
if (distance_output1 > 300 && distanceI1 != 0 && distanceII1 != 0 && distanceIII1 != 0 && distanceIV1 == 0){
  distance1 = distanceIII1;
}
if (distance_output1 > 300 && distanceI1 != 0 && distanceII1 != 0 && distanceIII1 != 0 && distanceIV1 != 0){
  distance1 = 0;
}
if (distance_output1 <= 300) {
  distance1 = distance_output1;
}

//filtersystem part.1_2
if (distance_output2 > 300 && distanceI2 != 0 && distanceII2 == 0 && distanceIII2 == 0 && distanceIV2 == 0){
  distance2 = distanceI2;
}
if (distance_output2 > 300 && distanceI2 != 0 && distanceII2 != 0 && distanceIII2 == 0 && distanceIV2 == 0){
  distance2 = distanceII2;
}
if (distance_output2 > 300 && distanceI2 != 0 && distanceII2 != 0 && distanceIII2 != 0 && distanceIV2 == 0){
  distance2 = distanceIII1;
}
if (distance_output2 > 300 && distanceI2 != 0 && distanceII2 != 0 && distanceIII2 != 0 && distanceIV2 != 0){
  distance2 = 0;
}
if (distance_output2 <= 300) {
  distance2 = distance_output2;
}

//filtersystem part.1_3
if (distance_output3 > 300 && distanceI3 != 0 && distanceII3 == 0 && distanceIII3 == 0 && distanceIV3 == 0){
  distance3 = distanceI3;
}
if (distance_output3 > 300 && distanceI3 != 0 && distanceII3 != 0 && distanceIII3 == 0 && distanceIV3 == 0){
  distance3 = distanceII3;
}
if (distance_output3 > 300 && distanceI3 != 0 && distanceII3 != 0 && distanceIII3 != 0 && distanceIV3 == 0){
  distance3 = distanceIII3;
}
if (distance_output3 > 300 && distanceI3 != 0 && distanceII3 != 0 && distanceIII3 != 0 && distanceIV3 != 0){
  distance3 = 0;
}
if (distance_output3 <= 300) {
  distance3 = distance_output3;
}

//filtersystem part.1_4
if (distance_output4 > 300 && distanceI4 != 0 && distanceII4 == 0 && distanceIII4 == 0 && distanceIV4 == 0){
  distance4 = distanceI4;
}
if (distance_output4 > 300 && distanceI4 != 0 && distanceII4 != 0 && distanceIII1 == 0 && distanceIV4 == 0){
  distance4 = distanceII4;
}
if (distance_output4 > 300 && distanceI4 != 0 && distanceII4 != 0 && distanceIII4 != 0 && distanceIV4 == 0){
  distance4 = distanceIII4;
}
if (distance_output4 > 300 && distanceI4 != 0 && distanceII4 != 0 && distanceIII4 != 0 && distanceIV4 != 0){
  distance4 = 0;
}
if (distance_output4 <= 300) {
  distance4 = distance_output4;
}

//filtersystem part.1_5
if (distance_output5 > 300 && distanceI5 != 0 && distanceII5 == 0 && distanceIII5 == 0 && distanceIV5 == 0){
  distance4 = distanceI4;
}
if (distance_output5 > 300 && distanceI5 != 0 && distanceII5 != 0 && distanceIII5 == 0 && distanceIV5 == 0){
  distance5 = distanceII5;
}
if (distance_output5 > 300 && distanceI5 != 0 && distanceII5 != 0 && distanceIII5 != 0 && distanceIV5 == 0){
  distance5 = distanceIII5;
}
if (distance_output5 > 300 && distanceI5 != 0 && distanceII5 != 0 && distanceIII5 != 0 && distanceIV5 != 0){
  distance5 = 0;
}
if (distance_output5 <= 300) {
  distance5 = distance_output5;
}


//led pin code//


//filtersystem part.2_1
if (distance_output1 > 300 && distanceI1 != 0 && distanceII1 != 0 && distanceIII1 !=0) {
  distanceIV1 = distanceIII1;
}

if (distance_output1 > 300 && distanceI1 != 0 && distanceII1 != 0) {
  distanceIII1 = distanceII1;
}

if (distance_output1 > 300 && distanceI1 != 0) {
  distanceII1 = distanceI1;
}

if (distance_output1 <= 300) {
  distanceI1 = distance_output1;
  distanceII1 = 0;
  distanceIII1 = 0;
  distanceIV1 = 0;
}

//filtersystem part.2_2
if (distance_output2 > 300 && distanceI2 != 0 && distanceII2 != 0 && distanceIII2 !=0) {
  distanceIV2 = distanceIII2;
}

if (distance_output2 > 300 && distanceI2 != 0 && distanceII2 != 0) {
  distanceIII2 = distanceII2;
}

if (distance_output2 > 300 && distanceI2 != 0) {
  distanceII2 = distanceI2;
}

if (distance_output2 <= 300) {
  distanceI2 = distance_output2;
  distanceII2 = 0;
  distanceIII2 = 0;
  distanceIV2 = 0;
}

//filtersystem part.2_3
if (distance_output3 > 300 && distanceI3 != 0 && distanceII3 != 0 && distanceIII3 !=0) {
  distanceIV3 = distanceIII3;
}

if (distance_output3 > 300 && distanceI3 != 0 && distanceII3 != 0) {
  distanceIII3 = distanceII3;
}

if (distance_output3 > 300 && distanceI3 != 0) {
  distanceII3 = distanceI3;
}

if (distance_output3 <= 300) {
  distanceI3 = distance_output3;
  distanceII3 = 0;
  distanceIII3 = 0;
  distanceIV3 = 0;
}

//filtersystem part.2_4
if (distance_output4 > 300 && distanceI4 != 0 && distanceII4 != 0 && distanceIII4 !=0) {
  distanceIV4 = distanceIII4;
}

if (distance_output4 > 300 && distanceI4 != 0 && distanceII4 != 0) {
  distanceIII4 = distanceII4;
}

if (distance_output4 > 300 && distanceI4 != 0) {
  distanceII4 = distanceI4;
}

if (distance_output4 <= 300) {
  distanceI4 = distance_output1;
  distanceII4 = 0;
  distanceIII4 = 0;
  distanceIV4 = 0;
}

//filtersystem part.2_5
if (distance_output5 > 300 && distanceI5 != 0 && distanceII5 != 0 && distanceIII5 !=0) {
  distanceIV5 = distanceIII5;
}

if (distance_output5 > 300 && distanceI5 != 0 && distanceII5 != 0) {
  distanceIII5 = distanceII5;
}

if (distance_output5 > 300 && distanceI5 != 0) {
  distanceII5 = distanceI5;
}

if (distance_output5 <= 300) {
  distanceI5 = distance_output1;
  distanceII5 = 0;
  distanceIII5 = 0;
  distanceIV5 = 0;
}

//developer
Serial.print(distance_output1);
Serial.print(" - ");
Serial.print(distance1);
Serial.print(" - ");
Serial.print(distance_output2);
Serial.print(" - ");
Serial.print(distance2);
Serial.print(" - ");
Serial.print(distance_output3);
Serial.print(" - ");
Serial.print(distance3);
Serial.print(" - ");
Serial.print(distance_output4);
Serial.print(" - ");
Serial.print(distance4);
Serial.print(" - ");
Serial.print(distance_output5);
Serial.print(" - ");
Serial.println(distance5);
//developer
}