Stap 2: Programmeren 2 Actuators
Nu dat alles is aangesloten kunnen we de codes uploaden. De code zal Lees de schakelopties en verlengen of intrekken van de actuatoren. Terwijl de aandrijvers bewegende zijn zal zij gelijke positie behouden. Als u een lading op een plaatst, zal de andere vertragen om dit te koppelen. Zie het codefragment hieronder, ervoor zorgen dat de jumpers op de MegaMoto aan de juiste pinnen zijn ingesteld en dat de hall-effect-sensoren zijn gekoppeld aan de juiste pinnen.
#define amp0 A5 #define PWMA0 6 #define PWMB0 5 #define enable0 13 //pins for first MegaMoto #define amp1 A4 #define PWMA1 9 #define PWMB1 10 #define enable1 12 //pins for second MegaMoto #define hall0 52 #define hall1 53 //interrupt pins for hall effect sensors #define switch0 4 //Up button #define switch1 7 //Down button
De code is goed commentaar om te zien hoe alles werkt. Bijgevoegd is de volledige code, raadpleegt u de volgende stappen om te zien van de details van de code.