Arduino Hexapod Avoider Robot (9 / 10 steg)
Steg 9: Programmering och Algoritma
Denna flödet av programmet:
- # första påslagen, roboten göra "Stance Pose" för 3 andra
# Ultrasonics programmet körs för att samla in data seten
# Framåt funktion körs som standardfunktion
# Alla LED indikator inaktivera
# 1, 2nd & 3rd ultrasonics samlar in data seten
# Robot fortsätta framåt tills 1st, 2nd & 3rd ultrasonics läser rad < 11 cm - # När 2: a ultraljud eller 3rd ultraljud Läs sträcker < 11 cm
# det menar robot i inte raka skick
# robot kommer sväng höger, 1 steg när Läs sträcker < 11 cm på 2: a Ultraljuds
# robot kommer att vända vänster, 1 steg när läser rad < 11 cm på 3nd Ultraljuds
# När robotens staten är rak, trädde fram funktion körs som standardfunktion - # När roboten läser 1. Checkpoint (det finns vägg framför av robot)
# Robot läsa data från 4: e & 5: e Ultrasonics
# robot kommer sväng höger, 3 steg när Läs sträcker < 11 cm på ultraljuds-4, 1: a LED och slå sedan på
# robot kommer att vända vänster, 3 steg när läser rad < 11 cm på ultraljuds-5. 1: a LED och slå sedan på
# Robot kör 1st och 2nd algoritma (utan Stance pose)
# När roboten läser 2. Checkpoint
# Robot läsa data från 4: e & 5: e Ultrasonics
# robot kommer sväng höger, 3 steg när Läs sträcker < 11 cm på ultraljuds-4, 2: a LED och slå sedan på
# robot kommer att vända vänster, 3 steg när läser rad < 11 cm på ultraljuds-5. 2: a LED och slå sedan på
# Robot kör 1st och 2nd algoritma (utan Stance pose
# När roboten läser 3: e Checkpoint
# Robot läsa data från 4: e & 5: e Ultrasonics
# robot kommer sväng höger, 3 steg när Läs sträcker < 11 cm på ultraljuds-4, 3: e LED och slå sedan på
# robot kommer att vända vänster, 3 steg när läser rad < 11 cm på ultraljuds-5, 3: e LED och slå sedan på
# Robot kör 1st och 2nd algoritma (utan Stance pose)
# När roboten läser 4. Checkpoint
# Robot läsa data från 4: e & 5: e Ultrasonics
# Robot läsa 3 lysdioder på hög State och sväng vänster 3 steg 4: e LED och slå sedan på
# Robot kör 1st och 2nd algoritma (utan Stance pose)
# När roboten läser det är en vägg framför roboten
# Robot läsa alla LED-indikator med hög status, som menar roboten är FINISH
# Robot standby pose i 10 sekunder