Arduino FPV headtracker (2 / 3 stap)

Stap 2: De Code

Hier is het!

De meerderheid van de code gaat met het krijgen van de hoek van de MPU6050, maar zodra dat gebeurd, is het gewoon een geval van limieten instellen voor de hoek:

hoek = constrain(angle_y,-90,45);

Kaart brengen van het tot het volledige scala van de PWM-pin:

angleOut = kaart (hoek, - 90,45,0,255)

En te verzenden naar de PWM-pin:

analogueWrite (wiperPin, angleOut);