M & M färg sorterare (6 / 7 steg)
Steg 6: kod
Först packa upp mappen Bibliotek, och importera den till din arduino IDE bibliotek.
Det finns två koder som du behöver använda.
En heter Färg Läs, och detta är den du kommer att behöva ladda upp först, för att felsöka dina program för att ställa in rätt färger. Helt enkelt öppna upp seriella bildskärmen och samtidigt som din M & M, observera de RGB-värdena och ändra dem i den kod som motsvarar färgen på M & M du sätter in. när du gör ändringar i projektet som påverkar färgsensor, se till att du är kalibrera färgerna med hjälp av denna.
Andra är din faktiska projektet skiss, kallas MMs sorterare.
Följande är en beskrivning av hur varje del av koden fungerar:
- Det finns flera funktioner som initialisera färgsensor och uppsättning skalningsfaktor färger utifrån sin nuvarande miljö. Härifrån går huvudloop färgsensor, och baserat på dess frekvens behandlingen, det utvärderar villkorssatser att bestämma vilken färg på M & M är, och därför där det bör vara tappade bort. Inom varje villkorad kan du se ett unikt servo-läge och sedan en 1/6 full rotation för att släppa på M & M ner i hålet och ner i bilden.
Förklaringar av funktioner:
- TCS_Init(): Kartor stiften av färgsensor och befogenheter på färgsensor
- TSC_FilterColor (int Level01, int Level02): väljer filter färg (röd, grön eller blå)
- TSC_Count(): Ökar matrisen för att växla filter
- TSC_Callback(): Filter utan färger en i taget (föregångare till vitbalans)
- TSC_WB(): Bestämmer vad white är i nuvarande miljö
- ISR(TIMER2_COMPA_vect): Timer för servo
- Ogiltig servoInit(): Setup för servo
- void servoSetPosition (uint16_t highTimeMicroseconds): funktion som sätter servo till en plats
Med av toppen och arduino fortfarande ansluten till datorn, Använd monitorn följetong för att felsöka eventuella problem. Ändra till servo position och färg frekvenser.