dlls/dsound/dsound_convert.c

   1 /* DirectSound format conversion and mixing routines
   2  *
   3  * Copyright 2007 Maarten Lankhorst
   4  * Copyright 2011 Owen Rudge for CodeWeavers
   5  *
   6  * This library is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU Lesser General Public
   8  * License as published by the Free Software Foundation; either
   9  * version 2.1 of the License, or (at your option) any later version.
  10  *
  11  * This library is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  14  * Lesser General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU Lesser General Public
  17  * License along with this library; if not, write to the Free Software
  18  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301, USA
  19  */
  20
  21 /* 8 bits is unsigned, the rest is signed.
  22  * First I tried to reuse existing stuff from alsa-lib, after that
  23  * didn't work, I gave up and just went for individual hacks.
  24  *
  25  * 24 bit is expensive to do, due to unaligned access.
  26  * In dlls/winex11.drv/dib_convert.c convert_888_to_0888_asis there is a way
  27  * around it, but I'm happy current code works, maybe something for later.
  28  *
  29  * The ^ 0x80 flips the signed bit, this is the conversion from
  30  * signed (-128.. 0.. 127) to unsigned (0...255)
  31  * This is only temporary: All 8 bit data should be converted to signed.
  32  * then when fed to the sound card, it should be converted to unsigned again.
  33  *
  34  * Sound is LITTLE endian
  35  */
  36
  37 #include "config.h"
  38
  39 #include <stdarg.h>
  40
  41 #define NONAMELESSSTRUCT
  42 #define NONAMELESSUNION
  43 #include "windef.h"
  44 #include "winbase.h"
  45 #include "mmsystem.h"
  46 #include "winternl.h"
  47 #include "wine/debug.h"
  48 #include "dsound.h"
  49 #include "dsound_private.h"
  50
  51 WINE_DEFAULT_DEBUG_CHANNEL(dsound);
  52
  53 #ifdef WORDS_BIGENDIAN
  54 #define le16(x) RtlUshortByteSwap((x))
  55 #define le32(x) RtlUlongByteSwap((x))
  56 #else
  57 #define le16(x) (x)
  58 #define le32(x) (x)
  59 #endif
  60
  61 static inline void src_advance(const void **src, UINT stride, INT *count, UINT *freqAcc, UINT adj)
  62 {
  63     *freqAcc += adj;
  64     if (*freqAcc >= (1 << DSOUND_FREQSHIFT))
  65     {
  66         ULONG adv = (*freqAcc >> DSOUND_FREQSHIFT);
  67         *freqAcc &= (1 << DSOUND_FREQSHIFT) - 1;
  68         *(const char **)src += adv * stride;
  69         *count -= adv;
  70     }
  71 }
  72
  73 static void convert_8_to_8 (const void *src, void *dst, UINT src_stride,
  74         UINT dst_stride, INT count, UINT freqAcc, UINT adj)
  75 {
  76     while (count > 0)
  77     {
  78         *(BYTE *)dst = *(const BYTE *)src;
  79
  80         dst = (char *)dst + dst_stride;
  81         src_advance(&src, src_stride, &count, &freqAcc, adj);
  82     }
  83 }
  84
  85 static void convert_8_to_16 (const void *src, void *dst, UINT src_stride,
  86         UINT dst_stride, INT count, UINT freqAcc, UINT adj)
  87 {
  88     while (count > 0)
  89     {
  90         WORD dest = *(const BYTE *)src, *dest16 = dst;
  91         *dest16 = le16(dest * 257 - 32768);
  92
  93         dst = (char *)dst + dst_stride;
  94         src_advance(&src, src_stride, &count, &freqAcc, adj);
  95     }
  96 }
  97
  98 static void convert_8_to_24 (const void *src, void *dst, UINT src_stride,
  99         UINT dst_stride, INT count, UINT freqAcc, UINT adj)
 100 {
 101     while (count > 0)
 102     {
 103         BYTE dest = *(const BYTE *)src;
 104         BYTE *dest24 = dst;
 105         dest24[0] = dest;
 106         dest24[1] = dest;
 107         dest24[2] = dest - 0x80;
 108
 109         dst = (char *)dst + dst_stride;
 110         src_advance(&src, src_stride, &count, &freqAcc, adj);
 111     }
 112 }
 113
 114 static void convert_8_to_32 (const void *src, void *dst, UINT src_stride,
 115         UINT dst_stride, INT count, UINT freqAcc, UINT adj)
 116 {
 117     while (count > 0)
 118     {
 119         DWORD dest = *(const BYTE *)src, *dest32 = dst;
 120         *dest32 = le32(dest * 16843009 - 2147483648U);
 121
 122         dst = (char *)dst + dst_stride;
 123         src_advance(&src, src_stride, &count, &freqAcc, adj);
 124     }
 125 }
 126
 127 static void convert_16_to_8 (const void *src, void *dst, UINT src_stride,
 128         UINT dst_stride, INT count, UINT freqAcc, UINT adj)
 129 {
 130     while (count > 0)
 131     {
 132         BYTE *dst8 = dst;
 133         *dst8 = (le16(*(const WORD *)src)) / 256;
 134         *dst8 -= 0x80;
 135
 136         dst = (char *)dst + dst_stride;
 137         src_advance(&src, src_stride, &count, &freqAcc, adj);
 138     }
 139 }
 140
 141 static void convert_16_to_16 (const void *src, void *dst, UINT src_stride,
 142         UINT dst_stride, INT count, UINT freqAcc, UINT adj)
 143 {
 144     while (count > 0)
 145     {
 146         *(WORD *)dst = *(const WORD *)src;
 147
 148         dst = (char *)dst + dst_stride;
 149         src_advance(&src, src_stride, &count, &freqAcc, adj);
 150     }
 151 }
 152
 153 static void convert_16_to_24 (const void *src, void *dst, UINT src_stride,
 154         UINT dst_stride, INT count, UINT freqAcc, UINT adj)
 155 {
 156     while (count > 0)
 157     {
 158         WORD dest = le16(*(const WORD *)src);
 159         BYTE *dest24 = dst;
 160
 161         dest24[0] = dest / 256;
 162         dest24[1] = dest;
 163         dest24[2] = dest / 256;
 164
 165         dst = (char *)dst + dst_stride;
 166         src_advance(&src, src_stride, &count, &freqAcc, adj);
 167     }
 168 }
 169
 170 static void convert_16_to_32 (const void *src, void *dst, UINT src_stride,
 171         UINT dst_stride, INT count, UINT freqAcc, UINT adj)
 172 {
 173     while (count > 0)
 174     {
 175         DWORD dest = *(const WORD *)src, *dest32 = dst;
 176         *dest32 = dest * 65537;
 177
 178         dst = (char *)dst + dst_stride;
 179         src_advance(&src, src_stride, &count, &freqAcc, adj);
 180     }
 181 }
 182
 183 static void convert_24_to_8 (const void *src, void *dst, UINT src_stride,
 184         UINT dst_stride, INT count, UINT freqAcc, UINT adj)
 185 {
 186     while (count > 0)
 187     {
 188         BYTE *dst8 = dst;
 189         *dst8 = ((const BYTE *)src)[2];
 190
 191         dst = (char *)dst + dst_stride;
 192         src_advance(&src, src_stride, &count, &freqAcc, adj);
 193     }
 194 }
 195
 196 static void convert_24_to_16 (const void *src, void *dst, UINT src_stride,
 197         UINT dst_stride, INT count, UINT freqAcc, UINT adj)
 198 {
 199     while (count > 0)
 200     {
 201         WORD *dest16 = dst;
 202         const BYTE *source = src;
 203         *dest16 = le16(source[2] * 256 + source[1]);
 204
 205         dst = (char *)dst + dst_stride;
 206         src_advance(&src, src_stride, &count, &freqAcc, adj);
 207     }
 208 }
 209
 210 static void convert_24_to_24 (const void *src, void *dst, UINT src_stride,
 211         UINT dst_stride, INT count, UINT freqAcc, UINT adj)
 212 {
 213     while (count > 0)
 214     {
 215         BYTE *dest24 = dst;
 216         const BYTE *src24 = src;
 217
 218         dest24[0] = src24[0];
 219         dest24[1] = src24[1];
 220         dest24[2] = src24[2];
 221
 222         dst = (char *)dst + dst_stride;
 223         src_advance(&src, src_stride, &count, &freqAcc, adj);
 224     }
 225 }
 226
 227 static void convert_24_to_32 (const void *src, void *dst, UINT src_stride,
 228         UINT dst_stride, INT count, UINT freqAcc, UINT adj)
 229 {
 230     while (count > 0)
 231     {
 232         DWORD *dest32 = dst;
 233         const BYTE *source = src;
 234         *dest32 = le32(source[2] * 16777217 + source[1] * 65536 + source[0] * 256);
 235
 236         dst = (char *)dst + dst_stride;
 237         src_advance(&src, src_stride, &count, &freqAcc, adj);
 238     }
 239 }
 240
 241 static void convert_32_to_8 (const void *src, void *dst, UINT src_stride,
 242         UINT dst_stride, INT count, UINT freqAcc, UINT adj)
 243 {
 244     while (count > 0)
 245     {
 246         BYTE *dst8 = dst;
 247         *dst8 = (le32(*(const DWORD *)src) / 16777216);
 248         *dst8 -= 0x80;
 249
 250         dst = (char *)dst + dst_stride;
 251         src_advance(&src, src_stride, &count, &freqAcc, adj);
 252     }
 253 }
 254
 255 static void convert_32_to_16 (const void *src, void *dst, UINT src_stride,
 256         UINT dst_stride, INT count, UINT freqAcc, UINT adj)
 257 {
 258     while (count > 0)
 259     {
 260         WORD *dest16 = dst;
 261         *dest16 = le16(le32(*(const DWORD *)src) / 65536);
 262
 263         dst = (char *)dst + dst_stride;
 264         src_advance(&src, src_stride, &count, &freqAcc, adj);
 265     }
 266 }
 267
 268 static void convert_32_to_24 (const void *src, void *dst, UINT src_stride,
 269         UINT dst_stride, INT count, UINT freqAcc, UINT adj)
 270 {
 271     while (count > 0)
 272     {
 273         DWORD dest = le32(*(const DWORD *)src);
 274         BYTE *dest24 = dst;
 275
 276         dest24[0] = dest / 256;
 277         dest24[1] = dest / 65536;
 278         dest24[2] = dest / 16777216;
 279
 280         dst = (char *)dst + dst_stride;
 281         src_advance(&src, src_stride, &count, &freqAcc, adj);
 282     }
 283 }
 284
 285 static void convert_32_to_32 (const void *src, void *dst, UINT src_stride,
 286         UINT dst_stride, INT count, UINT freqAcc, UINT adj)
 287 {
 288     while (count > 0)
 289     {
 290         DWORD *dest = dst;
 291         *dest = *(const DWORD *)src;
 292
 293         dst = (char *)dst + dst_stride;
 294         src_advance(&src, src_stride, &count, &freqAcc, adj);
 295     }
 296 }
 297
 298 static void convert_ieee_32_to_8 (const void *src, void *dst, UINT src_stride,
 299         UINT dst_stride, INT count, UINT freqAcc, UINT adj)
 300 {
 301     while (count > 0)
 302     {
 303         DWORD src_le = le32(*(DWORD *) src);
 304         float v = *((float *) &src_le);
 305         INT8 d = 0;
 306
 307         if (v < -1.0f)
 308             d = -128;
 309         else if (v >  1.0f)
 310             d = 127;
 311         else
 312             d = v * 127.5f - 0.5f;
 313
 314         *(BYTE *) dst = d ^ 0x80;
 315
 316         dst = (char *)dst + dst_stride;
 317         src_advance(&src, src_stride, &count, &freqAcc, adj);
 318     }
 319 }
 320
 321 static void convert_ieee_32_to_16 (const void *src, void *dst, UINT src_stride,
 322         UINT dst_stride, INT count, UINT freqAcc, UINT adj)
 323 {
 324     while (count > 0)
 325     {
 326         DWORD src_le = le32(*(DWORD *) src);
 327         float v = *((float *) &src_le);
 328
 329         INT16 *d = (INT16 *) dst;
 330
 331         if (v < -1.0f)
 332             *d = -32768;
 333         else if (v >  1.0f)
 334             *d = 32767;
 335         else
 336             *d = v * 32767.5f - 0.5f;
 337
 338         *d = le16(*d);
 339
 340         dst = (char *)dst + dst_stride;
 341         src_advance(&src, src_stride, &count, &freqAcc, adj);
 342     }
 343 }
 344
 345 static void convert_ieee_32_to_24 (const void *src, void *dst, UINT src_stride,
 346         UINT dst_stride, INT count, UINT freqAcc, UINT adj)
 347 {
 348     while (count > 0)
 349     {
 350         DWORD src_le = le32(*(DWORD *) src);
 351         float v = *((float *) &src_le);
 352         BYTE *dest24 = dst;
 353
 354         if (v < -1.0f)
 355         {
 356             dest24[0] = 0;
 357             dest24[1] = 0;
 358             dest24[2] = 0x80;
 359         }
 360         else if (v > 1.0f)
 361         {
 362             dest24[0] = 0xff;
 363             dest24[1] = 0xff;
 364             dest24[2] = 0x7f;
 365         }
 366         else if (v < 0.0f)
 367         {
 368             dest24[0] = v * 8388608.0f;
 369             dest24[1] = v * 32768.0f;
 370             dest24[2] = v * 128.0f;
 371         }
 372         else if (v >= 0.0f)
 373         {
 374             dest24[0] = v * 8388608.0f;
 375             dest24[1] = v * 32768.0f;
 376             dest24[2] = v * 127.0f;
 377         }
 378
 379         dst = (char *)dst + dst_stride;
 380         src_advance(&src, src_stride, &count, &freqAcc, adj);
 381     }
 382 }
 383
 384 static void convert_ieee_32_to_32 (const void *src, void *dst, UINT src_stride,
 385         UINT dst_stride, INT count, UINT freqAcc, UINT adj)
 386 {
 387     while (count > 0)
 388     {
 389         DWORD src_le = le32(*(DWORD *) src);
 390         float v = *((float *) &src_le);
 391         INT32 *d = (INT32 *) dst;
 392
 393         if (v < -1.0f)
 394             *d = -2147483647 - 1; /* silence warning */
 395         else if (v >  1.0f)
 396             *d = 2147483647;
 397         else
 398             *d = v * 2147483647.5f - 0.5f;
 399
 400         *d = le32(*d);
 401
 402         dst = (char *)dst + dst_stride;
 403         src_advance(&src, src_stride, &count, &freqAcc, adj);
 404     }
 405 }
 406
 407 const bitsconvertfunc convertbpp[5][4] = {
 408     { convert_8_to_8, convert_8_to_16, convert_8_to_24, convert_8_to_32 },
 409     { convert_16_to_8, convert_16_to_16, convert_16_to_24, convert_16_to_32 },
 410     { convert_24_to_8, convert_24_to_16, convert_24_to_24, convert_24_to_32 },
 411     { convert_32_to_8, convert_32_to_16, convert_32_to_24, convert_32_to_32 },
 412     { convert_ieee_32_to_8, convert_ieee_32_to_16, convert_ieee_32_to_24, convert_ieee_32_to_32 },
 413 };
 414
 415 static void mix8(signed char *src, INT *dst, unsigned len)
 416 {
 417     TRACE("%p - %p %d\n", src, dst, len);
 418     while (len--)
 419         /* 8-bit WAV is unsigned, it's here converted to signed, normalize function will convert it back again */
 420         *(dst++) += (signed char)((BYTE)*(src++) - (BYTE)0x80);
 421 }
 422
 423 static void mix16(SHORT *src, INT *dst, unsigned len)
 424 {
 425     TRACE("%p - %p %d\n", src, dst, len);
 426     len /= 2;
 427     while (len--)
 428     {
 429         *dst += le16(*src);
 430         ++dst; ++src;
 431     }
 432 }
 433
 434 static void mix24(BYTE *src, INT *dst, unsigned len)
 435 {
 436     TRACE("%p - %p %d\n", src, dst, len);
 437     len /= 3;
 438     while (len--)
 439     {
 440         DWORD field;
 441         field = ((DWORD)src[2] << 16) + ((DWORD)src[1] << 8) + (DWORD)src[0];
 442         if (src[2] & 0x80)
 443             field |= 0xFF000000U;
 444         *(dst++) += field;
 445         ++src;
 446     }
 447 }
 448
 449 static void mix32(INT *src, LONGLONG *dst, unsigned len)
 450 {
 451     TRACE("%p - %p %d\n", src, dst, len);
 452     len /= 4;
 453     while (len--)
 454         *(dst++) += le32(*(src++));
 455 }
 456
 457 const mixfunc mixfunctions[4] = {
 458     (mixfunc)mix8,
 459     (mixfunc)mix16,
 460     (mixfunc)mix24,
 461     (mixfunc)mix32
 462 };
 463
 464 static void norm8(INT *src, signed char *dst, unsigned len)
 465 {
 466     TRACE("%p - %p %d\n", src, dst, len);
 467     while (len--)
 468     {
 469         *dst = (*src) + 0x80;
 470         if (*src < -0x80)
 471             *dst = 0;
 472         else if (*src > 0x7f)
 473             *dst = 0xff;
 474         ++dst;
 475         ++src;
 476     }
 477 }
 478
 479 static void norm16(INT *src, SHORT *dst, unsigned len)
 480 {
 481     TRACE("%p - %p %d\n", src, dst, len);
 482     len /= 2;
 483     while (len--)
 484     {
 485         *dst = le16(*src);
 486         if (*src <= -0x8000)
 487             *dst = le16(0x8000);
 488         else if (*src > 0x7fff)
 489             *dst = le16(0x7fff);
 490         ++dst;
 491         ++src;
 492     }
 493 }
 494
 495 static void norm24(INT *src, BYTE *dst, unsigned len)
 496 {
 497     TRACE("%p - %p %d\n", src, dst, len);
 498     len /= 3;
 499     while (len--)
 500     {
 501         if (*src <= -0x800000)
 502         {
 503             dst[0] = 0;
 504             dst[1] = 0;
 505             dst[2] = 0x80;
 506         }
 507         else if (*src > 0x7fffff)
 508         {
 509             dst[0] = 0xff;
 510             dst[1] = 0xff;
 511             dst[2] = 0x7f;
 512         }
 513         else
 514         {
 515             dst[0] = *src;
 516             dst[1] = *src >> 8;
 517             dst[2] = *src >> 16;
 518         }
 519         ++dst;
 520         ++src;
 521     }
 522 }
 523
 524 static void norm32(LONGLONG *src, INT *dst, unsigned len)
 525 {
 526     TRACE("%p - %p %d\n", src, dst, len);
 527     len /= 4;
 528     while (len--)
 529     {
 530         *dst = le32(*src);
 531         if (*src <= -(LONGLONG)0x80000000)
 532             *dst = le32(0x80000000);
 533         else if (*src > 0x7fffffff)
 534             *dst = le32(0x7fffffff);
 535         ++dst;
 536         ++src;
 537     }
 538 }
 539
 540 const normfunc normfunctions[4] = {
 541     (normfunc)norm8,
 542     (normfunc)norm16,
 543     (normfunc)norm24,
 544     (normfunc)norm32,
 545 };