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);

}


sonraki bilgi: huzursuzlugun kitabi
önceki bilgi: tp link



Bu sayfaya 86 defa bakıldı
Bu internet sitesi kar amacı gütmemektedir. Bu içeriğin siteden kaldırılmasını istiyorsanız alttaki butonu kullanarak içeriğin kaldırılması için istekte bulunabilirsiniz.

***

Telefon Uyumlu Sayfa