ค่ายอบรมหุ่นยนต์ ค่ายหุ่นยนต์เติมฝัน1 โปรแกรม arduino 2 ไดรส์เวอร์3 ภาพการประกอบ 4 หลักการต่อวงจรหุ่นยนต์
5 หลักการเขียนโปรแกรม
6 ตารางคะแนน
7 การเขียนโปรแกรม
8 กติกาการแข่งขัน
9 ช่องยูทูป
10 ฝากติดตามผลงาน เพจ fackbook
AAP robot
//CODE---------------------------
#include <Servo.h>
Servo myservo1;
Servo myservo2;
int pos =90;
int pos2 =90;
int M1=8;
int M2=9;
int M3=10;
int M4=11;
String readString;
char unChar;
void setup()
{
myservo1.attach(6);
myservo2.attach(7);
Serial.begin(9600);
pinMode(M1, OUTPUT);
pinMode(M2, OUTPUT);
pinMode(M3, OUTPUT);
pinMode(M4, OUTPUT);
}
void loop()
{
if(Serial.available())
{
unChar = Serial.read();
if(unChar=='A')
{
GO();
}
if(unChar=='D')
{
BK();
}
/////////////////////////////
if(unChar=='B')
{
LL();
}
/////////////////////////////////
if(unChar=='C')
{
RR();
}
/////////////////////////////////
if(unChar=='Z')
{
ST();
}
if(unChar=='E')
{
KP();
}
if(unChar=='F')
{
UKP();
}
if(unChar=='G')
{
YG();
}
if(unChar=='H')
{
WG();
}
}
}
void GO() //ตรง
{
digitalWrite(M1, HIGH);//ซ้ายหน้า
digitalWrite(M2, LOW);
digitalWrite(M3, HIGH);//ซ้ายขวา
digitalWrite(M4, LOW);
}
void LL() //ซ้าย
{
digitalWrite(M1, LOW);//ซ้ายหน้า
digitalWrite(M2, HIGH);
digitalWrite(M3, HIGH);//ซ้ายขวา
digitalWrite(M4, LOW);
}
void RR() //ขวา
{
digitalWrite(M1, HIGH);//ซ้ายหน้า
digitalWrite(M2, LOW);
digitalWrite(M3, LOW);//ซ้ายขวา
digitalWrite(M4, HIGH);
}
void BK() //ถอย
{
digitalWrite(M1, LOW);//ซ้ายหน้า
digitalWrite(M2, HIGH);
digitalWrite(M3, LOW);//ซ้ายขวา
digitalWrite(M4, HIGH);
}
void ST() //หยุด
{
digitalWrite(M1, LOW);//ซ้ายหน้า
digitalWrite(M2, LOW);
digitalWrite(M3, LOW);//ซ้ายขวา
digitalWrite(M4, LOW);
}
void UKP()//คีบ
{
if(pos<50)
{
myservo1.write(50);
}
else
{
pos=pos-10;
myservo1.write(pos);
}
}
void KP()
{
if(pos>150)
{
myservo1.write(150);
}
else
{
pos=pos+10;
myservo1.write(pos);
}
}
void YG()
{
if(pos2<50)
{
myservo2.write(pos2);
}
else
{
pos2=pos2+10;
myservo2.write(pos2);
}
}
void WG()
{
if(pos2<50)
{
myservo2.write(50);
}
else
{
pos2=pos2-10;
myservo2.write(pos2);
}
}
/////////////////////////////////////////////







