#include <Servo.h> // servo library
  Servo myservo1, myservo2; // servo name
  #define In1 3
  #define In2 4
  #define ENA 9
  #define In3 12
  #define In4 7
  #define ENB 10



  int command=0;

  void setup(){



  // put your setup code here, to run once:
  pinMode(In1,OUTPUT);
  pinMode(In2,OUTPUT);
  pinMode(ENA,OUTPUT);
  pinMode(In3,OUTPUT);
  pinMode(In4,OUTPUT);
  pinMode(ENB,OUTPUT);

  analogWrite(ENA,0);
  digitalWrite(In1,LOW);
  digitalWrite(In2,LOW);
  analogWrite(ENB,0);
  digitalWrite(In3,LOW);
  digitalWrite(In4,LOW);

  Serial.begin(9600);
  }


void loop() {
  dc();
}
void dc(){
  if(Serial.available()>0){
    command=Serial.read();
    if(command == 70){ //przód
      digitalWrite(In1,HIGH);
      digitalWrite(In2,LOW);
      analogWrite(ENA,200);
      digitalWrite(In3,LOW);
      digitalWrite(In4,HIGH);
      analogWrite(ENB,200);
    }
    else if(command == 66){ //tył
      digitalWrite(In1,LOW);
      digitalWrite(In2,HIGH);
      analogWrite(ENA,200);
      digitalWrite(In3,HIGH);
      digitalWrite(In4,LOW);
      analogWrite(ENB,200);
    }
    else if(command == 76){ //prawo
      digitalWrite(In1,LOW);
      digitalWrite(In2,LOW);
      analogWrite(ENA,0);
      digitalWrite(In3,LOW);
      digitalWrite(In4,HIGH);
      analogWrite(ENB,200);
    }
    else if(command == 82){ //lewo
      digitalWrite(In1,HIGH);
      digitalWrite(In2,LOW);
      analogWrite(ENA,200);
      digitalWrite(In3,LOW);
      digitalWrite(In4,LOW);
      analogWrite(ENB,0);
    }
    else{
      digitalWrite(In1,LOW);
      digitalWrite(In2,LOW);
      analogWrite(ENA,0);
      digitalWrite(In3,LOW);
      digitalWrite(In4,LOW);
      analogWrite(ENB,0);
    }
   Serial.println(command);

}
}