PINGBot - Explorer Robot (1 / 6 steg)
Steg 1: Programmering logik
-inklusive bibliotek;
-initiera variabler och konstanter;
-definiera och initiera stift;
-initiera seriell kommunikation;
-"BÖRJA"
-Rutinen att stoppa motorer.
-positionering servo till 90 grader;
-läsa fram avstånd och lager.
-servo position vid 0 grader;
-läsa vänster avstånd och lagra;
-positionering servo till 180 grader;
-läsa rätt avstånd och lagra;
-jämförelse (1): FRONT är större än vänster?;
-Ja:-jämförelse (2): FRONT är större än höger?;
-Ja:-rutinen att gå framåt;
-ingen:-Ring routinel till höger;
-ingen:-(jämförelse (1) är mindre än:-rutinen att svänga vänster;
-Om alla tillstånd är möjligt (alla avstånd är exakt lika med: - gå vidare och sluta ett tag, och så börjar cykeln igen.
-gångavstånd till upptäcka mindre än 20 cm.
-slinga för att "Börja";
Obs - 1:
Motorerna måste vara ansluten för att ha samma rotationshastighet och riktning, så att ta roboten framåt - högt värde på pin 2 i varje motor och pin 1 kvar på en låg nivå.
Flödesschemat Visa oss, hur man utför dessa programmeringsfunktioner (endast som exempel):
Obs - 2:
Använder samma hårdvara, skapades en andra version med en enklare kod. Där operationen är som nedan:
Inledningsvis går roboten framåt tills han stöter på ett hinder på ett avstånd mindre än avståndet gränsen;
Sedan analyserar han "Rätt" avståndet - om "Rätt" avståndet är större än avståndet gräns - han väljer att vända "Rätt" och gå vidare;
Om "Rätt" avståndet är mindre än avståndet gräns - han analyserar sträckan "Vänster" - om "Vänster" avståndet är större än begränsa avståndet - väljer han att vända "Vänstern" och gå vidare;
Om ingen av avstånd, både "Rätt" och "Vänster" är inte tillfredsställande - han vända 180 grader och gå vidare.
Starta en ny cykel.
I avsnittet mjukvara och programmering hittar du båda versionerna för nedladdning.