#include <AFMotor.h>
#include <SoftwareSerial.h>


int bluetoothTx = 1;
int bluetoothRx = 0;

SoftwareSerial bluetooth (bluetoothTx, bluetoothRx);

AF_DCMotor motor1(1, MOTOR12_1KHZ); 
AF_DCMotor motor2(2, MOTOR12_1KHZ); 
AF_DCMotor motor3(3, MOTOR12_1KHZ);
AF_DCMotor motor4(4, MOTOR12_1KHZ);
const int lightsfront = 13;
const int lightsback = 2;

int state;
int vSpeed=200;


void setup() 
{    
 pinMode(lightsfront, OUTPUT);
 pinMode(lightsback, OUTPUT);

  bluetooth.begin (9600);   
  
  Serial.begin(9600);  //Set the baud rate to your Bluetooth module.
  
}

void loop(){
 
  if(Serial.available() > 0){ 
    state = Serial.read();
  }  
    Serial.println(state); 
    
   if (state == '0'){
      vSpeed=0;}
    else if (state == '1'){
      vSpeed=80;}
    else if (state == '2'){
      vSpeed=90;}
    else if (state == '3'){
      vSpeed=110;}
    else if (state == '4'){
      vSpeed=130;}
    else if (state == '5'){
      vSpeed=150;}
    else if (state == '6'){
      vSpeed=170;}
    else if (state == '7'){
      vSpeed=190;}
    else if (state == '8'){
      vSpeed=210;}
    else if (state == '9'){
      vSpeed=230;}
    else if (state == 'q'){
      vSpeed=255;}
   



if (state == 'F')
{
  motor1.setSpeed(vSpeed); //Define maximum velocity
  motor1.run(FORWARD); //rotate the motor clockwise
  motor3.setSpeed(vSpeed); //Define maximum velocity
  motor3.run(FORWARD); //rotate the motor clockwise

}

if (state == 'B')
{
  motor1.setSpeed(vSpeed); //Define maximum velocity
  motor1.run(BACKWARD); //rotate the motor anti-clockwise
  motor3.setSpeed(vSpeed); //Define maximum velocity
  motor3.run(BACKWARD); //rotate the motor anti-clockwise

}

if (state == 'L')
{
  motor1.setSpeed(vSpeed); //Define maximum velocity
  motor1.run(BACKWARD); //rotate the motor anti-clockwise
  motor3.setSpeed(vSpeed); //Define maximum velocity
  motor3.run(FORWARD); //rotate the motor anti-clockwise
}

if (state == 'R')
{
  motor1.setSpeed(vSpeed); //Define maximum velocity
  motor1.run(FORWARD); //rotate the motor clockwise
  motor3.setSpeed(vSpeed); //Define maximum velocity
  motor3.run(BACKWARD); //rotate the motor clockwise

} 

if(state == 'G')
{
  motor1.setSpeed(0);
  motor1.run(FORWARD);
  motor3.setSpeed(vSpeed);
  motor3.run(FORWARD);
  }

if (state == 'I')
{
  motor1.setSpeed(vSpeed);
  motor1.run(FORWARD);
  motor3.setSpeed(0);
  motor3.run(FORWARD);
  }

if  (state == 'H')
{
  motor1.setSpeed(0);
  motor1.run(BACKWARD);  
  motor3.setSpeed(vSpeed);
  motor3.run(BACKWARD);
}


if (state == 'J')
{
  motor1.setSpeed(vSpeed);
  motor1.run(BACKWARD);
  motor3.setSpeed(0);
  motor3.run(BACKWARD);
  }
if (state == 'S')
{
  motor1.setSpeed(0);
  motor1.run(RELEASE);
  motor2.setSpeed(0);
  motor2.run(RELEASE);
  motor3.setSpeed(0);
  motor3.run(RELEASE);
  motor4.setSpeed(0);
  motor4.run(RELEASE);

}
if (state == 'O'){
  motor2.setSpeed(255);
  motor2.run(FORWARD);
  }

if (state== 'P'){
  motor2.setSpeed(255);
  motor2.run(RELEASE);
  }
  
if (state == 'M'){
  motor4.setSpeed(255);
  motor4.run(FORWARD);
  }
  
if (state == 'W')
{ 
  digitalWrite(lightsfront, HIGH);
  }

if (state == 'w'){
  digitalWrite (lightsfront, LOW);
  }
  
if (state == 'U'){
  digitalWrite (lightsback, HIGH);
  }

if (state == 'u');{
  digitalWrite (lightsback, LOW);
  }
}