#include <SoftwareSerial.h>

int HC05_RX_PIN=11; //digital pin to receiver
int HC05_TX_PIN=10; //digital pin to transceiver
int forward = 7; // LED on digital pin 7
int back=6;
int left=5;
int right=4;

SoftwareSerial serialBT(HC05_TX_PIN, HC05_RX_PIN); //BLUETOOTH: define pins to Rx and Tx
//SoftwareSerial serialBT(10,11);
boolean NL = true;
char str[20]={'\0'};
int counter=0;
void setup() {
  Serial.begin(9600);
  Serial.println("Sketch HC-05");
  Serial.println("Arduino with HC-05 is ready");
  Serial.println("Make sure Both NL & CR are set");
  Serial.println("");

  //Set to HC-05 default baud rate, found using AT+UART.  It is usually 38400.
  serialBT.begin(9600);
  Serial.println("BTserial started at 38400");
  Serial.println("");
  
  pinMode(forward, OUTPUT); //
  pinMode(back, OUTPUT); //
  pinMode(left, OUTPUT); //
  pinMode(right, OUTPUT); //

    
}
char a;
void loop() 
{
  int i = 0; //index to str
  char c;
  int input;
  // Read from the Bluetooth module and send to the Arduino Serial Monitor
  if (serialBT.available())
  {
    c = (char)serialBT.read(); //get each char and fill string
    if(c=='a'){//forward
      Serial.println("forward");
      digitalWrite(forward, HIGH); 
      delay(500);
      digitalWrite(forward, LOW);
      delay(500);
      }
    else if(c=='b'){//back
      Serial.println("back");
      digitalWrite(back, HIGH); 
      delay(500);
      digitalWrite(back, LOW); 
      delay(500);
      }
    else if(c=='c'){//left
      Serial.println("left");
      digitalWrite(left, HIGH); 
      delay(500);
      digitalWrite(left, LOW); 
      delay(500);
      }
    else if(c=='d'){//right
      Serial.println("right");
      digitalWrite(right, HIGH); 
      delay(500);
      digitalWrite(right, LOW);
      delay(500);
      }
    else if(c=='e'){//rotate_right
      Serial.println("rotate_right");
      digitalWrite(forward, HIGH);
      digitalWrite(back, HIGH); 
      delay(500);
      digitalWrite(forward, LOW);
      digitalWrite(back, LOW);
      delay(500);
      }     
    else if(c=='f'){//rotate_left
      Serial.println("rotate_left");
      digitalWrite(forward, HIGH);
      digitalWrite(right, HIGH); 
      delay(500);
      digitalWrite(forward, LOW);
      digitalWrite(right, LOW);
      delay(500);
      }     
    else if(c=='g'){//arm_forward
      Serial.println("ar,_forward");
      digitalWrite(forward, HIGH);
      digitalWrite(left, HIGH); 
      delay(500);
      digitalWrite(forward, LOW);
      digitalWrite(left, LOW);
      delay(500);
      }     
      

    Serial.print(" c=:");
    Serial.println(c);
  }

    // Read from the Serial Monitor and send to the Bluetooth module
  if (Serial.available())
  {
    c = Serial.read();
    serialBT.write(c);
    digitalWrite(forward, HIGH); // turns the LED on
    delay(100); // pauses for 1 second
    digitalWrite(forward, LOW);
    // Echo the user input to the main window. The ">" character indicates the user entered text.
    if (NL) {
      Serial.print(">");
      NL = false;
    }
    Serial.write(c);
    if (c == 10) {
      NL = true;
    }
  }

}