fir_pc.c

/* -----------------------------------------------------------------------------
 *  Copyright (C) 2021 daiteq s.r.o.                     http://www.daiteq.com
 *
 *  This program is distributed WITHOUT ANY WARRANTY; without even
 *  the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR
 *  PURPOSE.
 *
 * -----------------------------------------------------------------------------
 *  Filename    : fir_.c
 *  Authors     : Roman Bartosinski
 *  Description : FIR filter - reference desktop implementation
 *  Release     :
 *  Version     : 1.0
 *  Date        : 27.4.2021
 * -----------------------------------------------------------------------------
 */


#include <sys/time.h>
#include <unistd.h>
#include <stdlib.h>
#include <stdio.h>

/* test online fir filter for linear a ring buffers */
typedef char dataelm;
typedef int resultelm;

#define MAXFIRLENGTH      512
#define FIR_LENGTH        15    /* more accurately it is a number of FIR coefficients [c0,c1,c2,c3,c4,...]  */
#define DATA_LENGTH       1000000

#define m_print(x)    printf(x)


/* -------------------------------------------------------------------------- */
// experimental data
// signal (sinus 1kHz + sinus 15kHz, sampl.f=48kHz
const dataelm test_input[] = {
  0,55,-9,18,92,38,33,115,80,42,121,109,46,109,121,42,80,115,33,38,92,18,-9,55,0,
  -55,9,-18,-92,-38,-33,-115,-80,-42,-121,-109,-46,-109,-121,-42,-80,-115,-33,-38,
  -92,-18,9,-55,0,55,-9,18,92,38,33,115,80,42,121,109,46,109,121,42,80,115,33,38,
  92,18,-9,55,0,-55,9,-18,-92,-38,-33,-115,-80,-42,-121,-109,-46,-109,-121,-42,-80,
  -115,-33,-38,-92,-18,9,-55,0,55,-9,18,92,38,33,115,80,42,121,109,46,109,121,42,
  80,115,33,38,92,18,-9,55,0,-55,9,-18,-92,-38,-33,-115,-80,-42,-121,-109,-46,-109,
  -121,-42,-80,-115,-33,-38,-92,-18,9,-55,0,55,-9,18,92,38,33,115,80,42,121,109,
  46,109,121,42,80,115,33,38,92,18,-9,55,0,-55,9,-18,-92,-38,-33,-115,-80,-42,-121,
  -109,-46,-109,-121,-42,-80,-115,-33,-38,-92,-18,9,-55,0,55,-9,18,92,38,33,115,
  80,42,121,109,46,109,121,42,80,115,33,38,92,18,-9,55,0,-55,9,-18,-92,-38,-33,-115,
  -80,-42,-121,-109,-46,-109,-121,-42,-80,-115,-33,-38,-92,-18,9,-55,0,55,-9,18,
  92,38,33,115,80,42,121,109,46,109,121,42,80,115,33,38,92,18,-9,55,0,-55,9,-18,
  -92,-38,-33,-115,-80,-42,-121,-109,-46,-109,-121,-42,-80,-115,-33,-38,-92,-18,
  9,-55,0,55,-9,18,92,38,33,115,80,42,121,109,46,109,121,42,80,115,33,38,92,18,
  -9,55,0,-55,9,-18,-92,-38,-33,-115,-80,-42,-121,-109,-46,-109,-121,-42,-80,-115,
  -33,-38,-92,-18,9,-55,0,55,-9,18,92,38,33,115,80,42,121,109,46,109,121,42,80,115,
  33,38,92,18,-9,55,0,-55,9,-18,-92,-38,-33,-115,-80,-42,-121,-109,-46,-109,-121,
  -42,-80,-115,-33,-38,-92,-18,9,-55,0,55,-9,18,92,38,33,115,80,42,121,109,46,109,
  121,42,80,115,33,38,92,18,-9,55,0,-55,9,-18,-92,-38,-33,-115,-80,-42,-121,-109,
  -46,-109,-121,-42,-80,-115,-33,-38,-92,-18,9,-55,0,55,-9,18,92,38,33,115,80,42,
  121,109,46,109,121,42,80,115,33,38,92,18,-9,55,0,-55,9,-18,-92,-38,-33,-115,-80,
  -42,-121,-109,-46,-109,-121,-42,-80,-115,-33,-38,-92,-18,9,-55,0,55,-9,18,92,38,
  33,115,80,42,121,109,46,109,121,42,80,115,33,38,92,18,-9,55,0,-55,9,-18,-92,-38,
  -33,-115,-80,-42,-121,-109,-46,-109,-121,-42,-80,-115,-33,-38,-92,-18,9,-55,0,55,
  -9,18,92,38,33,115,80,42,121,109,46,109,121,42,80,115,33,38,92,18,-9,55,0,-55,9,
  -18,-92,-38,-33,-115,-80,-42,-121,-109,-46,-109,-121,-42,-80,-115,-33,-38,-92,-18,
  9,-55,0,55,-9,18,92,38,33,115,80,42,121,109,46,109,121,42,80,115,33,38,92,18,-9,
  55,0,-55,9,-18,-92,-38,-33,-115,-80,-42,-121,-109,-46,-109,-121,-42,-80,-115,-33,
  -38,-92,-18,9,-55,0,55,-9,18,92,38,33,115,80,42,121,109,46,109,121,42,80,115,33,
  38,92,18,-9,55,0,-55,9,-18,-92,-38,-33,-115,-80,-42,-121,-109,-46,-109,-121,-42,
  -80,-115,-33,-38,-92,-18,9,-55,0,55,-9,18,92,38,33,115,80,42,121,109,46,109,121,
  42,80,115,33,38,92,18,-9,55,0,-55,9,-18,-92,-38,-33,-115,-80,-42,-121,-109,-46,
  -109,-121,-42,-80,-115,-33,-38,-92,-18,9,-55,0,55,-9,18,92,38,33,115,80,42,121,
  109,46,109,121,42,80,115,33,38,92,18,-9,55,0,-55,9,-18,-92,-38,-33,-115,-80,-42,
  -121,-109,-46,-109,-121,-42,-80,-115,-33,-38,-92,-18,9,-55,0,55,-9,18,92,38,33,
  115,80,42,121,109,46,109,121,42,80,115,33,38,92,18,-9,55,0,-55,9,-18,-92,-38,-33,
  -115,-80,-42,-121,-109,-46,-109,-121,-42,-80,-115,-33,-38,-92,-18,9,-55,0,55,-9,
  18,92,38,33,115,80,42,121,109,46,109,121,42,80,115,33,38,92,18,-9,55,0,-55,9,-18,
  -92,-38,-33,-115,-80,-42,-121,-109,-46,-109,-121,-42,-80,-115,-33,-38,-92,-18,9,
  -55,0,55,-9,18,92,38,33,115,80,42,121,109,46,109,121,42,80,115,33,38,92,18,-9,55,
  0,-55,9,-18,-92,-38,-33,-115,-80,-42,-121,-109,-46,-109,-121,-42,-80,-115,-33,-38,
  -92,-18,9,-55,0,55,-9,18,92,38,33,115,80,42,121,109,46,109,121,42,80,115,33,38,92,
  18,-9,55,0,-55,9,-18,-92,-38,-33,-115,-80,-42,-121,-109,-46,-109,-121,-42,-80,
  -115,-33,-38,-92,-18,9,-55,0,55,-9,18,92,38,33,115,80,42,121,109,46,109,121,42,
  80,115,33,38,92,18,-9,55,0,-55,9,-18,-92,-38,-33,-115,-80,-42,-121,-109,-46,-109,-121,-42
};
#define TEST_INDATA_SIZE  (sizeof(test_input)/sizeof(dataelm))
// coefficients of FIR filter
const dataelm test_fircoef[] = {
  0,0,0,0,1,1,0,-2,-3,-3,0,6,14,20,23,20,14,6,0,-3,-3,-2,0,1,1
};
#define TEST_FIRCOEF_SIZE  (sizeof(test_fircoef)/sizeof(dataelm))
// extra longer vector for testing only
const dataelm test_fircoef_extra[] = {
  0,0,0,0,1,1,0,-2,-3,-3,0,6,14,20,23,20,14,6,0,-3,-3,-2,0,1,1,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
};

