*/
#include <math.h>
+#include <assert.h>
#include "ardour/mtdm.h"
-MTDM::MTDM (int fsamp)
+MTDM::MTDM (int fsamp)
: _cnt (0)
, _inv (0)
+ , _peak (0)
{
int i;
Freq *F;
_freq [2].f = 3072;
_freq [3].f = 2560;
_freq [4].f = 2304;
- _freq [5].f = 2176;
+ _freq [5].f = 2176;
_freq [6].f = 1088;
_freq [7].f = 1312;
_freq [8].f = 1552;
int i;
float vip, vop, a, c, s;
Freq *F;
+ float peak = 0;
+ assert (len > 0);
while (len--)
{
vop = 0.0f;
vip = *ip++;
+ if (fabsf(vip) > peak) { peak = vip; }
for (i = 0, F = _freq; i < 13; i++, F++)
{
- a = 2 * (float) M_PI * (F->p & 65535) / 65536.0;
+ a = 2 * (float) M_PI * (F->p & 65535) / 65536.0;
F->p += F->f;
- c = cosf (a);
- s = -sinf (a);
+ c = cosf (a);
+ s = -sinf (a);
vop += (i ? 0.01f : 0.20f) * s;
F->xa += s * vip;
F->ya += c * vip;
- }
+ }
*op++ = vop;
if (++_cnt == 16)
{
}
}
+ if (peak > _peak) { _peak = vip; }
+
return 0;
}
k = (int)(floor (p + 0.5));
e = fabs (p - k);
if (e > _err) _err = e;
- if (e > 0.4) return 1;
+ if (e > 0.4) return 1;
d += m * (k & 1);
m *= 2;
- }
+ }
_del = 16 * d;
return 0;