36 lines
1005 B
Python
36 lines
1005 B
Python
from logique_BR import *
|
|
def main():
|
|
print("Démarrage")
|
|
sleep(1)
|
|
|
|
try:
|
|
while True:
|
|
distance = mesure_distance_cm()
|
|
|
|
if distance is not None:
|
|
print(f"Distance: {distance} cm")
|
|
|
|
if distance < 20:
|
|
print("Obstacle détecté !")
|
|
moteurs_stop()
|
|
sleep_ms(200)
|
|
reculer(VITESSE_BASE)
|
|
sleep_ms(500)
|
|
moteurs_stop()
|
|
sleep_ms(200)
|
|
tourner_gauche(VITESSE_BASE)
|
|
sleep_ms(600)
|
|
else:
|
|
avancer(VITESSE_BASE)
|
|
else:
|
|
print("Erreur capteur")
|
|
moteurs_stop()
|
|
sleep_ms(100)
|
|
except KeyboardInterrupt:
|
|
print("Arrêt du programme")
|
|
moteurs_stop()
|
|
|
|
# Lancer automatiquement si ce fichier est main.py
|
|
if __name__ == "__main__":
|
|
main()
|