// filtered data for checking
const resultelm test_output[] = {
  0,0,0,0,0,0,-55,-156,-156,-119,-38,293,754,1365,2142,3087,3994,4926,5848,6579,
  7204,7706,8022,8244,8346,8244,8022,7706,7204,6579,5903,5082,4150,3206,2180,1072,
  0,-1072,-2180,-3206,-4150,-5082,-5903,-6579,-7204,-7706,-8022,-8244,-8346,-8244,
  -8022,-7706,-7204,-6579,-5903,-5082,-4150,-3206,-2180,-1072,0,1072,2180,3206,4150,
  5082,5903,6579,7204,7706,8022,8244,8346,8244,8022,7706,7204,6579,5903,5082,4150,
  3206,2180,1072,0,-1072,-2180,-3206,-4150,-5082,-5903,-6579,-7204,-7706,-8022,-8244,
  -8346,-8244,-8022,-7706,-7204,-6579,-5903,-5082,-4150,-3206,-2180,-1072,0,1072,
  2180,3206,4150,5082,5903,6579,7204,7706,8022,8244,8346,8244,8022,7706,7204,6579,
  5903,5082,4150,3206,2180,1072,0,-1072,-2180,-3206,-4150,-5082,-5903,-6579,-7204,
  -7706,-8022,-8244,-8346,-8244,-8022,-7706,-7204,-6579,-5903,-5082,-4150,-3206,
  -2180,-1072,0,1072,2180,3206,4150,5082,5903,6579,7204,7706,8022,8244,8346,8244,
  8022,7706,7204,6579,5903,5082,4150,3206,2180,1072,0,-1072,-2180,-3206,-4150,-5082,
  -5903,-6579,-7204,-7706,-8022,-8244,-8346,-8244,-8022,-7706,-7204,-6579,-5903,
  -5082,-4150,-3206,-2180,-1072,0,1072,2180,3206,4150,5082,5903,6579,7204,7706,8022,
  8244,8346,8244,8022,7706,7204,6579,5903,5082,4150,3206,2180,1072,0,-1072,-2180,
  -3206,-4150,-5082,-5903,-6579,-7204,-7706,-8022,-8244,-8346,-8244,-8022,-7706,
  -7204,-6579,-5903,-5082,-4150,-3206,-2180,-1072,0,1072,2180,3206,4150,5082,5903,
  6579,7204,7706,8022,8244,8346,8244,8022,7706,7204,6579,5903,5082,4150,3206,2180,
  1072,0,-1072,-2180,-3206,-4150,-5082,-5903,-6579,-7204,-7706,-8022,-8244,-8346,
  -8244,-8022,-7706,-7204,-6579,-5903,-5082,-4150,-3206,-2180,-1072,0,1072,2180,
  3206,4150,5082,5903,6579,7204,7706,8022,8244,8346,8244,8022,7706,7204,6579,5903,
  5082,4150,3206,2180,1072,0,-1072,-2180,-3206,-4150,-5082,-5903,-6579,-7204,-7706,
  -8022,-8244,-8346,-8244,-8022,-7706,-7204,-6579,-5903,-5082,-4150,-3206,-2180,
  -1072,0,1072,2180,3206,4150,5082,5903,6579,7204,7706,8022,8244,8346,8244,8022,
  7706,7204,6579,5903,5082,4150,3206,2180,1072,0,-1072,-2180,-3206,-4150,-5082,-5903,
  -6579,-7204,-7706,-8022,-8244,-8346,-8244,-8022,-7706,-7204,-6579,-5903,-5082,-4150,
  -3206,-2180,-1072,0,1072,2180,3206,4150,5082,5903,6579,7204,7706,8022,8244,8346,
  8244,8022,7706,7204,6579,5903,5082,4150,3206,2180,1072,0,-1072,-2180,-3206,-4150,
  -5082,-5903,-6579,-7204,-7706,-8022,-8244,-8346,-8244,-8022,-7706,-7204,-6579,-5903,
  -5082,-4150,-3206,-2180,-1072,0,1072,2180,3206,4150,5082,5903,6579,7204,7706,8022,
  8244,8346,8244,8022,7706,7204,6579,5903,5082,4150,3206,2180,1072,0,-1072,-2180,
  -3206,-4150,-5082,-5903,-6579,-7204,-7706,-8022,-8244,-8346,-8244,-8022,-7706,
  -7204,-6579,-5903,-5082,-4150,-3206,-2180,-1072,0,1072,2180,3206,4150,5082,5903,
  6579,7204,7706,8022,8244,8346,8244,8022,7706,7204,6579,5903,5082,4150,3206,2180,
  1072,0,-1072,-2180,-3206,-4150,-5082,-5903,-6579,-7204,-7706,-8022,-8244,-8346,
  -8244,-8022,-7706,-7204,-6579,-5903,-5082,-4150,-3206,-2180,-1072,0,1072,2180,
  3206,4150,5082,5903,6579,7204,7706,8022,8244,8346,8244,8022,7706,7204,6579,5903,
  5082,4150,3206,2180,1072,0,-1072,-2180,-3206,-4150,-5082,-5903,-6579,-7204,-7706,
  -8022,-8244,-8346,-8244,-8022,-7706,-7204,-6579,-5903,-5082,-4150,-3206,-2180,
  -1072,0,1072,2180,3206,4150,5082,5903,6579,7204,7706,8022,8244,8346,8244,8022,
  7706,7204,6579,5903,5082,4150,3206,2180,1072,0,-1072,-2180,-3206,-4150,-5082,-5903,
  -6579,-7204,-7706,-8022,-8244,-8346,-8244,-8022,-7706,-7204,-6579,-5903,-5082,
  -4150,-3206,-2180,-1072,0,1072,2180,3206,4150,5082,5903,6579,7204,7706,8022,8244,
  8346,8244,8022,7706,7204,6579,5903,5082,4150,3206,2180,1072,0,-1072,-2180,-3206,
  -4150,-5082,-5903,-6579,-7204,-7706,-8022,-8244,-8346,-8244,-8022,-7706,-7204,
  -6579,-5903,-5082,-4150,-3206,-2180,-1072,0,1072,2180,3206,4150,5082,5903,6579,
  7204,7706,8022,8244,8346,8244,8022,7706,7204,6579,5903,5082,4150,3206,2180,1072,
  0,-1072,-2180,-3206,-4150,-5082,-5903,-6579,-7204,-7706,-8022,-8244,-8346,-8244,
  -8022,-7706,-7204,-6579,-5903,-5082,-4150,-3206,-2180,-1072,0,1072,2180,3206,4150,
  5082,5903,6579,7204,7706,8022,8244,8346,8244,8022,7706,7204,6579,5903,5082,4150,
  3206,2180,1072,0,-1072,-2180,-3206,-4150,-5082,-5903,-6579,-7204,-7706,-8022,-8244,
  -8346,-8244,-8022,-7706,-7204,-6579,-5903,-5082,-4150,-3206,-2180,-1072,0,1072,
  2180,3206,4150,5082,5903,6579,7204,7706,8022,8244,8346,8244,8022,7706,7204,6579,
  5903,5082,4150,3206,2180,1072,0,-1072,-2180,-3206,-4150,-5082,-5903,-6579,-7204,
  -7706,-8022,-8244,-8346,-8244,-8022,-7706,-7204,-6579,-5903,-5082,-4150,-3206,
  -2180,-1072,0,1072,2180,3206,4150,5082,5903,6579,7204,7706,8022,8244,8346,8244,
  8022,7706,7204,6579,5903,5082,4150,3206,2180,1072,0,-1072,-2180,-3206,-4150,-5082,
  -5903,-6579,-7204,-7706,-8022,-8244,-8346,-8244,-8022,-7706,-7204,-6579,-5903,
  -5082,-4150,-3206,-2180,-1072,0,1072,2180,3206,4150,5082,5903,6579,7204,7706,8022,
  8244,8346,8244,8022,7706,7204,6579,5903,5082,4150,3206,2180,1072,0,-1072,-2180,
  -3206,-4150,-5082,-5903,-6579,-7204,-7706,-8022,-8244,-8346,-8244,-8022,-7706,
  -7204,-6579,-5903,-5082,-4150,-3206,-2180,-1072,0,1072,2180,3206,4150,5082,5903,
  6579,7204,7706,8022,8244,8346,8244,8022,7706,7204,6579,5903,5082,4150,3206,2180,
  1072,0,-1072,-2180,-3206,-4150,-5082,-5903,-6579,-7204,-7706,-8022,-8244,-8346,
  -8244,-8022,-7706,-7204,-6579,-5903,-5082,-4150,-3206,-2180,-1072,0,1072,2180,
  3206,4150,5082,5903,6579,7204,7706,8022,8244,8346,8244,8022,7706,7204,6579,5903,
  5082,4150,3206,2180,1072,0,-1072,-2180,-3206
};
#define TEST_OUTPUT_SIZE  (sizeof(test_output)/sizeof(resultelm))

