Innovation Lab #16 Ultrasonic_Servo Motor_RGB LED

#include <Servo.h>

Servo gol;
long distance;
long duration;
int red = 3;
int green = 5;
int blue = 6;
const int trigPin = 11;
const int echoPin = 12;

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

void loop() {
  ultra();
  top_open();
}

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);
  }
}

void ultra(){
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
duration = pulseIn(echoPin, HIGH);
distance= duration*0.034/2;
}