#include <Servo.h>
#include <SoftwareSerial.h> 
SoftwareSerial mySerial(A1,A2); 
#include <AFMotor.h>
AF_DCMotor motor1(1);
AF_DCMotor motor2(2);
AF_DCMotor motor3(3);
AF_DCMotor motor4(4);
String readString;
//const int Pin_A =  4;
//const int Pin_B =  5;
//const int Pin_C =  6;
//const int Pin_D =  7;
//const int Pin_E =  8;
//const int Pin_F =  9;
//const int Pin_G =  10;
//const int Pin_H =  11;
char unChar;
void setup() 
{
//pinMode(Pin_A, OUTPUT);
//pinMode(Pin_B, OUTPUT);
//pinMode(Pin_C, OUTPUT);
//pinMode(Pin_D, OUTPUT);
//pinMode(Pin_E, OUTPUT);
//pinMode(Pin_F, OUTPUT);
//pinMode(Pin_G, OUTPUT);
//pinMode(Pin_H, OUTPUT);
delay(100);
//digitalWrite(Pin_A, HIGH);
//digitalWrite(Pin_B, LOW);
//digitalWrite(Pin_C, LOW);
//digitalWrite(Pin_D, LOW);
//digitalWrite(Pin_E, LOW);
//digitalWrite(Pin_F, LOW);
//digitalWrite(Pin_G, LOW);
//digitalWrite(Pin_H, LOW);
//delay(1000);
  Serial.begin(57600);
  while (!Serial)
  {
  }
  Serial.println("Goodnight moon!");
  mySerial.begin(9600);
  mySerial.println("Hello, world?");
  motor1.setSpeed(255);
  motor2.setSpeed(255);
  motor3.setSpeed(255);
  motor4.setSpeed(255);
  
  motor1.run(RELEASE);
  motor2.run(RELEASE);
  motor3.run(RELEASE);
  motor4.run(RELEASE);
}
void loop() 
{ 
  if (mySerial.available()) 
  {
    unChar = mySerial.read();
    Serial.println(unChar);
 
 
  if(unChar=='A')///////
    {
  motor1.setSpeed(255);
  motor2.setSpeed(255);
  motor3.setSpeed(255);
  motor4.setSpeed(255);
  
  motor1.run(FORWARD);
  motor2.run(FORWARD);
  motor3.run(FORWARD);
  motor4.run(FORWARD);
    delay(50);
    
     }
  if(unChar=='B')
    {
  motor1.setSpeed(255);
  motor2.setSpeed(255);
  motor3.setSpeed(255);
  motor4.setSpeed(255);
  
  motor1.run(BACKWARD);
  motor2.run(BACKWARD);
  motor3.run(BACKWARD);
  motor4.run(BACKWARD);
    delay(50);
     }
  
  if(unChar=='C')
    {
   motor1.setSpeed(255);
  motor2.setSpeed(255);
  motor3.setSpeed(255);
  motor4.setSpeed(255);
  
   motor1.run(FORWARD);
  motor2.run(BACKWARD);
  motor3.run(FORWARD);
  motor4.run(BACKWARD );
    delay(50);
     }
  if(unChar=='D')
    {
   motor1.setSpeed(255);
  motor2.setSpeed(255);
  motor3.setSpeed(255);
  motor4.setSpeed(255);
  motor1.run(BACKWARD);
  motor2.run(FORWARD);
  motor3.run(BACKWARD);
  motor4.run(FORWARD);
  
    delay(50);
     }
  if(unChar=='F')///
    {
    }
    
    if(unChar=='E')///ซ้าย
    {
  motor1.setSpeed(255);
  motor2.setSpeed(255);
  motor3.setSpeed(255);
  motor4.setSpeed(255);    
  motor1.run(BACKWARD);
  motor2.run(FORWARD);
  motor3.run(FORWARD);
  motor4.run(BACKWARD);
   delay(50);
    }   
  if(unChar=='N')
    {
    
    }
    
    if(unChar=='M')///ขวา
    {
   motor1.setSpeed(255);
  motor2.setSpeed(255);
  motor3.setSpeed(255);
  motor4.setSpeed(255);    
  motor1.run(FORWARD);
  motor2.run(BACKWARD);
  motor3.run(BACKWARD);
  motor4.run(FORWARD);
   delay(50);
    }   
    
    if(unChar=='I')//สามเหลี่ยม
    {
    
    }  
     
    if(unChar=='J')//กากบาท
        
    {
    
    }   
    
        if(unChar=='K')//สี่เหลี่ยม
    {
   
    }  
       if(unChar=='L')//วงกลม
    {
 
    }  
/////////////////////////////////////////////////////////////////
  }
//////////////////////////////////////////  
else
{
  motor1.setSpeed(0);
  motor2.setSpeed(0);
  motor3.setSpeed(0);
  motor4.setSpeed(0);
  
  motor1.run(RELEASE);
  motor2.run(RELEASE);
  motor3.run(RELEASE);
  motor4.run(RELEASE);
  }
}
//void Run() {
//  
//  
//  motor1.run(FORWARD);
//  motor2.run(FORWARD);
//  motor3.run(FORWARD);
//  motor4.run(FORWARD);
//
//  delay(4000);
//  motor1.run(RELEASE);
//  motor2.run(RELEASE);
//  motor3.run(RELEASE);
//  motor4.run(RELEASE);
//  delay(200);
//  
//  motor1.run(BACKWARD);
//  motor2.run(BACKWARD);
//  motor3.run(BACKWARD);
//  motor4.run(BACKWARD);
//
//  delay(4000);
//  motor1.run(RELEASE);
//  motor2.run(RELEASE);
//  motor3.run(RELEASE);
//  motor4.run(RELEASE);
//  delay(200);
// 
// 
//}
