1 /* DirectSound
2 *
3 * Copyright 1998 Marcus Meissner
4 * Copyright 1998 Rob Riggs
5 * Copyright 2000-2002 TransGaming Technologies, Inc.
6 * Copyright 2007 Peter Dons Tychsen
7 * Copyright 2007 Maarten Lankhorst
8 *
9 * This library is free software; you can redistribute it and/or
10 * modify it under the terms of the GNU Lesser General Public
11 * License as published by the Free Software Foundation; either
12 * version 2.1 of the License, or (at your option) any later version.
13 *
14 * This library is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
17 * Lesser General Public License for more details.
18 *
19 * You should have received a copy of the GNU Lesser General Public
20 * License along with this library; if not, write to the Free Software
21 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301, USA
22 */
23
24 #include <assert.h>
25 #include <stdarg.h>
26 #include <math.h> /* Insomnia - pow() function */
27
28 #define NONAMELESSSTRUCT
29 #define NONAMELESSUNION
30 #include "windef.h"
31 #include "winbase.h"
32 #include "mmsystem.h"
33 #include "winternl.h"
34 #include "wine/debug.h"
35 #include "dsound.h"
36 #include "dsdriver.h"
37 #include "dsound_private.h"
38
39 WINE_DEFAULT_DEBUG_CHANNEL(dsound);
40
41 void DSOUND_RecalcVolPan(PDSVOLUMEPAN volpan)
42 {
43 double temp;
44 TRACE("(%p)\n",volpan);
45
46 TRACE("Vol=%d Pan=%d\n", volpan->lVolume, volpan->lPan);
47 /* the AmpFactors are expressed in 16.16 fixed point */
48 volpan->dwVolAmpFactor = (ULONG) (pow(2.0, volpan->lVolume / 600.0) * 0xffff);
49 /* FIXME: dwPan{Left|Right}AmpFactor */
50
51 /* FIXME: use calculated vol and pan ampfactors */
52 temp = (double) (volpan->lVolume - (volpan->lPan > 0 ? volpan->lPan : 0));
53 volpan->dwTotalLeftAmpFactor = (ULONG) (pow(2.0, temp / 600.0) * 0xffff);
54 temp = (double) (volpan->lVolume + (volpan->lPan < 0 ? volpan->lPan : 0));
55 volpan->dwTotalRightAmpFactor = (ULONG) (pow(2.0, temp / 600.0) * 0xffff);
56
57 TRACE("left = %x, right = %x\n", volpan->dwTotalLeftAmpFactor, volpan->dwTotalRightAmpFactor);
58 }
59
60 void DSOUND_AmpFactorToVolPan(PDSVOLUMEPAN volpan)
61 {
62 double left,right;
63 TRACE("(%p)\n",volpan);
64
65 TRACE("left=%x, right=%x\n",volpan->dwTotalLeftAmpFactor,volpan->dwTotalRightAmpFactor);
66 if (volpan->dwTotalLeftAmpFactor==0)
67 left=-10000;
68 else
69 left=600 * log(((double)volpan->dwTotalLeftAmpFactor) / 0xffff) / log(2);
70 if (volpan->dwTotalRightAmpFactor==0)
71 right=-10000;
72 else
73 right=600 * log(((double)volpan->dwTotalRightAmpFactor) / 0xffff) / log(2);
74 if (left<right)
75 {
76 volpan->lVolume=right;
77 volpan->dwVolAmpFactor=volpan->dwTotalRightAmpFactor;
78 }
79 else
80 {
81 volpan->lVolume=left;
82 volpan->dwVolAmpFactor=volpan->dwTotalLeftAmpFactor;
83 }
84 if (volpan->lVolume < -10000)
85 volpan->lVolume=-10000;
86 volpan->lPan=right-left;
87 if (volpan->lPan < -10000)
88 volpan->lPan=-10000;
89
90 TRACE("Vol=%d Pan=%d\n", volpan->lVolume, volpan->lPan);
91 }
92
93 /** Convert a primary buffer position to a pointer position for device->mix_buffer
94 * device: DirectSoundDevice for which to calculate
95 * pos: Primary buffer position to converts
96 * Returns: Offset for mix_buffer
97 */
98 DWORD DSOUND_bufpos_to_mixpos(const DirectSoundDevice* device, DWORD pos)
99 {
100 DWORD ret = pos * 32 / device->pwfx->wBitsPerSample;
101 if (device->pwfx->wBitsPerSample == 32)
102 ret *= 2;
103 return ret;
104 }
105
106 /* NOTE: Not all secpos have to always be mapped to a bufpos, other way around is always the case
107 * DWORD64 is used here because a single DWORD wouldn't be big enough to fit the freqAcc for big buffers
108 */
109 /** This function converts a 'native' sample pointer to a resampled pointer that fits for primary
110 * secmixpos is used to decide which freqAcc is needed
111 * overshot tells what the 'actual' secpos is now (optional)
112 */
113 DWORD DSOUND_secpos_to_bufpos(const IDirectSoundBufferImpl *dsb, DWORD secpos, DWORD secmixpos, DWORD* overshot)
114 {
115 DWORD64 framelen = secpos / dsb->pwfx->nBlockAlign;
116 DWORD64 freqAdjust = dsb->freqAdjust;
117 DWORD64 acc, freqAcc;
118
119 if (secpos < secmixpos)
120 freqAcc = dsb->freqAccNext;
121 else freqAcc = dsb->freqAcc;
122 acc = (framelen << DSOUND_FREQSHIFT) + (freqAdjust - 1 - freqAcc);
123 acc /= freqAdjust;
124 if (overshot)
125 {
126 DWORD64 oshot = acc * freqAdjust + freqAcc;
127 assert(oshot >= framelen << DSOUND_FREQSHIFT);
128 oshot -= framelen << DSOUND_FREQSHIFT;
129 *overshot = (DWORD)oshot;
130 assert(*overshot < dsb->freqAdjust);
131 }
132 return (DWORD)acc * dsb->device->pwfx->nBlockAlign;
133 }
134
135 /** Convert a resampled pointer that fits for primary to a 'native' sample pointer
136 * freqAccNext is used here rather than freqAcc: In case the app wants to fill up to
137 * the play position it won't overwrite it
138 */
139 static DWORD DSOUND_bufpos_to_secpos(const IDirectSoundBufferImpl *dsb, DWORD bufpos)
140 {
141 DWORD oAdv = dsb->device->pwfx->nBlockAlign, iAdv = dsb->pwfx->nBlockAlign, pos;
142 DWORD64 framelen;
143 DWORD64 acc;
144
145 framelen = bufpos/oAdv;
146 acc = framelen * (DWORD64)dsb->freqAdjust + (DWORD64)dsb->freqAccNext;
147 acc = acc >> DSOUND_FREQSHIFT;
148 pos = (DWORD)acc * iAdv;
149 if (pos >= dsb->buflen)
150 /* Because of differences between freqAcc and freqAccNext, this might happen */
151 pos = dsb->buflen - iAdv;
152 TRACE("Converted %d/%d to %d/%d\n", bufpos, dsb->tmp_buffer_len, pos, dsb->buflen);
153 return pos;
154 }
155
156 /**
157 * Move freqAccNext to freqAcc, and find new values for buffer length and freqAccNext
158 */
159 static void DSOUND_RecalcFreqAcc(IDirectSoundBufferImpl *dsb)
160 {
161 if (!dsb->freqneeded) return;
162 dsb->freqAcc = dsb->freqAccNext;
163 dsb->tmp_buffer_len = DSOUND_secpos_to_bufpos(dsb, dsb->buflen, 0, &dsb->freqAccNext);
164 TRACE("New freqadjust: %04x, new buflen: %d\n", dsb->freqAccNext, dsb->tmp_buffer_len);
165 }
166
167 /**
168 * Recalculate the size for temporary buffer, and new writelead
169 * Should be called when one of the following things occur:
170 * - Primary buffer format is changed
171 * - This buffer format (frequency) is changed
172 *
173 * After this, DSOUND_MixToTemporary(dsb, 0, dsb->buflen) should
174 * be called to refill the temporary buffer with data.
175 */
176 void DSOUND_RecalcFormat(IDirectSoundBufferImpl *dsb)
177 {
178 BOOL needremix = TRUE, needresample = (dsb->freq != dsb->device->pwfx->nSamplesPerSec);
179 DWORD bAlign = dsb->pwfx->nBlockAlign, pAlign = dsb->device->pwfx->nBlockAlign;
180
181 TRACE("(%p)\n",dsb);
182
183 /* calculate the 10ms write lead */
184 dsb->writelead = (dsb->freq / 100) * dsb->pwfx->nBlockAlign;
185
186 if ((dsb->pwfx->wBitsPerSample == dsb->device->pwfx->wBitsPerSample) &&
187 (dsb->pwfx->nChannels == dsb->device->pwfx->nChannels) && !needresample)
188 needremix = FALSE;
189 HeapFree(GetProcessHeap(), 0, dsb->tmp_buffer);
190 dsb->tmp_buffer = NULL;
191 dsb->max_buffer_len = dsb->freqAcc = dsb->freqAccNext = 0;
192 dsb->freqneeded = needresample;
193
194 dsb->convert = convertbpp[dsb->pwfx->wBitsPerSample/8 - 1][dsb->device->pwfx->wBitsPerSample/8 - 1];
195
196 dsb->resampleinmixer = FALSE;
197
198 if (needremix)
199 {
200 if (needresample)
201 DSOUND_RecalcFreqAcc(dsb);
202 else
203 dsb->tmp_buffer_len = dsb->buflen / bAlign * pAlign;
204 dsb->max_buffer_len = dsb->tmp_buffer_len;
205 if ((dsb->max_buffer_len <= dsb->device->buflen || dsb->max_buffer_len < ds_snd_shadow_maxsize * 1024 * 1024) && ds_snd_shadow_maxsize >= 0)
206 dsb->tmp_buffer = HeapAlloc(GetProcessHeap(), 0, dsb->max_buffer_len);
207 if (dsb->tmp_buffer)
208 FillMemory(dsb->tmp_buffer, dsb->tmp_buffer_len, dsb->device->pwfx->wBitsPerSample == 8 ? 128 : 0);
209 else
210 dsb->resampleinmixer = TRUE;
211 }
212 else dsb->max_buffer_len = dsb->tmp_buffer_len = dsb->buflen;
213 dsb->buf_mixpos = DSOUND_secpos_to_bufpos(dsb, dsb->sec_mixpos, 0, NULL);
214 }
215
216 /**
217 * Check for application callback requests for when the play position
218 * reaches certain points.
219 *
220 * The offsets that will be triggered will be those between the recorded
221 * "last played" position for the buffer (i.e. dsb->playpos) and "len" bytes
222 * beyond that position.
223 */
224 void DSOUND_CheckEvent(const IDirectSoundBufferImpl *dsb, DWORD playpos, int len)
225 {
226 int i;
227 DWORD offset;
228 LPDSBPOSITIONNOTIFY event;
229 TRACE("(%p,%d)\n",dsb,len);
230
231 if (dsb->nrofnotifies == 0)
232 return;
233
234 TRACE("(%p) buflen = %d, playpos = %d, len = %d\n",
235 dsb, dsb->buflen, playpos, len);
236 for (i = 0; i < dsb->nrofnotifies ; i++) {
237 event = dsb->notifies + i;
238 offset = event->dwOffset;
239 TRACE("checking %d, position %d, event = %p\n",
240 i, offset, event->hEventNotify);
241 /* DSBPN_OFFSETSTOP has to be the last element. So this is */
242 /* OK. [Inside DirectX, p274] */
243 /* Windows does not seem to enforce this, and some apps rely */
244 /* on that, so we can't stop there. */
245 /* */
246 /* This also means we can't sort the entries by offset, */
247 /* because DSBPN_OFFSETSTOP == -1 */
248 if (offset == DSBPN_OFFSETSTOP) {
249 if (dsb->state == STATE_STOPPED) {
250 SetEvent(event->hEventNotify);
251 TRACE("signalled event %p (%d)\n", event->hEventNotify, i);
252 }
253 continue;
254 }
255 if ((playpos + len) >= dsb->buflen) {
256 if ((offset < ((playpos + len) % dsb->buflen)) ||
257 (offset >= playpos)) {
258 TRACE("signalled event %p (%d)\n", event->hEventNotify, i);
259 SetEvent(event->hEventNotify);
260 }
261 } else {
262 if ((offset >= playpos) && (offset < (playpos + len))) {
263 TRACE("signalled event %p (%d)\n", event->hEventNotify, i);
264 SetEvent(event->hEventNotify);
265 }
266 }
267 }
268 }
269
270 /**
271 * Copy a single frame from the given input buffer to the given output buffer.
272 * Translate 8 <-> 16 bits and mono <-> stereo
273 */
274 static inline void cp_fields(const IDirectSoundBufferImpl *dsb, const BYTE *ibuf, BYTE *obuf )
275 {
276 DirectSoundDevice *device = dsb->device;
277 INT istep = dsb->pwfx->wBitsPerSample / 8, ostep = device->pwfx->wBitsPerSample / 8;
278
279 if (device->pwfx->nChannels == dsb->pwfx->nChannels) {
280 dsb->convert(ibuf, obuf);
281 if (device->pwfx->nChannels == 2)
282 dsb->convert(ibuf + istep, obuf + ostep);
283 }
284
285 if (device->pwfx->nChannels == 1 && dsb->pwfx->nChannels == 2)
286 {
287 dsb->convert(ibuf, obuf);
288 }
289
290 if (device->pwfx->nChannels == 2 && dsb->pwfx->nChannels == 1)
291 {
292 dsb->convert(ibuf, obuf);
293 dsb->convert(ibuf, obuf + ostep);
294 }
295 }
296
297 /**
298 * Calculate the distance between two buffer offsets, taking wraparound
299 * into account.
300 */
301 static inline DWORD DSOUND_BufPtrDiff(DWORD buflen, DWORD ptr1, DWORD ptr2)
302 {
303 /* If these asserts fail, the problem is not here, but in the underlying code */
304 assert(ptr1 < buflen);
305 assert(ptr2 < buflen);
306 if (ptr1 >= ptr2) {
307 return ptr1 - ptr2;
308 } else {
309 return buflen + ptr1 - ptr2;
310 }
311 }
312 /**
313 * Mix at most the given amount of data into the allocated temporary buffer
314 * of the given secondary buffer, starting from the dsb's first currently
315 * unsampled frame (writepos), translating frequency (pitch), stereo/mono
316 * and bits-per-sample so that it is ideal for the primary buffer.
317 * Doesn't perform any mixing - this is a straight copy/convert operation.
318 *
319 * dsb = the secondary buffer
320 * writepos = Starting position of changed buffer
321 * len = number of bytes to resample from writepos
322 *
323 * NOTE: writepos + len <= buflen. When called by mixer, MixOne makes sure of this.
324 */
325 void DSOUND_MixToTemporary(const IDirectSoundBufferImpl *dsb, DWORD writepos, DWORD len, BOOL inmixer)
326 {
327 INT i, size;
328 BYTE *ibp, *obp, *obp_begin;
329 INT iAdvance = dsb->pwfx->nBlockAlign;
330 INT oAdvance = dsb->device->pwfx->nBlockAlign;
331 DWORD freqAcc, target_writepos = 0, overshot, maxlen;
332
333 /* We resample only when needed */
334 if ((dsb->tmp_buffer && inmixer) || (!dsb->tmp_buffer && !inmixer) || dsb->resampleinmixer != inmixer)
335 return;
336
337 assert(writepos + len <= dsb->buflen);
338 if (inmixer && writepos + len < dsb->buflen)
339 len += dsb->pwfx->nBlockAlign;
340
341 maxlen = DSOUND_secpos_to_bufpos(dsb, len, 0, NULL);
342
343 ibp = dsb->buffer->memory + writepos;
344 if (!inmixer)
345 obp_begin = dsb->tmp_buffer;
346 else if (dsb->device->tmp_buffer_len < maxlen || !dsb->device->tmp_buffer)
347 {
348 dsb->device->tmp_buffer_len = maxlen;
349 if (dsb->device->tmp_buffer)
350 dsb->device->tmp_buffer = HeapReAlloc(GetProcessHeap(), 0, dsb->device->tmp_buffer, maxlen);
351 else
352 dsb->device->tmp_buffer = HeapAlloc(GetProcessHeap(), 0, maxlen);
353 obp_begin = dsb->device->tmp_buffer;
354 }
355 else
356 obp_begin = dsb->device->tmp_buffer;
357
358 TRACE("(%p, %p)\n", dsb, ibp);
359
360 /* Check for same sample rate */
361 if (dsb->freq == dsb->device->pwfx->nSamplesPerSec) {
362 TRACE("(%p) Same sample rate %d = primary %d\n", dsb,
363 dsb->freq, dsb->device->pwfx->nSamplesPerSec);
364 obp = obp_begin;
365 if (!inmixer)
366 obp += writepos/iAdvance*oAdvance;
367
368 for (i = 0; i < len; i += iAdvance) {
369 cp_fields(dsb, ibp, obp);
370 ibp += iAdvance;
371 obp += oAdvance;
372 }
373 return;
374 }
375
376 /* Mix in different sample rates */
377 TRACE("(%p) Adjusting frequency: %d -> %d\n", dsb, dsb->freq, dsb->device->pwfx->nSamplesPerSec);
378 size = len / iAdvance;
379
380 target_writepos = DSOUND_secpos_to_bufpos(dsb, writepos, dsb->sec_mixpos, &freqAcc);
381 overshot = freqAcc >> DSOUND_FREQSHIFT;
382 if (overshot)
383 {
384 if (overshot >= size)
385 return;
386 size -= overshot;
387 writepos += overshot * iAdvance;
388 if (writepos >= dsb->buflen)
389 return;
390 ibp = dsb->buffer->memory + writepos;
391 freqAcc &= (1 << DSOUND_FREQSHIFT) - 1;
392 TRACE("Overshot: %d, freqAcc: %04x\n", overshot, freqAcc);
393 }
394
395 if (!inmixer)
396 obp = obp_begin + target_writepos;
397 else obp = obp_begin;
398
399 /* FIXME: Small problem here when we're overwriting buf_mixpos, it then STILL uses old freqAcc, not sure if it matters or not */
400 while (size > 0) {
401 cp_fields(dsb, ibp, obp);
402 obp += oAdvance;
403 freqAcc += dsb->freqAdjust;
404 if (freqAcc >= (1<<DSOUND_FREQSHIFT)) {
405 ULONG adv = (freqAcc>>DSOUND_FREQSHIFT);
406 freqAcc &= (1<<DSOUND_FREQSHIFT)-1;
407 ibp += adv * iAdvance;
408 size -= adv;
409 }
410 }
411 }
412
413 /** Apply volume to the given soundbuffer from (primary) position writepos and length len
414 * Returns: NULL if no volume needs to be applied
415 * or else a memory handle that holds 'len' volume adjusted buffer */
416 static LPBYTE DSOUND_MixerVol(const IDirectSoundBufferImpl *dsb, INT len)
417 {
418 INT i;
419 BYTE *bpc;
420 INT16 *bps, *mems;
421 DWORD vLeft, vRight;
422 INT nChannels = dsb->device->pwfx->nChannels;
423 LPBYTE mem = (dsb->tmp_buffer ? dsb->tmp_buffer : dsb->buffer->memory) + dsb->buf_mixpos;
424
425 if (dsb->resampleinmixer)
426 mem = dsb->device->tmp_buffer;
427
428 TRACE("(%p,%d)\n",dsb,len);
429 TRACE("left = %x, right = %x\n", dsb->volpan.dwTotalLeftAmpFactor,
430 dsb->volpan.dwTotalRightAmpFactor);
431
432 if ((!(dsb->dsbd.dwFlags & DSBCAPS_CTRLPAN) || (dsb->volpan.lPan == 0)) &&
433 (!(dsb->dsbd.dwFlags & DSBCAPS_CTRLVOLUME) || (dsb->volpan.lVolume == 0)) &&
434 !(dsb->dsbd.dwFlags & DSBCAPS_CTRL3D))
435 return NULL; /* Nothing to do */
436
437 if (nChannels != 1 && nChannels != 2)
438 {
439 FIXME("There is no support for %d channels\n", nChannels);
440 return NULL;
441 }
442
443 if (dsb->device->pwfx->wBitsPerSample != 8 && dsb->device->pwfx->wBitsPerSample != 16)
444 {
445 FIXME("There is no support for %d bpp\n", dsb->device->pwfx->wBitsPerSample);
446 return NULL;
447 }
448
449 if (dsb->device->tmp_buffer_len < len || !dsb->device->tmp_buffer)
450 {
451 /* If we just resampled in DSOUND_MixToTemporary, we shouldn't need to resize here */
452 assert(!dsb->resampleinmixer);
453 dsb->device->tmp_buffer_len = len;
454 if (dsb->device->tmp_buffer)
455 dsb->device->tmp_buffer = HeapReAlloc(GetProcessHeap(), 0, dsb->device->tmp_buffer, len);
456 else
457 dsb->device->tmp_buffer = HeapAlloc(GetProcessHeap(), 0, len);
458 }
459
460 bpc = dsb->device->tmp_buffer;
461 bps = (INT16 *)bpc;
462 mems = (INT16 *)mem;
463 vLeft = dsb->volpan.dwTotalLeftAmpFactor;
464 if (nChannels > 1)
465 vRight = dsb->volpan.dwTotalRightAmpFactor;
466 else
467 vRight = vLeft;
468
469 switch (dsb->device->pwfx->wBitsPerSample) {
470 case 8:
471 /* 8-bit WAV is unsigned, but we need to operate */
472 /* on signed data for this to work properly */
473 for (i = 0; i < len-1; i+=2) {
474 *(bpc++) = (((*(mem++) - 128) * vLeft) >> 16) + 128;
475 *(bpc++) = (((*(mem++) - 128) * vRight) >> 16) + 128;
476 }
477 if (len % 2 == 1 && nChannels == 1)
478 *(bpc++) = (((*(mem++) - 128) * vLeft) >> 16) + 128;
479 break;
480 case 16:
481 /* 16-bit WAV is signed -- much better */
482 for (i = 0; i < len-3; i += 4) {
483 *(bps++) = (*(mems++) * vLeft) >> 16;
484 *(bps++) = (*(mems++) * vRight) >> 16;
485 }
486 if (len % 4 == 2 && nChannels == 1)
487 *(bps++) = ((INT)*(mems++) * vLeft) >> 16;
488 break;
489 }
490 return dsb->device->tmp_buffer;
491 }
492
493 /**
494 * Mix (at most) the given number of bytes into the given position of the
495 * device buffer, from the secondary buffer "dsb" (starting at the current
496 * mix position for that buffer).
497 *
498 * Returns the number of bytes actually mixed into the device buffer. This
499 * will match fraglen unless the end of the secondary buffer is reached
500 * (and it is not looping).
501 *
502 * dsb = the secondary buffer to mix from
503 * writepos = position (offset) in device buffer to write at
504 * fraglen = number of bytes to mix
505 */
506 static DWORD DSOUND_MixInBuffer(IDirectSoundBufferImpl *dsb, DWORD writepos, DWORD fraglen)
507 {
508 INT len = fraglen, ilen;
509 BYTE *ibuf = (dsb->tmp_buffer ? dsb->tmp_buffer : dsb->buffer->memory) + dsb->buf_mixpos, *volbuf;
510 DWORD oldpos, mixbufpos;
511
512 TRACE("buf_mixpos=%d/%d sec_mixpos=%d/%d\n", dsb->buf_mixpos, dsb->tmp_buffer_len, dsb->sec_mixpos, dsb->buflen);
513 TRACE("(%p,%d,%d)\n",dsb,writepos,fraglen);
514
515 assert(dsb->buf_mixpos + len <= dsb->tmp_buffer_len);
516
517 if (len % dsb->device->pwfx->nBlockAlign) {
518 INT nBlockAlign = dsb->device->pwfx->nBlockAlign;
519 ERR("length not a multiple of block size, len = %d, block size = %d\n", len, nBlockAlign);
520 len -= len % nBlockAlign; /* data alignment */
521 }
522
523 /* Resample buffer to temporary buffer specifically allocated for this purpose, if needed */
524 DSOUND_MixToTemporary(dsb, dsb->sec_mixpos, DSOUND_bufpos_to_secpos(dsb, dsb->buf_mixpos+len) - dsb->sec_mixpos, TRUE);
525 if (dsb->resampleinmixer)
526 ibuf = dsb->device->tmp_buffer;
527
528 /* Apply volume if needed */
529 volbuf = DSOUND_MixerVol(dsb, len);
530 if (volbuf)
531 ibuf = volbuf;
532
533 mixbufpos = DSOUND_bufpos_to_mixpos(dsb->device, writepos);
534 /* Now mix the temporary buffer into the devices main buffer */
535 if ((writepos + len) <= dsb->device->buflen)
536 dsb->device->mixfunction(ibuf, dsb->device->mix_buffer + mixbufpos, len);
537 else
538 {
539 DWORD todo = dsb->device->buflen - writepos;
540 dsb->device->mixfunction(ibuf, dsb->device->mix_buffer + mixbufpos, todo);
541 dsb->device->mixfunction(ibuf + todo, dsb->device->mix_buffer, len - todo);
542 }
543
544 oldpos = dsb->sec_mixpos;
545 dsb->buf_mixpos += len;
546
547 if (dsb->buf_mixpos >= dsb->tmp_buffer_len) {
548 if (dsb->buf_mixpos > dsb->tmp_buffer_len)
549 ERR("Mixpos (%u) past buflen (%u), capping...\n", dsb->buf_mixpos, dsb->tmp_buffer_len);
550 if (dsb->playflags & DSBPLAY_LOOPING) {
551 dsb->buf_mixpos -= dsb->tmp_buffer_len;
552 } else if (dsb->buf_mixpos >= dsb->tmp_buffer_len) {
553 dsb->buf_mixpos = dsb->sec_mixpos = 0;
554 dsb->state = STATE_STOPPED;
555 }
556 DSOUND_RecalcFreqAcc(dsb);
557 }
558
559 dsb->sec_mixpos = DSOUND_bufpos_to_secpos(dsb, dsb->buf_mixpos);
560 ilen = DSOUND_BufPtrDiff(dsb->buflen, dsb->sec_mixpos, oldpos);
561 /* check for notification positions */
562 if (dsb->dsbd.dwFlags & DSBCAPS_CTRLPOSITIONNOTIFY &&
563 dsb->state != STATE_STARTING) {
564 DSOUND_CheckEvent(dsb, oldpos, ilen);
565 }
566
567 /* increase mix position */
568 dsb->primary_mixpos += len;
569 if (dsb->primary_mixpos >= dsb->device->buflen)
570 dsb->primary_mixpos -= dsb->device->buflen;
571 return len;
572 }
573
574 /**
575 * Mix some frames from the given secondary buffer "dsb" into the device
576 * primary buffer.
577 *
578 * dsb = the secondary buffer
579 * playpos = the current play position in the device buffer (primary buffer)
580 * writepos = the current safe-to-write position in the device buffer
581 * mixlen = the maximum number of bytes in the primary buffer to mix, from the
582 * current writepos.
583 *
584 * Returns: the number of bytes beyond the writepos that were mixed.
585 */
586 static DWORD DSOUND_MixOne(IDirectSoundBufferImpl *dsb, DWORD writepos, DWORD mixlen)
587 {
588 /* The buffer's primary_mixpos may be before or after the device
589 * buffer's mixpos, but both must be ahead of writepos. */
590 DWORD primary_done;
591
592 TRACE("(%p,%d,%d)\n",dsb,writepos,mixlen);
593 TRACE("writepos=%d, buf_mixpos=%d, primary_mixpos=%d, mixlen=%d\n", writepos, dsb->buf_mixpos, dsb->primary_mixpos, mixlen);
594 TRACE("looping=%d, leadin=%d, buflen=%d\n", dsb->playflags, dsb->leadin, dsb->tmp_buffer_len);
595
596 /* If leading in, only mix about 20 ms, and 'skip' mixing the rest, for more fluid pointer advancement */
597 if (dsb->leadin && dsb->state == STATE_STARTING)
598 {
599 if (mixlen > 2 * dsb->device->fraglen)
600 {
601 dsb->primary_mixpos += mixlen - 2 * dsb->device->fraglen;
602 dsb->primary_mixpos %= dsb->device->buflen;
603 }
604 }
605 dsb->leadin = FALSE;
606
607 /* calculate how much pre-buffering has already been done for this buffer */
608 primary_done = DSOUND_BufPtrDiff(dsb->device->buflen, dsb->primary_mixpos, writepos);
609
610 /* sanity */
611 if(mixlen < primary_done)
612 {
613 /* Should *NEVER* happen */
614 ERR("Fatal error. Under/Overflow? primary_done=%d, mixpos=%d/%d (%d/%d), primary_mixpos=%d, writepos=%d, mixlen=%d\n", primary_done,dsb->buf_mixpos,dsb->tmp_buffer_len,dsb->sec_mixpos, dsb->buflen, dsb->primary_mixpos, writepos, mixlen);
615 return 0;
616 }
617
618 /* take into account already mixed data */
619 mixlen -= primary_done;
620
621 TRACE("primary_done=%d, mixlen (primary) = %i\n", primary_done, mixlen);
622
623 if (!mixlen)
624 return primary_done;
625
626 /* First try to mix to the end of the buffer if possible
627 * Theoretically it would allow for better optimization
628 */
629 if (mixlen + dsb->buf_mixpos >= dsb->tmp_buffer_len)
630 {
631 DWORD newmixed, mixfirst = dsb->tmp_buffer_len - dsb->buf_mixpos;
632 newmixed = DSOUND_MixInBuffer(dsb, dsb->primary_mixpos, mixfirst);
633 mixlen -= newmixed;
634
635 if (dsb->playflags & DSBPLAY_LOOPING)
636 while (newmixed && mixlen)
637 {
638 mixfirst = (dsb->tmp_buffer_len < mixlen ? dsb->tmp_buffer_len : mixlen);
639 newmixed = DSOUND_MixInBuffer(dsb, dsb->primary_mixpos, mixfirst);
640 mixlen -= newmixed;
641 }
642 }
643 else DSOUND_MixInBuffer(dsb, dsb->primary_mixpos, mixlen);
644
645 /* re-calculate the primary done */
646 primary_done = DSOUND_BufPtrDiff(dsb->device->buflen, dsb->primary_mixpos, writepos);
647
648 TRACE("new primary_mixpos=%d, total mixed data=%d\n", dsb->primary_mixpos, primary_done);
649
650 /* Report back the total prebuffered amount for this buffer */
651 return primary_done;
652 }
653
654 /**
655 * For a DirectSoundDevice, go through all the currently playing buffers and
656 * mix them in to the device buffer.
657 *
658 * writepos = the current safe-to-write position in the primary buffer
659 * mixlen = the maximum amount to mix into the primary buffer
660 * (beyond the current writepos)
661 * mustlock = Do we have to fight for lock because we otherwise risk an underrun?
662 * recover = true if the sound device may have been reset and the write
663 * position in the device buffer changed
664 * all_stopped = reports back if all buffers have stopped
665 *
666 * Returns: the length beyond the writepos that was mixed to.
667 */
668
669 static DWORD DSOUND_MixToPrimary(const DirectSoundDevice *device, DWORD writepos, DWORD mixlen, BOOL mustlock, BOOL recover, BOOL *all_stopped)
670 {
671 INT i, len;
672 DWORD minlen = 0;
673 IDirectSoundBufferImpl *dsb;
674 BOOL gotall = TRUE;
675
676 /* unless we find a running buffer, all have stopped */
677 *all_stopped = TRUE;
678
679 TRACE("(%d,%d,%d)\n", writepos, mixlen, recover);
680 for (i = 0; i < device->nrofbuffers; i++) {
681 dsb = device->buffers[i];
682
683 TRACE("MixToPrimary for %p, state=%d\n", dsb, dsb->state);
684
685 if (dsb->buflen && dsb->state && !dsb->hwbuf) {
686 TRACE("Checking %p, mixlen=%d\n", dsb, mixlen);
687 if (!RtlAcquireResourceShared(&dsb->lock, mustlock))
688 {
689 gotall = FALSE;
690 continue;
691 }
692 /* if buffer is stopping it is stopped now */
693 if (dsb->state == STATE_STOPPING) {
694 dsb->state = STATE_STOPPED;
695 DSOUND_CheckEvent(dsb, 0, 0);
696 } else if (dsb->state != STATE_STOPPED) {
697
698 /* if recovering, reset the mix position */
699 if ((dsb->state == STATE_STARTING) || recover) {
700 dsb->primary_mixpos = writepos;
701 }
702
703 /* if the buffer was starting, it must be playing now */
704 if (dsb->state == STATE_STARTING)
705 dsb->state = STATE_PLAYING;
706
707 /* mix next buffer into the main buffer */
708 len = DSOUND_MixOne(dsb, writepos, mixlen);
709
710 if (!minlen) minlen = len;
711
712 /* record the minimum length mixed from all buffers */
713 /* we only want to return the length which *all* buffers have mixed */
714 else if (len) minlen = (len < minlen) ? len : minlen;
715
716 *all_stopped = FALSE;
717 }
718 RtlReleaseResource(&dsb->lock);
719 }
720 }
721
722 TRACE("Mixed at least %d from all buffers\n", minlen);
723 if (!gotall) return 0;
724 return minlen;
725 }
726
727 /**
728 * Add buffers to the emulated wave device system.
729 *
730 * device = The current dsound playback device
731 * force = If TRUE, the function will buffer up as many frags as possible,
732 * even though and will ignore the actual state of the primary buffer.
733 *
734 * Returns: None
735 */
736
737 static void DSOUND_WaveQueue(DirectSoundDevice *device, BOOL force)
738 {
739 DWORD prebuf_frags, wave_writepos, wave_fragpos, i;
740 TRACE("(%p)\n", device);
741
742 /* calculate the current wave frag position */
743 wave_fragpos = (device->pwplay + device->pwqueue) % device->helfrags;
744
745 /* calculate the current wave write position */
746 wave_writepos = wave_fragpos * device->fraglen;
747
748 TRACE("wave_fragpos = %i, wave_writepos = %i, pwqueue = %i, prebuf = %i\n",
749 wave_fragpos, wave_writepos, device->pwqueue, device->prebuf);
750
751 if (!force)
752 {
753 /* check remaining prebuffered frags */
754 prebuf_frags = device->mixpos / device->fraglen;
755 if (prebuf_frags == device->helfrags)
756 --prebuf_frags;
757 TRACE("wave_fragpos = %d, mixpos_frags = %d\n", wave_fragpos, prebuf_frags);
758 if (prebuf_frags < wave_fragpos)
759 prebuf_frags += device->helfrags;
760 prebuf_frags -= wave_fragpos;
761 TRACE("wanted prebuf_frags = %d\n", prebuf_frags);
762 }
763 else
764 /* buffer the maximum amount of frags */
765 prebuf_frags = device->prebuf;
766
767 /* limit to the queue we have left */
768 if ((prebuf_frags + device->pwqueue) > device->prebuf)
769 prebuf_frags = device->prebuf - device->pwqueue;
770
771 TRACE("prebuf_frags = %i\n", prebuf_frags);
772
773 /* adjust queue */
774 device->pwqueue += prebuf_frags;
775
776 /* get out of CS when calling the wave system */
777 LeaveCriticalSection(&(device->mixlock));
778 /* **** */
779
780 /* queue up the new buffers */
781 for(i=0; i<prebuf_frags; i++){
782 TRACE("queueing wave buffer %i\n", wave_fragpos);
783 waveOutWrite(device->hwo, &device->pwave[wave_fragpos], sizeof(WAVEHDR));
784 wave_fragpos++;
785 wave_fragpos %= device->helfrags;
786 }
787
788 /* **** */
789 EnterCriticalSection(&(device->mixlock));
790
791 TRACE("queue now = %i\n", device->pwqueue);
792 }
793
794 /**
795 * Perform mixing for a Direct Sound device. That is, go through all the
796 * secondary buffers (the sound bites currently playing) and mix them in
797 * to the primary buffer (the device buffer).
798 */
799 static void DSOUND_PerformMix(DirectSoundDevice *device)
800 {
801 TRACE("(%p)\n", device);
802
803 /* **** */
804 EnterCriticalSection(&(device->mixlock));
805
806 if (device->priolevel != DSSCL_WRITEPRIMARY) {
807 BOOL recover = FALSE, all_stopped = FALSE;
808 DWORD playpos, writepos, writelead, maxq, frag, prebuff_max, prebuff_left, size1, size2, mixplaypos, mixplaypos2;
809 LPVOID buf1, buf2;
810 BOOL lock = (device->hwbuf && !(device->drvdesc.dwFlags & DSDDESC_DONTNEEDPRIMARYLOCK));
811 BOOL mustlock = FALSE;
812 int nfiller;
813
814 /* the sound of silence */
815 nfiller = device->pwfx->wBitsPerSample == 8 ? 128 : 0;
816
817 /* get the position in the primary buffer */
818 if (DSOUND_PrimaryGetPosition(device, &playpos, &writepos) != 0){
819 LeaveCriticalSection(&(device->mixlock));
820 return;
821 }
822
823 TRACE("primary playpos=%d, writepos=%d, clrpos=%d, mixpos=%d, buflen=%d\n",
824 playpos,writepos,device->playpos,device->mixpos,device->buflen);
825 assert(device->playpos < device->buflen);
826
827 mixplaypos = DSOUND_bufpos_to_mixpos(device, device->playpos);
828 mixplaypos2 = DSOUND_bufpos_to_mixpos(device, playpos);
829 /* wipe out just-played sound data */
830 if (playpos < device->playpos) {
831 buf1 = device->buffer + device->playpos;
832 buf2 = device->buffer;
833 size1 = device->buflen - device->playpos;
834 size2 = playpos;
835 FillMemory(device->mix_buffer + mixplaypos, device->mix_buffer_len - mixplaypos, 0);
836 FillMemory(device->mix_buffer, mixplaypos2, 0);
837 if (lock)
838 IDsDriverBuffer_Lock(device->hwbuf, &buf1, &size1, &buf2, &size2, device->playpos, size1+size2, 0);
839 FillMemory(buf1, size1, nfiller);
840 if (playpos && (!buf2 || !size2))
841 FIXME("%d: (%d, %d)=>(%d, %d) There should be an additional buffer here!!\n", __LINE__, device->playpos, device->mixpos, playpos, writepos);
842 FillMemory(buf2, size2, nfiller);
843 if (lock)
844 IDsDriverBuffer_Unlock(device->hwbuf, buf1, size1, buf2, size2);
845 } else {
846 buf1 = device->buffer + device->playpos;
847 buf2 = NULL;
848 size1 = playpos - device->playpos;
849 size2 = 0;
850 FillMemory(device->mix_buffer + mixplaypos, mixplaypos2 - mixplaypos, 0);
851 if (lock)
852 IDsDriverBuffer_Lock(device->hwbuf, &buf1, &size1, &buf2, &size2, device->playpos, size1+size2, 0);
853 FillMemory(buf1, size1, nfiller);
854 if (buf2 && size2)
855 {
856 FIXME("%d: There should be no additional buffer here!!\n", __LINE__);
857 FillMemory(buf2, size2, nfiller);
858 }
859 if (lock)
860 IDsDriverBuffer_Unlock(device->hwbuf, buf1, size1, buf2, size2);
861 }
862 device->playpos = playpos;
863
864 /* calc maximum prebuff */
865 prebuff_max = (device->prebuf * device->fraglen);
866 if (!device->hwbuf && playpos + prebuff_max >= device->helfrags * device->fraglen)
867 prebuff_max += device->buflen - device->helfrags * device->fraglen;
868
869 /* check how close we are to an underrun. It occurs when the writepos overtakes the mixpos */
870 prebuff_left = DSOUND_BufPtrDiff(device->buflen, device->mixpos, playpos);
871 writelead = DSOUND_BufPtrDiff(device->buflen, writepos, playpos);
872
873 /* find the maximum we can prebuffer from current write position */
874 maxq = (writelead < prebuff_max) ? (prebuff_max - writelead) : 0;
875
876 TRACE("prebuff_left = %d, prebuff_max = %dx%d=%d, writelead=%d\n",
877 prebuff_left, device->prebuf, device->fraglen, prebuff_max, writelead);
878
879 /* check for underrun. underrun occurs when the write position passes the mix position */
880 if((prebuff_left > prebuff_max) || (device->state == STATE_STOPPED) || (device->state == STATE_STARTING)){
881 if (device->state == STATE_STOPPING || device->state == STATE_PLAYING)
882 WARN("Probable buffer underrun\n");
883 else TRACE("Buffer starting or buffer underrun\n");
884
885 /* recover mixing for all buffers */
886 recover = TRUE;
887
888 /* reset mix position to write position */
889 device->mixpos = writepos;
890 }
891
892 /* Do we risk an 'underrun' if we don't advance pointer? */
893 if (writelead/device->fraglen <= ds_snd_queue_min || recover)
894 mustlock = TRUE;
895
896 if (lock)
897 IDsDriverBuffer_Lock(device->hwbuf, &buf1, &size1, &buf2, &size2, writepos, maxq, 0);
898
899 /* do the mixing */
900 frag = DSOUND_MixToPrimary(device, writepos, maxq, mustlock, recover, &all_stopped);
901
902 if (frag + writepos > device->buflen)
903 {
904 DWORD todo = device->buflen - writepos;
905 device->normfunction(device->mix_buffer + DSOUND_bufpos_to_mixpos(device, writepos), device->buffer + writepos, todo);
906<