98 lines
2.4 KiB
C
98 lines
2.4 KiB
C
/* halfband polyphase IIR filter
|
|
coefficients designed with halfband program:
|
|
https://gist.github.com/3be345efb6c97d757398#file-halfband-c
|
|
parameters: 16 coefficients, 0.1 transition band
|
|
stopband: ~-150dB
|
|
overall delay: ~8 samples
|
|
*/
|
|
|
|
#define copy(dst, src) memcpy(dst, src, sizeof(v2df)*8)
|
|
//#define copy(dst, src) _copy(dst, src)
|
|
|
|
// all should be initialized to 0
|
|
typedef struct {
|
|
v2df ao[8], bo[8];
|
|
v2df at[8], bt[8];
|
|
v2df x1, x2, x3;
|
|
int i;
|
|
} halfband_t;
|
|
|
|
INNER void
|
|
halfband_a(v2df a[8], v2df ao[8], v2df x0, v2df x2)
|
|
{
|
|
a[0] = x2 + (x0 - ao[0])*V(0.006185967461045014);
|
|
a[1] = ao[0] + (a[0] - ao[1])*V(0.054230780876613788);
|
|
a[2] = ao[1] + (a[1] - ao[2])*V(0.143280861566087270);
|
|
a[3] = ao[2] + (a[2] - ao[3])*V(0.262004358403954640);
|
|
a[4] = ao[3] + (a[3] - ao[4])*V(0.398796973552973666);
|
|
a[5] = ao[4] + (a[4] - ao[5])*V(0.545323651071132232);
|
|
a[6] = ao[5] + (a[5] - ao[6])*V(0.698736833646440347);
|
|
a[7] = ao[6] + (a[6] - ao[7])*V(0.862917812650502936);
|
|
}
|
|
|
|
INNER void
|
|
halfband_b(v2df b[8], v2df bo[8], v2df x1, v2df x3)
|
|
{
|
|
b[0] = x3 + (x1 - bo[0])*V(0.024499027624721819);
|
|
b[1] = bo[0] + (b[0] - bo[1])*V(0.094283481125726432);
|
|
b[2] = bo[1] + (b[1] - bo[2])*V(0.199699579426327684);
|
|
b[3] = bo[2] + (b[2] - bo[3])*V(0.328772348316831664);
|
|
b[4] = bo[3] + (b[3] - bo[4])*V(0.471167216679969414);
|
|
b[5] = bo[4] + (b[4] - bo[5])*V(0.621096845120503893);
|
|
b[6] = bo[5] + (b[5] - bo[6])*V(0.778944517099529166);
|
|
b[7] = bo[6] + (b[6] - bo[7])*V(0.952428157718303137);
|
|
}
|
|
|
|
INNER v2df
|
|
halfband(halfband_t *h, v2df x0)
|
|
{
|
|
v2df a[8], b[8];
|
|
halfband_a(a, h->ao, x0, h->x2);
|
|
halfband_b(b, h->bo, h->x1, h->x3);
|
|
copy(h->ao, h->at);
|
|
copy(h->bo, h->bt);
|
|
copy(h->at, a);
|
|
copy(h->bt, b);
|
|
h->x3 = h->x2;
|
|
h->x2 = h->x1;
|
|
h->x1 = x0;
|
|
return (a[7] + b[7])*V(0.5);
|
|
}
|
|
|
|
INNER v2df
|
|
decimate(halfband_t *h, v2df x0)
|
|
{
|
|
v2df c[8];
|
|
if ((h->i = !h->i)) {
|
|
halfband_b(c, h->bo, x0, h->x2);
|
|
copy(h->bo, c);
|
|
h->x2 = h->x1;
|
|
h->x1 = x0;
|
|
return V(0);
|
|
} else {
|
|
halfband_a(c, h->ao, x0, h->x2);
|
|
copy(h->ao, c);
|
|
h->x2 = h->x1;
|
|
h->x1 = x0;
|
|
return (c[7] + h->bo[7])*V(0.5);
|
|
}
|
|
}
|
|
|
|
// note: do not zero-stuff! send the input each time.
|
|
INNER v2df
|
|
interpolate(halfband_t *h, v2df x0)
|
|
{
|
|
v2df c[8];
|
|
if ((h->i = !h->i)) {
|
|
halfband_a(c, h->ao, x0, h->x1);
|
|
copy(h->ao, c);
|
|
return c[7];
|
|
} else {
|
|
halfband_b(c, h->bo, x0, h->x1);
|
|
copy(h->bo, c);
|
|
h->x1 = x0;
|
|
return c[7];
|
|
}
|
|
}
|
|
|
|
#undef copy
|