project-19-steps-us1-us2

int t1 = 500;
int t2 = 100;

#define r1    2
#define r2    3
#define r3    4
#define r4    5
#define r5    6
#define r6    7
#define r7    8
#define r8    9
#define r9    31
#define r10   33
#define r11   35
#define r12   37
#define r13   39
#define r14   41
#define r15   43
#define r16   45
#define r17   30
#define r18   32
#define r19   34

#define trigPin1 22
#define echoPin1 24

#define trigPin2 26
#define echoPin2 28

long duration1;
int distance1;

long duration2;
int distance2;

void setup() {
  // put your setup code here, to run once:
  initSensors();
  initRelay();
  allOFF();
}

void loop() {
  //allON();
  //allOFF();
  //lowToHigh();
  //highToLow();
  //lowToHighON();
  //highToLowON();
  //delay(1000);
  us1();
  us2();
  if (distance1 < 150) {
    lowToHigh();
    delay(10000);
  }
  else if (distance2 < 150) {
    highToLow();
    delay(10000);
  }
  else {
    allOFF();
  }
  delay(100);
}//end of LOOP.


void initSensors() {
  pinMode(trigPin1, OUTPUT);
  pinMode(echoPin1, INPUT);
  pinMode(trigPin2, OUTPUT);
  pinMode(echoPin2, INPUT);
}

void us1() {
  digitalWrite(trigPin1, LOW);
  delayMicroseconds(5);
  digitalWrite(trigPin1, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin1, LOW);
  duration1 = pulseIn(echoPin1, HIGH);
  distance1 = duration1 * 0.034 / 2;
  Serial.print("Distance = ");
  Serial.print(distance1);
  Serial.println(" cm");
  delay(100);
}
void us2() {
  digitalWrite(trigPin2, LOW);
  delayMicroseconds(5);
  digitalWrite(trigPin2, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin2, LOW);
  duration2 = pulseIn(echoPin2, HIGH);
  distance2 = duration2 * 0.034 / 2;
  Serial.print("Distance = ");
  Serial.print(distance2);
  Serial.println(" cm");
  delay(100);
}

void allOFF() {
  digitalWrite(r1, HIGH);
  digitalWrite(r2, HIGH);
  digitalWrite(r3, HIGH);
  digitalWrite(r4, HIGH);
  digitalWrite(r5, HIGH);
  digitalWrite(r6, HIGH);
  digitalWrite(r7, HIGH);
  digitalWrite(r8, HIGH);
  digitalWrite(r9, HIGH);
  digitalWrite(r10, HIGH);
  digitalWrite(r11, HIGH);
  digitalWrite(r12, HIGH);
  digitalWrite(r13, HIGH);
  digitalWrite(r14, HIGH);
  digitalWrite(r15, HIGH);
  digitalWrite(r16, HIGH);
  digitalWrite(r17, HIGH);
  digitalWrite(r18, HIGH);
  digitalWrite(r19, HIGH);
}

void allON() {
  digitalWrite(r1, LOW);
  digitalWrite(r2, LOW);
  digitalWrite(r3, LOW);
  digitalWrite(r4, LOW);
  digitalWrite(r5, LOW);
  digitalWrite(r6, LOW);
  digitalWrite(r7, LOW);
  digitalWrite(r8, LOW);
  digitalWrite(r9, LOW);
  digitalWrite(r10, LOW);
  digitalWrite(r11, LOW);
  digitalWrite(r12, LOW);
  digitalWrite(r13, LOW);
  digitalWrite(r14, LOW);
  digitalWrite(r15, LOW);
  digitalWrite(r16, LOW);
  digitalWrite(r17, LOW);
  digitalWrite(r18, LOW);
  digitalWrite(r19, LOW);
}

void initRelay() {
  pinMode(r1, OUTPUT);
  pinMode(r2, OUTPUT);
  pinMode(r3, OUTPUT);
  pinMode(r4, OUTPUT);
  pinMode(r5, OUTPUT);
  pinMode(r6, OUTPUT);
  pinMode(r7, OUTPUT);
  pinMode(r8, OUTPUT);
  pinMode(r9, OUTPUT);
  pinMode(r10, OUTPUT);
  pinMode(r11, OUTPUT);
  pinMode(r12, OUTPUT);
  pinMode(r13, OUTPUT);
  pinMode(r14, OUTPUT);
  pinMode(r15, OUTPUT);
  pinMode(r16, OUTPUT);
  pinMode(r17, OUTPUT);
  pinMode(r18, OUTPUT);
  pinMode(r19, OUTPUT);
}

