Доступная автоматика HelloDistiller на Ардуино Мега 2560

#define PIN_NASOS_NBK 12


void SetAngle(unsigned char Angl)
{
  int TAngl;
  unsigned char i;
//  TAngl= map(Angl, 0, 180, 600, 2400);
  TAngl= map(Angl, 0, 180, 500, 2500);
  noInterrupts();
  for(i=0;i<50;i++)
  { digitalWrite(PIN_NASOS_NBK,HIGH);
    delayMicroseconds(TAngl);
    digitalWrite(PIN_NASOS_NBK,LOW);
    delayMicroseconds(10000-TAngl);
    delayMicroseconds(10000);
  }
 interrupts();

}



void setup() {
  // put your setup code here, to run once:

  pinMode(PIN_NASOS_NBK, OUTPUT);

}

int pos = 0;    // variable to store the servo position 

void loop() {
  // put your main code here, to run repeatedly:
  
SetAngle(34);
delay(2000);
/*SetAngle(90);
delay(2000);
SetAngle(45);
delay(2000);
SetAngle(180);
delay(5000);
*/
/*
 for(pos = 0; pos <= 180; pos += 10) // goes from 0 degrees to 180 degrees 
  {                                  // in steps of 1 degree 
    SetAngle(pos);              // tell servo to go to position in variable 'pos' 
    delay(15);                       // waits 15ms for the servo to reach the position 
  } 
  for(pos = 180; pos>=0; pos-=10)     // goes from 180 degrees to 0 degrees 
  {                                
    SetAngle(pos);              // tell servo to go to position in variable 'pos' 
    delay(15);                       // waits 15ms for the servo to reach the position 
  } 
*/

//SetAngle(90);
//delay(5000);


}