Lines Matching refs:akf
162 initKasa(&acc->akf);
270 static void accelCalUpdate(struct KasaFit *akf, struct AccelStillDet *asd) {
275 akf->acc_x += asd->mean_x;
276 akf->acc_y += asd->mean_y;
277 akf->acc_z += asd->mean_z;
278 akf->acc_w += w;
280 akf->acc_xx += asd->mean_x * asd->mean_x;
281 akf->acc_xy += asd->mean_x * asd->mean_y;
282 akf->acc_xz += asd->mean_x * asd->mean_z;
283 akf->acc_xw += asd->mean_x * w;
285 akf->acc_yy += asd->mean_y * asd->mean_y;
286 akf->acc_yz += asd->mean_y * asd->mean_z;
287 akf->acc_yw += asd->mean_y * w;
289 akf->acc_zz += asd->mean_z * asd->mean_z;
290 akf->acc_zw += asd->mean_z * w;
291 akf->nsamples += 1;
306 accelCalUpdate(&ac1->akf, asd);
313 accelCalUpdate(&ac1->akf, asd);
320 accelCalUpdate(&ac1->akf, asd);
327 accelCalUpdate(&ac1->akf, asd);
334 accelCalUpdate(&ac1->akf, asd);
341 accelCalUpdate(&ac1->akf, asd);
350 accelCalUpdate(&ac1->akf, asd);
356 // Check if akf->nsamples is zero.
357 if (ac1->akf.nsamples == 0) {
359 magKasaReset(&ac1->akf);
364 inv = 1.0f / ac1->akf.nsamples;
367 ac1->akf.acc_x *= inv;
368 ac1->akf.acc_y *= inv;
369 ac1->akf.acc_z *= inv;
370 ac1->akf.acc_w *= inv;
372 ac1->akf.acc_xx *= inv;
373 ac1->akf.acc_xy *= inv;
374 ac1->akf.acc_xz *= inv;
375 ac1->akf.acc_xw *= inv;
377 ac1->akf.acc_yy *= inv;
378 ac1->akf.acc_yz *= inv;
379 ac1->akf.acc_yw *= inv;
381 ac1->akf.acc_zz *= inv;
382 ac1->akf.acc_zw *= inv;
397 magKasaReset(&ac1->akf);
405 static int accEigenTest(struct KasaFit *akf, struct AccelGoodData *agd) {
408 S.elem[0][0] = akf->acc_xx - akf->acc_x * akf->acc_x;
409 S.elem[0][1] = S.elem[1][0] = akf->acc_xy - akf->acc_x * akf->acc_y;
410 S.elem[0][2] = S.elem[2][0] = akf->acc_xz - akf->acc_x * akf->acc_z;
411 S.elem[1][1] = akf->acc_yy - akf->acc_y * akf->acc_y;
412 S.elem[1][2] = S.elem[2][1] = akf->acc_yz - akf->acc_y * akf->acc_z;
413 S.elem[2][2] = akf->acc_zz - akf->acc_z * akf->acc_z;
521 magKasaFit(&acc->ac1[temp_gate].akf, &bias, &radius);
527 if (accEigenTest(&acc->ac1[temp_gate].akf,
564 magKasaReset(&acc->ac1[temp_gate].akf);
749 (unsigned)acc->ac1[0].agd.nle, (unsigned)acc->ac1[0].akf.nsamples);
758 (unsigned)acc->ac1[1].agd.nle, (unsigned)acc->ac1[1].akf.nsamples);
