อบรมการเขียนโปรแกรม หุ่นยนต์ อัตโนมัติ โรงเรียนฤทธิยะวรรณาลัย : Rittiyawannalai School

2 กติกาการแข่งขัน

  3 ช่องยูทูป

  4 ฝากติดตามผลงาน เพจ fackbook

Setup
  5 คู่มือการประกอบ 

อบรมการเขียนโปรแกรม หุ่นยนต์ อัตโนมัติ โรงเรียนฤทธิยะวรรณาลัย : Rittiyawannalai School

 1 ตารางคะแนน

2 กติกาการแข่งขัน

  3 ช่องยูทูป

  4 ฝากติดตามผลงาน เพจ fackbook

Setup

  5 คู่มือการประกอบ 

int MA=4;

int MB=5;

int MC=6;

int MD=7;

int ME=8;

int MF=9;

int MG=10;

int MH=11;

const int analogInPin = A0;

int sensorValue = 0;

const int analogInPin1 = A1;

int sensorValue1= 1;

const int analogInPin2 = A2;

int sensorValue2 = 0;

const int analogInPin3 = A3;

int sensorValue3 = 0;

int RUN=0;

void setup() //หัวข้อ

{

 Serial.begin(9600);

 pinMode(MA, OUTPUT);

 pinMode(MB, OUTPUT);

 pinMode(MC, OUTPUT);

 pinMode(MD, OUTPUT);

 pinMode(ME, OUTPUT);

 pinMode(MF, OUTPUT);

 pinMode(MG, OUTPUT);

 pinMode(MH, OUTPUT);

digitalWrite(MA, LOW);

digitalWrite(MB, LOW);

digitalWrite(MC, LOW);

digitalWrite(MD, LOW);

}

void loop() //วน

{

sensorValue = analogRead(analogInPin);

sensorValue1 = analogRead(analogInPin1);

sensorValue2 = analogRead(analogInPin2);

sensorValue3 = analogRead(analogInPin3);

Serial.print("sensor = ");

Serial.print(RUN);

Serial.print("sensor = ");

Serial.print(sensorValue1);

Serial.print("sensor = ");

Serial.print(sensorValue2);

Serial.print("sensor = ");

Serial.println(sensorValue3);

////////////////////////////////////////////////////

if(sensorValue<10)//กด

{

delay(500);

RUN++;

}

else if(RUN==1)//สเตป1

{

GO(); 

delay(1000);

RUN++;

STD();   

}

else if(RUN==2)//สเตป1

{

LL();

delay(1000);

RUN++;

STD();     

}

else if(RUN==3)//สเตป1

{

GO();  

delay(1000);

RUN++; 

STD();   

}

/////////////////////////////////////

else

{

 ST();  

}

}

void GO()//เดินหน้า

{

digitalWrite(MA, HIGH);

digitalWrite(MB, LOW);

digitalWrite(MC, HIGH);

digitalWrite(MD, LOW);

 digitalWrite(ME, HIGH);

digitalWrite(MF, LOW);

digitalWrite(MG, HIGH);

digitalWrite(MH, LOW);

delay(50); 

}

void LL()//หมุนซ้าย

{

digitalWrite(MA, HIGH);//3

digitalWrite(MB, LOW);//3

digitalWrite(MC, HIGH);//4

digitalWrite(MD, LOW);//4

digitalWrite(ME,LOW);//1

digitalWrite(MF, HIGH);//1

digitalWrite(MG, LOW);//2

digitalWrite(MH, HIGH);//2 

delay(50); 

}

void RR()//หมุนขวา

{

digitalWrite(MA, LOW);

digitalWrite(MB, HIGH);

digitalWrite(MC, LOW);

digitalWrite(MD, HIGH);

digitalWrite(ME, HIGH);

digitalWrite(MF, LOW);

digitalWrite(MG, HIGH);

digitalWrite(MH, LOW);

delay(50);   

}

void ST()//หยุด

{

digitalWrite(MA, LOW);

digitalWrite(MB, LOW);

digitalWrite(MC, LOW);

digitalWrite(MD, LOW); 

digitalWrite(ME, LOW);

digitalWrite(MF, LOW);

digitalWrite(MG, LOW);

digitalWrite(MH, LOW);

delay(10);   

}

void STD()//หยุด

{

digitalWrite(MA, LOW);

digitalWrite(MB, LOW);

digitalWrite(MC, LOW);

digitalWrite(MD, LOW); 

digitalWrite(ME, LOW);

digitalWrite(MF, LOW);

digitalWrite(MG, LOW);

digitalWrite(MH, LOW);

delay(1000);   

}

void SL()

{

digitalWrite(MA, LOW);//3

digitalWrite(MB, HIGH);

digitalWrite(MC, HIGH);//4

digitalWrite(MD, LOW);

 digitalWrite(ME, LOW);//1

digitalWrite(MF, HIGH);

digitalWrite(MG, HIGH);//2

digitalWrite(MH, LOW);  

  delay(50);

}

void SR()

{

digitalWrite(MA, HIGH);//3

digitalWrite(MB, LOW);

digitalWrite(MC, LOW);//4

digitalWrite(MD, HIGH);

 digitalWrite(ME, HIGH);//1

digitalWrite(MF, LOW);

digitalWrite(MG, LOW);//2

digitalWrite(MH, HIGH);  

  delay(50);

}