BASIC ARDUINO hinder SKATTEUNDANDRAGANDE ROBOT (5 / 5 steg)
Steg 5: kod
Detta är en grundläggande kod för hinder skatteundandragande robot.Du kan ändra den för att göra olika saker som att lägga ett servo till avsöka omgivningen och att göra roboten att flytta till längsta väg. Men eftersom jag bygger den enklaste roboten jag inte kommer att...
int maximumRange = 30.
lång varaktighet, avstånd;
void setup() {
Serial.BEGIN (9600);
pinMode (trigpin, produktionen);
pinMode (echopin, ingång);
pinMode (4, OUTPUT);
pinMode (5, OUTPUT);
pinMode (13, OUTPUT);
pinMode (6, OUTPUT);
pinMode (7, OUTPUT);
}
Ogiltig loop)
{
{
digitalWrite(trigpin,LOW);
delayMicroseconds(2);
digitalWrite(trigpin,HIGH);
delayMicroseconds(10);
längd = pulseIn (echopin, hög);
avståndet = varaktighet/58,2;
fördröjning (50);
Serial.println(Distance);
}
om (avstånd > = 30) {
digitalWrite(4,HIGH);
digitalWrite(5,HIGH);
digitalWrite(6,LOW);
digitalWrite(7,LOW);
fördröjning (200);
}
annars om (avstånd > = 15 & & avstånd digitalWrite (4, hög);
digitalWrite (5, låg);
digitalWrite (6, låg);
digitalWrite (7, låg);
fördröjning (1000);
}
annars om (avstånd < 15) {
digitalWrite (4, låg);
digitalWrite (5, låg);
digitalWrite (6, hög).
digitalWrite (7, hög).
fördröjning (1000);
digitalWrite (4, låg);
digitalWrite 5, hög,
digitalWrite (6, låg);
digitalWrite (7, låg);
fördröjning (1000);
}
}