/*Program LED LGBT*/
/*By Rix Ryuzoku*/

int R = 15;
int G = 2;
int B = 4;
int trig = 12;
int echo = 13;
long durasi, jarak;

void setup() {
  Serial.begin(9600);
  Serial.println ("Jaraaaakkk");
  pinMode (12, OUTPUT);
  pinMode (13, INPUT);
  pinMode (15, OUTPUT);
  pinMode (2, OUTPUT);
  pinMode (4, OUTPUT);
}

void loop() {
  digitalWrite (trig, HIGH);
  delayMicroseconds (5);
  digitalWrite (trig, LOW);
  delayMicroseconds (5);
  durasi = pulseIn(echo, HIGH);
  jarak = durasi/58.2;
  Serial.println(jarak);

  if(jarak < 100){
    digitalWrite (R, LOW);
    digitalWrite (G, HIGH);
    digitalWrite (B, HIGH);
  }

  else if(jarak > 100 && jarak < 200){
    digitalWrite (R, LOW);
    digitalWrite (G, LOW);
    digitalWrite (B, HIGH);
  }

  else{
    digitalWrite (R, HIGH);
    digitalWrite (G, LOW);
    digitalWrite (B, HIGH);
  }
}

void R_on(){
  digitalWrite (R, LOW);
  digitalWrite (G, HIGH);
  digitalWrite (B, HIGH);
}

void G_on(){
  digitalWrite (R, HIGH);
  digitalWrite (G, LOW);
  digitalWrite (B, HIGH);
}

void B_on(){
  digitalWrite (R, HIGH);
  digitalWrite (G, HIGH);
  digitalWrite (B, LOW);
}

void Y_on(){
  digitalWrite (R, LOW);
  digitalWrite (G, LOW);
  digitalWrite (B, HIGH);
}

void P_on(){
  digitalWrite (R, LOW);
  digitalWrite (G, HIGH);
  digitalWrite (B, LOW);
}

void C_on(){
  digitalWrite (R, HIGH);
  digitalWrite (G, LOW);
  digitalWrite (B, LOW);
}