Автоматический мусорный бак

здравствуйте, господа программисты.
пытаюсь сделать автомусорку, но при загрузку вот этого кода в плату ардуино уно сервопривод не вращается.

Код (C++):

#include <Servo.h>
int trig=5;
int echo=6;
int servo=9;
const int trigDistance = 20;
Servo Servo1;

void setup() {
  pinMode(trig, OUTPUT); // триггер - выходной пин
  pinMode(echo, INPUT); // эхо - входной
Servo1.write(0);
  Serial.begin(9600); // инициализация послед. порта
   Servo1.attach(9);
}
void loop(){
 
  long duration, distance,cm;
digitalWrite(trig, LOW);
delayMicroseconds(5);
digitalWrite(trig, HIGH);
delayMicroseconds(10);
digitalWrite(trig, LOW);
duration = pulseIn(echo, HIGH);
distance = (duration/2) / 29.1;
Serial.println(distance); // выводим в последовательный порт
   Serial.print(cm);
  Serial.println(" см.");
  delay(1000);
    if (distance <= trigDistance){
Servo1.write(90);
  delay(3000);
  Servo1.write(0);
  }else{
    Servo1.write(0);
  }
}

 

 

спасибо, работает