int trigPin = 6;    // Trigger
int echoPin = 5;    // Echo
long duration, cm;
int rouge = 3;
int vert = 4;
#define r 9
#define g 10
#define b 11
int a=0;

void setup() {
  //Serial Port begin
  Serial.begin (9600);
  //Define inputs and outputs
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  pinMode(r, OUTPUT);
  pinMode(g, OUTPUT);
  pinMode(b, OUTPUT);
  pinMode(vert, OUTPUT);
  pinMode(rouge, OUTPUT);
}
void rgb(int rv, int gv, int bv){
  analogWrite(r, rv);
  analogWrite(g, gv);
  analogWrite(b, bv);
  }
void loop() {
  // The sensor is triggered by a HIGH pulse of 10 or more microseconds.
  // Give a short LOW pulse beforehand to ensure a clean HIGH pulse:
  digitalWrite(trigPin, LOW);
  delayMicroseconds(5);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
 
  // Read the signal from the sensor: a HIGH pulse whose
  // duration is the time (in microseconds) from the sending
  // of the ping to the reception of its echo off of an object.
  pinMode(echoPin, INPUT);
  duration = pulseIn(echoPin, HIGH);
 
  // Convert the time into a distance
  cm = (duration/2) / 29.1;     // Divide by 29.1 or multiply by 0.0343
 


  if(cm<200){
    digitalWrite(rouge, HIGH);
    digitalWrite(vert , LOW);
    
      rgb(255-cm,0,0);
    }

  if(cm>150){
    digitalWrite(rouge, LOW);
    digitalWrite(vert , HIGH);
    
      rgb(255-cm, cm,0);
    }
  
  
  Serial.print(cm);
  Serial.print("cm");
  Serial.println();
  
  delay(50);
}