ค่ายอบรมหุ่นยนต์ ค่ายหุ่นยนต์เติมฝัน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); 
}    
}
 
/////////////////////////////////////////////







