Simulatore di evitamento ostacoli per robot mobili

Controlli

L’area di lavoro include ostacoli mobili, velocità del robot, portata di rilevamento, campo visivo, rumore nelle misurazioni e una soglia di distanza di sicurezza. I raggi dei sensori e la distanza di arresto prevista restano visibili. La modalità passo mostra esattamente quale osservazione ha causato ogni decisione di sterzo.

Teoria

Un robot deve fermarsi o cambiare direzione prima che il suo ingombro spazzato incontri un ostacolo. La distanza sicura dipende dalla velocità attuale, dalla latenza del controllore, dalla capacità di frenata, dall’incertezza della misurazione e dal raggio fisico del robot, non solo dall’ultimo valore di distanza.

I controllori reattivi come i campi di potenziale trasformano gli ostacoli vicini in vettori repulsivi e l’obiettivo in un vettore attrattivo. Rispondono rapidamente, ma possono rimanere intrappolati in minimi locali. Una pila pratica abbina la sicurezza reattiva a un pianificatore globale o locale.

Algoritmo

1. Scarta i campioni di distanza obsoleti e fisicamente impossibili.
2. Trasforma le osservazioni valide nel sistema di riferimento del robot.
3. Espande ogni ostacolo di un valore pari al raggio del robot più il margine di sicurezza.
4. Calcola la distanza di arresto dalla velocità e dalla decelerazione stimata.
5. Ferma quando il corridoio frontale non è sicuro; altrimenti sterza verso il settore allineato all’obiettivo più sgombro.
6. Limita l’accelerazione e la velocità angolare prima di inviare i comandi ai motori.

Codice sorgente

Mantieni la decisione di emergenza abbastanza piccola da poterla testare in modo esaustivo:

def safe_velocity(target, ranges, stop_distance):
    front = [r for angle, r in ranges if abs(angle) < 0.35]
    if not front or min(front) <= stop_distance:
        return 0.0, choose_clear_turn(ranges)
    return limit_acceleration(target), steer_toward_clearance(ranges)

In un sistema reale, registra i timestamp dei sensori ed entra in uno stato di arresto sicuro quando i dati necessari diventano non disponibili.

Ipotesi e differenze hardware

Il mondo è visto dall’alto ed è bidimensionale: i raggi dei sensori sono istantanei, perfettamente sottili e mai occultati dal corpo stesso del robot; il robot è un disco che può frenare fino a zero senza inerzia. Su un robot con Raspberry Pi, i fasci ultrasonori si disperdono di 15°, le letture a tempo di volo dipendono dalla superficie e dal sole e la distanza di arresto è determinata dalla massa reale, dalla coppia del motore e dalla latenza tra rilevamento, decisione e attuazione: sono tutti aspetti trattati nel percorso di apprendimento sulla navigazione reattiva. Il simulatore ignora anche il jitter del ciclo e il calo di tensione, quindi considera la curva della distanza di arresto come una forma da interiorizzare, non come un numero da copiare.

Schema elettrico

Esegui la conversione di livello di qualsiasi segnale di eco a 5 V prima che raggiunga i GPIO del Raspberry Pi. Alimenta separatamente i motori e collega le masse in un punto comune scelto deliberatamente.

Esperimenti guidati

1. Deriva la soglia di arresto invece di indovinarla

Imposta una velocità bassa e abbassa la soglia di arresto finché il robot non inizia a toccare gli ostacoli. Annota il valore. Raddoppia ora la velocità e ripeti.

La soglia necessaria non raddoppia, perché è la somma di un termine che scala con la velocità e uno che scala con il suo quadrato:

stop_distance = (v x t_latency) + (v^2 / (2 x a_brake)) + robot_radius + margin

Ecco perché un robot che evita gli ostacoli in modo affidabile a passo d’uomo inizia a colpirli quando aumenti la velocità, e perché la correzione è una soglia dipendente dalla velocità anziché un unico valore fisso elevato che rende il robot timido ovunque.

2. Produci il tremolio della soglia, poi risolvilo

Piazza il robot in modo che resti esattamente alla distanza di arresto. Con una sola soglia passa più volte al secondo tra guida e sterzo.

Ora separa le due: fermati a 20 cm e non ripartire finché non raggiungi 30 cm. Il tremolio scompare perché il comportamento deve assumere un impegno. Quello scarto è l’isteresi, e lo stesso schema risolve quasi ogni oscillazione pilotata da soglia nel codice di un robot.

3. Intrappolalo deliberatamente

Costruisci un angolo concavo, a ferro di cavallo, e fai entrare il robot. Con una regola deterministica di «svolta verso la direzione più aperta» girerà, guiderà e tornerà per sempre nel punto da cui è partito.

Questo non è un bug da correggere. È ciò che significa non avere una mappa, ed è la dimostrazione più chiara del limite della navigazione reattiva. Le mitigazioni sono una componente casuale nella svolta e un rilevatore di blocco che aumenta la severità dopo diversi tentativi falliti; la soluzione reale è la memoria, che è un percorso completamente diverso.

4. Confronta la risoluzione della scansione con il tempo di scansione

Aumenta il numero di angoli di scansione e osserva due aspetti muoversi in direzioni opposte: le decisioni di svolta migliorano, ma il robot passa più tempo fermo.

Una scansione è un momento cieco: il robot è fermo e non progredisce. Tre-cinque angoli è di solito il punto d’equilibrio, e oltre quello raramente le informazioni aggiuntive giustificano il tempo aggiuntivo.

Cosa devi osservare

Passaggio all’hardware

I raggi del simulatore sono istantanei, privi di rumore e infinitamente sottili. Un vero sensore ultrasonoro non è nessuna di queste cose, e le differenze costituiscono tutto il lavoro sull’hardware:

Trova qui una distanza di arresto sicura e una regola per la direzione libera, dove un errore non costa nulla. Poi sull’hardware aggiungi il filtro mediano, il ritardo di assestamento del servomotore e il rilevamento del contatto: il tutorial sull’algoritmo di evitamento contiene il codice per tutti e tre.