Intro
S’arrêter devant un obstacle
Dans cette leçon, tu apprendras à utiliser les capteurs de l’Eliobot pour détecter des obstacles et arrêter Eliobot.
Étape 1
Déclaration des entrées / sorties
Nous allons commencer notre code en intégrant quelques bibliothèques. Ce sont des ensembles de codes déjà écrits nous permettant de rajouter des fonctions facilement.
La première s’appelle “board” et est spécifique à CircuitPython. C’est grâce à elle que nous allons pouvoir expliquer à notre programme comment sont connectés les éléments au microcontrôleur (le cerveau de Eliobot)
Pour l’intégrer dans notre programme on utilise la ligne suivante :
import board
Cela nous permet d’appeler les entrée / sorties de la cartes en utilisant le numéro de la broche.
board.IO4
Étape 2
Déclaration des capteurs
Pour déclarer les capteurs on va utiliser la bibliothèque « analogio ».
import analogio
Ensuite on défini chaque capteur.
obstacleInput = [analogio.AnalogIn(pin) for pin in
(board.IO4, board.IO5, board.IO6, board.IO7)]
Les capteurs d’obstacles sont classés dans un tableau et sont numérotés de 0 à 3 : 0 pour la gauche, 1 pour l’avant, 2 pour la droite, et 3 pour l’arrière. Dans la fonction, nous utilisons l’indice 1 pour le capteur de devant.
Déclaration des moteurs
Pour déclarer les moteurs on va utiliser une bibliothèque qui se nomme « pwmio ».
import pwmio
Ensuite nous définissons chaque moteur, son sens et la batterie.
AIN1 = pwmio.PWMOut(board.IO36)
AIN2 = pwmio.PWMOut(board.IO38)
BIN1 = pwmio.PWMOut(board.IO35)
BIN2 = pwmio.PWMOut(board.IO37)
vBatt_pin = analogio.AnalogIn(board.BATTERY)
Pour nous faciliter la tâche on va utiliser la bibliothèque « elio ».
from elio import Motors, ObstacleSensor
Ensuite on définit les moteurs et capteur d’obstacle.
motors = Motors(AIN1, AIN2, BIN1, BIN2, vBatt_pin)
obstacleSensor = ObstacleSensor(obstacleInput)
Étape 3
Détecter l’obstacle
Pour commencer, nous allons reprendre le programme créé dans la leçon précédente. On te le remet ci-dessous :
while True:
if obstacleSensor.get_obstacle(1):
print("Un obstacle est devant")
else:
print("Aucun obstacle")
On va utiliser les fonctions de mouvements « elio.move_forward(100) » et « elio.motor_stop() » pour faire des actions en fonction de la situation :
while True:
if obstacleSensor.get_obstacle(1):
print("Un obstacle est devant")
motors.motor_stop()
else:
print("Aucun obstacle")
motors.move_forward(100)
Étape 4
Programme final
Voici le programme final que l’on va pouvoir exécuter ▶️ :
import board
from elio import Motors, ObstacleSensor
import pwmio
import analogio
obstacleInput = [analogio.AnalogIn(pin) for pin in
(board.IO4, board.IO5, board.IO6, board.IO7)]
AIN1 = pwmio.PWMOut(board.IO36)
AIN2 = pwmio.PWMOut(board.IO38)
BIN1 = pwmio.PWMOut(board.IO35)
BIN2 = pwmio.PWMOut(board.IO37)
motors = Motors(AIN1, AIN2, BIN1, BIN2, vBatt_pin)
obstacleSensor = ObstacleSensor(obstacleInput)
while True:
if obstacleSensor.get_obstacle(1):
print("Un obstacle est devant")
motors.motor_stop()
else:
print("Aucun obstacle")
motors.move_forward(100)
Bravo !
Et voila, ton programme est fini ! Il ne te reste plus qu’à le Téléverser pour admirer le résultat