void BlockX_i(
OUT EXILIB_tData_1 *bOutData
) {
int i = 0;
int sum = 0;
int r = _loll(CSL_tscRead()) & 0x00FF;
//for (i = 0; i < BLOCKX_N_VALS; i++) {
for (i = 0; i < EXILIB_N_VALS_1; i++) {
bOutData->val[i] = r * (i + 1); //fill data
sum += bOutData->val[i];
}
DEBUG(
printf("X: Buffer sum %d\n", sum);
)
}
void DSP_QMFA_process(DSP_QMFA_bank_t *QMFA_bank_obj)
{
sint32 i,j;
uint32 * restrict filter = (uint32 *)QMFA_bank_obj->flt_ptr;
uint32 * restrict data_ptr = (uint32 *)(QMFA_bank_obj->data_in_buffer + 0); /*input */
uint32 L = QMFA_bank_obj->blk_len/2;
uint32 M = FILT_LEN/2;
uint32 * restrict hist_rd_ptr0 = (uint32 *)QMFA_bank_obj->history[0];
uint32 * restrict hist_rd_ptr1 = (uint32 *)QMFA_bank_obj->history[1];
uint32 * restrict hist_wr_ptr0 = (uint32 *)QMFA_bank_obj->history[0];
uint32 * restrict hist_wr_ptr1 = (uint32 *)QMFA_bank_obj->history[1];
uint32 * restrict data_out_lo_ptr = (uint32 *)QMFA_bank_obj->data_out_LO_ptr;
uint32 * restrict data_out_hi_ptr = (uint32 *)QMFA_bank_obj->data_out_HI_ptr;
for(i=0;i<L;++i)
{
/*Iterations 0 to (L-1) produce the current block of output*/
register uint32 o0,o1,out0,out1;
register __int40_t accum0l,accum1l,accum0r,accum1r; /*accumulators for polyphase filter commponent 0 and 1*/
register long long temp;
accum0l = 0;accum0r = 0;
accum1l = 0;accum1r = 0;
uint32 *dptr = data_ptr + 2*i + 1;
uint32 *fptr = filter;
#pragma MUST_ITERATE( 1)
for(j=0;j<QMFA_bank_obj->iter_count[i];++j)
{
/* Limit for j is beginning at the rightmost overlap
position to the leftmost overlap position*/
register uint32 d0,d1;
register uint32 filt_coef10 = *fptr++; /*Loads the decimated filter coeficients*/
register uint32 filt_coef0 = _packh2(filt_coef10,filt_coef10); /*in the correct order i.e. with reversal*/
register uint32 filt_coef1 = _pack2(filt_coef10,filt_coef10); /*in the correct order i.e. with reversal*/
d1 = *dptr--;//data_ptr1[(2*(i-j))]; /*load the data right to left with 1:2 split*/
d0 = *dptr--;//data_ptr0[(2*(i-j))]; /*load the data right to left with 1:2 split*/
temp = _mpy2ll(d0, filt_coef0);
accum0l = _lsadd(_loll(temp), accum0l); accum0r = _lsadd(_hill(temp), accum0r);
temp = _mpy2ll(d1, filt_coef1);
accum1l = _lsadd(_loll(temp), accum1l); accum1r = _lsadd(_hill(temp), accum1r);
}
o0 = _pack2( _sat((accum0r + 16384)>>15), _sat((accum0l + 16384)>>15));
o1 = _pack2( _sat((accum1r + 16384)>>15), _sat((accum1l + 16384)>>15));
o0 = _add2(o0, hist_rd_ptr0[i]); /*add history sample filter 0 overlap add*/
o1 = _add2(o1, hist_rd_ptr1[i]); /*add history sample filter 1 overlap add*/
out0 = _add2(o0,o1) ;
data_out_lo_ptr[i] = out0; /*out bank0 is out0 + out1*/
out1 = _sub2(o0,o1) ;
data_out_hi_ptr[i] = out1; /*out bank1 is out0 - out1*/
}
for(i=L;i<L+M-1;++i)
{
/*Iterations L to (L + (M-1) -1) produce the
history for overlap add for next block*/
register uint32 o0,o1;
register __int40_t accum0l,accum1l,accum0r,accum1r; /*accumulators for polyphase filter commponent 0 and 1*/
register long long temp;
accum0l = 0;accum0r = 0;
accum1l = 0;accum1r = 0;
uint32 *dptr = data_ptr + 2*(L-1) + 1;
uint32 *fptr = filter + (i-L+1);
#pragma MUST_ITERATE( 1)
for(j=0;j<QMFA_bank_obj->iter_count[i];++j)
{
/*same logic for j starting at the
rightmost point of overlap to leftmost*/
register sint32 d0,d1;
register sint32 filt_coef10 = *fptr++;; /*Loads the decimated filter coeficients*/
register sint32 filt_coef0 = _packh2(filt_coef10,filt_coef10); /*in the correct order i.e. with reversal*/
register sint32 filt_coef1 = _pack2(filt_coef10,filt_coef10); /*in the correct order i.e. with reversal*/
d1 = *dptr--; /*load the data right to left with 1:2 split*/
d0 = *dptr--; /*load the data right to left with 1:2 split*/
temp = _mpy2ll(d0, filt_coef0);
accum0l = _lsadd(_loll(temp), accum0l); accum0r = _lsadd(_hill(temp), accum0r);
temp = _mpy2ll(d1, filt_coef1);
accum1l = _lsadd(_loll(temp), accum1l); accum1r = _lsadd(_hill(temp), accum1r);
}
o0 = _pack2( _sat((accum0r + 16384)>>15), _sat((accum0l + 16384)>>15));
o1 = _pack2( _sat((accum1r + 16384)>>15), _sat((accum1l + 16384)>>15));
o0 = _add2(o0, hist_rd_ptr0[i]); /*add history sample filter 0 overlap add*/
o1 = _add2(o1, hist_rd_ptr1[i]); /*add history sample filter 1 overlap add*/
hist_wr_ptr0[(i-L)] = o0; /* write out overlap add history history filter 0*/
hist_wr_ptr1[(i-L)] = o1; /* write out overlap add history history filter 1*/
}
return;
}
void DSP_QMFS_process(DSP_QMFS_bank_t *QMFS_bank_obj)
{
sint32 i,j;
uint32 * restrict filter = (uint32 *)QMFS_bank_obj->flt_ptr;
uint32 * restrict data_ptr0 = (uint32 *)QMFS_bank_obj->data_in_buffer_LO; /*input buffer bank0*/
uint32 * restrict data_ptr1 = (uint32 *)QMFS_bank_obj->data_in_buffer_HI; /*input buffer bank0*/
sint32 L = QMFS_bank_obj->blk_len;
sint32 M = FILT_LEN/2;
uint32 * restrict hist_rd_ptr0 = (uint32 *)QMFS_bank_obj->history[0];
uint32 * restrict hist_rd_ptr1 = (uint32 *)QMFS_bank_obj->history[1];
uint32 * restrict hist_wr_ptr0 = (uint32 *)QMFS_bank_obj->history[0];
uint32 * restrict hist_wr_ptr1 = (uint32 *)QMFS_bank_obj->history[1];
uint32 * restrict dataout_ptr = (uint32 *)QMFS_bank_obj->data_out_ptr;
for(i=0;i<L;++i)
{
/* iteration 0 to (L-1) produces the L outputs of the current block*/
register uint32 t0,t1,out;
register __int40_t accum0l, accum1l, accum0r, accum1r;
register long long temp;
accum0l = 0; accum0r = 0;
accum1l = 0; accum1r = 0;
uint32 *dptr0 = data_ptr0 + i ;
uint32 *dptr1 = data_ptr1 + i ;
uint32 *fptr = filter;
#pragma MUST_ITERATE( 1)
for(j=0; j<QMFS_bank_obj->iter_count[i];++j)
{
/*j indexes from the point of rightmost overlap to the leftmost overlap position */
register uint32 d0,d1;
register uint32 filt_coef10 = *fptr++; /*Loads the decimated filter coeficients*/
register uint32 filt_coef0 = _pack2(filt_coef10,filt_coef10); /*in the correct order i.e. with reversal*/
register uint32 filt_coef1 = _packh2(filt_coef10,filt_coef10); /*in the correct order i.e. with reversal*/
d1 = *dptr1--;//data_ptr1[(2*(i-j))]; /*load the data right to left with 1:2 split*/
d0 = *dptr0--;//data_ptr0[(2*(i-j))]; /*load the data right to left with 1:2 split*/
t0 = _add2(d0,d1);
t1 = _sub2(d0,d1);
temp = _mpy2ll(t0, filt_coef0);
accum0l = _lsadd(_loll(temp), accum0l); accum0r = _lsadd(_hill(temp), accum0r);
temp = _mpy2ll(t1, filt_coef1);
accum1l = _lsadd(_loll(temp), accum1l); accum1r = _lsadd(_hill(temp), accum1r);
}
t0 = _pack2( _sat((accum0l + 16384)>>15), _sat((accum0l + 16384)>>15));
t1 = _pack2( _sat((accum1l + 16384)>>15), _sat((accum1l + 16384)>>15));
out = _add2(t0, hist_rd_ptr0[i]);
dataout_ptr[2*i + 0] = out; /*filter 0 produces the odd output*/
out = _add2(t1, hist_rd_ptr1[i]);
dataout_ptr[2*i + 1] = out; /*filter 1 produces the even output*/
}
for(i=L;i<L+M-1;++i)
{
register uint32 t0,t1,out;
register __int40_t accum0l, accum1l, accum0r, accum1r;
register long long temp;
accum0l = 0; accum0r = 0;
accum1l = 0; accum1r = 0;
uint32 *dptr0 = data_ptr0 + (L-1) ;
uint32 *dptr1 = data_ptr1 + (L-1) ;
uint32 *fptr = filter + (i-L+1);
#pragma MUST_ITERATE( 1)
for(j=0; j<QMFS_bank_obj->iter_count[i];++j)
{
/*same logic for j starting at the
rightmost point of overlap to leftmost*/
register sint32 d0,d1;
register sint32 filt_coef10 = *fptr++;; /*Loads the decimated filter coeficients*/
register sint32 filt_coef0 = _pack2(filt_coef10,filt_coef10); /*in the correct order i.e. with reversal*/
register sint32 filt_coef1 = _packh2(filt_coef10,filt_coef10); /*in the correct order i.e. with reversal*/
d1 = *dptr1--; /*load the data right to left with 1:2 split*/
d0 = *dptr0--; /*load the data right to left with 1:2 split*/
t0 = _add2(d0,d1);
t1 = _sub2(d0,d1);
temp = _mpy2ll(t0, filt_coef0);
accum0l = _lsadd(_loll(temp), accum0l); accum0r = _lsadd(_hill(temp), accum0r);
temp = _mpy2ll(t1, filt_coef1);
accum1l = _lsadd(_loll(temp), accum1l); accum1r = _lsadd(_hill(temp), accum1r);
}
t0 = _pack2( _sat((accum0l + 16384)>>15), _sat((accum0l + 16384)>>15));
t1 = _pack2( _sat((accum1l + 16384)>>15), _sat((accum1l + 16384)>>15));
out = _add2(t0, hist_rd_ptr0[i]);
hist_wr_ptr0[(i-L)] = out; /* write out overlap add history history filter 0*/
out = _add2(t1, hist_rd_ptr1[i]);
hist_wr_ptr1[(i-L)] = out; /* write out overlap add history history filter 1*/
}
return;
}
unsigned int row4_54, row5_54;
unsigned int mask1_44, mask2_44, mask3_44;
unsigned int mask4_44, mask5_44;
const short *restrict in0;
const short *restrict in1;
const short *restrict in2;
const short *restrict in3;
const short *restrict in4;
/* -------------------------------------------------------------------- */
/* Load mask values (reverse order for mask rotation) */
/* -------------------------------------------------------------------- */
mask_temp = _mem8_const ((void *) &mask_ptr[21]);
mask1_3210 = _itoll(_packlh2(_loll(mask_temp),_loll(mask_temp)),
_packlh2(_hill(mask_temp),_hill(mask_temp)));
mask1_44 = _pack2((int) mask_ptr[20], (int) mask_ptr[20]);
mask_temp = _mem8_const ((void *) &mask_ptr[16]);
mask2_3210 = _itoll(_packlh2(_loll(mask_temp),_loll(mask_temp)),
_packlh2(_hill(mask_temp),_hill(mask_temp)));
mask2_44 = _pack2((int) mask_ptr[15], (int) mask_ptr[15]);
mask_temp = _mem8_const ((void *) &mask_ptr[11]);
mask3_3210 = _itoll(_packlh2(_loll(mask_temp),_loll(mask_temp)),
_packlh2(_hill(mask_temp),_hill(mask_temp)));
mask3_44 = _pack2((int) mask_ptr[10], (int) mask_ptr[10]);
mask_temp = _mem8_const ((void *) &mask_ptr[6]);
mask4_3210 = _itoll(_packlh2(_loll(mask_temp),_loll(mask_temp)),
