Lines Matching refs:fir
262 struct data_filter fir; member
499 memset(&stk->fir, 0x00, sizeof(stk->fir)); in stk8baxx_reg_init()
532 if (stk->fir.num < firlength) { in stk8baxx_low_pass()
533 stk->fir.raw[stk->fir.num][0] = acc_lp->x; in stk8baxx_low_pass()
534 stk->fir.raw[stk->fir.num][1] = acc_lp->y; in stk8baxx_low_pass()
535 stk->fir.raw[stk->fir.num][2] = acc_lp->z; in stk8baxx_low_pass()
536 stk->fir.sum[0] += acc_lp->x; in stk8baxx_low_pass()
537 stk->fir.sum[1] += acc_lp->y; in stk8baxx_low_pass()
538 stk->fir.sum[2] += acc_lp->z; in stk8baxx_low_pass()
539 stk->fir.num++; in stk8baxx_low_pass()
540 stk->fir.idx++; in stk8baxx_low_pass()
542 idx = stk->fir.idx % firlength; in stk8baxx_low_pass()
543 stk->fir.sum[0] -= stk->fir.raw[idx][0]; in stk8baxx_low_pass()
544 stk->fir.sum[1] -= stk->fir.raw[idx][1]; in stk8baxx_low_pass()
545 stk->fir.sum[2] -= stk->fir.raw[idx][2]; in stk8baxx_low_pass()
546 stk->fir.raw[idx][0] = acc_lp->x; in stk8baxx_low_pass()
547 stk->fir.raw[idx][1] = acc_lp->y; in stk8baxx_low_pass()
548 stk->fir.raw[idx][2] = acc_lp->z; in stk8baxx_low_pass()
549 stk->fir.sum[0] += acc_lp->x; in stk8baxx_low_pass()
550 stk->fir.sum[1] += acc_lp->y; in stk8baxx_low_pass()
551 stk->fir.sum[2] += acc_lp->z; in stk8baxx_low_pass()
552 stk->fir.idx++; in stk8baxx_low_pass()
554 if (abs(stk->fir.sum[0] / firlength) <= STK_ZG_COUNT) in stk8baxx_low_pass()
555 acc_lp->x = (stk->fir.sum[0] * zero_fir) / firlength; in stk8baxx_low_pass()
557 acc_lp->x = stk->fir.sum[0] / firlength; in stk8baxx_low_pass()
558 if (abs(stk->fir.sum[1] / firlength) <= STK_ZG_COUNT) in stk8baxx_low_pass()
559 acc_lp->y = (stk->fir.sum[1] * zero_fir) / firlength; in stk8baxx_low_pass()
561 acc_lp->y = stk->fir.sum[1] / firlength; in stk8baxx_low_pass()
562 if (abs(stk->fir.sum[2] / firlength) <= STK_ZG_COUNT) in stk8baxx_low_pass()
563 acc_lp->z = (stk->fir.sum[2] * zero_fir) / firlength; in stk8baxx_low_pass()
565 acc_lp->z = stk->fir.sum[2] / firlength; in stk8baxx_low_pass()
567 acc_lp->x = stk->fir.sum[0] / firlength; in stk8baxx_low_pass()
568 acc_lp->y = stk->fir.sum[1] / firlength; in stk8baxx_low_pass()
569 acc_lp->z = stk->fir.sum[2] / firlength; in stk8baxx_low_pass()