Algoritme

Inleiding

Laten we het algoritme maken met behulp van een simpel doolhof.

We gebruiken de linkerhandregel. Wanneer de robot linksaf kan slaan, dan doet hij dit.

Het gevolg is dat, als hij niet linksaf kan slaan, dan gaat hij rechtdoor.

En als dat niet kan, dan gaat slaat hij rechtsaf.

Unnamed

We krijgen zo volgende conditie's:

Bewegingen

Met de lijnsensor gaan we detecteren of we op een kruispunt staan en of we de lijn volgne. We gaan hiervoor de lijnsensorstrip gebruiken met 5 sensoren.

Naar links draaien

We draaien naar links als de linkse sensor een weg (lijn) detecteerd

  1. Linkse sensor detecteert lijn
  2. Rij verder totdat de linkse sensor geen lijn meer detecteert
  3. Draai naar links totdat de middelste sensor opnieuw een lijn detecteert
  4. Volg opnieuw de lijn
Links1 Links2 Links3

Rechtdoor rijden

We rijden rechtdoor als er links geen weg is.

  1. Rechtse sensor detecteert lijn
  2. Rij verder totdat de linkse sensor geen lijn meer detecteert
  3. Als de rechtse sensor geen lijn meer detecteert, maar de middelste nogwel, dan rij je rechtdoor
  4. Volg opnieuw de lijn
Rechtdoor

Naar rechts draaien

We draaien naar rechts als er enkel de mogelijkheid is om naar rechts te gaan.

  1. Rechtse sensor detecteert lijn
  2. Rij verder totdat rechtse sensor geen lijn detecteert
  3. Draai rechts tot middelste sensor opnieuw een lijn detecteert
  4. Volg opnieuw de lijn
Rechts

Omkeren

Komen we op het einde van een pad, dan keren we om.

  1. Geen enkele sensor detecteert een lijn.
  2. Draai links tot middelste sensor opnieuw een lijn ziet
  3. Volg opnieuw de lijn
Omkeren

Lijn volgen

  1. Linkse sensor detecteert lijn, middelste niet ==> licht naar rechts draaien
  2. Rechtse sensor detecteert lijn, middelste niet ==> licht naar links draaien
Lijn