Searched refs:GQGt (Results 1 – 2 of 2) sorted by relevance
245 GQGt[0][0] = q00; // rad^2 in initFusion()246 GQGt[1][0] = -q10; in initFusion()247 GQGt[0][1] = -q01; in initFusion()248 GQGt[1][1] = q11; // (rad/s)^2 in initFusion()490 P = Phi*P*transpose(Phi) + GQGt; in predict()
61 mat<mat33_t, 2, 2> GQGt; variable