/[rdesktop]/sourceforge.net/trunk/rdesktop/rdpsnd_dsp.c
This is repository of my old source code which isn't updated any more. Go to git.rot13.org for current projects!
ViewVC logotype

Diff of /sourceforge.net/trunk/rdesktop/rdpsnd_dsp.c

Parent Directory Parent Directory | Revision Log Revision Log | View Patch Patch

revision 1258 by stargo, Sun Sep 17 14:41:16 2006 UTC revision 1282 by stargo, Sun Oct 1 15:07:55 2006 UTC
# Line 22  Line 22 
22  #include "rdpsnd.h"  #include "rdpsnd.h"
23  #include "rdpsnd_dsp.h"  #include "rdpsnd_dsp.h"
24    
25    #ifdef HAVE_LIBSAMPLERATE
26    #include <samplerate.h>
27    
28    #define SRC_CONVERTER SRC_SINC_MEDIUM_QUALITY
29    #endif
30    
31  #define MAX_VOLUME 65535  #define MAX_VOLUME 65535
32    
33  static uint16 softvol_left = MAX_VOLUME;  static uint16 softvol_left = MAX_VOLUME;
34  static uint16 softvol_right = MAX_VOLUME;  static uint16 softvol_right = MAX_VOLUME;
35    static uint32 resample_to_srate = 44100;
36    static uint16 resample_to_bitspersample = 16;
37    static uint16 resample_to_channels = 2;
38    #ifdef HAVE_LIBSAMPLERATE
39    static SRC_STATE *src_converter = NULL;
40    #endif
41    
42  void  void
43  rdpsnd_dsp_softvol_set(uint16 left, uint16 right)  rdpsnd_dsp_softvol_set(uint16 left, uint16 right)
# Line 35  rdpsnd_dsp_softvol_set(uint16 left, uint Line 47  rdpsnd_dsp_softvol_set(uint16 left, uint
47          DEBUG(("rdpsnd_dsp_softvol_set: left: %u, right: %u\n", left, right));          DEBUG(("rdpsnd_dsp_softvol_set: left: %u, right: %u\n", left, right));
48  }  }
49    
50  inline void  void
51  rdpsnd_dsp_softvol(unsigned char *inbuffer, unsigned char *outbuffer, unsigned int size,  rdpsnd_dsp_softvol(unsigned char *buffer, unsigned int size, WAVEFORMATEX * format)
                    WAVEFORMATEX * format)  
