Simulatie van obstakelvermijding voor mobiele robots

Bediening

De werkruimte bevat verplaatsbare obstakels, robotsnelheid, detectiebereik, gezichtsveld, meetruis en een drempel voor de veiligheidsafstand. Sensorstralen en de voorspelde stopafstand blijven zichtbaar. De stapmodus laat precies zien welke waarneming elke stuurbeslissing veroorzaakte.

Theorie

Een robot moet stoppen of draaien voordat zijn meegesweerde voetafdruk een obstakel raakt. De veilige afstand hangt af van de huidige snelheid, de latentie van de regelaar, het remvermogen, de onzekerheid in de meting en de fysieke straal van de robot — niet alleen van de laatste afstandswaarde.

Reactieve regelaars zoals potentiaalvelden maken van nabije obstakels afstotende vectoren en van het doel een aantrekkende vector. Ze reageren snel, maar kunnen in lokale minima vast komen te zitten. Een praktische opbouw combineert reactieve veiligheid met een globale of lokale planner.

Algoritme

1. Verwerp verouderde en fysisch onmogelijke afstandsmonsters.
2. Transformeer geldige waarnemingen naar het robotcoördinatenstelsel.
3. Vergroot elk obstakel met de robotstraal plus een veiligheidsmarge.
4. Bereken de stopafstand uit snelheid en geschatte vertraging.
5. Stop wanneer de gang vooruit onveilig is; stuur anders naar de meest vrije sector die op het doel is gericht.
6. Begrens versnelling en hoeksnelheid voordat je motorcommando’s verstuurt.

Broncode

Houd de noodbepaling klein genoeg om uitputtend te testen:

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 een echt systeem leg je tijdstempels van sensoren vast en ga je in een veilige gestopte toestand wanneer benodigde gegevens onbeschikbaar worden.

Aannames en hardwareverschillen

De wereld is van bovenaf gezien en tweedimensionaal: sensorstralen zijn direct, volledig dun en worden nooit door het eigen chassis van de robot geblokkeerd, en de robot is een schijf die zonder momentum tot stilstand kan remmen. Op een Raspberry Pi-robot loopt een ultrasone bundel 15° uiteen, hangen time-of-flight-metingen af van het oppervlak en de zon, en wordt de stopafstand bepaald door echte massa, motorkoppel en de latentie van waarnemen-beslissen-handelen — allemaal besproken in de routekaart voor reactieve navigatie. De simulatie negeert ook jitter in de lus en spanningsval, dus neem de stopafstandcurve als de vorm die je moet internaliseren, niet als een getal dat je overneemt.

Schakelschema

Niveauverschuif elk 5 V-echosignaal voordat het de GPIO van de Raspberry Pi bereikt. Voed de motoren apart en verbind de massa’s op een bewust gekozen gemeenschappelijk punt.

Begeleide experimenten

1. Leid de stopdrempel af in plaats van hem te gokken

Stel een lage snelheid in en verlaag de stopdrempel totdat de robot obstakels gaat raken. Noteer de waarde. Verdubbel nu de snelheid en herhaal dat.

De drempel die je nodig hebt verdubbelt niet, omdat die de som is van een term die schaalt met de snelheid en een term die schaalt met het kwadraat ervan:

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

Daarom begint een robot die bij loopsnelheid betrouwbaar uitwijkt dingen te raken zodra je hem versnelt — en daarom is de oplossing een snelheidsafhankelijke drempel in plaats van één grote vaste waarde die de robot overal schuchter maakt.

2. Veroorzaak het stotteren van de drempel en repareer het

Park de robot zo dat hij vlak op de stopafstand balanceert. Met één drempel wisselt hij meerdere keren per seconde tussen rijden en draaien.

Scheid nu de twee: stop bij 20 cm en ga pas verder bij 30 cm. Het stotteren verdwijnt omdat het gedrag zich moet vastleggen. Dat gat is hysterese, en hetzelfde patroon verhelpt vrijwel elke door een drempel veroorzaakte oscillatie in robotcode.

3. Vang hem bewust

Bouw een concave hoek — een hoefijzer — en laat de robot erin rijden. Met een deterministische regel „draai naar de meest open richting“ draait hij, rijdt hij en komt hij steeds weer terug op zijn startpunt.

Dit is geen fout om te repareren. Dit is wat het ontbreken van een kaart betekent, en het is het duidelijkst mogelijke bewijs van de grens van reactieve navigatie. De tegenmaatregelen zijn een willekeurige component in de draai en een vastlopersensor die opschaling toepast na meerdere mislukte pogingen; de échte oplossing is geheugen, en dat is een volledig ander pad.

4. Vergelijk scantresolutie met scantijd

Vergroot het aantal scanhoeken en zie twee dingen in tegengestelde richting bewegen: de draaibeslissingen worden beter, en de robot staat langer stil.

Een scan is een blind moment — de robot staat stil en maakt geen vordering. Drie tot vijf hoeken is de gebruikelijke beste keuze, en daarboven is de extra informatie zelden de extra tijd waard.

Wat je moet zien

Naar de hardware

De stralen van de simulatie zijn direct, ruisvrij en oneindig dun. Een echte ultrasone sensor is geen van die dingen, en de verschillen vormen het hele werk op hardware:

Bepaal hier een veilige stopafstand en een regel voor de vrijste richting, waar een fout niets kost. Voeg op hardware daarna het mediaanfilter, de stabilisatietijd van de servo en de contactdetectie toe — de tutorial over het vermijdingsalgoritme heeft ze alle drie in code.