Stap 8: Uitleg van de code
Dit voegt de ultrasonic.h bibliotheek aan de schets
int MOTOR = 9; Relais de Pin. Dit is de pin waar de motor1 wordt verbonden
int MOTOR2 = 7; Dit is de pin waar de motor2 is aangesloten
int TRIG = 11; Trigger de Pin, dit is de Trigger-pin van de ultrasone sensor
int ECHO = 10; ECHO Pin, dit is de echo-pin van de ultrasone sensor
int bereik; Het bereik van het object van Ping Sensor
int Dist; De waarde van de afstand, de hoeveelheid inch die u instellen waarbij de motor ie draait detecteert de muur
Ultrasone ultrasonic(TRIG,ECHO); Maken en de ultrasone object te initialiseren.
VOID Setup {}
pinMode (MOTOR, uitvoer); Dit is de instelling van de 1ste motor als uitgang
pinMode (MOTOR2, uitvoer); Dit is de instelling van de 2e motor als uitgang
Dist = 10; De afstand in inches. Deze voor verhoogde of verminderde bereik te wijzigen.
}
void loop {}
statische int sensorCount = 0; Dit geldt in principe de sensor ingang 0 aanvankelijk
Bereik = ultrasone. Ranging(Inc); Bereik wordt berekend in Inches.
Als (bereik > Dist) {}
digitalWrite (MOTOR, hoge);
digitalWrite (MOTOR2, hoge);
sensorCount = 0;
} else {}
++ sensorCount;
Als (sensorCount = 5) als het bereik niet > afstand dan de sensor wordt het bereik 5 keer op een rij met een tussenruimte van 20ms gecontroleerd en als zij alle dat bereik tonen < afstand, dan is de functie anders wordt uitgevoerd die een motor wordt uitgeschakeld, zodat de robot van richting verandert
{
digitalWrite (MOTOR, laag);
digitalWrite (MOTOR2, hoge);
delay(500);
sensorCount = 0; De eerste waarde van de sensor lezingen terug naar 0
}
anders
{
vertraging(20); 20ms wachten voordat de sensor weer zintuigen om 5 waarden van bereik < dist om te stoppen met motor1
}
}
}