Hi,
The file "gtrack_unit_start.c" of the gtrack of mmwave SDK 3.2,
I do not understand the initialization of error covariance matrix.
Why P_apriori_hat is diag([0,0,0.5,0.5,1,1])? Does there exist a more
detailed explanation or references?
Thank you
Liang-Yu
line 111
/* P_apriori_hat = eye(6) */
/* memcpy(inst->P_apriori_hat, eye6x6, sizeof(eye6x6)); */
/* P_apriori_hat = diag([0,0,0.5,0.5,1,1]) */
memset(inst->P_apriori_hat, 0, sizeof(inst->P_apriori_hat));
for(n = 0; n < GTRACK_STATE_VECTOR_SIZE; n++)
inst->P_apriori_hat[n*GTRACK_STATE_VECTOR_SIZE+n] = pInit[n];