I'm currently adding a new user message to the INS application to output the covariance of the estimated values.
Just to check, I'm getting them from the diagonal elements of the gKalmanFilter.P, is that right ?
However, the algorithm maintains covariance of quaternion elements. Would someone could give me an idea on how to convert that to covariances for euler angles ?
Thanks in advance.