Нужна помощь с сервой MG995

Короче нужно сделать так что бы она от одной кнопки вращалась в одну сторону от другой в другую. Вот сам скетч
#include <Servo.h>
Servo myservo;
int button1, button2;
int pos=90;
void setup(){
pinMode(2, INPUT);
pinMode(3,INPUT);
myservo.attach(9);
myservo.write(pos);
}
void loop(){
button1 = digitalRead(2);
button2 = digitalRead(3);
if (button1 == LOW) (pos=180);
if (button2 == LOW ) (pos=0);
myservo.write (pos);
delay(3);}

вот схема

 

Сервопривод MG995

 

Более правильно, имхо, так:

Код (C++):

if (!digitalRead(2))
   // нажата кнопка N1
   pos = 180;
else if (!digitalRead(3))
   // нажата кнопка N2
   pos = 0;
else
   // ни одна из кнопок не нажата
   pos = 90;
mysrevo.write(pos);

 

MG995 нужно отдельно питать от 6,6 вольт.
(Я думаю так будет лучше).