52  {  {
53          unsigned int factor_left, factor_right;          unsigned int factor_left, factor_right;
54          unsigned char *posin = inbuffer;          unsigned char *posin = buffer;
55          unsigned char *posout = outbuffer;          unsigned char *posout = buffer;
56    
57            if ((softvol_left == MAX_VOLUME) && (softvol_right == MAX_VOLUME))
58                    return;
59    
60          factor_left = (softvol_left * 256) / 65535;          factor_left = (softvol_left * 256) / MAX_VOLUME;
61          factor_right = (softvol_right * 256) / 65535;          factor_right = (softvol_right * 256) / MAX_VOLUME;
62    
63          if (format->nChannels == 1)          if (format->nChannels == 1)
64          {          {
# Line 53  rdpsnd_dsp_softvol(unsigned char *inbuff Line 67  rdpsnd_dsp_softvol(unsigned char *inbuff
67    
68          if (format->wBitsPerSample == 8)          if (format->wBitsPerSample == 8)
69          {          {
70                  char val;                  sint8 val;
71    
72                  while (posout < outbuffer + size)                  while (posout < buffer + size)
73                  {                  {
74                          /* Left */                          /* Left */
75                          val = *posin++;                          val = *posin++;
# Line 70  rdpsnd_dsp_softvol(unsigned char *inbuff Line 84  rdpsnd_dsp_softvol(unsigned char *inbuff
84          }          }
85          else          else
86          {          {
87                  short val;                  sint16 val;
88    
89                  while (posout < outbuffer + size)                  while (posout < buffer + size)
90                  {                  {
91                          /* Left */                          /* Left */
92                          val = *posin++;                          val = *posin++;
# Line 90  rdpsnd_dsp_softvol(unsigned char *inbuff Line 104  rdpsnd_dsp_softvol(unsigned char *inbuff
104                  }                  }
105          }          }
106    
107          DEBUG(("using softvol with shifts left: %d, right: %d (%d/%d)\n", factor_left, factor_right,          DEBUG(("using softvol with factors left: %d, right: %d (%d/%d)\n", factor_left,
108                 format->wBitsPerSample, format->nChannels));                 factor_right, format->wBitsPerSample, format->nChannels));
109    }
110    
111    void
112    rdpsnd_dsp_swapbytes(unsigned char *buffer, unsigned int size, WAVEFORMATEX * format)
113    {
114            int i;
115            uint8 swap;
116    
117            if (format->wBitsPerSample == 8)
118                    return;
119    
120            for (i = 0; i < size; i += 2)
121            {
122                    swap = *(buffer + i);
123                    *(buffer + i) = *(buffer + i + 1);
124                    *(buffer + i + 1) = swap;
125            }
126    }
127    
128    BOOL
129    rdpsnd_dsp_resample_set(uint32 device_srate, uint16 device_bitspersample, uint16 device_channels)
130    {
131    #ifdef HAVE_LIBSAMPLERATE
132            int err;
133    #endif
134    
135    #ifndef HAVE_LIBSAMPLERATE
136            if (device_srate != 44100 && device_srate != 22050)
137                    return False;
138    #endif
139    
140            if (device_bitspersample != 16 && device_bitspersample != 8)
141                    return False;
142    
143            if (device_channels != 1 && device_channels != 2)
144                    return False;
145    
146            resample_to_srate = device_srate;
147            resample_to_bitspersample = device_bitspersample;
148            resample_to_channels = device_channels;
149    
150    #ifdef HAVE_LIBSAMPLERATE
151            if (src_converter != NULL)
152                    src_converter = src_delete(src_converter);
153    
154            if ((src_converter = src_new(SRC_CONVERTER, device_channels, &err)) == NULL)
155            {
156                    warning("src_new failed: %d!\n", err);
157                    return False;
158            }
159    #endif
160    
161            return True;
162    }
163    
164    BOOL
165    rdpsnd_dsp_resample_supported(WAVEFORMATEX * format)
166    {
167            if (format->wFormatTag != WAVE_FORMAT_PCM)
168                    return False;
169            if ((format->nChannels != 1) && (format->nChannels != 2))
170                    return False;
171            if ((format->wBitsPerSample != 8) && (format->wBitsPerSample != 16))
172                    return False;
173    #ifndef HAVE_LIBSAMPLERATE
174            if ((format->nSamplesPerSec != 44100) && (format->nSamplesPerSec != 22050))
175                    return False;
176    #endif
177    
178            return True;
179  }  }
180    
181  unsigned char *  uint32
182  rdpsnd_dsp_process(unsigned char *inbuffer, unsigned int size, struct audio_driver *current_driver,  rdpsnd_dsp_resample(unsigned char **out, unsigned char *in, unsigned int size,
183                     WAVEFORMATEX * format)                      WAVEFORMATEX * format, BOOL stream_be)
184  {  {
185          unsigned char *outbuffer;  #ifdef HAVE_LIBSAMPLERATE
186            SRC_DATA resample_data;
187            float *infloat, *outfloat;
188            int innum, outnum;
189            int err;
190    #else
191            int offset;
192    #endif
193            static BOOL warned = False;
194            unsigned char *tmpdata = NULL;
195            int samplewidth = format->wBitsPerSample / 8;
196            int outsize = 0;
197            int i;
198    
199            if ((resample_to_bitspersample == format->wBitsPerSample) &&
200                (resample_to_channels == format->nChannels) &&
201                (resample_to_srate == format->nSamplesPerSec))
202                    return 0;
203    
204    #ifdef B_ENDIAN
205            if (!stream_be)
206                    rdpsnd_dsp_swapbytes(in, size, format);
207    #endif
208    
209            /* Expand 8bit input-samples to 16bit */
210    #ifndef HAVE_LIBSAMPLERATE      /* libsamplerate needs 16bit samples */
211            if (format->wBitsPerSample != resample_to_bitspersample)
212    #endif
213            {
214                    /* source: 8 bit, dest: 16bit */
215                    if (format->wBitsPerSample == 8)
216                    {
217                            tmpdata = xmalloc(size * 2);
218                            for (i = 0; i < size; i++)
219                            {
220                                    tmpdata[i * 2] = in[i];
221                                    tmpdata[(i * 2) + 1] = 0x00;
222                            }
223                            in = tmpdata;
224                            samplewidth = 16 / 2;
225                            size *= 2;
226                    }
227            }
228    
229          outbuffer = xmalloc(size);          if (resample_to_channels != format->nChannels)
230            {
231                    warning("unsupported resample-settings (%u -> %u/%u -> %u/%u -> %u), not resampling!\n", format->nSamplesPerSec, resample_to_srate, format->wBitsPerSample, resample_to_bitspersample, format->nChannels, resample_to_channels);
232                    warned = True;
233            }
234    
235          /* Software volume control */          /* Do the resampling */
236    #ifdef HAVE_LIBSAMPLERATE
237            if (src_converter == NULL)
238            {
239                    warning("no samplerate converter available!!\n");
240                    return 0;
241            }
242    
243            innum = size / samplewidth;
244            outnum = ((float)innum * ((float)resample_to_srate / (float)format->nSamplesPerSec)) + 1;
245    
246            infloat = xmalloc(sizeof(float) * innum);
247            outfloat = xmalloc(sizeof(float) * outnum);
248    
249            src_short_to_float_array((short *) in, infloat, innum);
250    
251            bzero(&resample_data, sizeof(resample_data));
252            resample_data.data_in = infloat;
253            resample_data.data_out = outfloat;
254            resample_data.input_frames = innum / resample_to_channels;
255            resample_data.output_frames = outnum / resample_to_channels;
256            resample_data.src_ratio = (double) resample_to_srate / (double) format->nSamplesPerSec;
257            resample_data.end_of_input = 0;
258    
259            if ((err = src_process(src_converter, &resample_data)) != 0)
260                    error("src_process: %s", src_strerror(err));
261    
262            xfree(infloat);
263    
264            outsize = resample_data.output_frames_gen * resample_to_channels * samplewidth;
265            *out = xmalloc(outsize);
266            src_float_to_short_array(outfloat, (short *) *out, resample_data.output_frames_gen * resample_to_channels);
267            xfree(outfloat);
268    
269    #else
270            if (format->nSamplesPerSec != 22050)
271            {
272                    if (!warned)
273                    {
274                            warning("unsupported source samplerate (%u), not resampling!\n",
275                                    format->nSamplesPerSec);
276                            warned = True;
277                    }
278                    return 0;
279            }
280    
281            outsize = size * 2;
282            *out = xmalloc(outsize);
283    
284            /* Resample from 22050 to 44100 */
285            for (i = 0; i < (size / samplewidth); i++)
286            {
287                    /* On a stereo-channel we must make sure that left and right
288                       does not get mixed up, so we need to expand the sample-
289                       data with channels in mind: 1234 -> 12123434
290                       If we have a mono-channel, we can expand the data by simply
291                       doubling the sample-data: 1234 -> 11223344 */
292                    if (resample_to_channels == 2)
293                            offset = ((i * 2) - (i & 1)) * samplewidth;
294                    else
295                            offset = (i * 2) * samplewidth;
296    
297                    memcpy(*out + offset, in + (i * samplewidth), samplewidth);
298                    memcpy(*out + (resample_to_channels * samplewidth + offset),
299                           in + (i * samplewidth), samplewidth);
300    
301            }
302    #endif
303    
304            if (tmpdata != NULL)
305                    xfree(tmpdata);
306    
307            /* Shrink 16bit output-samples to 8bit */
308    #ifndef HAVE_LIBSAMPLERATE      /* libsamplerate produces 16bit samples */
309            if (format->wBitsPerSample != resample_to_bitspersample)
310    #endif
311            {
312                    /* source: 16 bit, dest: 8 bit */
313                    if (resample_to_bitspersample == 8)
314                    {
315                            for (i = 0; i < outsize; i++)
316                            {
317                                    *out[i] = *out[i * 2];
318                            }
319                            outsize /= 2;
320                    }
321            }
322    
323    #ifdef B_ENDIAN
324            if (!stream_be)
325                    rdpsnd_dsp_swapbytes(*out, outsize, format);
326    #endif
327            return outsize;
328    }
329    
330    STREAM
331    rdpsnd_dsp_process(STREAM s, struct audio_driver * current_driver, WAVEFORMATEX * format)
332    {
333            static struct stream out;
334            BOOL stream_be = False;
335    
336            /* softvol and byteswap do not change the amount of data they
337               return, so they can operate on the input-stream */
338          if (current_driver->wave_out_volume == rdpsnd_dsp_softvol_set)          if (current_driver->wave_out_volume == rdpsnd_dsp_softvol_set)
339                    rdpsnd_dsp_softvol(s->data, s->size, format);
340    
341    #ifdef B_ENDIAN
342            if (current_driver->need_byteswap_on_be)
343          {          {
344                  rdpsnd_dsp_softvol(inbuffer, outbuffer, size, format);                  rdpsnd_dsp_swapbytes(s->data, s->size, format);
345                    stream_be = True;
346          }          }
347          else  #endif
348    
349            out.data = NULL;
350    
351            if (current_driver->need_resampling)
352                    out.size = rdpsnd_dsp_resample(&out.data, s->data, s->size, format, stream_be);
353    
354            if (out.data == NULL)
355          {          {
356                  memcpy(outbuffer, inbuffer, size);                  out.data = xmalloc(s->size);
357                    memcpy(out.data, s->data, s->size);
358                    out.size = s->size;
359          }          }
360    
361          return outbuffer;          out.p = out.data;
362            out.end = out.p + out.size;
363    
364            return &out;
365  }  }
Legend:
Removed from v.1258  
changed lines
  Added in v.1282
  ViewVC Help
Powered by ViewVC 1.1.26