Hallo , zoals sommigen misschien al vernomen hebben ben ik bezig aan een robot voor mijn eindwerk.
Ik maak nu gebruik van 4 CNY70 sensoren die ik vanvoor ga plaatsen , langs elkaar op een rij.
Deze dienen dus om een zwarte lijn de detecteren en te volgen. Maar ik loop vast in het programma. Het probleem zit hem denk in dat hij niet continu alle ingangen bekijkt opt de microcontroller. Ik denk dat als hij zijn eerste programma heeft , dat hij daarin blijft hangen. En het is dus de bedoeling dat de robot zijn weg volledig zelf doet wanneer ik draadloos een toets bedien.

Wanneer de sensor een lijn detecteert hebben we een logische 1 op de ingangen.
Ab en Ba zijn 2 variabelen die staan voor de PWM kanalen die uiteindelijk de motoren gaan sturen. Wanneer deze een '0' hebben wordt de motor volle bak gestuurd.

In de eerste If functie hier onder is dus de bedoeling dat de aller rechtste sensor ( pinc.3 ) een lijn detecteert. Dat betekent dus dat de robot zich links van de lijn bevind, en dat de linkse motor gestuurd moet worden zodat de robot zich op de lijn kan plaatsen.
Nu de PWM waardes zijn extreem genomen. In dit geval is het alles of niets , dat gaat natuurlijk nog verzacht worden.
Maar ik hoop dat mijn uitleg goed te begrijpen is. En dat jullie me verder zouden kunnen helpen.

Do
If Pinc.0 = 0 And Pinc.1 = 0 And Pinc.2 = 0 And Pinc.3 = 0 Then
Ab = 0
Ba = 0

If Pinc.0 = 0 And Pinc.1 = 0 And Pinc.2 = 0 And Pinc.3 = 1 Then
Ab = 0
Ba = 255

If Pinc.0 = 0 And Pinc.1 = 0 And Pinc.2 = 1 And Pinc.3 = 1 Then
Ab = 0
Ba = 255

If Pinc.0 = 0 And Pinc.1 = 1 And Pinc.2 = 1 And Pinc.3 = 0 Then
Ab = 0
Ba = 0

If Pinc.0 = 1 And Pinc.1 = 0 And Pinc.2 = 0 And Pinc.3 = 0 Then
Ab = 255
Ba = 0

If Pinc.0 = 1 And Pinc.1 = 1 And Pinc.2 = 0 And Pinc.3 = 0 Then
Ab = 255
Ba = 0

If Pinc.0 = 1 And Pinc.1 = 1 And Pinc.2 = 1 And Pinc.3 = 1 Then
Ab = 0
Ba = 255

End If
End If
End If
End If
End If
End If
End If
Loop

Ik snap er niet zoveel van, maar op het eerste gezicht heb je de end if verkeerd staan.
Zoals het nu staat wordt de 2e if regel pas uitgevoerd als de 1e voldoed.
En dat is tegenstrijdig omdat bijvoorbeeld pinc.3 nooit 2 states tegelijk kan aannemen.
Kortom probeer het eens zo;

En verder is het natuurlijk nog belangrijk hoe je de sensors hebt aagesloten en of je ze als input hebt geconfigureerd met de pull-upps aan....


Do
If Pinc.0 = 0 And Pinc.1 = 0 And Pinc.2 = 0 And Pinc.3 = 0 Then
 Ab = 0
 Ba = 0
end if

If Pinc.0 = 0 And Pinc.1 = 0 And Pinc.2 = 0 And Pinc.3 = 1 Then
 Ab = 0
 Ba = 255
end if

If Pinc.0 = 0 And Pinc.1 = 0 And Pinc.2 = 1 And Pinc.3 = 1 Then
 Ab = 0
 Ba = 255
end if

If Pinc.0 = 0 And Pinc.1 = 1 And Pinc.2 = 1 And Pinc.3 = 0 Then
 Ab = 0
 Ba = 0
end if

If Pinc.0 = 1 And Pinc.1 = 0 And Pinc.2 = 0 And Pinc.3 = 0 Then
 Ab = 255
 Ba = 0
end if

If Pinc.0 = 1 And Pinc.1 = 1 And Pinc.2 = 0 And Pinc.3 = 0 Then
 Ab = 255
 Ba = 0
end if

If Pinc.0 = 1 And Pinc.1 = 1 And Pinc.2 = 1 And Pinc.3 = 1 Then
 Ab = 0
 Ba = 255
end if

Loop

Dat ga ik eens proberen met die endif ertussen in.
En die sensoren die gaan eerst nog naar een opamp en en schmitt-trigger. Moet dan nog een pull-up weerstand? ik denk niet tot dat moet in dat geval. Maar ik ga nu onmiddelijk proberen of het werkt. Bedankt voor de snelle reactie.

Zo te zien hangt Ba alleen van Pinc.3 af, dus daar kan je alvast 2 IF's mee wegsnoeien.
Verder is er een ASM commando om een hele byte hoog en laag te maken, dat scheelt ook weer een paar insctructies.

Het programma werkt zo. Nog niet helemaal naar behoren , maar die andere fout zit in het hoofdprogramma denk ik.
En ik weet dat als ik Carnaugh zou toepassen op mijn waarheidstabel dat ik misschien wel een kortere oplossing zou hebben , maar daarom niet altijd simpelder om te begrijpen.