When I use fRun_6DOF_GY_KALMAN, the yaw keeps drifting, when in stationary condition the gyroscope sensor frame is shown below:
I don't know if it is the reason for drifting? the output of the gyroscope is not around zero, or it is normal for gyroscope sensors?
Thanks!
ChuDaidai
Our Kalman filters are based on equations of motion and work best when the board is moving. If your board is stationary on a table top, then the gravity vector is expressed entirely in the Z-axis and there is no information in X&Y to help compute Z-axis offset. Yaw drift is eventually always going to occur in that case. Pick the board up, rotate it in free space a few seconds and put it back down, you'll see the yaw drift rate cut dramtically. Eventually it will creep back up.
That said, I don't see a clear drift in the plot you included, just offset. That is normal. Take a look at the angular velocity graph on "Dynamics" tab to see what the corrected angular rate looks like.
Hi
Thank you
I did as you told, and find that the yaw drift rate cut. However, it's not obvious. I put the board on the table in another way as follows:
And after a long time, the yaw drift isn't very obvious, and the angular velocity graph on "Dynamics" tab shows that the corrected angular rate walks sround zero.
Then comes another problem, the liner acceleration of z axis is bigger than x axis and y axis, it looks strange.
Thanks!
ChuDaidai
ChuDaidai,
There are several issues at play:
#2 means that any errors from any of the terms in #1 get distributed across modeled terms as a function of the various covariances used in the Kalman filter. So an error in a gyro could manifest as a residual error in an acceleration term.
Basically, my advice is to not over think it.
Mike