Stap 9: Controleer de robot in een "tafelblad zwerver"
Deze code is voor een hindernis vermijden robot met één QRD-1114 reflectived sensor.
voel je vrij om de wijzigingen te verbeteren of het oplossen van problemen.
Const int Lf = 9; //forwards aan linkerkant
Const int Lb = 10; //backwards aan linkerkant
Const int Rf = 11; //forwards aan rechterkant
Const int Rb = 12; achteruit aan rechterkant
int val = 0; gegevens van de sensor opslaan
VOID Setup {}
pinMode (Lf, uitvoer); linker motor output
pinMode (Lb, uitvoer); linker motor output
pinMode (Rf, uitvoer); rechts motor output
pinMode (Rb, uitvoer); rechts motor output
analoge pinnen automatisch ingesteld als input
}
void loop {}
Val = analogRead(0); lezen van sensor
Als (val > 100) {}
digitalWrite (Lf, laag); / / stop gaan vooruit
digitalWrite (Rf, laag); //stop gaan vooruit
digitalWrite (Lb, hoge); / / terug weg fromn object
digitalWrite (Rb, hoge); //back uit de buurt van object
delay(2500);
digitalWrite (Rb, laag); //turn uit de buurt van object
delay(2500);
digitalWrite (Lb, laag); / / stoppen met bewegen
} else {}
digitalWrite (Lf, hoge);
digitalWrite (Rf, hoge); Ga naar voren als geen object
}
}
met behulp van deze code, met de sensor naar beneden gebogen, kun je je robot kunnen bewegen rond een tafel op eigen zonder eraf.