dataelm dir_in_x[DATA_LENGTH+FIR_LENGTH];  /* INPUT DATA + zeros */
dataelm dir_in_c[FIR_LENGTH];             /* COEFFICIENTS */
resultelm dir_out_y[DATA_LENGTH];            /* OUTPUT DATA */

resultelm test_dir_output[DATA_LENGTH];
resultelm test_sec_output[DATA_LENGTH];



dataelm dir_x_mem[MAXFIRLENGTH];  // [x(n),x(n-1),x(n-2),x(n-3),...]
dataelm dir_c_mem[MAXFIRLENGTH];  // [c0,c1,c2,c3,c4,...]
unsigned mem_firlen;
unsigned rbuf_next;


/* ---------------------------------- */
/* online fir with linear buffer */
void fir_offline(resultelm *out_y, dataelm *in_x, int len_data, dataelm *in_c)
{
  for (unsigned j=0; j<len_data; ++j) {
    resultelm s = 0;
    for (unsigned i=0; i<FIR_LENGTH; ++i) {
      s += in_c[i] * in_x[i+j];
    }
    out_y[j] = s;
  }
}


/* ---------------------------------- */
/* online fir with linear buffer */
void fir_online_init(unsigned firlen, dataelm *in_c)
{
  if (firlen>MAXFIRLENGTH) {
    printf("!!! Too long FIR filter\n");
    firlen = MAXFIRLENGTH;
  }
  for (unsigned n=0;n<firlen;++n) {
    dir_x_mem[n] = 0;
    dir_c_mem[n] = in_c[n]; //firlen-n-1];
//m_print("#"); i_print(n); m_print(":"); i_print(dir_c_mem[n]); m_print("  ");
  }
  mem_firlen = firlen;
//NL;
}

