Innovation Lab #15 Servo Motor_RGB LED

#include <Servo.h>

Servo gol;
long distance;
int red = 3;
int green = 5;
int blue = 6;

void setup() {
  gol.attach(9);
  pinMode(red, OUTPUT);
  pinMode(green, OUTPUT);
  pinMode(blue, OUTPUT);
}

void loop() {
  distance = 100;
  top_open();
  delay(2000);
  distance = 20;
  top_open();
  delay(2000);
}

void top_open() {
  if(distance < 30) {
    gol.write(90);
    digitalWrite(red, HIGH);
    digitalWrite(green, LOW);
    digitalWrite(blue, LOW);
  }
  else {
    gol.write(0);
    digitalWrite(red, LOW);
    digitalWrite(green, HIGH);
    digitalWrite(blue, LOW);
  }
}