hw/hda-audio.c

   1 /*
   2  * Copyright (C) 2010 Red Hat, Inc.
   3  *
   4  * written by Gerd Hoffmann <[email protected]>
   5  *
   6  * This program is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU General Public License as
   8  * published by the Free Software Foundation; either version 2 or
   9  * (at your option) version 3 of the License.
  10  *
  11  * This program 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
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program; if not, see <http://www.gnu.org/licenses/>.
  18  */
  19
  20 #include "hw.h"
  21 #include "pci.h"
  22 #include "intel-hda.h"
  23 #include "intel-hda-defs.h"
  24 #include "audio/audio.h"
  25
  26 /* -------------------------------------------------------------------------- */
  27
  28 typedef struct desc_param {
  29     uint32_t id;
  30     uint32_t val;
  31 } desc_param;
  32
  33 typedef struct desc_node {
  34     uint32_t nid;
  35     const char *name;
  36     const desc_param *params;
  37     uint32_t nparams;
  38     uint32_t config;
  39     uint32_t pinctl;
  40     uint32_t *conn;
  41     uint32_t stindex;
  42 } desc_node;
  43
  44 typedef struct desc_codec {
  45     const char *name;
  46     uint32_t iid;
  47     const desc_node *nodes;
  48     uint32_t nnodes;
  49 } desc_codec;
  50
  51 static const desc_param* hda_codec_find_param(const desc_node *node, uint32_t id)
  52 {
  53     int i;
  54
  55     for (i = 0; i < node->nparams; i++) {
  56         if (node->params[i].id == id) {
  57             return &node->params[i];
  58         }
  59     }
  60     return NULL;
  61 }
  62
  63 static const desc_node* hda_codec_find_node(const desc_codec *codec, uint32_t nid)
  64 {
  65     int i;
  66
  67     for (i = 0; i < codec->nnodes; i++) {
  68         if (codec->nodes[i].nid == nid) {
  69             return &codec->nodes[i];
  70         }
  71     }
  72     return NULL;
  73 }
  74
  75 static void hda_codec_parse_fmt(uint32_t format, struct audsettings *as)
  76 {
  77     if (format & AC_FMT_TYPE_NON_PCM) {
  78         return;
  79     }
  80
  81     as->freq = (format & AC_FMT_BASE_44K) ? 44100 : 48000;
  82
  83     switch ((format & AC_FMT_MULT_MASK) >> AC_FMT_MULT_SHIFT) {
  84     case 1: as->freq *= 2; break;
  85     case 2: as->freq *= 3; break;
  86     case 3: as->freq *= 4; break;
  87     }
  88
  89     switch ((format & AC_FMT_DIV_MASK) >> AC_FMT_DIV_SHIFT) {
  90     case 1: as->freq /= 2; break;
  91     case 2: as->freq /= 3; break;
  92     case 3: as->freq /= 4; break;
  93     case 4: as->freq /= 5; break;
  94     case 5: as->freq /= 6; break;
  95     case 6: as->freq /= 7; break;
  96     case 7: as->freq /= 8; break;
  97     }
  98
  99     switch (format & AC_FMT_BITS_MASK) {
 100     case AC_FMT_BITS_8:  as->fmt = AUD_FMT_S8;  break;
 101     case AC_FMT_BITS_16: as->fmt = AUD_FMT_S16; break;
 102     case AC_FMT_BITS_32: as->fmt = AUD_FMT_S32; break;
 103     }
 104
 105     as->nchannels = ((format & AC_FMT_CHAN_MASK) >> AC_FMT_CHAN_SHIFT) + 1;
 106 }
 107
 108 /* -------------------------------------------------------------------------- */
 109 /*
 110  * HDA codec descriptions
 111  */
 112
 113 /* some defines */
 114
 115 #define QEMU_HDA_ID_VENDOR  0x1af4
 116 #define QEMU_HDA_ID_OUTPUT  ((QEMU_HDA_ID_VENDOR << 16) | 0x10)
 117 #define QEMU_HDA_ID_DUPLEX  ((QEMU_HDA_ID_VENDOR << 16) | 0x20)
 118
 119 #define QEMU_HDA_PCM_FORMATS (AC_SUPPCM_BITS_16 |       \
 120                               0x1fc /* 16 -> 96 kHz */)
 121 #define QEMU_HDA_AMP_NONE    (0)
 122 #define QEMU_HDA_AMP_STEPS   0x4a
 123
 124 #ifdef CONFIG_MIXEMU
 125 #define QEMU_HDA_AMP_CAPS                                               \
 126     (AC_AMPCAP_MUTE |                                                   \
 127      (QEMU_HDA_AMP_STEPS << AC_AMPCAP_OFFSET_SHIFT)    |                \
 128      (QEMU_HDA_AMP_STEPS << AC_AMPCAP_NUM_STEPS_SHIFT) |                \
 129      (3                  << AC_AMPCAP_STEP_SIZE_SHIFT))
 130 #else
 131 #define QEMU_HDA_AMP_CAPS    QEMU_HDA_AMP_NONE
 132 #endif
 133
 134 /* common: audio output widget */
 135 static const desc_param common_params_audio_dac[] = {
 136     {
 137         .id  = AC_PAR_AUDIO_WIDGET_CAP,
 138         .val = ((AC_WID_AUD_OUT << AC_WCAP_TYPE_SHIFT) |
 139                 AC_WCAP_FORMAT_OVRD |
 140                 AC_WCAP_AMP_OVRD |
 141                 AC_WCAP_OUT_AMP |
 142                 AC_WCAP_STEREO),
 143     },{
 144         .id  = AC_PAR_PCM,
 145         .val = QEMU_HDA_PCM_FORMATS,
 146     },{
 147         .id  = AC_PAR_STREAM,
 148         .val = AC_SUPFMT_PCM,
 149     },{
 150         .id  = AC_PAR_AMP_IN_CAP,
 151         .val = QEMU_HDA_AMP_NONE,
 152     },{
 153         .id  = AC_PAR_AMP_OUT_CAP,
 154         .val = QEMU_HDA_AMP_CAPS,
 155     },
 156 };
 157
 158 /* common: pin widget (line-out) */
 159 static const desc_param common_params_audio_lineout[] = {
 160     {
 161         .id  = AC_PAR_AUDIO_WIDGET_CAP,
 162         .val = ((AC_WID_PIN << AC_WCAP_TYPE_SHIFT) |
 163                 AC_WCAP_CONN_LIST |
 164                 AC_WCAP_STEREO),
 165     },{
 166         .id  = AC_PAR_PIN_CAP,
 167         .val = AC_PINCAP_OUT,
 168     },{
 169         .id  = AC_PAR_CONNLIST_LEN,
 170         .val = 1,
 171     },{
 172         .id  = AC_PAR_AMP_IN_CAP,
 173         .val = QEMU_HDA_AMP_NONE,
 174     },{
 175         .id  = AC_PAR_AMP_OUT_CAP,
 176         .val = QEMU_HDA_AMP_NONE,
 177     },
 178 };
 179
 180 /* output: root node */
 181 static const desc_param output_params_root[] = {
 182     {
 183         .id  = AC_PAR_VENDOR_ID,
 184         .val = QEMU_HDA_ID_OUTPUT,
 185     },{
 186         .id  = AC_PAR_SUBSYSTEM_ID,
 187         .val = QEMU_HDA_ID_OUTPUT,
 188     },{
 189         .id  = AC_PAR_REV_ID,
 190         .val = 0x00100101,
 191     },{
 192         .id  = AC_PAR_NODE_COUNT,
 193         .val = 0x00010001,
 194     },
 195 };
 196
 197 /* output: audio function */
 198 static const desc_param output_params_audio_func[] = {
 199     {
 200         .id  = AC_PAR_FUNCTION_TYPE,
 201         .val = AC_GRP_AUDIO_FUNCTION,
 202     },{
 203         .id  = AC_PAR_SUBSYSTEM_ID,
 204         .val = QEMU_HDA_ID_OUTPUT,
 205     },{
 206         .id  = AC_PAR_NODE_COUNT,
 207         .val = 0x00020002,
 208     },{
 209         .id  = AC_PAR_PCM,
 210         .val = QEMU_HDA_PCM_FORMATS,
 211     },{
 212         .id  = AC_PAR_STREAM,
 213         .val = AC_SUPFMT_PCM,
 214     },{
 215         .id  = AC_PAR_AMP_IN_CAP,
 216         .val = QEMU_HDA_AMP_NONE,
 217     },{
 218         .id  = AC_PAR_AMP_OUT_CAP,
 219         .val = QEMU_HDA_AMP_NONE,
 220     },{
 221         .id  = AC_PAR_GPIO_CAP,
 222         .val = 0,
 223     },{
 224         .id  = AC_PAR_AUDIO_FG_CAP,
 225         .val = 0x00000808,
 226     },{
 227         .id  = AC_PAR_POWER_STATE,
 228         .val = 0,
 229     },
 230 };
 231
 232 /* output: nodes */
 233 static const desc_node output_nodes[] = {
 234     {
 235         .nid     = AC_NODE_ROOT,
 236         .name    = "root",
 237         .params  = output_params_root,
 238         .nparams = ARRAY_SIZE(output_params_root),
 239     },{
 240         .nid     = 1,
 241         .name    = "func",
 242         .params  = output_params_audio_func,
 243         .nparams = ARRAY_SIZE(output_params_audio_func),
 244     },{
 245         .nid     = 2,
 246         .name    = "dac",
 247         .params  = common_params_audio_dac,
 248         .nparams = ARRAY_SIZE(common_params_audio_dac),
 249         .stindex = 0,
 250     },{
 251         .nid     = 3,
 252         .name    = "out",
 253         .params  = common_params_audio_lineout,
 254         .nparams = ARRAY_SIZE(common_params_audio_lineout),
 255         .config  = ((AC_JACK_PORT_COMPLEX << AC_DEFCFG_PORT_CONN_SHIFT) |
 256                     (AC_JACK_LINE_OUT     << AC_DEFCFG_DEVICE_SHIFT)    |
 257                     (AC_JACK_CONN_UNKNOWN << AC_DEFCFG_CONN_TYPE_SHIFT) |
 258                     (AC_JACK_COLOR_GREEN  << AC_DEFCFG_COLOR_SHIFT)     |
 259                     0x10),
 260         .pinctl  = AC_PINCTL_OUT_EN,
 261         .conn    = (uint32_t[]) { 2 },
 262     }
 263 };
 264
 265 /* output: codec */
 266 static const desc_codec output = {
 267     .name   = "output",
 268     .iid    = QEMU_HDA_ID_OUTPUT,
 269     .nodes  = output_nodes,
 270     .nnodes = ARRAY_SIZE(output_nodes),
 271 };
 272
 273 /* duplex: root node */
 274 static const desc_param duplex_params_root[] = {
 275     {
 276         .id  = AC_PAR_VENDOR_ID,
 277         .val = QEMU_HDA_ID_DUPLEX,
 278     },{
 279         .id  = AC_PAR_SUBSYSTEM_ID,
 280         .val = QEMU_HDA_ID_DUPLEX,
 281     },{
 282         .id  = AC_PAR_REV_ID,
 283         .val = 0x00100101,
 284     },{
 285         .id  = AC_PAR_NODE_COUNT,
 286         .val = 0x00010001,
 287     },
 288 };
 289
 290 /* duplex: audio input widget */
 291 static const desc_param duplex_params_audio_adc[] = {
 292     {
 293         .id  = AC_PAR_AUDIO_WIDGET_CAP,
 294         .val = ((AC_WID_AUD_IN << AC_WCAP_TYPE_SHIFT) |
 295                 AC_WCAP_CONN_LIST |
 296                 AC_WCAP_FORMAT_OVRD |
 297                 AC_WCAP_AMP_OVRD |
 298                 AC_WCAP_IN_AMP |
 299                 AC_WCAP_STEREO),
 300     },{
 301         .id  = AC_PAR_CONNLIST_LEN,
 302         .val = 1,
 303     },{
 304         .id  = AC_PAR_PCM,
 305         .val = QEMU_HDA_PCM_FORMATS,
 306     },{
 307         .id  = AC_PAR_STREAM,
 308         .val = AC_SUPFMT_PCM,
 309     },{
 310         .id  = AC_PAR_AMP_IN_CAP,
 311         .val = QEMU_HDA_AMP_CAPS,
 312     },{
 313         .id  = AC_PAR_AMP_OUT_CAP,
 314         .val = QEMU_HDA_AMP_NONE,
 315     },
 316 };
 317
 318 /* duplex: pin widget (line-in) */
 319 static const desc_param duplex_params_audio_linein[] = {
 320     {
 321         .id  = AC_PAR_AUDIO_WIDGET_CAP,
 322         .val = ((AC_WID_PIN << AC_WCAP_TYPE_SHIFT) |
 323                 AC_WCAP_STEREO),
 324     },{
 325         .id  = AC_PAR_PIN_CAP,
 326         .val = AC_PINCAP_IN,
 327     },{
 328         .id  = AC_PAR_AMP_IN_CAP,
 329         .val = QEMU_HDA_AMP_NONE,
 330     },{
 331         .id  = AC_PAR_AMP_OUT_CAP,
 332         .val = QEMU_HDA_AMP_NONE,
 333     },
 334 };
 335
 336 /* duplex: audio function */
 337 static const desc_param duplex_params_audio_func[] = {
 338     {
 339         .id  = AC_PAR_FUNCTION_TYPE,
 340         .val = AC_GRP_AUDIO_FUNCTION,
 341     },{
 342         .id  = AC_PAR_SUBSYSTEM_ID,
 343         .val = QEMU_HDA_ID_DUPLEX,
 344     },{
 345         .id  = AC_PAR_NODE_COUNT,
 346         .val = 0x00020004,
 347     },{
 348         .id  = AC_PAR_PCM,
 349         .val = QEMU_HDA_PCM_FORMATS,
 350     },{
 351         .id  = AC_PAR_STREAM,
 352         .val = AC_SUPFMT_PCM,
 353     },{
 354         .id  = AC_PAR_AMP_IN_CAP,
 355         .val = QEMU_HDA_AMP_NONE,
 356     },{
 357         .id  = AC_PAR_AMP_OUT_CAP,
 358         .val = QEMU_HDA_AMP_NONE,
 359     },{
 360         .id  = AC_PAR_GPIO_CAP,
 361         .val = 0,
 362     },{
 363         .id  = AC_PAR_AUDIO_FG_CAP,
 364         .val = 0x00000808,
 365     },{
 366         .id  = AC_PAR_POWER_STATE,
 367         .val = 0,
 368     },
 369 };
 370
 371 /* duplex: nodes */
 372 static const desc_node duplex_nodes[] = {
 373     {
 374         .nid     = AC_NODE_ROOT,
 375         .name    = "root",
 376         .params  = duplex_params_root,
 377         .nparams = ARRAY_SIZE(duplex_params_root),
 378     },{
 379         .nid     = 1,
 380         .name    = "func",
 381         .params  = duplex_params_audio_func,
 382         .nparams = ARRAY_SIZE(duplex_params_audio_func),
 383     },{
 384         .nid     = 2,
 385         .name    = "dac",
 386         .params  = common_params_audio_dac,
 387         .nparams = ARRAY_SIZE(common_params_audio_dac),
 388         .stindex = 0,
 389     },{
 390         .nid     = 3,
 391         .name    = "out",
 392         .params  = common_params_audio_lineout,
 393         .nparams = ARRAY_SIZE(common_params_audio_lineout),
 394         .config  = ((AC_JACK_PORT_COMPLEX << AC_DEFCFG_PORT_CONN_SHIFT) |
 395                     (AC_JACK_LINE_OUT     << AC_DEFCFG_DEVICE_SHIFT)    |
 396                     (AC_JACK_CONN_UNKNOWN << AC_DEFCFG_CONN_TYPE_SHIFT) |
 397                     (AC_JACK_COLOR_GREEN  << AC_DEFCFG_COLOR_SHIFT)     |
 398                     0x10),
 399         .pinctl  = AC_PINCTL_OUT_EN,
 400         .conn    = (uint32_t[]) { 2 },
 401     },{
 402         .nid     = 4,
 403         .name    = "adc",
 404         .params  = duplex_params_audio_adc,
 405         .nparams = ARRAY_SIZE(duplex_params_audio_adc),
 406         .stindex = 1,
 407         .conn    = (uint32_t[]) { 5 },
 408     },{
 409         .nid     = 5,
 410         .name    = "in",
 411         .params  = duplex_params_audio_linein,
 412         .nparams = ARRAY_SIZE(duplex_params_audio_linein),
 413         .config  = ((AC_JACK_PORT_COMPLEX << AC_DEFCFG_PORT_CONN_SHIFT) |
 414                     (AC_JACK_LINE_IN      << AC_DEFCFG_DEVICE_SHIFT)    |
 415                     (AC_JACK_CONN_UNKNOWN << AC_DEFCFG_CONN_TYPE_SHIFT) |
 416                     (AC_JACK_COLOR_RED    << AC_DEFCFG_COLOR_SHIFT)     |
 417                     0x20),
 418         .pinctl  = AC_PINCTL_IN_EN,
 419     }
 420 };
 421
 422 /* duplex: codec */
 423 static const desc_codec duplex = {
 424     .name   = "duplex",
 425     .iid    = QEMU_HDA_ID_DUPLEX,
 426     .nodes  = duplex_nodes,
 427     .nnodes = ARRAY_SIZE(duplex_nodes),
 428 };
 429
 430 /* -------------------------------------------------------------------------- */
 431
 432 static const char *fmt2name[] = {
 433     [ AUD_FMT_U8  ] = "PCM-U8",
 434     [ AUD_FMT_S8  ] = "PCM-S8",
 435     [ AUD_FMT_U16 ] = "PCM-U16",
 436     [ AUD_FMT_S16 ] = "PCM-S16",
 437     [ AUD_FMT_U32 ] = "PCM-U32",
 438     [ AUD_FMT_S32 ] = "PCM-S32",
 439 };
 440
 441 typedef struct HDAAudioState HDAAudioState;
 442 typedef struct HDAAudioStream HDAAudioStream;
 443
 444 struct HDAAudioStream {
 445     HDAAudioState *state;
 446     const desc_node *node;
 447     bool output, running;
 448     uint32_t stream;
 449     uint32_t channel;
 450     uint32_t format;
 451     uint32_t gain_left, gain_right;
 452     bool mute_left, mute_right;
 453     struct audsettings as;
 454     union {
 455         SWVoiceIn *in;
 456         SWVoiceOut *out;
 457     } voice;
 458     uint8_t buf[HDA_BUFFER_SIZE];
 459     uint32_t bpos;
 460 };
 461
 462 struct HDAAudioState {
 463     HDACodecDevice hda;
 464     const char *name;
 465
 466     QEMUSoundCard card;
 467     const desc_codec *desc;
 468     HDAAudioStream st[4];
 469     bool running_compat[16];
 470     bool running_real[2 * 16];
 471
 472     /* properties */
 473     uint32_t debug;
 474 };
 475
 476 static void hda_audio_input_cb(void *opaque, int avail)
 477 {
 478     HDAAudioStream *st = opaque;
 479     int recv = 0;
 480     int len;
 481     bool rc;
 482
 483     while (avail - recv >= sizeof(st->buf)) {
 484         if (st->bpos != sizeof(st->buf)) {
 485             len = AUD_read(st->voice.in, st->buf + st->bpos,
 486                            sizeof(st->buf) - st->bpos);
 487             st->bpos += len;
 488             recv += len;
 489             if (st->bpos != sizeof(st->buf)) {
 490                 break;
 491             }
 492         }
 493         rc = hda_codec_xfer(&st->state->hda, st->stream, false,
 494                             st->buf, sizeof(st->buf));
 495         if (!rc) {
 496             break;
 497         }
 498         st->bpos = 0;
 499     }
 500 }
 501
 502 static void hda_audio_output_cb(void *opaque, int avail)
 503 {
 504     HDAAudioStream *st = opaque;
 505     int sent = 0;
 506     int len;
 507     bool rc;
 508
 509     while (avail - sent >= sizeof(st->buf)) {
 510         if (st->bpos == sizeof(st->buf)) {
 511             rc = hda_codec_xfer(&st->state->hda, st->stream, true,
 512                                 st->buf, sizeof(st->buf));
 513             if (!rc) {
 514                 break;
 515             }
 516             st->bpos = 0;
 517         }
 518         len = AUD_write(st->voice.out, st->buf + st->bpos,
 519                         sizeof(st->buf) - st->bpos);
 520         st->bpos += len;
 521         sent += len;
 522         if (st->bpos != sizeof(st->buf)) {
 523             break;
 524         }
 525     }
 526 }
 527
 528 static void hda_audio_set_running(HDAAudioStream *st, bool running)
 529 {
 530     if (st->node == NULL) {
 531         return;
 532     }
 533     if (st->running == running) {
 534         return;
 535     }
 536     st->running = running;
 537     dprint(st->state, 1, "%s: %s (stream %d)\n", st->node->name,
 538            st->running ? "on" : "off", st->stream);
 539     if (st->output) {
 540         AUD_set_active_out(st->voice.out, st->running);
 541     } else {
 542         AUD_set_active_in(st->voice.in, st->running);
 543     }
 544 }
 545
 546 static void hda_audio_set_amp(HDAAudioStream *st)
 547 {
 548     bool muted;
 549     uint32_t left, right;
 550
 551     if (st->node == NULL) {
 552         return;
 553     }
 554
 555     muted = st->mute_left && st->mute_right;
 556     left  = st->mute_left  ? 0 : st->gain_left;
 557     right = st->mute_right ? 0 : st->gain_right;
 558
 559     left = left * 255 / QEMU_HDA_AMP_STEPS;
 560     right = right * 255 / QEMU_HDA_AMP_STEPS;
 561
 562     if (st->output) {
 563         AUD_set_volume_out(st->voice.out, muted, left, right);
 564     } else {
 565         AUD_set_volume_in(st->voice.in, muted, left, right);
 566     }
 567 }
 568
 569 static void hda_audio_setup(HDAAudioStream *st)
 570 {
 571     if (st->node == NULL) {
 572         return;
 573     }
 574
 575     dprint(st->state, 1, "%s: format: %d x %s @ %d Hz\n",
 576            st->node->name, st->as.nchannels,
 577            fmt2name[st->as.fmt], st->as.freq);
 578
 579     if (st->output) {
 580         st->voice.out = AUD_open_out(&st->state->card, st->voice.out,
 581                                      st->node->name, st,
 582                                      hda_audio_output_cb, &st->as);
 583     } else {
 584         st->voice.in = AUD_open_in(&st->state->card, st->voice.in,
 585                                    st->node->name, st,
 586                                    hda_audio_input_cb, &st->as);
 587     }
 588 }
 589
 590 static void hda_audio_command(HDACodecDevice *hda, uint32_t nid, uint32_t data)
 591 {
 592     HDAAudioState *a = DO_UPCAST(HDAAudioState, hda, hda);
 593     HDAAudioStream *st;
 594     const desc_node *node = NULL;
 595     const desc_param *param;
 596     uint32_t verb, payload, response, count, shift;
 597
 598     if ((data & 0x70000) == 0x70000) {
 599         /* 12/8 id/payload */
 600         verb = (data >> 8) & 0xfff;
 601         payload = data & 0x00ff;
 602     } else {
 603         /* 4/16 id/payload */
 604         verb = (data >> 8) & 0xf00;
 605         payload = data & 0xffff;
 606     }
 607
 608     node = hda_codec_find_node(a->desc, nid);
 609     if (node == NULL) {
 610         goto fail;
 611     }
 612     dprint(a, 2, "%s: nid %d (%s), verb 0x%x, payload 0x%x\n",
 613            __FUNCTION__, nid, node->name, verb, payload);
 614
 615     switch (verb) {
 616     /* all nodes */
 617     case AC_VERB_PARAMETERS:
 618         param = hda_codec_find_param(node, payload);
 619         if (param == NULL) {
 620             goto fail;
 621         }
 622         hda_codec_response(hda, true, param->val);
 623         break;
 624     case AC_VERB_GET_SUBSYSTEM_ID:
 625         hda_codec_response(hda, true, a->desc->iid);
 626         break;
 627
 628     /* all functions */
 629     case AC_VERB_GET_CONNECT_LIST:
 630         param = hda_codec_find_param(node, AC_PAR_CONNLIST_LEN);
 631         count = param ? param->val : 0;
 632         response = 0;
 633         shift = 0;
 634         while (payload < count && shift < 32) {
 635             response |= node->conn[payload] << shift;
 636             payload++;
 637             shift += 8;
 638         }
 639         hda_codec_response(hda, true, response);
 640         break;
 641
 642     /* pin widget */
 643     case AC_VERB_GET_CONFIG_DEFAULT:
 644         hda_codec_response(hda, true, node->config);
 645         break;
 646     case AC_VERB_GET_PIN_WIDGET_CONTROL:
 647         hda_codec_response(hda, true, node->pinctl);
 648         break;
 649     case AC_VERB_SET_PIN_WIDGET_CONTROL:
 650         if (node->pinctl != payload) {
 651             dprint(a, 1, "unhandled pin control bit\n");
 652         }
 653         hda_codec_response(hda, true, 0);
 654         break;
 655
 656     /* audio in/out widget */
 657     case AC_VERB_SET_CHANNEL_STREAMID:
 658         st = a->st + node->stindex;
 659         if (st->node == NULL) {
 660             goto fail;
 661         }
 662         hda_audio_set_running(st, false);
 663         st->stream = (payload >> 4) & 0x0f;
 664         st->channel = payload & 0x0f;
 665         dprint(a, 2, "%s: stream %d, channel %d\n",
 666                st->node->name, st->stream, st->channel);
 667         hda_audio_set_running(st, a->running_real[st->output * 16 + st->stream]);
 668         hda_codec_response(hda, true, 0);
 669         break;
 670     case AC_VERB_GET_CONV:
 671         st = a->st + node->stindex;
 672         if (st->node == NULL) {
 673             goto fail;
 674         }
 675         response = st->stream << 4 | st->channel;
 676         hda_codec_response(hda, true, response);
 677         break;
 678     case AC_VERB_SET_STREAM_FORMAT:
 679         st = a->st + node->stindex;
 680         if (st->node == NULL) {
 681             goto fail;
 682         }
 683         st->format = payload;
 684         hda_codec_parse_fmt(st->format, &st->as);
 685         hda_audio_setup(st);
 686         hda_codec_response(hda, true, 0);
 687         break;
 688     case AC_VERB_GET_STREAM_FORMAT:
 689         st = a->st + node->stindex;
 690         if (st->node == NULL) {
 691             goto fail;
 692         }
 693         hda_codec_response(hda, true, st->format);
 694         break;
 695     case AC_VERB_GET_AMP_GAIN_MUTE:
 696         st = a->st + node->stindex;
 697         if (st->node == NULL) {
 698             goto fail;
 699         }
 700         if (payload & AC_AMP_GET_LEFT) {
 701             response = st->gain_left | (st->mute_left ? AC_AMP_MUTE : 0);
 702         } else {
 703             response = st->gain_right | (st->mute_right ? AC_AMP_MUTE : 0);
 704         }
 705         hda_codec_response(hda, true, response);
 706         break;
 707     case AC_VERB_SET_AMP_GAIN_MUTE:
 708         st = a->st + node->stindex;
 709         if (st->node == NULL) {
 710             goto fail;
 711         }
 712         dprint(a, 1, "amp (%s): %s%s%s%s index %d  gain %3d %s\n",
 713                st->node->name,
 714                (payload & AC_AMP_SET_OUTPUT) ? "o" : "-",
 715                (payload & AC_AMP_SET_INPUT)  ? "i" : "-",
 716                (payload & AC_AMP_SET_LEFT)   ? "l" : "-",
 717                (payload & AC_AMP_SET_RIGHT)  ? "r" : "-",
 718                (payload & AC_AMP_SET_INDEX) >> AC_AMP_SET_INDEX_SHIFT,
 719                (payload & AC_AMP_GAIN),
 720                (payload & AC_AMP_MUTE) ? "muted" : "");
 721         if (payload & AC_AMP_SET_LEFT) {
 722             st->gain_left = payload & AC_AMP_GAIN;
 723             st->mute_left = payload & AC_AMP_MUTE;
 724         }
 725         if (payload & AC_AMP_SET_RIGHT) {
 726             st->gain_right = payload & AC_AMP_GAIN;
 727             st->mute_right = payload & AC_AMP_MUTE;
 728         }
 729         hda_audio_set_amp(st);
 730         hda_codec_response(hda, true, 0);
 731         break;
 732
 733     /* not supported */
 734     case AC_VERB_SET_POWER_STATE:
 735     case AC_VERB_GET_POWER_STATE:
 736     case AC_VERB_GET_SDI_SELECT:
 737         hda_codec_response(hda, true, 0);
 738         break;
 739     default:
 740         goto fail;
 741     }
 742     return;
 743
 744 fail:
 745     dprint(a, 1, "%s: not handled: nid %d (%s), verb 0x%x, payload 0x%x\n",
 746            __FUNCTION__, nid, node ? node->name : "?", verb, payload);
 747     hda_codec_response(hda, true, 0);
 748 }
 749
 750 static void hda_audio_stream(HDACodecDevice *hda, uint32_t stnr, bool running, bool output)
 751 {
 752     HDAAudioState *a = DO_UPCAST(HDAAudioState, hda, hda);
 753     int s;
 754
 755     a->running_compat[stnr] = running;
 756     a->running_real[output * 16 + stnr] = running;
 757     for (s = 0; s < ARRAY_SIZE(a->st); s++) {
 758         if (a->st[s].node == NULL) {
 759             continue;
 760         }
 761         if (a->st[s].output != output) {
 762             continue;
 763         }
 764         if (a->st[s].stream != stnr) {
 765             continue;
 766         }
 767         hda_audio_set_running(&a->st[s], running);
 768     }
 769 }
 770
 771 static int hda_audio_init(HDACodecDevice *hda, const struct desc_codec *desc)
 772 {
 773     HDAAudioState *a = DO_UPCAST(HDAAudioState, hda, hda);
 774     HDAAudioStream *st;
 775     const desc_node *node;
 776     const desc_param *param;
 777     uint32_t i, type;
 778
 779     a->desc = desc;
 780     a->name = a->hda.qdev.info->name;
 781     dprint(a, 1, "%s: cad %d\n", __FUNCTION__, a->hda.cad);
 782
 783     AUD_register_card("hda", &a->card);
 784     for (i = 0; i < a->desc->nnodes; i++) {
 785         node = a->desc->nodes + i;
 786         param = hda_codec_find_param(node, AC_PAR_AUDIO_WIDGET_CAP);
 787         if (NULL == param)
 788             continue;
 789         type = (param->val & AC_WCAP_TYPE) >> AC_WCAP_TYPE_SHIFT;
 790         switch (type) {
 791         case AC_WID_AUD_OUT:
 792         case AC_WID_AUD_IN:
 793             assert(node->stindex < ARRAY_SIZE(a->st));
 794             st = a->st + node->stindex;
 795             st->state = a;
 796             st->node = node;
 797             if (type == AC_WID_AUD_OUT) {
 798                 /* unmute output by default */
 799                 st->gain_left = QEMU_HDA_AMP_STEPS;
 800                 st->gain_right = QEMU_HDA_AMP_STEPS;
 801                 st->bpos = sizeof(st->buf);
 802                 st->output = true;
 803             } else {
 804                 st->output = false;
 805             }
 806             st->format = AC_FMT_TYPE_PCM | AC_FMT_BITS_16 |
 807                 (1 << AC_FMT_CHAN_SHIFT);
 808             hda_codec_parse_fmt(st->format, &st->as);
 809             hda_audio_setup(st);
 810             break;
 811         }
 812     }
 813     return 0;
 814 }
 815
 816 static int hda_audio_exit(HDACodecDevice *hda)
 817 {
 818     HDAAudioState *a = DO_UPCAST(HDAAudioState, hda, hda);
 819     HDAAudioStream *st;
 820     int i;
 821
 822     dprint(a, 1, "%s\n", __FUNCTION__);
 823     for (i = 0; i < ARRAY_SIZE(a->st); i++) {
 824         st = a->st + i;
 825         if (st->node == NULL) {
 826             continue;
 827         }
 828         if (st->output) {
 829             AUD_close_out(&a->card, st->voice.out);
 830         } else {
 831             AUD_close_in(&a->card, st->voice.in);
 832         }
 833     }
 834     AUD_remove_card(&a->card);
 835     return 0;
 836 }
 837
 838 static int hda_audio_post_load(void *opaque, int version)
 839 {
 840     HDAAudioState *a = opaque;
 841     HDAAudioStream *st;
 842     int i;
 843
 844     dprint(a, 1, "%s\n", __FUNCTION__);
 845     if (version == 1) {
 846         /* assume running_compat[] is for output streams */
 847         for (i = 0; i < ARRAY_SIZE(a->running_compat); i++)
 848             a->running_real[16 + i] = a->running_compat[i];
 849     }
 850
 851     for (i = 0; i < ARRAY_SIZE(a->st); i++) {
 852         st = a->st + i;
 853         if (st->node == NULL)
 854             continue;
 855         hda_codec_parse_fmt(st->format, &st->as);
 856         hda_audio_setup(st);
 857         hda_audio_set_amp(st);
 858         hda_audio_set_running(st, a->running_real[st->output * 16 + st->stream]);
 859     }
 860     return 0;
 861 }
 862
 863 static const VMStateDescription vmstate_hda_audio_stream = {
 864     .name = "hda-audio-stream",
 865     .version_id = 1,
 866     .fields = (VMStateField []) {
 867         VMSTATE_UINT32(stream, HDAAudioStream),
 868         VMSTATE_UINT32(channel, HDAAudioStream),
 869         VMSTATE_UINT32(format, HDAAudioStream),
 870         VMSTATE_UINT32(gain_left, HDAAudioStream),
 871         VMSTATE_UINT32(gain_right, HDAAudioStream),
 872         VMSTATE_BOOL(mute_left, HDAAudioStream),
 873         VMSTATE_BOOL(mute_right, HDAAudioStream),
 874         VMSTATE_UINT32(bpos, HDAAudioStream),
 875         VMSTATE_BUFFER(buf, HDAAudioStream),
 876         VMSTATE_END_OF_LIST()
 877     }
 878 };
 879
 880 static const VMStateDescription vmstate_hda_audio = {
 881     .name = "hda-audio",
 882     .version_id = 2,
 883     .post_load = hda_audio_post_load,
 884     .fields = (VMStateField []) {
 885         VMSTATE_STRUCT_ARRAY(st, HDAAudioState, 4, 0,
 886                              vmstate_hda_audio_stream,
 887                              HDAAudioStream),
 888         VMSTATE_BOOL_ARRAY(running_compat, HDAAudioState, 16),
 889         VMSTATE_BOOL_ARRAY_V(running_real, HDAAudioState, 2 * 16, 2),
 890         VMSTATE_END_OF_LIST()
 891     }
 892 };
 893
 894 static Property hda_audio_properties[] = {
 895     DEFINE_PROP_UINT32("debug", HDAAudioState, debug, 0),
 896     DEFINE_PROP_END_OF_LIST(),
 897 };
 898
 899 static int hda_audio_init_output(HDACodecDevice *hda)
 900 {
 901     return hda_audio_init(hda, &output);
 902 }
 903
 904 static int hda_audio_init_duplex(HDACodecDevice *hda)
 905 {
 906     return hda_audio_init(hda, &duplex);
 907 }
 908
 909 static HDACodecDeviceInfo hda_audio_info_output = {
 910     .qdev.name    = "hda-output",
 911     .qdev.desc    = "HDA Audio Codec, output-only",
 912     .qdev.size    = sizeof(HDAAudioState),
 913     .qdev.vmsd    = &vmstate_hda_audio,
 914     .qdev.props   = hda_audio_properties,
 915     .init         = hda_audio_init_output,
 916     .exit         = hda_audio_exit,
 917     .command      = hda_audio_command,
 918     .stream       = hda_audio_stream,
 919 };
 920
 921 static HDACodecDeviceInfo hda_audio_info_duplex = {
 922     .qdev.name    = "hda-duplex",
 923     .qdev.desc    = "HDA Audio Codec, duplex",
 924     .qdev.size    = sizeof(HDAAudioState),
 925     .qdev.vmsd    = &vmstate_hda_audio,
 926     .qdev.props   = hda_audio_properties,
 927     .init         = hda_audio_init_duplex,
 928     .exit         = hda_audio_exit,
 929     .command      = hda_audio_command,
 930     .stream       = hda_audio_stream,
 931 };
 932
 933 static void hda_audio_register(void)
 934 {
 935     hda_codec_register(&hda_audio_info_output);
 936     hda_codec_register(&hda_audio_info_duplex);
 937 }
 938 device_init(hda_audio_register);