Bilgiler > Çizgi izleyen robot program(3 sensörlü)

Çizgi izleyen robot program(3 sensörlü)

#define sagi 12
#define sagg 13
#define soli 8
#define solg 9

#define sr 3
#define so 4
#define sl 2

int sld=0;
int srd=0;
int sod=0;



void setup()
{
pinMode(sagi,OUTPUT);
pinMode(sagg,OUTPUT);
pinMode(soli,OUTPUT);
pinMode(solg,OUTPUT);
pinMode(sr,INPUT);
pinMode(so,INPUT);
pinMode(sl,INPUT);
Serial.begin(9600);
}

void loop()
{
sld=digitalRead(sl);
sod=digitalRead(so);
srd=digitalRead(sr);


if(sld==1&&sod==1&&srd==1)
{
digitalWrite(sagi,LOW);
digitalWrite(sagg,LOW);
digitalWrite(soli,LOW);
digitalWrite(solg,LOW);
}
else if(sld==1&&sod==1&&srd==0)
{
digitalWrite(soli,1);
digitalWrite(solg,0);
digitalWrite(sagi,0);
digitalWrite(sagg,1);

}
else if(sld==1&&sod==0&&srd==1)
{
digitalWrite(soli,1);
digitalWrite(solg,0);
digitalWrite(sagi,1);
digitalWrite(sagg,0);

}
else if(sld==1&&sod==0&&srd==0)
{
digitalWrite(soli,1);
digitalWrite(solg,0);
digitalWrite(sagi,0);
digitalWrite(sagg,1);

}

else if(sld==0&&sod==1&&srd==1)
{
digitalWrite(soli,0);
digitalWrite(solg,1);
digitalWrite(sagi,1);
digitalWrite(sagg,0);

}


else if(sld==0&&sod==1&&srd==0)
{
digitalWrite(soli,1);
digitalWrite(solg,0);
digitalWrite(sagi,0);
digitalWrite(sagg,1);

}


else if(sld==0&&sod==0&&srd==1)
{
digitalWrite(soli,0);
digitalWrite(solg,1);
digitalWrite(sagi,1);
digitalWrite(sagg,0);

}

else if(sld==0&&sod==0&&srd==0)
{
digitalWrite(soli,0);
digitalWrite(solg,1);
digitalWrite(sagi,1);
digitalWrite(sagg,0);

}

delay(100);
Serial.print("");
Serial.print("sl:");
Serial.println(sld);

Serial.print("so:");
Serial.println(sod);

Serial.print("sr:");
Serial.println(srd);







}

Kaynak: Çoğunlukla Ekşisözlük ve Wikipedia
sonraki bilgi:      huzursuzlugun kitabi
önceki bilgi:       tp link
Bu sayfaya 88  defa bakıldı

***