Hoekmeting met behulp van de gyroscoop, versnellingsmeter en Arduino (4 / 5 stap)

Stap 4: Code:

De code is een aanpassing van een code die ik op een ander project gebruikte. Er zijn waarschijnlijk enkele variabelen ongebruikte.
Ik gebruikte een bibliotheek de nunchuck om gegevens te lezen van http://todbot.com/blog/. Dank u Tod E. Kurt.
De commentaren op code zijn in het Portugees, zodra ik heb een vrije tijd, ik zal het vertalen.

De code output via de seriële lijn enkele nummers met dit patroon:

DT: w: teta: toonhoogte: filter_teta $
tijd: angular_velocity: gyro_angle:accel_angle:filtered_angle$

Dus kunt u deze waarden op een seriële terminal opslaan en uitzetten van een afbeelding of de hoek voor andere dingen gebruiken.

Als u nodig hebt enige uitleg over de code viel vrij om vragen.

De code is ziped. Gewoon unzipe, open en upload het aan uw arduino.