resultelm fir_online(dataelm in_x)
{
  resultelm y = 0;
  for (unsigned i=mem_firlen-1;i>0;--i) {
    dir_x_mem[i] = dir_x_mem[i-1];  // x(n-1) = x'(n)
//m_print("#"); i_print(i); m_print(":"); i_print(dir_x_mem[i]); m_print("  ");
    y += dir_x_mem[i]*dir_c_mem[i];
  }
  dir_x_mem[0] = in_x;
  y+= dir_x_mem[0]*dir_c_mem[0];
//m_print("#0:"); i_print(dir_x_mem[0]); m_print("  ==>>  "); i_print(y); NL;
  return y;
}

/* ---------------------------------- */
/* online fir with ring buffer */
void fir_online_rbuf_init(unsigned firlen, dataelm *in_c)
{
  if (firlen>MAXFIRLENGTH) {
    m_print("!!! Too long FIR filter\n");
    firlen = MAXFIRLENGTH;
  }
  rbuf_next = firlen-1; // fill from back to front
  for (unsigned n=0;n<firlen;++n) {
    dir_x_mem[n] = 0;
    dir_c_mem[n] = in_c[n];
//m_print("#"); i_print(n); m_print(":"); i_print(dir_c_mem[n]); m_print("  ");
  }
  mem_firlen = firlen;
//NL;
}

