Aller au contenu principal

ObstacleSensor

La classe ObstacleSensor gère les 4 capteurs infrarouges d'obstacles d'Eliobot.

Positions des capteurs

PositionIndexDirectionPin
Gauche0Côté gaucheIO4
Avant1DevantIO5
Droite2Côté droitIO6
Arrière3DerrièreIO7

Initialisation

import board
import analogio
from elio import ObstacleSensor

obstacle_pins = [
analogio.AnalogIn(board.IO4), # Gauche
analogio.AnalogIn(board.IO5), # Avant
analogio.AnalogIn(board.IO6), # Droite
analogio.AnalogIn(board.IO7), # Arrière
]

obstacle_sensor = ObstacleSensor(obstacle_pins)

Méthodes

get_obstacle(obstacle_pos)

Retourne True si un obstacle est détecté par le capteur à la position donnée, False sinon.

ParamètreTypeDescription
obstacle_posintIndex du capteur (0, 1, 2 ou 3)

La détection se déclenche lorsque la valeur analogique est inférieure à 10000.

if obstacle_sensor.get_obstacle(1):  # Capteur avant
print("Obstacle devant !")

Exemple complet — évitement d'obstacles

import board
import pwmio
import analogio
import time
from elio import Motors, ObstacleSensor

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)

obstacle_pins = [
analogio.AnalogIn(board.IO4),
analogio.AnalogIn(board.IO5),
analogio.AnalogIn(board.IO6),
analogio.AnalogIn(board.IO7),
]

motors = Motors(AIN1, AIN2, BIN1, BIN2, vBatt_pin)
obstacle_sensor = ObstacleSensor(obstacle_pins)

while True:
if obstacle_sensor.get_obstacle(1): # Obstacle devant
motors.turn_right(speed=60)
time.sleep(0.3)
else:
motors.move_forward(speed=80)