Fijibot (5 / 6 steg)

Steg 5: Programmet



Fijibots huvudsakliga uppdrag är att hitta "mat". Hans mat är ljus att ladda sina batterier via solpanelen på ryggen. Jag använde fyra photoresistors monterad i LED hållare (fram, höger, vänster och topp) för att hjälpa honom att hitta den ljusaste platsen i rummet. Huvudprogrammet ögla Jämför värdena för fyra motstånden och flyttar mot de mest ljus. När han har hittat den ljusaste platsen (hans topp motstånd ser mest ljus), han stannar och åtnjuter de fri måltiden!

Samtidigt letar ljus att ladda sina batterier, undviker Fijibot kör in i saker med ultraljud (via en Ping sensor). Huvudprogrammet ögla kontrollerar ständigt för hinder inom ett visst intervall (30 tum). Om något är upptäckt, Fijibot stannar, ser vänster och höger (med en standard Parallax servo) och bestämmer vilken riktning är tydlig. Om han har blockerat framåt, vänster, och rätt han kommer backup i en halv sekund och försök igen.

Källkoden finns tillgänglig på https://github.com/mikesoniat/Fijibot

Se Steg
Relaterade Ämnen