Stap 5: CODE
Dit is een basic-code voor belemmering vermijden robot.U kunt wijzigen om verschillende dingen zoals het toevoegen van een servo voor het scannen van de omgeving en het maken van de robot om te verplaatsen naar de langste weg te doen. Maar sinds ik ben het bouwen van de eenvoudigste robot ik ga niet die...
int maximumRange = 30;
lange duur, afstand;
VOID Setup {}
Serial.begin (9600);
pinMode (trigpin, OUTPUT);
pinMode (echopin, INPUT);
pinMode (4, OUTPUT);
pinMode (5, OUTPUT);
pinMode (13, OUTPUT);
pinMode (6, OUTPUT);
pinMode (7, OUTPUT);
}
void loop)
{
{
digitalWrite(trigpin,LOW);
delayMicroseconds(2);
digitalWrite(trigpin,HIGH);
delayMicroseconds(10);
duur = pulseIn (echopin, hoge);
afstand = duur/58.2;
vertraging (50);
Serial.println(distance);
}
Als (afstand > = 30) {}
digitalWrite(4,HIGH);
digitalWrite(5,HIGH);
digitalWrite(6,LOW);
digitalWrite(7,LOW);
vertraging (200);
}
anders als (afstand > = 15 & & afstand digitalWrite (4, HIGH);
digitalWrite (5, laag);
digitalWrite (6, laag);
digitalWrite (7, laag);
vertraging (1000);
}
anders als (afstand < 15) {}
digitalWrite (4, laag);
digitalWrite (5, laag);
digitalWrite (6, hoge);
digitalWrite (7, hoge);
vertraging (1000);
digitalWrite (4, laag);
digitalWrite (5, hoge);
digitalWrite (6, laag);
digitalWrite (7, laag);
vertraging (1000);
}
}