64 lines
1.3 KiB
C
64 lines
1.3 KiB
C
|
#include <stdio.h>
|
||
|
|
#include <stdlib.h>
|
||
|
|
#include "vadpcm.h"
|
||
|
|
|
||
|
|
static void fmtchan(s32 size, u8 *p, s32 *data, s32 stride)
|
||
|
|
{
|
||
|
|
s32 i;
|
||
|
|
s32 c;
|
||
|
|
|
||
|
|
for (i = 0; i < size; i++)
|
||
|
|
{
|
||
|
|
c = *data++;
|
||
|
|
if (c < -0x7fff)
|
||
|
|
{
|
||
|
|
c = -0x7fff;
|
||
|
|
}
|
||
|
|
if (c >= 0x8000)
|
||
|
|
{
|
||
|
|
c = 0x7fff;
|
||
|
|
}
|
||
|
|
p[0] = c >> 8;
|
||
|
|
p[1] = c;
|
||
|
|
p += stride;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void writeout(FILE *outfd, s32 size, s32 *l_out, s32 *r_out, s32 chans)
|
||
|
|
{
|
||
|
|
static u8 obuf[0x1000];
|
||
|
|
s32 i;
|
||
|
|
|
||
|
|
switch (chans)
|
||
|
|
{
|
||
|
|
case 2:
|
||
|
|
fmtchan(size, obuf, l_out, chans * 2);
|
||
|
|
fmtchan(size, obuf + 2, r_out, chans * 2);
|
||
|
|
if (outfd != NULL)
|
||
|
|
{
|
||
|
|
if ((i = fwrite(obuf, 1, size * 4, outfd)) != size * 4)
|
||
|
|
{
|
||
|
|
fprintf(stderr, "write error %d\n", i);
|
||
|
|
exit(1);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
case 1:
|
||
|
|
fmtchan(size, obuf, l_out, 2);
|
||
|
|
if (outfd != NULL)
|
||
|
|
{
|
||
|
|
if ((i = fwrite(obuf, 1, size * 2, outfd)) != size * 2)
|
||
|
|
{
|
||
|
|
fprintf(stderr, "write error %d\n", i);
|
||
|
|
exit(1);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
default:
|
||
|
|
fprintf(stderr, "Error in number of channels\n");
|
||
|
|
exit(1);
|
||
|
|
}
|
||
|
|
}
|