void lowToHigh() {//trun off 1 to 19
  allON();
  digitalWrite(r1, HIGH);
  delay(t1);
  digitalWrite(r2, HIGH);
  delay(t1);
  digitalWrite(r3, HIGH);
  delay(t1);
  digitalWrite(r4, HIGH);
  delay(t1);
  digitalWrite(r5, HIGH);
  delay(t1);
  digitalWrite(r6, HIGH);
  delay(t1);
  digitalWrite(r7, HIGH);
  delay(t1);
  digitalWrite(r8, HIGH);
  delay(t1);
  digitalWrite(r9, HIGH);
  delay(t1);
  digitalWrite(r10, HIGH);
  delay(t1);
  digitalWrite(r11, HIGH);
  delay(t1);
  digitalWrite(r12, HIGH);
  delay(t1);
  digitalWrite(r13, HIGH);
  delay(t1);
  digitalWrite(r14, HIGH);
  delay(t1);
  digitalWrite(r15, HIGH);
  delay(t1);
  digitalWrite(r16, HIGH);
  delay(t1);
  digitalWrite(r17, HIGH);
  delay(t1);
  digitalWrite(r18, HIGH);
  delay(t1);
  digitalWrite(r19, HIGH);
  delay(t1);
}

void lowToHighON() {//trun on 1 to 19
  allOFF();
  digitalWrite(r1, 0);
  delay(t1);
  digitalWrite(r2, 0);
  delay(t1);
  digitalWrite(r3, 0);
  delay(t1);
  digitalWrite(r4, 0);
  delay(t1);
  digitalWrite(r5, 0);
  delay(t1);
  digitalWrite(r6, 0);
  delay(t1);
  digitalWrite(r7, 0);
  delay(t1);
  digitalWrite(r8, 0);
  delay(t1);
  digitalWrite(r9, 0);
  delay(t1);
  digitalWrite(r10, 0);
  delay(t1);
  digitalWrite(r11, 0);
  delay(t1);
  digitalWrite(r12, 0);
  delay(t1);
  digitalWrite(r13, 0);
  delay(t1);
  digitalWrite(r14, 0);
  delay(t1);
  digitalWrite(r15, 0);
  delay(t1);
  digitalWrite(r16, 0);
  delay(t1);
  digitalWrite(r17, 0);
  delay(t1);
  digitalWrite(r18, 0);
  delay(t1);
  digitalWrite(r19, 0);
  delay(t1);
}

void highToLow() {//trun off 19 to 1
  allON();
  digitalWrite(r19, HIGH);
  delay(t2);
  digitalWrite(r18, HIGH);
  delay(t2);
  digitalWrite(r17, HIGH);
  delay(t2);
  digitalWrite(r16, HIGH);
  delay(t2);
  digitalWrite(r15, HIGH);
  delay(t2);
  digitalWrite(r14, HIGH);
  delay(t2);
  digitalWrite(r13, HIGH);
  delay(t2);
  digitalWrite(r12, HIGH);
  delay(t2);
  digitalWrite(r11, HIGH);
  delay(t2);
  digitalWrite(r10, HIGH);
  delay(t2);
  digitalWrite(r9, HIGH);
  delay(t2);
  digitalWrite(r8, HIGH);
  delay(t2);
  digitalWrite(r7, HIGH);
  delay(t2);
  digitalWrite(r6, HIGH);
  delay(t2);
  digitalWrite(r5, HIGH);
  delay(t2);
  digitalWrite(r4, HIGH);
  delay(t2);
  digitalWrite(r3, HIGH);
  delay(t2);
  digitalWrite(r2, HIGH);
  delay(t2);
  digitalWrite(r1, HIGH);
  delay(t2);
}

void highToLowON() {//trun on 19 to 1
  allOFF();
  digitalWrite(r19, 0);
  delay(t2);
  digitalWrite(r18, 0);
  delay(t2);
  digitalWrite(r17, 0);
  delay(t2);
  digitalWrite(r16, 0);
  delay(t2);
  digitalWrite(r15, 0);
  delay(t2);
  digitalWrite(r14, 0);
  delay(t2);
  digitalWrite(r13, 0);
  delay(t2);
  digitalWrite(r12, 0);
  delay(t2);
  digitalWrite(r11, 0);
  delay(t2);
  digitalWrite(r10, 0);
  delay(t2);
  digitalWrite(r9, 0);
  delay(t2);
  digitalWrite(r8, 0);
  delay(t2);
  digitalWrite(r7, 0);
  delay(t2);
  digitalWrite(r6, 0);
  delay(t2);
  digitalWrite(r5, 0);
  delay(t2);
  digitalWrite(r4, 0);
  delay(t2);
  digitalWrite(r3, 0);
  delay(t2);
  digitalWrite(r2, 0);
  delay(t2);
  digitalWrite(r1, 0);
  delay(t2);
}