void UKF_para(int L, float alpha, float beta, float kappa, float *gamma, float *wm, float *wc); void UKF_quat(float *quat, float P[4][4], float *gyr, float *mag_prev, float *mag_now, float gamma, float *wm, float *wc, int L, float dt);
