Dwengo/sumobot: verschil tussen versies
Verwijderde inhoud Toegevoegde inhoud
Geen bewerkingssamenvatting |
|||
Regel 45:
#include <dwengoMotor.h>
#include <dwengoSensorModule.h>
// To do in deze code: de delays zoveel mogelijk eruit halen omdat er dan geen sensoren worden ingelezen
void main(void) {
int os8,i;
Regel 54:
powerLongRange(TRUE);
i=0;
while (TRUE){ // oneindige lus starten
os8 = readSensor(OS8, ACTIVE_MODE); // Lange Afstandssensor meten
clearLCD(); // LCD scherm leegmaken
printIntToLCD(os8,1,0); // Gemeten waarde op scherm weergeven
// Interpreteren waarde
if (os8>30 ) { // Als de lange afstandssensor 'iets' detecteert
setSpeedMotor1 (800); // Rechtdoor rijden
setSpeedMotor2 (800);
delay_ms(400);
}
else // Als de sensor niks detecteert
{
if (i<10){ //De eerste 10 keer naar links draaien ... scannen naar een slachtoffer
setSpeedMotor1 (-600);
setSpeedMotor2 (600);
Regel 74:
i=i+1;
}
else if (i<20){ //Dan naar rechts
setSpeedMotor1 (600);
setSpeedMotor2 (-600);
Regel 82:
else
{
i=0; //Niks gevonden... we beginnen opnieuw
}
}
| |||