qemu with hax to log dma reads & writes jcs.org/2018/11/12/vfio
at master 572 lines 14 kB view raw
1/* 2 * QEMU Audio subsystem header 3 * 4 * Copyright (c) 2005 Vassili Karpov (malc) 5 * 6 * Permission is hereby granted, free of charge, to any person obtaining a copy 7 * of this software and associated documentation files (the "Software"), to deal 8 * in the Software without restriction, including without limitation the rights 9 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell 10 * copies of the Software, and to permit persons to whom the Software is 11 * furnished to do so, subject to the following conditions: 12 * 13 * The above copyright notice and this permission notice shall be included in 14 * all copies or substantial portions of the Software. 15 * 16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 19 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 20 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 21 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN 22 * THE SOFTWARE. 23 */ 24 25#ifdef DAC 26#define NAME "playback" 27#define HWBUF hw->mix_buf 28#define TYPE out 29#define HW HWVoiceOut 30#define SW SWVoiceOut 31#else 32#define NAME "capture" 33#define TYPE in 34#define HW HWVoiceIn 35#define SW SWVoiceIn 36#define HWBUF hw->conv_buf 37#endif 38 39static void glue(audio_init_nb_voices_, TYPE)(AudioState *s, 40 struct audio_driver *drv) 41{ 42 int max_voices = glue (drv->max_voices_, TYPE); 43 int voice_size = glue (drv->voice_size_, TYPE); 44 45 if (glue (s->nb_hw_voices_, TYPE) > max_voices) { 46 if (!max_voices) { 47#ifdef DAC 48 dolog ("Driver `%s' does not support " NAME "\n", drv->name); 49#endif 50 } 51 else { 52 dolog ("Driver `%s' does not support %d " NAME " voices, max %d\n", 53 drv->name, 54 glue (s->nb_hw_voices_, TYPE), 55 max_voices); 56 } 57 glue (s->nb_hw_voices_, TYPE) = max_voices; 58 } 59 60 if (audio_bug(__func__, !voice_size && max_voices)) { 61 dolog ("drv=`%s' voice_size=0 max_voices=%d\n", 62 drv->name, max_voices); 63 glue (s->nb_hw_voices_, TYPE) = 0; 64 } 65 66 if (audio_bug(__func__, voice_size && !max_voices)) { 67 dolog ("drv=`%s' voice_size=%d max_voices=0\n", 68 drv->name, voice_size); 69 } 70} 71 72static void glue (audio_pcm_hw_free_resources_, TYPE) (HW *hw) 73{ 74 g_free(hw->buf_emul); 75 g_free (HWBUF); 76 HWBUF = NULL; 77} 78 79static void glue(audio_pcm_hw_alloc_resources_, TYPE)(HW *hw) 80{ 81 if (glue(audio_get_pdo_, TYPE)(hw->s->dev)->mixing_engine) { 82 size_t samples = hw->samples; 83 if (audio_bug(__func__, samples == 0)) { 84 dolog("Attempted to allocate empty buffer\n"); 85 } 86 87 HWBUF = g_malloc0(sizeof(STSampleBuffer) + sizeof(st_sample) * samples); 88 HWBUF->size = samples; 89 } else { 90 HWBUF = NULL; 91 } 92} 93 94static void glue (audio_pcm_sw_free_resources_, TYPE) (SW *sw) 95{ 96 g_free (sw->buf); 97 98 if (sw->rate) { 99 st_rate_stop (sw->rate); 100 } 101 102 sw->buf = NULL; 103 sw->rate = NULL; 104} 105 106static int glue (audio_pcm_sw_alloc_resources_, TYPE) (SW *sw) 107{ 108 int samples; 109 110 if (!glue(audio_get_pdo_, TYPE)(sw->s->dev)->mixing_engine) { 111 return 0; 112 } 113 114 samples = ((int64_t) sw->HWBUF->size << 32) / sw->ratio; 115 116 sw->buf = audio_calloc(__func__, samples, sizeof(struct st_sample)); 117 if (!sw->buf) { 118 dolog ("Could not allocate buffer for `%s' (%d samples)\n", 119 SW_NAME (sw), samples); 120 return -1; 121 } 122 123#ifdef DAC 124 sw->rate = st_rate_start (sw->info.freq, sw->hw->info.freq); 125#else 126 sw->rate = st_rate_start (sw->hw->info.freq, sw->info.freq); 127#endif 128 if (!sw->rate) { 129 g_free (sw->buf); 130 sw->buf = NULL; 131 return -1; 132 } 133 return 0; 134} 135 136static int glue (audio_pcm_sw_init_, TYPE) ( 137 SW *sw, 138 HW *hw, 139 const char *name, 140 struct audsettings *as 141 ) 142{ 143 int err; 144 145 audio_pcm_init_info (&sw->info, as); 146 sw->hw = hw; 147 sw->active = 0; 148#ifdef DAC 149 sw->ratio = ((int64_t) sw->hw->info.freq << 32) / sw->info.freq; 150 sw->total_hw_samples_mixed = 0; 151 sw->empty = 1; 152#else 153 sw->ratio = ((int64_t) sw->info.freq << 32) / sw->hw->info.freq; 154#endif 155 156 if (sw->info.is_float) { 157#ifdef DAC 158 sw->conv = mixeng_conv_float[sw->info.nchannels == 2]; 159#else 160 sw->clip = mixeng_clip_float[sw->info.nchannels == 2]; 161#endif 162 } else { 163#ifdef DAC 164 sw->conv = mixeng_conv 165#else 166 sw->clip = mixeng_clip 167#endif 168 [sw->info.nchannels == 2] 169 [sw->info.is_signed] 170 [sw->info.swap_endianness] 171 [audio_bits_to_index(sw->info.bits)]; 172 } 173 174 sw->name = g_strdup (name); 175 err = glue (audio_pcm_sw_alloc_resources_, TYPE) (sw); 176 if (err) { 177 g_free (sw->name); 178 sw->name = NULL; 179 } 180 return err; 181} 182 183static void glue (audio_pcm_sw_fini_, TYPE) (SW *sw) 184{ 185 glue (audio_pcm_sw_free_resources_, TYPE) (sw); 186 g_free (sw->name); 187 sw->name = NULL; 188} 189 190static void glue (audio_pcm_hw_add_sw_, TYPE) (HW *hw, SW *sw) 191{ 192 QLIST_INSERT_HEAD (&hw->sw_head, sw, entries); 193} 194 195static void glue (audio_pcm_hw_del_sw_, TYPE) (SW *sw) 196{ 197 QLIST_REMOVE (sw, entries); 198} 199 200static void glue (audio_pcm_hw_gc_, TYPE) (HW **hwp) 201{ 202 HW *hw = *hwp; 203 AudioState *s = hw->s; 204 205 if (!hw->sw_head.lh_first) { 206#ifdef DAC 207 audio_detach_capture (hw); 208#endif 209 QLIST_REMOVE (hw, entries); 210 glue (hw->pcm_ops->fini_, TYPE) (hw); 211 glue (s->nb_hw_voices_, TYPE) += 1; 212 glue (audio_pcm_hw_free_resources_ ,TYPE) (hw); 213 g_free (hw); 214 *hwp = NULL; 215 } 216} 217 218static HW *glue(audio_pcm_hw_find_any_, TYPE)(AudioState *s, HW *hw) 219{ 220 return hw ? hw->entries.le_next : glue (s->hw_head_, TYPE).lh_first; 221} 222 223static HW *glue(audio_pcm_hw_find_any_enabled_, TYPE)(AudioState *s, HW *hw) 224{ 225 while ((hw = glue(audio_pcm_hw_find_any_, TYPE)(s, hw))) { 226 if (hw->enabled) { 227 return hw; 228 } 229 } 230 return NULL; 231} 232 233static HW *glue(audio_pcm_hw_find_specific_, TYPE)(AudioState *s, HW *hw, 234 struct audsettings *as) 235{ 236 while ((hw = glue(audio_pcm_hw_find_any_, TYPE)(s, hw))) { 237 if (audio_pcm_info_eq (&hw->info, as)) { 238 return hw; 239 } 240 } 241 return NULL; 242} 243 244static HW *glue(audio_pcm_hw_add_new_, TYPE)(AudioState *s, 245 struct audsettings *as) 246{ 247 HW *hw; 248 struct audio_driver *drv = s->drv; 249 250 if (!glue (s->nb_hw_voices_, TYPE)) { 251 return NULL; 252 } 253 254 if (audio_bug(__func__, !drv)) { 255 dolog ("No host audio driver\n"); 256 return NULL; 257 } 258 259 if (audio_bug(__func__, !drv->pcm_ops)) { 260 dolog ("Host audio driver without pcm_ops\n"); 261 return NULL; 262 } 263 264 hw = audio_calloc(__func__, 1, glue(drv->voice_size_, TYPE)); 265 if (!hw) { 266 dolog ("Can not allocate voice `%s' size %d\n", 267 drv->name, glue (drv->voice_size_, TYPE)); 268 return NULL; 269 } 270 271 hw->s = s; 272 hw->pcm_ops = drv->pcm_ops; 273 274 QLIST_INIT (&hw->sw_head); 275#ifdef DAC 276 QLIST_INIT (&hw->cap_head); 277#endif 278 if (glue (hw->pcm_ops->init_, TYPE) (hw, as, s->drv_opaque)) { 279 goto err0; 280 } 281 282 if (audio_bug(__func__, hw->samples <= 0)) { 283 dolog("hw->samples=%zd\n", hw->samples); 284 goto err1; 285 } 286 287 if (hw->info.is_float) { 288#ifdef DAC 289 hw->clip = mixeng_clip_float[hw->info.nchannels == 2]; 290#else 291 hw->conv = mixeng_conv_float[hw->info.nchannels == 2]; 292#endif 293 } else { 294#ifdef DAC 295 hw->clip = mixeng_clip 296#else 297 hw->conv = mixeng_conv 298#endif 299 [hw->info.nchannels == 2] 300 [hw->info.is_signed] 301 [hw->info.swap_endianness] 302 [audio_bits_to_index(hw->info.bits)]; 303 } 304 305 glue(audio_pcm_hw_alloc_resources_, TYPE)(hw); 306 307 QLIST_INSERT_HEAD (&s->glue (hw_head_, TYPE), hw, entries); 308 glue (s->nb_hw_voices_, TYPE) -= 1; 309#ifdef DAC 310 audio_attach_capture (hw); 311#endif 312 return hw; 313 314 err1: 315 glue (hw->pcm_ops->fini_, TYPE) (hw); 316 err0: 317 g_free (hw); 318 return NULL; 319} 320 321AudiodevPerDirectionOptions *glue(audio_get_pdo_, TYPE)(Audiodev *dev) 322{ 323 switch (dev->driver) { 324 case AUDIODEV_DRIVER_NONE: 325 return dev->u.none.TYPE; 326 case AUDIODEV_DRIVER_ALSA: 327 return qapi_AudiodevAlsaPerDirectionOptions_base(dev->u.alsa.TYPE); 328 case AUDIODEV_DRIVER_COREAUDIO: 329 return qapi_AudiodevCoreaudioPerDirectionOptions_base( 330 dev->u.coreaudio.TYPE); 331 case AUDIODEV_DRIVER_DSOUND: 332 return dev->u.dsound.TYPE; 333 case AUDIODEV_DRIVER_JACK: 334 return qapi_AudiodevJackPerDirectionOptions_base(dev->u.jack.TYPE); 335 case AUDIODEV_DRIVER_OSS: 336 return qapi_AudiodevOssPerDirectionOptions_base(dev->u.oss.TYPE); 337 case AUDIODEV_DRIVER_PA: 338 return qapi_AudiodevPaPerDirectionOptions_base(dev->u.pa.TYPE); 339 case AUDIODEV_DRIVER_SDL: 340 return dev->u.sdl.TYPE; 341 case AUDIODEV_DRIVER_SPICE: 342 return dev->u.spice.TYPE; 343 case AUDIODEV_DRIVER_WAV: 344 return dev->u.wav.TYPE; 345 346 case AUDIODEV_DRIVER__MAX: 347 break; 348 } 349 abort(); 350} 351 352static HW *glue(audio_pcm_hw_add_, TYPE)(AudioState *s, struct audsettings *as) 353{ 354 HW *hw; 355 AudiodevPerDirectionOptions *pdo = glue(audio_get_pdo_, TYPE)(s->dev); 356 357 if (!pdo->mixing_engine || pdo->fixed_settings) { 358 hw = glue(audio_pcm_hw_add_new_, TYPE)(s, as); 359 if (!pdo->mixing_engine || hw) { 360 return hw; 361 } 362 } 363 364 hw = glue(audio_pcm_hw_find_specific_, TYPE)(s, NULL, as); 365 if (hw) { 366 return hw; 367 } 368 369 hw = glue(audio_pcm_hw_add_new_, TYPE)(s, as); 370 if (hw) { 371 return hw; 372 } 373 374 return glue(audio_pcm_hw_find_any_, TYPE)(s, NULL); 375} 376 377static SW *glue(audio_pcm_create_voice_pair_, TYPE)( 378 AudioState *s, 379 const char *sw_name, 380 struct audsettings *as 381 ) 382{ 383 SW *sw; 384 HW *hw; 385 struct audsettings hw_as; 386 AudiodevPerDirectionOptions *pdo = glue(audio_get_pdo_, TYPE)(s->dev); 387 388 if (pdo->fixed_settings) { 389 hw_as = audiodev_to_audsettings(pdo); 390 } 391 else { 392 hw_as = *as; 393 } 394 395 sw = audio_calloc(__func__, 1, sizeof(*sw)); 396 if (!sw) { 397 dolog ("Could not allocate soft voice `%s' (%zu bytes)\n", 398 sw_name ? sw_name : "unknown", sizeof (*sw)); 399 goto err1; 400 } 401 sw->s = s; 402 403 hw = glue(audio_pcm_hw_add_, TYPE)(s, &hw_as); 404 if (!hw) { 405 goto err2; 406 } 407 408 glue (audio_pcm_hw_add_sw_, TYPE) (hw, sw); 409 410 if (glue (audio_pcm_sw_init_, TYPE) (sw, hw, sw_name, as)) { 411 goto err3; 412 } 413 414 return sw; 415 416err3: 417 glue (audio_pcm_hw_del_sw_, TYPE) (sw); 418 glue (audio_pcm_hw_gc_, TYPE) (&hw); 419err2: 420 g_free (sw); 421err1: 422 return NULL; 423} 424 425static void glue (audio_close_, TYPE) (SW *sw) 426{ 427 glue (audio_pcm_sw_fini_, TYPE) (sw); 428 glue (audio_pcm_hw_del_sw_, TYPE) (sw); 429 glue (audio_pcm_hw_gc_, TYPE) (&sw->hw); 430 g_free (sw); 431} 432 433void glue (AUD_close_, TYPE) (QEMUSoundCard *card, SW *sw) 434{ 435 if (sw) { 436 if (audio_bug(__func__, !card)) { 437 dolog ("card=%p\n", card); 438 return; 439 } 440 441 glue (audio_close_, TYPE) (sw); 442 } 443} 444 445SW *glue (AUD_open_, TYPE) ( 446 QEMUSoundCard *card, 447 SW *sw, 448 const char *name, 449 void *callback_opaque , 450 audio_callback_fn callback_fn, 451 struct audsettings *as 452 ) 453{ 454 AudioState *s; 455 AudiodevPerDirectionOptions *pdo; 456 457 if (audio_bug(__func__, !card || !name || !callback_fn || !as)) { 458 dolog ("card=%p name=%p callback_fn=%p as=%p\n", 459 card, name, callback_fn, as); 460 goto fail; 461 } 462 463 s = card->state; 464 pdo = glue(audio_get_pdo_, TYPE)(s->dev); 465 466 ldebug ("open %s, freq %d, nchannels %d, fmt %d\n", 467 name, as->freq, as->nchannels, as->fmt); 468 469 if (audio_bug(__func__, audio_validate_settings(as))) { 470 audio_print_settings (as); 471 goto fail; 472 } 473 474 if (audio_bug(__func__, !s->drv)) { 475 dolog ("Can not open `%s' (no host audio driver)\n", name); 476 goto fail; 477 } 478 479 if (sw && audio_pcm_info_eq (&sw->info, as)) { 480 return sw; 481 } 482 483 if (!pdo->fixed_settings && sw) { 484 glue (AUD_close_, TYPE) (card, sw); 485 sw = NULL; 486 } 487 488 if (sw) { 489 HW *hw = sw->hw; 490 491 if (!hw) { 492 dolog ("Internal logic error voice `%s' has no hardware store\n", 493 SW_NAME (sw)); 494 goto fail; 495 } 496 497 glue (audio_pcm_sw_fini_, TYPE) (sw); 498 if (glue (audio_pcm_sw_init_, TYPE) (sw, hw, name, as)) { 499 goto fail; 500 } 501 } 502 else { 503 sw = glue(audio_pcm_create_voice_pair_, TYPE)(s, name, as); 504 if (!sw) { 505 dolog ("Failed to create voice `%s'\n", name); 506 return NULL; 507 } 508 } 509 510 sw->card = card; 511 sw->vol = nominal_volume; 512 sw->callback.fn = callback_fn; 513 sw->callback.opaque = callback_opaque; 514 515#ifdef DEBUG_AUDIO 516 dolog ("%s\n", name); 517 audio_pcm_print_info ("hw", &sw->hw->info); 518 audio_pcm_print_info ("sw", &sw->info); 519#endif 520 521 return sw; 522 523 fail: 524 glue (AUD_close_, TYPE) (card, sw); 525 return NULL; 526} 527 528int glue (AUD_is_active_, TYPE) (SW *sw) 529{ 530 return sw ? sw->active : 0; 531} 532 533void glue (AUD_init_time_stamp_, TYPE) (SW *sw, QEMUAudioTimeStamp *ts) 534{ 535 if (!sw) { 536 return; 537 } 538 539 ts->old_ts = sw->hw->ts_helper; 540} 541 542uint64_t glue (AUD_get_elapsed_usec_, TYPE) (SW *sw, QEMUAudioTimeStamp *ts) 543{ 544 uint64_t delta, cur_ts, old_ts; 545 546 if (!sw) { 547 return 0; 548 } 549 550 cur_ts = sw->hw->ts_helper; 551 old_ts = ts->old_ts; 552 /* dolog ("cur %" PRId64 " old %" PRId64 "\n", cur_ts, old_ts); */ 553 554 if (cur_ts >= old_ts) { 555 delta = cur_ts - old_ts; 556 } 557 else { 558 delta = UINT64_MAX - old_ts + cur_ts; 559 } 560 561 if (!delta) { 562 return 0; 563 } 564 565 return muldiv64 (delta, sw->hw->info.freq, 1000000); 566} 567 568#undef TYPE 569#undef HW 570#undef SW 571#undef HWBUF 572#undef NAME