2011-08-14 17:46:02 +04:00
|
|
|
/**
|
2012-10-09 07:02:04 +04:00
|
|
|
* FreeRDP: A Remote Desktop Protocol Implementation
|
2011-08-14 17:46:02 +04:00
|
|
|
* Digital Sound Processing
|
|
|
|
*
|
|
|
|
* Copyright 2010-2011 Vic Lee
|
|
|
|
*
|
|
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
|
|
|
* you may not use this file except in compliance with the License.
|
|
|
|
* You may obtain a copy of the License at
|
|
|
|
*
|
|
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
|
|
*
|
|
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
|
|
* See the License for the specific language governing permissions and
|
|
|
|
* limitations under the License.
|
|
|
|
*/
|
|
|
|
|
2012-08-15 01:09:01 +04:00
|
|
|
#ifdef HAVE_CONFIG_H
|
|
|
|
#include "config.h"
|
|
|
|
#endif
|
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
#include <stdio.h>
|
|
|
|
#include <stdlib.h>
|
|
|
|
#include <string.h>
|
2012-08-15 01:09:01 +04:00
|
|
|
|
2012-11-22 05:21:08 +04:00
|
|
|
#include <winpr/crt.h>
|
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
#include <freerdp/types.h>
|
2013-02-20 02:47:55 +04:00
|
|
|
|
|
|
|
#include <freerdp/codec/dsp.h>
|
2011-08-14 17:46:02 +04:00
|
|
|
|
2013-02-27 02:54:16 +04:00
|
|
|
/**
|
|
|
|
* Microsoft Multimedia Standards Update
|
|
|
|
* http://download.microsoft.com/download/9/8/6/9863C72A-A3AA-4DDB-B1BA-CA8D17EFD2D4/RIFFNEW.pdf
|
|
|
|
*/
|
|
|
|
|
2012-05-09 12:15:23 +04:00
|
|
|
static void freerdp_dsp_resample(FREERDP_DSP_CONTEXT* context,
|
2012-10-09 11:01:37 +04:00
|
|
|
const BYTE* src, int bytes_per_sample,
|
2012-10-09 11:26:39 +04:00
|
|
|
UINT32 schan, UINT32 srate, int sframes,
|
|
|
|
UINT32 rchan, UINT32 rrate)
|
2011-08-14 17:46:02 +04:00
|
|
|
{
|
2012-10-09 11:01:37 +04:00
|
|
|
BYTE* dst;
|
|
|
|
BYTE* p;
|
2011-08-14 17:46:02 +04:00
|
|
|
int rframes;
|
|
|
|
int rsize;
|
|
|
|
int i, j;
|
|
|
|
int n1, n2;
|
|
|
|
int sbytes, rbytes;
|
|
|
|
|
|
|
|
sbytes = bytes_per_sample * schan;
|
|
|
|
rbytes = bytes_per_sample * rchan;
|
|
|
|
rframes = sframes * rrate / srate;
|
|
|
|
rsize = rbytes * rframes;
|
2012-05-22 00:01:24 +04:00
|
|
|
|
|
|
|
if (rsize > (int) context->resampled_maxlength)
|
2012-05-09 12:15:23 +04:00
|
|
|
{
|
|
|
|
context->resampled_maxlength = rsize + 1024;
|
2012-10-09 11:01:37 +04:00
|
|
|
context->resampled_buffer = (BYTE*) realloc(context->resampled_buffer, context->resampled_maxlength);
|
2012-05-09 12:15:23 +04:00
|
|
|
}
|
|
|
|
dst = context->resampled_buffer;
|
2011-08-14 17:46:02 +04:00
|
|
|
|
|
|
|
p = dst;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
for (i = 0; i < rframes; i++)
|
|
|
|
{
|
|
|
|
n1 = i * srate / rrate;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
if (n1 >= sframes)
|
|
|
|
n1 = sframes - 1;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
n2 = (n1 * rrate == i * srate || n1 == sframes - 1 ? n1 : n1 + 1);
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
for (j = 0; j < rbytes; j++)
|
|
|
|
{
|
|
|
|
/* Nearest Interpolation, probably the easiest, but works */
|
|
|
|
*p++ = (i * srate - n1 * rrate > n2 * rrate - i * srate ?
|
|
|
|
src[n2 * sbytes + (j % sbytes)] :
|
|
|
|
src[n1 * sbytes + (j % sbytes)]);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-05-09 12:15:23 +04:00
|
|
|
context->resampled_frames = rframes;
|
|
|
|
context->resampled_size = rsize;
|
2011-08-14 17:46:02 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* Microsoft IMA ADPCM specification:
|
|
|
|
*
|
|
|
|
* http://wiki.multimedia.cx/index.php?title=Microsoft_IMA_ADPCM
|
|
|
|
* http://wiki.multimedia.cx/index.php?title=IMA_ADPCM
|
|
|
|
*/
|
|
|
|
|
2012-10-09 11:01:37 +04:00
|
|
|
static const INT16 ima_step_index_table[] =
|
2011-08-14 17:46:02 +04:00
|
|
|
{
|
|
|
|
-1, -1, -1, -1, 2, 4, 6, 8,
|
|
|
|
-1, -1, -1, -1, 2, 4, 6, 8
|
|
|
|
};
|
|
|
|
|
2012-10-09 11:01:37 +04:00
|
|
|
static const INT16 ima_step_size_table[] =
|
2011-08-14 17:46:02 +04:00
|
|
|
{
|
|
|
|
7, 8, 9, 10, 11, 12, 13, 14, 16, 17,
|
|
|
|
19, 21, 23, 25, 28, 31, 34, 37, 41, 45,
|
|
|
|
50, 55, 60, 66, 73, 80, 88, 97, 107, 118,
|
|
|
|
130, 143, 157, 173, 190, 209, 230, 253, 279, 307,
|
|
|
|
337, 371, 408, 449, 494, 544, 598, 658, 724, 796,
|
|
|
|
876, 963, 1060, 1166, 1282, 1411, 1552, 1707, 1878, 2066,
|
|
|
|
2272, 2499, 2749, 3024, 3327, 3660, 4026, 4428, 4871, 5358,
|
|
|
|
5894, 6484, 7132, 7845, 8630, 9493, 10442, 11487, 12635, 13899,
|
|
|
|
15289, 16818, 18500, 20350, 22385, 24623, 27086, 29794, 32767
|
|
|
|
};
|
|
|
|
|
2012-10-09 11:01:37 +04:00
|
|
|
static UINT16 dsp_decode_ima_adpcm_sample(ADPCM* adpcm,
|
|
|
|
int channel, BYTE sample)
|
2011-08-14 17:46:02 +04:00
|
|
|
{
|
2012-10-09 11:26:39 +04:00
|
|
|
INT32 ss;
|
|
|
|
INT32 d;
|
2011-08-14 17:46:02 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
ss = ima_step_size_table[adpcm->ima.last_step[channel]];
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
d = (ss >> 3);
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
if (sample & 1)
|
|
|
|
d += (ss >> 2);
|
|
|
|
if (sample & 2)
|
|
|
|
d += (ss >> 1);
|
|
|
|
if (sample & 4)
|
|
|
|
d += ss;
|
|
|
|
if (sample & 8)
|
|
|
|
d = -d;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
d += adpcm->ima.last_sample[channel];
|
2011-08-14 17:46:02 +04:00
|
|
|
|
|
|
|
if (d < -32768)
|
|
|
|
d = -32768;
|
|
|
|
else if (d > 32767)
|
|
|
|
d = 32767;
|
|
|
|
|
2012-10-09 11:01:37 +04:00
|
|
|
adpcm->ima.last_sample[channel] = (INT16) d;
|
2011-08-14 17:46:02 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
adpcm->ima.last_step[channel] += ima_step_index_table[sample];
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
if (adpcm->ima.last_step[channel] < 0)
|
|
|
|
adpcm->ima.last_step[channel] = 0;
|
|
|
|
else if (adpcm->ima.last_step[channel] > 88)
|
|
|
|
adpcm->ima.last_step[channel] = 88;
|
2011-08-14 17:46:02 +04:00
|
|
|
|
2012-10-09 11:01:37 +04:00
|
|
|
return (UINT16) d;
|
2011-08-14 17:46:02 +04:00
|
|
|
}
|
|
|
|
|
2012-05-09 12:15:23 +04:00
|
|
|
static void freerdp_dsp_decode_ima_adpcm(FREERDP_DSP_CONTEXT* context,
|
2012-10-09 11:01:37 +04:00
|
|
|
const BYTE* src, int size, int channels, int block_size)
|
2011-08-14 17:46:02 +04:00
|
|
|
{
|
2012-10-09 11:01:37 +04:00
|
|
|
BYTE* dst;
|
|
|
|
BYTE sample;
|
|
|
|
UINT16 decoded;
|
2012-10-09 11:26:39 +04:00
|
|
|
UINT32 out_size;
|
2011-08-14 17:46:02 +04:00
|
|
|
int channel;
|
|
|
|
int i;
|
|
|
|
|
2012-05-09 12:15:23 +04:00
|
|
|
out_size = size * 4;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-09 12:15:23 +04:00
|
|
|
if (out_size > context->adpcm_maxlength)
|
|
|
|
{
|
|
|
|
context->adpcm_maxlength = out_size + 1024;
|
2012-10-09 07:21:26 +04:00
|
|
|
context->adpcm_buffer = realloc(context->adpcm_buffer, context->adpcm_maxlength);
|
2012-05-09 12:15:23 +04:00
|
|
|
}
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-09 12:15:23 +04:00
|
|
|
dst = context->adpcm_buffer;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
while (size > 0)
|
|
|
|
{
|
|
|
|
if (size % block_size == 0)
|
|
|
|
{
|
2012-10-09 11:01:37 +04:00
|
|
|
context->adpcm.ima.last_sample[0] = (INT16) (((UINT16)(*src)) | (((UINT16)(*(src + 1))) << 8));
|
|
|
|
context->adpcm.ima.last_step[0] = (INT16) (*(src + 2));
|
2011-08-14 17:46:02 +04:00
|
|
|
src += 4;
|
|
|
|
size -= 4;
|
2012-05-09 12:15:23 +04:00
|
|
|
out_size -= 16;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
if (channels > 1)
|
|
|
|
{
|
2012-10-09 11:01:37 +04:00
|
|
|
context->adpcm.ima.last_sample[1] = (INT16) (((UINT16)(*src)) | (((UINT16)(*(src + 1))) << 8));
|
|
|
|
context->adpcm.ima.last_step[1] = (INT16) (*(src + 2));
|
2011-08-14 17:46:02 +04:00
|
|
|
src += 4;
|
|
|
|
size -= 4;
|
2012-05-09 12:15:23 +04:00
|
|
|
out_size -= 16;
|
2011-08-14 17:46:02 +04:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (channels > 1)
|
|
|
|
{
|
|
|
|
for (i = 0; i < 8; i++)
|
|
|
|
{
|
|
|
|
channel = (i < 4 ? 0 : 1);
|
|
|
|
sample = ((*src) & 0x0f);
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-09 12:15:23 +04:00
|
|
|
decoded = dsp_decode_ima_adpcm_sample(&context->adpcm, channel, sample);
|
2013-02-27 02:54:16 +04:00
|
|
|
dst[((i & 3) << 3) + (channel << 1)] = (decoded & 0xFF);
|
2011-08-14 17:46:02 +04:00
|
|
|
dst[((i & 3) << 3) + (channel << 1) + 1] = (decoded >> 8);
|
|
|
|
sample = ((*src) >> 4);
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-09 12:15:23 +04:00
|
|
|
decoded = dsp_decode_ima_adpcm_sample(&context->adpcm, channel, sample);
|
2013-02-27 02:54:16 +04:00
|
|
|
dst[((i & 3) << 3) + (channel << 1) + 4] = (decoded & 0xFF);
|
2011-08-14 17:46:02 +04:00
|
|
|
dst[((i & 3) << 3) + (channel << 1) + 5] = (decoded >> 8);
|
|
|
|
src++;
|
|
|
|
}
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
dst += 32;
|
|
|
|
size -= 8;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
sample = ((*src) & 0x0f);
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-09 12:15:23 +04:00
|
|
|
decoded = dsp_decode_ima_adpcm_sample(&context->adpcm, 0, sample);
|
2013-02-27 02:54:16 +04:00
|
|
|
*dst++ = (decoded & 0xFF);
|
2011-08-14 17:46:02 +04:00
|
|
|
*dst++ = (decoded >> 8);
|
|
|
|
sample = ((*src) >> 4);
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-09 12:15:23 +04:00
|
|
|
decoded = dsp_decode_ima_adpcm_sample(&context->adpcm, 0, sample);
|
2013-02-27 02:54:16 +04:00
|
|
|
*dst++ = (decoded & 0xFF);
|
2011-08-14 17:46:02 +04:00
|
|
|
*dst++ = (decoded >> 8);
|
|
|
|
src++;
|
|
|
|
size--;
|
|
|
|
}
|
|
|
|
}
|
2012-05-09 12:15:23 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
context->adpcm_size = dst - context->adpcm_buffer;
|
2011-08-14 17:46:02 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* 0 1 2 3
|
|
|
|
* 2 0 6 4 10 8 14 12 <left>
|
|
|
|
*
|
|
|
|
* 4 5 6 7
|
|
|
|
* 3 1 7 5 11 9 15 13 <right>
|
|
|
|
*/
|
|
|
|
static const struct
|
|
|
|
{
|
2012-10-09 11:01:37 +04:00
|
|
|
BYTE byte_num;
|
|
|
|
BYTE byte_shift;
|
2011-08-14 17:46:02 +04:00
|
|
|
} ima_stereo_encode_map[] =
|
|
|
|
{
|
|
|
|
{ 0, 0 },
|
|
|
|
{ 4, 0 },
|
|
|
|
{ 0, 4 },
|
|
|
|
{ 4, 4 },
|
|
|
|
{ 1, 0 },
|
|
|
|
{ 5, 0 },
|
|
|
|
{ 1, 4 },
|
|
|
|
{ 5, 4 },
|
|
|
|
{ 2, 0 },
|
|
|
|
{ 6, 0 },
|
|
|
|
{ 2, 4 },
|
|
|
|
{ 6, 4 },
|
|
|
|
{ 3, 0 },
|
|
|
|
{ 7, 0 },
|
|
|
|
{ 3, 4 },
|
|
|
|
{ 7, 4 }
|
|
|
|
};
|
|
|
|
|
2013-02-27 02:54:16 +04:00
|
|
|
static BYTE dsp_encode_ima_adpcm_sample(ADPCM* adpcm, int channel, INT16 sample)
|
2011-08-14 17:46:02 +04:00
|
|
|
{
|
2012-10-09 11:26:39 +04:00
|
|
|
INT32 e;
|
|
|
|
INT32 d;
|
|
|
|
INT32 ss;
|
2012-10-09 11:01:37 +04:00
|
|
|
BYTE enc;
|
2012-10-09 11:26:39 +04:00
|
|
|
INT32 diff;
|
2011-08-14 17:46:02 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
ss = ima_step_size_table[adpcm->ima.last_step[channel]];
|
|
|
|
d = e = sample - adpcm->ima.last_sample[channel];
|
2011-08-14 17:46:02 +04:00
|
|
|
diff = ss >> 3;
|
|
|
|
enc = 0;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
if (e < 0)
|
|
|
|
{
|
|
|
|
enc = 8;
|
|
|
|
e = -e;
|
|
|
|
}
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
if (e >= ss)
|
|
|
|
{
|
|
|
|
enc |= 4;
|
|
|
|
e -= ss;
|
|
|
|
}
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
ss >>= 1;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
if (e >= ss)
|
|
|
|
{
|
|
|
|
enc |= 2;
|
|
|
|
e -= ss;
|
|
|
|
}
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
ss >>= 1;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
if (e >= ss)
|
|
|
|
{
|
|
|
|
enc |= 1;
|
|
|
|
e -= ss;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (d < 0)
|
|
|
|
diff = d + e - diff;
|
|
|
|
else
|
|
|
|
diff = d - e + diff;
|
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
diff += adpcm->ima.last_sample[channel];
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
if (diff < -32768)
|
|
|
|
diff = -32768;
|
|
|
|
else if (diff > 32767)
|
|
|
|
diff = 32767;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-10-09 11:01:37 +04:00
|
|
|
adpcm->ima.last_sample[channel] = (INT16) diff;
|
2011-08-14 17:46:02 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
adpcm->ima.last_step[channel] += ima_step_index_table[enc];
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
if (adpcm->ima.last_step[channel] < 0)
|
|
|
|
adpcm->ima.last_step[channel] = 0;
|
|
|
|
else if (adpcm->ima.last_step[channel] > 88)
|
|
|
|
adpcm->ima.last_step[channel] = 88;
|
2011-08-14 17:46:02 +04:00
|
|
|
|
|
|
|
return enc;
|
|
|
|
}
|
|
|
|
|
2012-05-09 12:15:23 +04:00
|
|
|
static void freerdp_dsp_encode_ima_adpcm(FREERDP_DSP_CONTEXT* context,
|
2012-10-09 11:01:37 +04:00
|
|
|
const BYTE* src, int size, int channels, int block_size)
|
2011-08-14 17:46:02 +04:00
|
|
|
{
|
2013-02-27 02:54:16 +04:00
|
|
|
int i;
|
2012-10-09 11:01:37 +04:00
|
|
|
BYTE* dst;
|
|
|
|
INT16 sample;
|
|
|
|
BYTE encoded;
|
2012-10-09 11:26:39 +04:00
|
|
|
UINT32 out_size;
|
2011-08-14 17:46:02 +04:00
|
|
|
|
2012-05-09 12:15:23 +04:00
|
|
|
out_size = size / 2;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-09 12:15:23 +04:00
|
|
|
if (out_size > context->adpcm_maxlength)
|
|
|
|
{
|
|
|
|
context->adpcm_maxlength = out_size + 1024;
|
2012-10-09 07:21:26 +04:00
|
|
|
context->adpcm_buffer = realloc(context->adpcm_buffer, context->adpcm_maxlength);
|
2012-05-09 12:15:23 +04:00
|
|
|
}
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-09 12:15:23 +04:00
|
|
|
dst = context->adpcm_buffer;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
while (size > 0)
|
|
|
|
{
|
2012-05-09 12:15:23 +04:00
|
|
|
if ((dst - context->adpcm_buffer) % block_size == 0)
|
2011-08-14 17:46:02 +04:00
|
|
|
{
|
2013-02-27 02:54:16 +04:00
|
|
|
*dst++ = context->adpcm.ima.last_sample[0] & 0xFF;
|
|
|
|
*dst++ = (context->adpcm.ima.last_sample[0] >> 8) & 0xFF;
|
2012-10-09 11:01:37 +04:00
|
|
|
*dst++ = (BYTE) context->adpcm.ima.last_step[0];
|
2011-08-14 17:46:02 +04:00
|
|
|
*dst++ = 0;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
if (channels > 1)
|
|
|
|
{
|
2013-02-27 02:54:16 +04:00
|
|
|
*dst++ = context->adpcm.ima.last_sample[1] & 0xFF;
|
|
|
|
*dst++ = (context->adpcm.ima.last_sample[1] >> 8) & 0xFF;
|
2012-10-09 11:01:37 +04:00
|
|
|
*dst++ = (BYTE) context->adpcm.ima.last_step[1];
|
2011-08-14 17:46:02 +04:00
|
|
|
*dst++ = 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (channels > 1)
|
|
|
|
{
|
2013-02-27 02:54:16 +04:00
|
|
|
ZeroMemory(dst, 8);
|
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
for (i = 0; i < 16; i++)
|
|
|
|
{
|
2012-10-09 11:01:37 +04:00
|
|
|
sample = (INT16) (((UINT16)(*src)) | (((UINT16)(*(src + 1))) << 8));
|
2011-08-14 17:46:02 +04:00
|
|
|
src += 2;
|
2012-05-09 12:15:23 +04:00
|
|
|
encoded = dsp_encode_ima_adpcm_sample(&context->adpcm, i % 2, sample);
|
2011-08-14 17:46:02 +04:00
|
|
|
dst[ima_stereo_encode_map[i].byte_num] |= encoded << ima_stereo_encode_map[i].byte_shift;
|
|
|
|
}
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2011-08-14 17:46:02 +04:00
|
|
|
dst += 8;
|
|
|
|
size -= 32;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
2012-10-09 11:01:37 +04:00
|
|
|
sample = (INT16) (((UINT16)(*src)) | (((UINT16)(*(src + 1))) << 8));
|
2011-08-14 17:46:02 +04:00
|
|
|
src += 2;
|
2012-05-09 12:15:23 +04:00
|
|
|
encoded = dsp_encode_ima_adpcm_sample(&context->adpcm, 0, sample);
|
2012-10-09 11:01:37 +04:00
|
|
|
sample = (INT16) (((UINT16)(*src)) | (((UINT16)(*(src + 1))) << 8));
|
2011-08-14 17:46:02 +04:00
|
|
|
src += 2;
|
2012-05-09 12:15:23 +04:00
|
|
|
encoded |= dsp_encode_ima_adpcm_sample(&context->adpcm, 0, sample) << 4;
|
2011-08-14 17:46:02 +04:00
|
|
|
*dst++ = encoded;
|
|
|
|
size -= 4;
|
|
|
|
}
|
|
|
|
}
|
2012-05-09 12:15:23 +04:00
|
|
|
|
|
|
|
context->adpcm_size = dst - context->adpcm_buffer;
|
2011-08-14 17:46:02 +04:00
|
|
|
}
|
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
/**
|
|
|
|
* Microsoft ADPCM Specification:
|
|
|
|
*
|
|
|
|
* http://wiki.multimedia.cx/index.php?title=Microsoft_ADPCM
|
|
|
|
*/
|
|
|
|
|
2013-02-27 02:54:16 +04:00
|
|
|
static const INT32 ms_adpcm_adaptation_table[] =
|
2012-05-24 17:26:17 +04:00
|
|
|
{
|
|
|
|
230, 230, 230, 230, 307, 409, 512, 614,
|
|
|
|
768, 614, 512, 409, 307, 230, 230, 230
|
|
|
|
};
|
|
|
|
|
2013-02-27 02:54:16 +04:00
|
|
|
static const INT32 ms_adpcm_coeffs1[7] =
|
2012-05-24 17:26:17 +04:00
|
|
|
{
|
|
|
|
256, 512, 0, 192, 240, 460, 392
|
|
|
|
};
|
|
|
|
|
2013-02-27 02:54:16 +04:00
|
|
|
static const INT32 ms_adpcm_coeffs2[7] =
|
2012-05-24 17:26:17 +04:00
|
|
|
{
|
|
|
|
0, -256, 0, 64, 0, -208, -232
|
|
|
|
};
|
|
|
|
|
2013-02-27 02:54:16 +04:00
|
|
|
static INLINE INT16 freerdp_dsp_decode_ms_adpcm_sample(ADPCM* adpcm, BYTE sample, int channel)
|
2012-05-24 17:26:17 +04:00
|
|
|
{
|
2012-10-09 11:01:37 +04:00
|
|
|
INT8 nibble;
|
2012-10-09 11:26:39 +04:00
|
|
|
INT32 presample;
|
2012-05-24 17:26:17 +04:00
|
|
|
|
2013-02-27 02:54:16 +04:00
|
|
|
nibble = (sample & 0x08 ? (INT8) sample - 16 : sample);
|
|
|
|
|
|
|
|
presample = ((adpcm->ms.sample1[channel] * ms_adpcm_coeffs1[adpcm->ms.predictor[channel]]) +
|
|
|
|
(adpcm->ms.sample2[channel] * ms_adpcm_coeffs2[adpcm->ms.predictor[channel]])) / 256;
|
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
presample += nibble * adpcm->ms.delta[channel];
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
if (presample > 32767)
|
|
|
|
presample = 32767;
|
|
|
|
else if (presample < -32768)
|
|
|
|
presample = -32768;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
adpcm->ms.sample2[channel] = adpcm->ms.sample1[channel];
|
|
|
|
adpcm->ms.sample1[channel] = presample;
|
|
|
|
adpcm->ms.delta[channel] = adpcm->ms.delta[channel] * ms_adpcm_adaptation_table[sample] / 256;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
if (adpcm->ms.delta[channel] < 16)
|
|
|
|
adpcm->ms.delta[channel] = 16;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-10-09 11:01:37 +04:00
|
|
|
return (INT16) presample;
|
2012-05-24 17:26:17 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
static void freerdp_dsp_decode_ms_adpcm(FREERDP_DSP_CONTEXT* context,
|
2012-10-09 11:01:37 +04:00
|
|
|
const BYTE* src, int size, int channels, int block_size)
|
2012-05-24 17:26:17 +04:00
|
|
|
{
|
2012-10-09 11:01:37 +04:00
|
|
|
BYTE* dst;
|
|
|
|
BYTE sample;
|
2012-10-09 11:26:39 +04:00
|
|
|
UINT32 out_size;
|
2012-05-24 17:26:17 +04:00
|
|
|
|
|
|
|
out_size = size * 4;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
if (out_size > context->adpcm_maxlength)
|
|
|
|
{
|
|
|
|
context->adpcm_maxlength = out_size + 1024;
|
2012-10-09 07:21:26 +04:00
|
|
|
context->adpcm_buffer = realloc(context->adpcm_buffer, context->adpcm_maxlength);
|
2012-05-24 17:26:17 +04:00
|
|
|
}
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
dst = context->adpcm_buffer;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
while (size > 0)
|
|
|
|
{
|
|
|
|
if (size % block_size == 0)
|
|
|
|
{
|
|
|
|
if (channels > 1)
|
|
|
|
{
|
|
|
|
context->adpcm.ms.predictor[0] = *src++;
|
|
|
|
context->adpcm.ms.predictor[1] = *src++;
|
2013-02-27 02:54:16 +04:00
|
|
|
context->adpcm.ms.delta[0] = *((INT16*) src);
|
2012-05-24 17:26:17 +04:00
|
|
|
src += 2;
|
2013-02-27 02:54:16 +04:00
|
|
|
context->adpcm.ms.delta[1] = *((INT16*) src);
|
2012-05-24 17:26:17 +04:00
|
|
|
src += 2;
|
2013-02-27 02:54:16 +04:00
|
|
|
context->adpcm.ms.sample1[0] = *((INT16*) src);
|
2012-05-24 17:26:17 +04:00
|
|
|
src += 2;
|
2013-02-27 02:54:16 +04:00
|
|
|
context->adpcm.ms.sample1[1] = *((INT16*) src);
|
2012-05-24 17:26:17 +04:00
|
|
|
src += 2;
|
2013-02-27 02:54:16 +04:00
|
|
|
context->adpcm.ms.sample2[0] = *((INT16*) src);
|
2012-05-24 17:26:17 +04:00
|
|
|
src += 2;
|
2013-02-27 02:54:16 +04:00
|
|
|
context->adpcm.ms.sample2[1] = *((INT16*) src);
|
2012-05-24 17:26:17 +04:00
|
|
|
src += 2;
|
|
|
|
size -= 14;
|
|
|
|
|
2013-02-27 02:54:16 +04:00
|
|
|
*((INT16*) dst) = context->adpcm.ms.sample2[0];
|
2012-05-24 17:26:17 +04:00
|
|
|
dst += 2;
|
2013-02-27 02:54:16 +04:00
|
|
|
*((INT16*) dst) = context->adpcm.ms.sample2[1];
|
2012-05-24 17:26:17 +04:00
|
|
|
dst += 2;
|
2013-02-27 02:54:16 +04:00
|
|
|
*((INT16*) dst) = context->adpcm.ms.sample1[0];
|
2012-05-24 17:26:17 +04:00
|
|
|
dst += 2;
|
2013-02-27 02:54:16 +04:00
|
|
|
*((INT16*) dst) = context->adpcm.ms.sample1[1];
|
2012-05-24 17:26:17 +04:00
|
|
|
dst += 2;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
context->adpcm.ms.predictor[0] = *src++;
|
2013-02-27 02:54:16 +04:00
|
|
|
context->adpcm.ms.delta[0] = *((INT16*) src);
|
2012-05-24 17:26:17 +04:00
|
|
|
src += 2;
|
2013-02-27 02:54:16 +04:00
|
|
|
context->adpcm.ms.sample1[0] = *((INT16*) src);
|
2012-05-24 17:26:17 +04:00
|
|
|
src += 2;
|
2013-02-27 02:54:16 +04:00
|
|
|
context->adpcm.ms.sample2[0] = *((INT16*) src);
|
2012-05-24 17:26:17 +04:00
|
|
|
src += 2;
|
|
|
|
size -= 7;
|
|
|
|
|
2013-02-27 02:54:16 +04:00
|
|
|
*((INT16*) dst) = context->adpcm.ms.sample2[0];
|
2012-05-24 17:26:17 +04:00
|
|
|
dst += 2;
|
2013-02-27 02:54:16 +04:00
|
|
|
*((INT16*) dst) = context->adpcm.ms.sample1[0];
|
2012-05-24 17:26:17 +04:00
|
|
|
dst += 2;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (channels > 1)
|
|
|
|
{
|
|
|
|
sample = *src++;
|
|
|
|
size--;
|
2013-02-27 02:54:16 +04:00
|
|
|
*((INT16*) dst) = freerdp_dsp_decode_ms_adpcm_sample(&context->adpcm, sample >> 4, 0);
|
2012-05-24 17:26:17 +04:00
|
|
|
dst += 2;
|
2013-02-27 02:54:16 +04:00
|
|
|
*((INT16*) dst) = freerdp_dsp_decode_ms_adpcm_sample(&context->adpcm, sample & 0x0F, 1);
|
2012-05-24 17:26:17 +04:00
|
|
|
dst += 2;
|
|
|
|
|
|
|
|
sample = *src++;
|
|
|
|
size--;
|
2013-02-27 02:54:16 +04:00
|
|
|
*((INT16*) dst) = freerdp_dsp_decode_ms_adpcm_sample(&context->adpcm, sample >> 4, 0);
|
2012-05-24 17:26:17 +04:00
|
|
|
dst += 2;
|
2013-02-27 02:54:16 +04:00
|
|
|
*((INT16*) dst) = freerdp_dsp_decode_ms_adpcm_sample(&context->adpcm, sample & 0x0F, 1);
|
2012-05-24 17:26:17 +04:00
|
|
|
dst += 2;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
sample = *src++;
|
|
|
|
size--;
|
2013-02-27 02:54:16 +04:00
|
|
|
*((INT16*) dst) = freerdp_dsp_decode_ms_adpcm_sample(&context->adpcm, sample >> 4, 0);
|
2012-05-24 17:26:17 +04:00
|
|
|
dst += 2;
|
2013-02-27 02:54:16 +04:00
|
|
|
*((INT16*) dst) = freerdp_dsp_decode_ms_adpcm_sample(&context->adpcm, sample & 0x0F, 0);
|
2012-05-24 17:26:17 +04:00
|
|
|
dst += 2;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
context->adpcm_size = dst - context->adpcm_buffer;
|
|
|
|
}
|
|
|
|
|
2012-10-09 11:26:39 +04:00
|
|
|
static BYTE freerdp_dsp_encode_ms_adpcm_sample(ADPCM* adpcm, INT32 sample, int channel)
|
2012-05-24 17:26:17 +04:00
|
|
|
{
|
2012-10-09 11:26:39 +04:00
|
|
|
INT32 presample;
|
|
|
|
INT32 errordelta;
|
2012-05-24 17:26:17 +04:00
|
|
|
|
2013-02-27 02:54:16 +04:00
|
|
|
presample = ((adpcm->ms.sample1[channel] * ms_adpcm_coeffs1[adpcm->ms.predictor[channel]]) +
|
|
|
|
(adpcm->ms.sample2[channel] * ms_adpcm_coeffs2[adpcm->ms.predictor[channel]])) / 256;
|
2012-05-24 17:26:17 +04:00
|
|
|
errordelta = (sample - presample) / adpcm->ms.delta[channel];
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
if ((sample - presample) % adpcm->ms.delta[channel] > adpcm->ms.delta[channel] / 2)
|
|
|
|
errordelta++;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
if (errordelta > 7)
|
|
|
|
errordelta = 7;
|
|
|
|
else if (errordelta < -8)
|
|
|
|
errordelta = -8;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
presample += adpcm->ms.delta[channel] * errordelta;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
if (presample > 32767)
|
|
|
|
presample = 32767;
|
|
|
|
else if (presample < -32768)
|
|
|
|
presample = -32768;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
adpcm->ms.sample2[channel] = adpcm->ms.sample1[channel];
|
|
|
|
adpcm->ms.sample1[channel] = presample;
|
2013-02-27 02:54:16 +04:00
|
|
|
adpcm->ms.delta[channel] = adpcm->ms.delta[channel] * ms_adpcm_adaptation_table[(((BYTE) errordelta) & 0x0F)] / 256;
|
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
if (adpcm->ms.delta[channel] < 16)
|
|
|
|
adpcm->ms.delta[channel] = 16;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
|
|
|
return ((BYTE) errordelta) & 0x0F;
|
2012-05-24 17:26:17 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
static void freerdp_dsp_encode_ms_adpcm(FREERDP_DSP_CONTEXT* context,
|
2012-10-09 11:01:37 +04:00
|
|
|
const BYTE* src, int size, int channels, int block_size)
|
2012-05-24 17:26:17 +04:00
|
|
|
{
|
2012-10-09 11:01:37 +04:00
|
|
|
BYTE* dst;
|
2012-10-09 11:26:39 +04:00
|
|
|
INT32 sample;
|
|
|
|
UINT32 out_size;
|
2012-05-24 17:26:17 +04:00
|
|
|
|
|
|
|
out_size = size / 2;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
if (out_size > context->adpcm_maxlength)
|
|
|
|
{
|
|
|
|
context->adpcm_maxlength = out_size + 1024;
|
2012-10-09 07:21:26 +04:00
|
|
|
context->adpcm_buffer = realloc(context->adpcm_buffer, context->adpcm_maxlength);
|
2012-05-24 17:26:17 +04:00
|
|
|
}
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
dst = context->adpcm_buffer;
|
|
|
|
|
|
|
|
if (context->adpcm.ms.delta[0] < 16)
|
|
|
|
context->adpcm.ms.delta[0] = 16;
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-24 17:26:17 +04:00
|
|
|
if (context->adpcm.ms.delta[1] < 16)
|
|
|
|
context->adpcm.ms.delta[1] = 16;
|
|
|
|
|
|
|
|
while (size > 0)
|
|
|
|
{
|
|
|
|
if ((dst - context->adpcm_buffer) % block_size == 0)
|
|
|
|
{
|
|
|
|
if (channels > 1)
|
|
|
|
{
|
|
|
|
*dst++ = context->adpcm.ms.predictor[0];
|
|
|
|
*dst++ = context->adpcm.ms.predictor[1];
|
2013-02-27 02:54:16 +04:00
|
|
|
*dst++ = (BYTE) (context->adpcm.ms.delta[0] & 0xFF);
|
|
|
|
*dst++ = (BYTE) ((context->adpcm.ms.delta[0] >> 8) & 0xFF);
|
|
|
|
*dst++ = (BYTE) (context->adpcm.ms.delta[1] & 0xFF);
|
|
|
|
*dst++ = (BYTE) ((context->adpcm.ms.delta[1] >> 8) & 0xFF);
|
2012-10-09 11:01:37 +04:00
|
|
|
context->adpcm.ms.sample1[0] = *((INT16*) (src + 4));
|
|
|
|
context->adpcm.ms.sample1[1] = *((INT16*) (src + 6));
|
|
|
|
context->adpcm.ms.sample2[0] = *((INT16*) (src + 0));
|
|
|
|
context->adpcm.ms.sample2[1] = *((INT16*) (src + 2));
|
|
|
|
*((INT16*) (dst + 0)) = (INT16) context->adpcm.ms.sample1[0];
|
|
|
|
*((INT16*) (dst + 2)) = (INT16) context->adpcm.ms.sample1[1];
|
|
|
|
*((INT16*) (dst + 4)) = (INT16) context->adpcm.ms.sample2[0];
|
|
|
|
*((INT16*) (dst + 6)) = (INT16) context->adpcm.ms.sample2[1];
|
2012-05-24 17:26:17 +04:00
|
|
|
dst += 8;
|
|
|
|
src += 8;
|
|
|
|
size -= 8;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
*dst++ = context->adpcm.ms.predictor[0];
|
2013-02-27 02:54:16 +04:00
|
|
|
*dst++ = (BYTE) (context->adpcm.ms.delta[0] & 0xFF);
|
|
|
|
*dst++ = (BYTE) ((context->adpcm.ms.delta[0] >> 8) & 0xFF);
|
2012-10-09 11:01:37 +04:00
|
|
|
context->adpcm.ms.sample1[0] = *((INT16*) (src + 2));
|
|
|
|
context->adpcm.ms.sample2[0] = *((INT16*) (src + 0));
|
|
|
|
*((INT16*) (dst + 0)) = (INT16) context->adpcm.ms.sample1[0];
|
|
|
|
*((INT16*) (dst + 2)) = (INT16) context->adpcm.ms.sample2[0];
|
2012-05-24 17:26:17 +04:00
|
|
|
dst += 4;
|
|
|
|
src += 4;
|
|
|
|
size -= 4;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-10-09 11:01:37 +04:00
|
|
|
sample = *((INT16*) src);
|
2012-05-24 17:26:17 +04:00
|
|
|
src += 2;
|
|
|
|
*dst = freerdp_dsp_encode_ms_adpcm_sample(&context->adpcm, sample, 0) << 4;
|
2012-10-09 11:01:37 +04:00
|
|
|
sample = *((INT16*) src);
|
2012-05-24 17:26:17 +04:00
|
|
|
src += 2;
|
|
|
|
*dst += freerdp_dsp_encode_ms_adpcm_sample(&context->adpcm, sample, channels > 1 ? 1 : 0);
|
|
|
|
dst++;
|
|
|
|
size -= 4;
|
|
|
|
}
|
|
|
|
|
|
|
|
context->adpcm_size = dst - context->adpcm_buffer;
|
|
|
|
}
|
|
|
|
|
2012-05-09 12:15:23 +04:00
|
|
|
FREERDP_DSP_CONTEXT* freerdp_dsp_context_new(void)
|
|
|
|
{
|
|
|
|
FREERDP_DSP_CONTEXT* context;
|
|
|
|
|
2012-11-22 05:21:08 +04:00
|
|
|
context = (FREERDP_DSP_CONTEXT*) malloc(sizeof(FREERDP_DSP_CONTEXT));
|
|
|
|
ZeroMemory(context, sizeof(FREERDP_DSP_CONTEXT));
|
2012-05-09 12:15:23 +04:00
|
|
|
|
|
|
|
context->resample = freerdp_dsp_resample;
|
|
|
|
context->decode_ima_adpcm = freerdp_dsp_decode_ima_adpcm;
|
|
|
|
context->encode_ima_adpcm = freerdp_dsp_encode_ima_adpcm;
|
2012-05-24 17:26:17 +04:00
|
|
|
context->decode_ms_adpcm = freerdp_dsp_decode_ms_adpcm;
|
|
|
|
context->encode_ms_adpcm = freerdp_dsp_encode_ms_adpcm;
|
2012-05-09 12:15:23 +04:00
|
|
|
|
|
|
|
return context;
|
|
|
|
}
|
|
|
|
|
|
|
|
void freerdp_dsp_context_free(FREERDP_DSP_CONTEXT* context)
|
|
|
|
{
|
|
|
|
if (context)
|
|
|
|
{
|
|
|
|
if (context->resampled_buffer)
|
2012-10-09 07:21:26 +04:00
|
|
|
free(context->resampled_buffer);
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-05-09 12:15:23 +04:00
|
|
|
if (context->adpcm_buffer)
|
2012-10-09 07:21:26 +04:00
|
|
|
free(context->adpcm_buffer);
|
2013-02-27 02:54:16 +04:00
|
|
|
|
2012-10-09 07:21:26 +04:00
|
|
|
free(context);
|
2012-05-09 12:15:23 +04:00
|
|
|
}
|
|
|
|
}
|