Dispensador de alcohol gel

Hola!
Estoy construyendo un dispensador de alcohol gel con motor mg 996r, tengo dudas como mover estos motores, el programa no me corre bien, los motores solo giran hacia un lado y cuando van a girar hacia el otro se traba.
I have made an automatic hand sanitizer dispenser with mg 996r, I have a problem with motor.

[

#include <Servo.h>

Servo myservo;  
int pos = 0;    //posicion del motor
int led =13;
int t=75;       //tiempo deteccion 
int wait=500;  //tiempo actuador
int espera= 2000;

int detect1 =0;
int detect2 =0;
int detect3 =0;


void setup() {
  Serial.begin(9600);
  myservo.attach(9,600,2400);
  pinMode(led,OUTPUT);
  pinMode(A0,INPUT);
  digitalWrite(led,HIGH);
  
}

void loop() {
  int sensor=digitalRead(A0);
  int detect1= sensor;
  delay(t);
  int detect2= sensor;
  delay(t);
  int detect3= sensor;
  delay(t);

  int DETECT= detect1+detect2+detect3;
  Serial.print("Detector= ");
  Serial.println(DETECT);
  
  if (DETECT == 0){
    myservo.write(0);
    delay(wait);
    //Serial.println("primero");
    myservo.write(90);
    delay(10);
    myservo.write(140);
    delay(wait*0.6);
    myservo.write(90);
    Serial.println("Listo");
    delay(wait);
    
     //novo
    while (DETECT == 0) { 
    DETECT=3*digitalRead(A0);
    Serial.println("Sigo en la medicion");
    delay(30);
    }  //fin novo 
    
    delay(espera);                     
  }
  Serial.println("---");
}]

Hi,
Haz tratado de corrrer el sketch que viene en la libreria de servo.Tiene dos sketch uno que hace scanning y el otro en ingless "knb".