c#include <Servo.

h>
Servo steerfront,steerback;

int alpha,betha;

/////////////////////////// Bringe H1 //////////////////////////////////////

//////////////
int m1s=3; // m1s = motor 1 speed //
int m2s=5; // m2s = motor 2 speed //
int FENB=2; // Forward enabled //
////////////////////////////////////////////////////////////////////////////////
//////////////

////////////////////////// Bridge H2 ///////////////////////////////////////

//////////////
int m3s=6; // m3s = motor 3 speed //
int m4s=9; // m4s = motor 4 speed //
int BENB=7; // backspin enabled //
////////////////////////////////////////////////////////////////////////////////
///////////////

void setup() {
Serial.begin(9600);
/////////////////////////// Servos /////////////////////////////////////////
///////////
steerfront.attach(10);
steerback.attach(11);
////////////////////////////////////////////////////////////////////////////////
//////////////
/////////////////////////// Bringe H1 //////////////////////////////////////
//////////////
pinMode(m1s,OUTPUT);
pinMode(m2s,OUTPUT);
pinMode(FENB,OUTPUT);
////////////////////////////////////////////////////////////////////////////////
//////////////

////////////////////////// Bridge H2 ///////////////////////////////////////

//////////////
pinMode(m3s,OUTPUT);
pinMode(m4s,OUTPUT);
pinMode(BENB,OUTPUT);
////////////////////////////////////////////////////////////////////////////////
///////////////
}
void autonomus (){
}

void turn_right(){
steerfront.write(90);
steerback.write(90);
delay(5000);
steerfront.write(125);
steerback.write(55);
delay(2000);
steerfront.write(55);
steerback.write(125);
delay(2000);
}

void turn_left(){
}

void forward(){
digitalWrite(FENB,HIGH);

analogWrite(m1s,100);
analogWrite(m2s,255);
analogWrite(m3s,100);
analogWrite(m4s,255);

delay(10000);
analogWrite(m1s,0);
analogWrite(m2s,0);
analogWrite(m3s,0);
analogWrite(m4s,0);
digitalWrite(FENB,LOW);
delay(2000);
}

void backspin (){

digitalWrite(BENB,HIGH);

analogWrite(m1s,100);
analogWrite(m2s,255);
analogWrite(m3s,100);
analogWrite(m4s,255);
delay(10000);
analogWrite(m1s,0);
 analogWrite(m2s,0);
analogWrite(m3s,0);
analogWrite(m4s,0);
digitalWrite(BENB,LOW);
}

void loop() {
forward();
delay(80);
}