Bouw een obstakelvermijdende robot: meten, scannen en sturen

Een obstakelvermijdende robot is de logische volgende build na een lijnvolger. Een lijnvolger volgt — hij volgt een lijn die iemand voor hem tekende. Deze robot beslist: zonder lijn en zonder kaart waarneemt hij de ruimte om zich heen en kiest waar hij heen gaat. Dat ene verschil — op de wereld reageren in plaats van hem te volgen — is de eerste echte smaak van autonomie, en het is nog steeds simpel genoeg om volledig te begrijpen.

De kern is een korte, herhalende cyclus: meten–scannen–beslissen–draaien. De HC-SR04 ultrasone sensor pingt vooruit en meet de looptijd van het echo-signaal om de afstand te schatten; is er iets dichterbij dan een veiligheidsdrempel, dan stopt de robot, zwaait de sensor met een SG90-servomotor links en rechts en draait naar de meest open richting. Die drempel is niet willekeurig — het is een veiligheidsafstand opgebouwd uit de huidige snelheid, de latentie van meten–beslissen–aansturen, de remweg (die met het kwadraat van de snelheid groeit), de straal van de robot en een marge, en dat is allemaal te zien als de stopafstandcurve in de simulator.

Je voegt de onderdelen toe die een mobiele robot nodig heeft en leert wat elk ervan doet: een Arduino Uno voor vergevingsgezinde 5 V-logica, de ultrasone sensor met zijn blinde zone (de minimale afstand waarbeneden hij niets kan melden), de servomotor die de bundel een tweede kijkpunt geeft, de L298N H-brug die de motorstroom schakelt die de logica-pinnen niet kunnen leveren, twee TT-gearmotoren waarin de tandwielkast snelheid inruilt voor bruikbaar koppel, een 2WD-chassis met zwenkwiel voor differentiële sturing, en een accupakket dat motor en logica op gescheiden rails moet voeden. De technologieboom voert je daarnaast door twee leerroutes — motorbesturing en reactieve navigatie — zodat dezelfde ideeën over PWM, odometrie en filtering die je bij de lijnvolger tegenkwam hier in een navigatiecontext terugkomen.

Daarna — vóór je iets uitgeeft of een verkeerde bedrading riskeert — stel je het vermijdingsgedrag in de browsersimulator af tot hij netjes door een rommelige ruimte navigeert. De werkruimte daar is in bovenaanzicht en tweedimensionaal, met directe stralen zonder ruis; een echte ultrasone bundel spreidt ongeveer 15° uit, wordt geblokkeerd door de eigen behuizing van de robot en wordt verstoord door zachte of schuine oppervlakken. Je zult metingen dus moeten filteren en een mediaanfilter en een korte stabilisatietijd toevoegen nadat de servomotor heeft gedraaid, voordat je een afstand op echte hardware vertrouwt. Een veilige stopafstand en een heldere regel voor de vrije richting bepaal je het beste in simulatie; zo haal je het meeste giswerk weg voordat de robot ook maar beweegt.

Pas dan bedraad je de echte robot — trig en echo op de juiste spanning, servosignaal op een PWM-compatibele pin, motor-PWM en richting naar de driver, motoraccu uitsluitend op de VM-pin van de driver, alle massa’s aan elkaar — en laat je hem over een vloer met dozen of stoelen zwerven. Dezelfde lessen over meten en filtering leiden rechtstreeks naar de Micromouse-doolhof met muren als je later wilt karteren, of naar ROS 2-navigatie als je een Raspberry Pi toevoegt.

Volg de technologieboom hieronder van boven naar beneden. Elke knoop gaat open zodra de vereisten zijn afgerond, en je voortgang wordt op dit apparaat bewaard, zodat je de robot in een weekend kunt bouwen zonder je plaats kwijt te raken.

Onderdelenlijst

Totaal: ongeveer $30–40.

De twee botsschakelaars zijn de beste veertig cent aan de robot, en het zijn precies de onderdelen die de meeste builds overslaan. Elke afstandssensor heeft oppervlakken die hij niet kan zien — sonar ziet niets van gordijnen en niets van wanden die hij steil tegenkomt — en een robot zonder aanraakdetectie duwt een gordijn weg tot er iets meegeeft. Twee schakelaars achter een omwikkelde bumper maken van “vermijdt meestal dingen” een “loopt nooit vast tegen iets dat het niet kon zien”.

Hoe alles samenhangt

Let op het timerconflict: de bibliotheek Servo neemt Timer 1 over, die op een Uno de PWM op pinnen 9 en 10 aanstuurt. Zet de motor-PWM op 3, 5, 6 of 11 en de servomotor op een willekeurige pin, dan doet het probleem zich nooit voor. Zet je een motor-enable op pin 9, dan werkt de snelheidsregeling stilzwijgend niet meer zodra je een servomotor aansluit.

De stopafstand berekend in plaats van geschat

De stopdrempel is het belangrijkste getal in dit project, en hij is niet willekeurig. Hij is de som van vier afstanden:

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

Uitgerekend voor een robot op 0,3 m/s met 80 ms latentie en 1,0 m/s² remming:

= (0.3 x 0.08) + (0.09 / 2.0) + 0.09 + 0.05
= 0.024 + 0.045 + 0.09 + 0.05 = 0.21 m

Dus ongeveer 21 cm. Verdubbel nu de snelheid tot 0,6 m/s:

= 0.048 + 0.18 + 0.09 + 0.05 = 0.37 m

De drempel is niet verdubbeld — hij is met 76% gegroeid, omdat de remterm met het kwadraat van de snelheid meegroeit. Daarom raakt een robot die bij wandelsnelheid betrouwbaar vermijdt ineens dingen zodra je hem versnelt, en daarom is de oplossing een snelheidsafhankelijke drempel in plaats van één groot vast getal dat de robot overal schuchter maakt.

Bouw de robot in mijlpalen

Mijlpaal 10 is de stap die een demo van een robot scheidt. Een kussen absorbeert de ultrasone puls volledig, dus de sensor meldt vrije ruimte en de robot rijdt er op volle snelheid tegenaan. Zonder botsschakelaar duwt hij daarna door tot de motoren blokkeren.

Problemen oplossen

Waar je hierna mee verder kunt

Voeg muurvolgen toe. Een robot die aan één kant een vaste afstand tot een muur houdt, doorloopt een kamer systematisch in plaats van te dwalen, en het is het eerste gedrag dat op een plan begint te lijken. Het is een kleine codewijziging en een grote denkstap.

Voeg een tweede sensortype toe. Een VL53L0X faalt op vrijwel precies de tegengestelde oppervlakken van sonar — donkere matte vlakken en spiegels, tegenover zachte en schuine. Samen dekken ze veel meer van de kamer dan een van beide alleen.

Erken het plafond en ga verder. Een reactieve robot kun je nergens naartoe sturen, hij kan niet beloven dat hij de hele vloer heeft gehad, en hij kan in een hoefijzervormige kamer eindeloos rond blijven lopen. Dat zijn eigenschappen van het ontbreken van een kaart, geen fouten. Zodra dat belangrijk wordt, voegt de micromouse kartering en planning toe, en pakt de dekkingrobot de vraag “ben ik wel overal geweest?” rechtstreeks aan.