int Read_sensor_L = 8;
int Read_sensor_R = 9;
int sensor_L ;
int sensor_R ;
void setup() {
pinMode(8, INPUT);
pinMode(9, INPUT);
delay(2000);
}
void loop() {
sensor_L = digitalRead(Read_sensor_L);
sensor_R = digitalRead(Read_sensor_R);
if(sensor_L==0&&sensor_R==0)// พื้นขาว
{
digitalWrite(2,LOW); // เดินหน้า
digitalWrite(3,HIGH);
digitalWrite(4,LOW);
digitalWrite(5,HIGH);
delay(100);
}
if (sensor_L==1&&sensor_R==0)// พื้นดำซ้าย
{
digitalWrite(2,HIGH);
digitalWrite(3,LOW);
digitalWrite(4,LOW);
digitalWrite(5,HIGH);
delay(100);
}
if(sensor_L==0&&sensor_R==1) // พื้นดำขวา
{
digitalWrite(2,LOW);
digitalWrite(3,HIGH);
digitalWrite(4,HIGH);
digitalWrite(5,LOW);
delay(100);
}
if (sensor_L==1&&sensor_R==1)// พื้นดำทั้งคู่
{
digitalWrite(2,LOW); // หยุด
digitalWrite(3,LOW);
digitalWrite(4,LOW);
digitalWrite(5,LOW);
delay(9000);
}
} |
|
