woensdag 13 februari 2013

Programma Mindstorms


Het geschreven programma voor de robot die een lijn volgt en obstakels uit de weg slaat.

Bovenaan: een loop waarin wordt vastgelegd dat de robot de lijn moet volgen aan de hand van de lichtsensor. Hiervoor werd het contrast op kleiner dan 40 vastgelegd, en werden alternerend motor B en C aan en uit gezet om bij te sturen waar nodig. Hierdoor kan de robot probleemloos een willekeurig en niet-rechtlijnig pad volgen.

Onderaan: een loop waarin wordt vastgelegd dat de robot alles dat zich in zijn pad bevindt en dichter dan 17 centimeter in de buurt staat, wegslaat door middel van zijn arm. Als er niets in de weg staat, rijdt de robot gewoon door. Als er wat in minder dan 17 centimeter voor de infraroodsensor komt te staan, zal de robot zijn arm ongeveer 100 graden heen en weer bewegen tot het object uit de weg is.

1 opmerking: