Étape 9: Programmation et Algoritma
Ce le flux du programme :
- # tout d’abord activé, le robot ne « Stanby Pose » pour 3 secondes
# Exécution du programme ultrasons pour collecter des données
# Foward fonction s’exécute comme fonction par défaut
# Tous les voyant s’éteindre
# 1er, 2e et 3e ultrasons recueille des données
# Robot continuer à avancer jusqu'à ce que des ultrasons 1er, 2e et 3e lu gamme < 11 cm - # lors de la 2e lecture ultrasonique ultrasonique ou 3e rang < 11 cm
# qui signifie robot en état pas droite
robot # tournera à droite, 1 étape de lecture plage < 11 cm à ultrasons 2ème
robot # tournera à gauche, 1 étape quand lu gamme < 11 cm à ultrasons 3nd
# Lorsque l’état du robot est droite, Foward fonction s’exécute comme fonction par défaut - # Quand le robot lire 1er point de contrôle (il est mur en face du robot)
# Robot lire les données d’ultrasons 4e & 5e
robot # tournera à droite, 3 étapes quand lecture plage < 11 cm à ultrasons 4e, puis 1ère LED s’allume
robot # tournera à gauche, 3 étapes quand lu gamme < 11 cm à 5e ultrasonique, puis 1ère LED s’allume
# Le robot exécute algoritma 1er et 2e (w/o stanby pose)
# Quand le robot lire 2e Checkpoint
# Robot lire les données d’ultrasons 4e & 5e
robot # tournera à droite, 3 étapes quand lecture plage < 11 cm à ultrasons 4ème, puis la LED 2 s’allume
robot # tournera à gauche, 3 étapes quand lu gamme < 11 cm à 5e ultrasonique, puis 2e LED s’allume
# Le robot exécute algoritma 1er et 2e (w/o stanby pose
# Quand le robot lire 3e point de contrôle
# Robot lire les données d’ultrasons 4e & 5e
robot # tournera à droite, 3 étapes quand lecture plage < 11 cm à ultrasons 4, puis 3 LED s’allume
robot # tournera à gauche, 3 étapes quand lu gamme < 11 cm à 5e ultrasonique, puis 3e LED s’allume
# Le robot exécute algoritma 1er et 2e (w/o stanby pose)
# Quand robot lu 4e Checkpoint
# Robot lire les données d’ultrasons 4e & 5e
# Robot lire 3 LEDs à l’État haut et tournez à gauche étape 3 puis 4 LED s’allume
# Le robot exécute algoritma 1er et 2e (w/o stanby pose)
# Quand le robot y lire est un mur devant le robot
# Robot lire tous les voyant dans l’état élevé, cela signifie que le robot est fini
# Pose de veille robot pendant 10 secondes