AHRS Problems

Hello, my name is Lee and fairly new to coding. I'm trying to adjust the "Sparkfun 9DOF Razor IMU AHRS" to read the following:

Linear: Acceleration, Velocity and Position in the X,Y,Z axis.

Angular: Pitch, Roll, and Yaw angles and rates.

 

My end goal is to use this code for my research, which is to make an unstable, 3-engine UAV hover. Unfortunately, my angle readings are... frustrating.

I start the accelerometer on the table, see how the readings drift. (About 0.1 degrees per second)

Then I tilt the 9DOF stick about 90 degrees. (Only reading about 70 degrees instead of 90)

And then I returned the 9DOF stick to level. (The readings begin oscilliating between pos/neg 70 degrees, very slowly.)

 

My code so far is below. ... Please help me.

NineDOFCleanv2.zip

You need to be a member of diydrones to add comments!

Join diydrones

Email me when people reply –

Activity