fixed NaN return values of the attitude in the imu message