resultelm fir_online_rbuf(dataelm in_x)
{
  resultelm y = 0;
  unsigned xi = rbuf_next;
  dir_x_mem[rbuf_next] = in_x;
  
  for (unsigned i=0;i<mem_firlen;++i) {
//m_print("#"); i_print(i); m_print(":"); i_print(dir_x_mem[i]); m_print("  ");
    y += dir_c_mem[i] * dir_x_mem[xi];
    if (++xi>=mem_firlen) xi=0;
  }
  if (rbuf_next) rbuf_next--;
  else rbuf_next = mem_firlen-1;
  return y;
}

/* ---------------------------------- */
unsigned bufsize;
unsigned bufmask;

/* online fir with aligned ring buffer */
void fir_online_align_rbuf_init(unsigned firlen, dataelm *in_c)
{
  if (firlen>MAXFIRLENGTH) {
    m_print("!!! Too long FIR filter\n");
    firlen = MAXFIRLENGTH;
  }
  unsigned p = 32 - __builtin_clz(firlen);
  mem_firlen = firlen;
  bufsize = 1<<p;
  bufmask = bufsize-1;
printf("FIRLEN = %d -> BUFSIZE = %d, mask=x%08X\n", mem_firlen, bufsize, bufmask);

  rbuf_next = bufsize-1; // fill from back to front

  for (unsigned n=0;n<bufsize;++n) {
    dir_x_mem[n] = 0;
  }
  for (unsigned n=0;n<firlen;++n) {
    dir_c_mem[n] = in_c[n];
//m_print("#"); i_print(n); m_print(":"); i_print(dir_c_mem[n]); m_print("  ");
  }
//NL;
}

