#include <Servo.h>
#include <SoftwareSerial.h>
SoftwareSerial mySerial(A1,A2);
Servo myservo1;
Servo myservo2;
int potpin = 0;
int pos1=90;
int pos2=90;
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);
myservo1.attach(2);
myservo2.attach(3);
delay(100);
digitalWrite(Pin_A, LOW);
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?");
}
void loop()
{
if (mySerial.available())
{
unChar = mySerial.read();
Serial.println(unChar);
if(unChar=='A')///////
{
digitalWrite(Pin_A, LOW);
digitalWrite(Pin_B, HIGH);
digitalWrite(Pin_C, LOW);
digitalWrite(Pin_D, HIGH);
digitalWrite(Pin_E, LOW);
digitalWrite(Pin_F, HIGH);
digitalWrite(Pin_G, LOW);
digitalWrite(Pin_H, HIGH);
delay(50);
}
if(unChar=='B')
{
digitalWrite(Pin_A, HIGH);
digitalWrite(Pin_B, LOW);
digitalWrite(Pin_C, HIGH);
digitalWrite(Pin_D, LOW);
digitalWrite(Pin_E, HIGH);
digitalWrite(Pin_F, LOW);
digitalWrite(Pin_G, HIGH);
digitalWrite(Pin_H,LOW);
delay(50);
}
if(unChar=='C')
{
digitalWrite(Pin_A, HIGH);
digitalWrite(Pin_B, LOW);
digitalWrite(Pin_C, LOW);
digitalWrite(Pin_D, HIGH);
digitalWrite(Pin_E, HIGH);
digitalWrite(Pin_F, LOW);
digitalWrite(Pin_G, LOW);
digitalWrite(Pin_H, HIGH);
delay(50);
}
if(unChar=='D')
{
digitalWrite(Pin_A, LOW);
digitalWrite(Pin_B, HIGH);
digitalWrite(Pin_C, HIGH);
digitalWrite(Pin_D, LOW);
digitalWrite(Pin_E, LOW);
digitalWrite(Pin_F, HIGH);
digitalWrite(Pin_G, HIGH);
digitalWrite(Pin_H, LOW);
delay(50);
}
if(unChar=='F'&&pos1<=180)///
{
pos1=pos1+5;
myservo1.write(pos1);
delay(50);
}
if(unChar=='E'&&pos1>=0)
{
pos1=pos1-5;
myservo1.write(pos1);
delay(50);
}
if(unChar=='N'&&pos2>=0)//ลง
{
pos2=pos2-5;
myservo2.write(pos2);
delay(50);
}
if(unChar=='M'&&pos2<=180)///ยกขึ้น
{
pos2=pos2+5;
myservo2.write(pos2);
delay(50);
}
if(unChar=='I')//สามเหลี่ยม
{
}
if(unChar=='J')//กากบาท
{
}
if(unChar=='K')//สี่เหลี่ยม
{
}
if(unChar=='L')//วงกลม
{
}
/////////////////////////////////////////////////////////////////
}
//////////////////////////////////////////
else
{
digitalWrite(Pin_A, LOW);
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);
}
}