Управление сервоприводом.

[Chip]

Попробовал библиотеку Servo.h для Arduino, но как то она мне не понравилась, написал свою процедуру. И накидал по быстрому программку для ПК
Планирую в дальнейшем прикрутить сервопривод к камере и кликнув по изображению камера будет смотреть в эту точку

Скетч для Carduino / Arduino

#define MIN 600 // минимальное положение сервы
#define MAX 2400 // максимальное положение сервы
#define STEP_ADD 10 //шаг сервы на 1 градус
#define SERVO_1 13 //управляющий выход для первой сервы

int step_on = (MAX-MIN)/2+MIN; //среднее положение сервы

void setup() 
{ 
pinMode(SERVO_1, OUTPUT); 
Serial.begin(115200);
} 

void loop() 
{ 
  if (Serial.available() > 0)  step_on=(Serial.read())*10;                          
      servo(step_on, SERVO_1);
}

void servo(int stepe, int ServoPin)
{
  if(stepe > MAX)stepe = MAX; 
  if(stepe < MIN)stepe = MIN; 
    digitalWrite(ServoPin, HIGH); 
    delayMicroseconds(stepe); 
    digitalWrite(ServoPin, LOW); 
    delay(20-(stepe/1000));
}