#include <Servo.h>  
Servo myservo;  
Servo myservo2;  
int state = 1;
int val=90;    
int val2=90;    
int Index;

void setup() 
{
  myservo.attach(9); 
  myservo2.attach(3);  
  pinMode(6, OUTPUT); 
  pinMode(5, OUTPUT); 
  pinMode(4, OUTPUT); 
  Serial.begin(9600);
 val2=90;
  digitalWrite(6,HIGH);    
}

void loop() 
{
  val2=90;
  if(Serial.available() > 0)   
       {  state = Serial.read();  }
       
if (state == '1')  //STOP 49
       { 
       digitalWrite(6,HIGH); //disable
       }

 else if (state == '2')  //right 50
       {
       digitalWrite(4,LOW);
       digitalWrite(6,LOW);}
       
else if (state == '3')  //left 51
       {
       digitalWrite(4,HIGH);
       digitalWrite(6,LOW);
       }
else if (state == '4')  //up  52
       {
      if (val <180 )
      { 
        val = val+1;    }
       }
else if (state == '5')  //down 53
       {
           if (val >0 ){  val = val-1;}
        }
else if (state == '6')  //upsmall 54
       {
       val2 = 80;}     
else if (state == '7')  //downsmall  55
       {
       val2 = 100;
       }

  myservo.write(val);    //0-180             
      
  myservo2.write(val2);                  
    
  Serial.println(Serial.read());

 
  for(Index = 0; Index < 10; Index++) 
 {
    digitalWrite(5,HIGH);
    delayMicroseconds(500);
    digitalWrite(5,LOW);
    delayMicroseconds(500);
   
 }
  
  delay(20);
}