Searched refs:GQGt (Results 1 – 2 of 2) sorted by relevance
129 initDiagonalMatrix(&fusion->GQGt[0][0], q00); in updateDt()130 initDiagonalMatrix(&fusion->GQGt[0][1], -q10); in updateDt()131 initDiagonalMatrix(&fusion->GQGt[1][0], -q01); in updateDt()132 initDiagonalMatrix(&fusion->GQGt[1][1], q11); in updateDt()381 mat33Add(&fusion->P[0][0], &fusion->GQGt[0][0]); in fusionPredict()382 mat33Add(&fusion->P[0][1], &fusion->GQGt[0][1]); in fusionPredict()383 mat33Add(&fusion->P[1][0], &fusion->GQGt[1][0]); in fusionPredict()384 mat33Add(&fusion->P[1][1], &fusion->GQGt[1][1]); in fusionPredict()
45 struct Mat33 GQGt[2][2]; member