resultelm fir_online_align_rbuf(dataelm in_x)
{
  resultelm y = 0;
  unsigned xi = rbuf_next;
  dir_x_mem[rbuf_next] = in_x;
  
  for (unsigned i=0;i<mem_firlen;++i) {
//printf("#%d -> %d : %d\n", i, xi, dir_x_mem[i]);
    y += dir_c_mem[i] * dir_x_mem[xi];
    xi = (xi+1)&bufmask;
  }
  rbuf_next = (rbuf_next-1)&bufmask;
  return y;
}

/* ========================================================================== */
/* print data */
void print_dir_data(const char *prefix, dataelm *pd, int len)
{
  printf("%s data:\n", prefix);
  for(int i=0;i<len;++i) {
    printf("  %d", *pd++);
  }
  printf("\n\n");
}

/* print results */
void print_results(const char *prefix, resultelm *pd, int len)
{
  printf("%s data @%08X:\n", prefix, pd);
  for(int i=0;i<len;++i) {
    printf("  %d",*pd++);
  }
  printf("\n\n");
}

/* comparing */
int check_results(unsigned len, resultelm *in, resultelm *sw)
{
  int res = 0;
  printf("Check results: ");
  for (unsigned p=0;p<len;++p) {
    if (in[p]!=sw[p]) {
#if PRINT_FAILED
      printf("\n failed pack #%d (%u @ %08X , %u @ %08X)", p, in[p], &in[p], sw[p], &sw[p]);
#endif /* PRINT_FAILED */
      res++;
    }
  }
  if (!res) {
    printf("  OK\n");
  } else { 
    printf(" FAILED %d\n", res);
  }

  return res;
}

struct timeval tval_before, tval_after, tval_result;
void sysregs_init(void) 
{
  gettimeofday(&tval_before, NULL);
}

