V1
/////////////
#include <Servo.h>
#include <SoftwareSerial.h>
SoftwareSerial mySerial(A1,A2);
Servo myservo;
int potpin = 0;
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);
myservo.attach(12);
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_E, HIGH);
digitalWrite(Pin_F, LOW);
digitalWrite(Pin_G, HIGH);
digitalWrite(Pin_H, LOW);
delay(50);
}
if(unChar=='B')
{
digitalWrite(Pin_E, LOW);
digitalWrite(Pin_F, HIGH);
digitalWrite(Pin_G, LOW);
digitalWrite(Pin_H, HIGH);
delay(50);
}
if(unChar=='C')
{
digitalWrite(Pin_E,LOW );
digitalWrite(Pin_F, HIGH);
digitalWrite(Pin_G, HIGH);
digitalWrite(Pin_H, LOW);
delay(50);
}
if(unChar=='D')
{
digitalWrite(Pin_E, HIGH);
digitalWrite(Pin_F, LOW);
digitalWrite(Pin_G, LOW);
digitalWrite(Pin_H, HIGH);
delay(50);
}
if(unChar=='F')/// ถอยยิง
{
digitalWrite(Pin_C, HIGH);
digitalWrite(Pin_D, LOW);
delay(50);
}
if(unChar=='E')////ยิง
{
digitalWrite(Pin_C, LOW);
digitalWrite(Pin_D,HIGH);
delay(50);
}
if(unChar=='N'&&potpin>=0)//ลง
{
digitalWrite(Pin_A, HIGH);
digitalWrite(Pin_B,LOW);
delay(50);
}
if(unChar=='M'&&potpin<=180)///ยกขึ้น
{
digitalWrite(Pin_A, LOW);
digitalWrite(Pin_B,HIGH);
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);
}
}
//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);
//
//
//}
////////////////////////////////////
V2 รุ่น ยกวางเซอร์โว
#include <Servo.h>
#include <SoftwareSerial.h>
SoftwareSerial mySerial(A1,A2);
Servo myservo;
int pos = 150;
int potpin = 0;
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);
myservo.attach(12);
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_E, HIGH);
digitalWrite(Pin_F, LOW);
digitalWrite(Pin_G, HIGH);
digitalWrite(Pin_H, LOW);
delay(50);
}
if(unChar=='B')
{
digitalWrite(Pin_E, LOW);
digitalWrite(Pin_F, HIGH);
digitalWrite(Pin_G, LOW);
digitalWrite(Pin_H, HIGH);
delay(50);
}
if(unChar=='C')
{
digitalWrite(Pin_E,LOW );
digitalWrite(Pin_F, HIGH);
digitalWrite(Pin_G, HIGH);
digitalWrite(Pin_H, LOW);
delay(50);
}
if(unChar=='D')
{
digitalWrite(Pin_E, HIGH);
digitalWrite(Pin_F, LOW);
digitalWrite(Pin_G, LOW);
digitalWrite(Pin_H, HIGH);
delay(50);
}
if(unChar=='F')/// ถอยยิง
{
digitalWrite(Pin_C, HIGH);
digitalWrite(Pin_D, LOW);
delay(50);
}
if(unChar=='E')////ยิง
{
digitalWrite(Pin_C, LOW);
digitalWrite(Pin_D,HIGH);
delay(50);
}
if(unChar=='N'&&pos<=180)//ลง
{
pos=pos+10;
myservo.write(pos);
delay(10);
}
if(unChar=='M'&&pos>=0)///ยกขึ้น
{
pos=pos-10;
myservo.write(pos);
delay(10);
}
if(unChar=='I')//สามเหลี่ยม
{
myservo.write(150);
delay(500);
}
if(unChar=='J')//กากบาท
{
myservo.write(5);
delay(500);
}
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);
}
}