Stap 9: Programmering en Algoritma
Deze de stroom van het programma:
- # eerst ingeschakeld, de robot doen "Stanby Pose" voor 3, tweede
# Ultrasonics programma draait om het verzamelen van datas
# Doorsturen functie wordt uitgevoerd als standaardfunctie
# Alle LED-Indicator uitschakelen
# 1e, 2e en 3e ultrasoon is het verzamelen van datas
# Robot blijven bewegen vooruit totdat 1e, 2e en 3e ultrasoon lezen bereik < 11 cm - # Wanneer 2de ultrasone of 3e ultrasone lezen bereik < 11 cm
# dat robot in niet rechte staat
# robot zal rechtsaf, 1 stap wanneer Lees bereik < 11 cm op 2de Ultrasonic
# robot zal linksaf, 1 stap wanneer Lees bereik < 11 cm bij 3nd Ultrasonic
# Wanneer de robot de staat recht is, doorsturen functie wordt uitgevoerd als standaardfunctie - # Wanneer robot 1ste Checkpoint lezen (er is muur in de voorkant van de robot)
# Gegevens lezen van 4e & 5e Ultrasonics robot
# robot zal rechtsaf, 3 stap wanneer Lees bereik < 11 cm op 4e Ultrasonic, dan 1e LED inschakelen
# robot zal linksaf, 3 stap wanneer Lees bereik < 11 cm op 5e Ultrasonic, dan 1e LED inschakelen
# Robot loopt 1e en 2e algoritma (w/o stanby pose)
# Wanneer robot 2de Checkpoint lezen
# Gegevens lezen van 4e & 5e Ultrasonics robot
# robot zal rechtsaf, 3 stap wanneer Lees bereik < 11 cm op 4e Ultrasonic, dan 2e LED inschakelen
# robot zal linksaf, 3 stap wanneer Lees bereik < 11 cm op 5e Ultrasonic, dan 2e LED inschakelen
# Robot loopt 1e en 2e algoritma (w/o stanby pose
# als robot Lees 3e Checkpoint
# Gegevens lezen van 4e & 5e Ultrasonics robot
# robot zal rechtsaf, 3 stap wanneer Lees bereik < 11 cm op 4e Ultrasonic, dan 3de LED inschakelen
# robot zal linksaf, 3 stap wanneer Lees bereik < 11 cm op 5e Ultrasonic en 3de LED inschakelen
# Robot loopt 1e en 2e algoritma (w/o stanby pose)
# als robot lees 4e Checkpoint
# Gegevens lezen van 4e & 5e Ultrasonics robot
# Robot gelezen 3 LED's op hoge stand en draai links 3 stappen en gaat dan 4e LED inschakelen
# Robot loopt 1e en 2e algoritma (w/o stanby pose)
# als robot Lees er is een muur voor de robot
# Robot Lees alle LED-Indicator in de hoge Braziliaanse dat betekenen dat de robot is afwerking
# Robot standby-pose gedurende 10 seconden