#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);
//
//
//}