void print_counters(const char *prefix) 
{
  gettimeofday(&tval_after, NULL);
  timersub(&tval_after, &tval_before, &tval_result);
  printf("%s - Time elapsed: %ld.%06ld\n", prefix ? prefix : "", (long int)tval_result.tv_sec, (long int)tval_result.tv_usec);
}


int main(int argc, char *argv) 
{
  printf("Test online FIR filter with %d coeffs on %d samples\n", FIR_LENGTH, DATA_LENGTH);

  dataelm   *pd  = (dataelm *)test_input;
  resultelm *pr1 = (resultelm *)test_dir_output;
  resultelm *pr2 = (resultelm *)test_sec_output;

  if (DATA_LENGTH>TEST_INDATA_SIZE) {
    pd = (dataelm *)malloc(DATA_LENGTH*sizeof(dataelm));
    pr1 = (resultelm *)malloc(DATA_LENGTH*sizeof(resultelm));
    pr2 = (resultelm *)malloc(DATA_LENGTH*sizeof(resultelm));
    if (!pd || !pr1 || !pr2) {
      printf("Malloc error\n");
      return -1;
    }
    for (unsigned i=0;i<DATA_LENGTH;++i) {
      unsigned r = rand();
      pd[i] = *(dataelm *)&r;
    }
  }
//  print_dir_data("IN-X", (dataelm *) &test_input[0], DATA_LENGTH);
//  print_dir_data("COEFFS", (dataelm *) &test_fircoef[0], FIR_LENGTH);

/* ---------------------------------- */
#if 1
  m_print("  * FIR online\n");
  fir_online_init(FIR_LENGTH, (dataelm *)test_fircoef);
  sysregs_init();
  for (unsigned i=0;i<DATA_LENGTH;++i) {
//printf("#%d : %d @%08X (%08X)\n", i, pd[i], &pd[i], &pr1[i]);
    pr1[i] = fir_online(pd[i]);
  }
  print_counters("NAIVE");
  #if PRINT_RESULTS
    print_results("OUT-Y", pr1, DATA_LENGTH);
  #endif /* PRINT_RESULTS */
#endif

  unsigned id = 0;
//  unsigned len = (TEST_INDATA_SIZE<TEST_OUTPUT_SIZE) ? TEST_INDATA_SIZE : TEST_OUTPUT_SIZE;
//  if (DATA_LENGTH<len) len = DATA_LENGTH;


/* ---------------------------------- */
#if 1
  m_print("  * FIR online rbuf\n");
  fir_online_rbuf_init(FIR_LENGTH, (dataelm *)test_fircoef_extra); //test_fircoef);
  id = 0;
  sysregs_init();
  for (unsigned i=0;i<DATA_LENGTH;++i) {
    //test_dir_output[id] 
//  m_print("#"); i_print(i); m_print(":"); i_print(test_input[id]);
    pr2[i] = fir_online_rbuf(pd[i]);
//  m_print(" -> "); i_print(test_swar_output[id]); NL;
    id++;
  }
  print_counters("RBUF");
  #if PRINT_RESULTS
    print_results("OUTPUT", pr2, len);
  #endif /* PRINT_RESULTS */
  check_results(DATA_LENGTH, pr1, pr2);
//  check_results(len, test_dir_output, test_swar_output);
#endif


/* ---------------------------------- */
#if 1
  m_print("  * FIR online aligned rbuf\n");
  fir_online_align_rbuf_init(FIR_LENGTH, (dataelm *)test_fircoef_extra);
  id = 0;
  sysregs_init();
  for (unsigned i=0;i<DATA_LENGTH;++i) {
    //test_dir_output[id] 
//  m_print("#"); i_print(i); m_print(":"); i_print(test_input[id]);
    pr2[i] = fir_online_align_rbuf(pd[i]);
//  m_print(" -> "); i_print(test_swar_output[id]); NL;
  }
  print_counters("RBUF");
  #if PRINT_RESULTS
    print_results("OUTPUT", pr2, len);
  #endif /* PRINT_RESULTS */
//  check_results(len, test_dir_output, test_output);
  check_results(DATA_LENGTH, pr1, pr2);
#endif
    
  return 0;
}