71 lines
1.2 KiB
C
71 lines
1.2 KiB
C
|
#include "vadpcm.h"
|
||
|
|
|
||
|
|
/**
|
||
|
|
* Compute x / scale rounded to the nearest integer, with x.5 (fuzzy with an
|
||
|
|
* epsilon of 1e-7) rounding towards zero.
|
||
|
|
*/
|
||
|
|
s16 qsample(f32 x, s32 scale)
|
||
|
|
{
|
||
|
|
if (x > 0.0f)
|
||
|
|
{
|
||
|
|
return (s16) ((x / scale) + 0.4999999);
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
return (s16) ((x / scale) - 0.4999999);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/**
|
||
|
|
* Round all ('fs' many) values in 'e' to the nearest 'bits'-bit integer,
|
||
|
|
* outputting to 'ie'.
|
||
|
|
*/
|
||
|
|
void clamp(s32 fs, f32 *e, s32 *ie, s32 bits)
|
||
|
|
{
|
||
|
|
s32 i;
|
||
|
|
f32 ulevel;
|
||
|
|
f32 llevel;
|
||
|
|
|
||
|
|
llevel = -(f32) (1 << (bits - 1));
|
||
|
|
ulevel = -llevel - 1.0f;
|
||
|
|
for (i = 0; i < fs; i++)
|
||
|
|
{
|
||
|
|
if (e[i] > ulevel)
|
||
|
|
{
|
||
|
|
e[i] = ulevel;
|
||
|
|
}
|
||
|
|
if (e[i] < llevel)
|
||
|
|
{
|
||
|
|
e[i] = llevel;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (e[i] > 0.0f)
|
||
|
|
{
|
||
|
|
ie[i] = (s32) (e[i] + 0.5);
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
ie[i] = (s32) (e[i] - 0.5);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/**
|
||
|
|
* Clamp ix to within [llevel, ulevel].
|
||
|
|
*/
|
||
|
|
s32 clip(s32 ix, s32 llevel, s32 ulevel)
|
||
|
|
{
|
||
|
|
if (ix < llevel || ix > ulevel)
|
||
|
|
{
|
||
|
|
if (ix < llevel)
|
||
|
|
{
|
||
|
|
return llevel;
|
||
|
|
}
|
||
|
|
if (ix > ulevel)
|
||
|
|
{
|
||
|
|
return ulevel;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
return ix;
|
||
|
|
}
|