Sensore ostacoli

La classe ObstacleSensor gestisce i 4 sensori di ostacoli a infrarossi di Eliobot.

Posizioni dei sensori

Position	Index	Direction	Pin
Gauche	0	Côté gauche	IO4
Avant	1	Devant	IO5
Droite	2	Côté droit	IO6
Arrière	3	Derrière	IO7

Inizializzazione

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)

Metodi

get_obstacle(obstacle_pos)

Restituisce True se viene rilevato un ostacolo dal sensore nella posizione specificata, False altrimenti.

Paramètre	Type	Description
obstacle_pos	int	Index du capteur (0, 1, 2 ou 3)

Il rilevamento viene attivato quando il valore analogico è inferiore a 10000.

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

Esempio completo: evitare gli ostacoli

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)