Archipelago » qemu

/*

 * Copyright (C) 2010 Red Hat, Inc.

 *

 * written by Gerd Hoffmann <kraxel@redhat.com>

 *

 * This program is free software; you can redistribute it and/or

 * modify it under the terms of the GNU General Public License as

 * published by the Free Software Foundation; either version 2 or

 * (at your option) version 3 of the License.

 *

 * This program is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 * GNU General Public License for more details.

 *

 * You should have received a copy of the GNU General Public License

 * along with this program; if not, see <http://www.gnu.org/licenses/>.

 */

#include "hw/hw.h"

#include "hw/pci/pci.h"

#include "intel-hda.h"

#include "intel-hda-defs.h"

#include "audio/audio.h"

/* -------------------------------------------------------------------------- */

typedef struct desc_param {

    uint32_t id;

    uint32_t val;

} desc_param;

typedef struct desc_node {

    uint32_t nid;

    const char *name;

    const desc_param *params;

    uint32_t nparams;

    uint32_t config;

    uint32_t pinctl;

    uint32_t *conn;

    uint32_t stindex;

} desc_node;

typedef struct desc_codec {

    const char *name;

    uint32_t iid;

    const desc_node *nodes;

    uint32_t nnodes;

} desc_codec;

static const desc_param* hda_codec_find_param(const desc_node *node, uint32_t id)

{

    int i;

    for (i = 0; i < node->nparams; i++) {

        if (node->params[i].id == id) {

            return &node->params[i];

        }

    }

    return NULL;

}

static const desc_node* hda_codec_find_node(const desc_codec *codec, uint32_t nid)

{

    int i;

    for (i = 0; i < codec->nnodes; i++) {

        if (codec->nodes[i].nid == nid) {

            return &codec->nodes[i];

        }

    }

    return NULL;

}

static void hda_codec_parse_fmt(uint32_t format, struct audsettings *as)

{

    if (format & AC_FMT_TYPE_NON_PCM) {

        return;

    }

    as->freq = (format & AC_FMT_BASE_44K) ? 44100 : 48000;

    switch ((format & AC_FMT_MULT_MASK) >> AC_FMT_MULT_SHIFT) {

    case 1: as->freq *= 2; break;

    case 2: as->freq *= 3; break;

    case 3: as->freq *= 4; break;

    }

    switch ((format & AC_FMT_DIV_MASK) >> AC_FMT_DIV_SHIFT) {

    case 1: as->freq /= 2; break;

    case 2: as->freq /= 3; break;

    case 3: as->freq /= 4; break;

    case 4: as->freq /= 5; break;

    case 5: as->freq /= 6; break;

    case 6: as->freq /= 7; break;

    case 7: as->freq /= 8; break;

    }

    switch (format & AC_FMT_BITS_MASK) {

    case AC_FMT_BITS_8:  as->fmt = AUD_FMT_S8;  break;

    case AC_FMT_BITS_16: as->fmt = AUD_FMT_S16; break;

    case AC_FMT_BITS_32: as->fmt = AUD_FMT_S32; break;

    }

    as->nchannels = ((format & AC_FMT_CHAN_MASK) >> AC_FMT_CHAN_SHIFT) + 1;

}

/* -------------------------------------------------------------------------- */

/*

 * HDA codec descriptions

 */

/* some defines */

#define QEMU_HDA_ID_VENDOR  0x1af4

#define QEMU_HDA_PCM_FORMATS (AC_SUPPCM_BITS_16 |       \

                              0x1fc /* 16 -> 96 kHz */)

#define QEMU_HDA_AMP_NONE    (0)

#define QEMU_HDA_AMP_STEPS   0x4a

#ifdef CONFIG_MIXEMU

# define QEMU_HDA_ID_OUTPUT  ((QEMU_HDA_ID_VENDOR << 16) | 0x12)

# define QEMU_HDA_ID_DUPLEX  ((QEMU_HDA_ID_VENDOR << 16) | 0x22)

# define QEMU_HDA_ID_MICRO   ((QEMU_HDA_ID_VENDOR << 16) | 0x32)

# define QEMU_HDA_AMP_CAPS                                              \

    (AC_AMPCAP_MUTE |                                                   \

     (QEMU_HDA_AMP_STEPS << AC_AMPCAP_OFFSET_SHIFT)    |                \

     (QEMU_HDA_AMP_STEPS << AC_AMPCAP_NUM_STEPS_SHIFT) |                \

     (3                  << AC_AMPCAP_STEP_SIZE_SHIFT))

#else

# define QEMU_HDA_ID_OUTPUT  ((QEMU_HDA_ID_VENDOR << 16) | 0x11)

# define QEMU_HDA_ID_DUPLEX  ((QEMU_HDA_ID_VENDOR << 16) | 0x21)

# define QEMU_HDA_ID_MICRO   ((QEMU_HDA_ID_VENDOR << 16) | 0x31)

# define QEMU_HDA_AMP_CAPS   QEMU_HDA_AMP_NONE

#endif

/* common: audio output widget */

static const desc_param common_params_audio_dac[] = {

    {

        .id  = AC_PAR_AUDIO_WIDGET_CAP,

        .val = ((AC_WID_AUD_OUT << AC_WCAP_TYPE_SHIFT) |

                AC_WCAP_FORMAT_OVRD |

                AC_WCAP_AMP_OVRD |

                AC_WCAP_OUT_AMP |

                AC_WCAP_STEREO),

    },{

        .id  = AC_PAR_PCM,

        .val = QEMU_HDA_PCM_FORMATS,

    },{

        .id  = AC_PAR_STREAM,

        .val = AC_SUPFMT_PCM,

    },{

        .id  = AC_PAR_AMP_IN_CAP,

        .val = QEMU_HDA_AMP_NONE,

    },{

        .id  = AC_PAR_AMP_OUT_CAP,

        .val = QEMU_HDA_AMP_CAPS,

    },

};

/* common: audio input widget */

static const desc_param common_params_audio_adc[] = {

    {

        .id  = AC_PAR_AUDIO_WIDGET_CAP,

        .val = ((AC_WID_AUD_IN << AC_WCAP_TYPE_SHIFT) |

                AC_WCAP_CONN_LIST |

                AC_WCAP_FORMAT_OVRD |

                AC_WCAP_AMP_OVRD |

                AC_WCAP_IN_AMP |

                AC_WCAP_STEREO),

    },{

        .id  = AC_PAR_CONNLIST_LEN,

        .val = 1,

    },{

        .id  = AC_PAR_PCM,

        .val = QEMU_HDA_PCM_FORMATS,

    },{

        .id  = AC_PAR_STREAM,

        .val = AC_SUPFMT_PCM,

    },{

        .id  = AC_PAR_AMP_IN_CAP,

        .val = QEMU_HDA_AMP_CAPS,

    },{

        .id  = AC_PAR_AMP_OUT_CAP,

        .val = QEMU_HDA_AMP_NONE,

    },

};

/* common: pin widget (line-out) */

static const desc_param common_params_audio_lineout[] = {

    {

        .id  = AC_PAR_AUDIO_WIDGET_CAP,

        .val = ((AC_WID_PIN << AC_WCAP_TYPE_SHIFT) |

                AC_WCAP_CONN_LIST |

                AC_WCAP_STEREO),

    },{

        .id  = AC_PAR_PIN_CAP,

        .val = AC_PINCAP_OUT,

    },{

        .id  = AC_PAR_CONNLIST_LEN,

        .val = 1,

    },{

        .id  = AC_PAR_AMP_IN_CAP,

        .val = QEMU_HDA_AMP_NONE,

    },{

        .id  = AC_PAR_AMP_OUT_CAP,

        .val = QEMU_HDA_AMP_NONE,

    },

};

/* common: pin widget (line-in) */

static const desc_param common_params_audio_linein[] = {

    {

        .id  = AC_PAR_AUDIO_WIDGET_CAP,

        .val = ((AC_WID_PIN << AC_WCAP_TYPE_SHIFT) |

                AC_WCAP_STEREO),

    },{

        .id  = AC_PAR_PIN_CAP,

        .val = AC_PINCAP_IN,

    },{

        .id  = AC_PAR_AMP_IN_CAP,

        .val = QEMU_HDA_AMP_NONE,

    },{

        .id  = AC_PAR_AMP_OUT_CAP,

        .val = QEMU_HDA_AMP_NONE,

    },

};

/* output: root node */

static const desc_param output_params_root[] = {

    {

        .id  = AC_PAR_VENDOR_ID,

        .val = QEMU_HDA_ID_OUTPUT,

    },{

        .id  = AC_PAR_SUBSYSTEM_ID,

        .val = QEMU_HDA_ID_OUTPUT,

    },{

        .id  = AC_PAR_REV_ID,

        .val = 0x00100101,

    },{

        .id  = AC_PAR_NODE_COUNT,

        .val = 0x00010001,

    },

};

/* output: audio function */

static const desc_param output_params_audio_func[] = {

    {

        .id  = AC_PAR_FUNCTION_TYPE,

        .val = AC_GRP_AUDIO_FUNCTION,

    },{

        .id  = AC_PAR_SUBSYSTEM_ID,

        .val = QEMU_HDA_ID_OUTPUT,

    },{

        .id  = AC_PAR_NODE_COUNT,

        .val = 0x00020002,

    },{

        .id  = AC_PAR_PCM,

        .val = QEMU_HDA_PCM_FORMATS,

    },{

        .id  = AC_PAR_STREAM,

        .val = AC_SUPFMT_PCM,

    },{

        .id  = AC_PAR_AMP_IN_CAP,

        .val = QEMU_HDA_AMP_NONE,

    },{

        .id  = AC_PAR_AMP_OUT_CAP,

        .val = QEMU_HDA_AMP_NONE,

    },{

        .id  = AC_PAR_GPIO_CAP,

        .val = 0,

    },{

        .id  = AC_PAR_AUDIO_FG_CAP,

        .val = 0x00000808,

    },{

        .id  = AC_PAR_POWER_STATE,

        .val = 0,

    },

};

/* output: nodes */

static const desc_node output_nodes[] = {

    {

        .nid     = AC_NODE_ROOT,

        .name    = "root",

        .params  = output_params_root,

        .nparams = ARRAY_SIZE(output_params_root),

    },{

        .nid     = 1,

        .name    = "func",

        .params  = output_params_audio_func,

        .nparams = ARRAY_SIZE(output_params_audio_func),

    },{

        .nid     = 2,

        .name    = "dac",

        .params  = common_params_audio_dac,

        .nparams = ARRAY_SIZE(common_params_audio_dac),

        .stindex = 0,

    },{

        .nid     = 3,

        .name    = "out",

        .params  = common_params_audio_lineout,

        .nparams = ARRAY_SIZE(common_params_audio_lineout),

        .config  = ((AC_JACK_PORT_COMPLEX << AC_DEFCFG_PORT_CONN_SHIFT) |

                    (AC_JACK_LINE_OUT     << AC_DEFCFG_DEVICE_SHIFT)    |

                    (AC_JACK_CONN_UNKNOWN << AC_DEFCFG_CONN_TYPE_SHIFT) |

                    (AC_JACK_COLOR_GREEN  << AC_DEFCFG_COLOR_SHIFT)     |

                    0x10),

        .pinctl  = AC_PINCTL_OUT_EN,

        .conn    = (uint32_t[]) { 2 },

    }

};

/* output: codec */

static const desc_codec output = {

    .name   = "output",

    .iid    = QEMU_HDA_ID_OUTPUT,

    .nodes  = output_nodes,

    .nnodes = ARRAY_SIZE(output_nodes),

};

/* duplex: root node */

static const desc_param duplex_params_root[] = {

    {

        .id  = AC_PAR_VENDOR_ID,

        .val = QEMU_HDA_ID_DUPLEX,

    },{

        .id  = AC_PAR_SUBSYSTEM_ID,

        .val = QEMU_HDA_ID_DUPLEX,

    },{

        .id  = AC_PAR_REV_ID,

        .val = 0x00100101,

    },{

        .id  = AC_PAR_NODE_COUNT,

        .val = 0x00010001,

    },

};

/* duplex: audio function */

static const desc_param duplex_params_audio_func[] = {

    {

        .id  = AC_PAR_FUNCTION_TYPE,

        .val = AC_GRP_AUDIO_FUNCTION,

    },{

        .id  = AC_PAR_SUBSYSTEM_ID,

        .val = QEMU_HDA_ID_DUPLEX,

    },{

        .id  = AC_PAR_NODE_COUNT,

        .val = 0x00020004,

    },{

        .id  = AC_PAR_PCM,

        .val = QEMU_HDA_PCM_FORMATS,

    },{

        .id  = AC_PAR_STREAM,

        .val = AC_SUPFMT_PCM,

    },{

        .id  = AC_PAR_AMP_IN_CAP,

        .val = QEMU_HDA_AMP_NONE,

    },{

        .id  = AC_PAR_AMP_OUT_CAP,

        .val = QEMU_HDA_AMP_NONE,

    },{

        .id  = AC_PAR_GPIO_CAP,

        .val = 0,

    },{

        .id  = AC_PAR_AUDIO_FG_CAP,

        .val = 0x00000808,

    },{

        .id  = AC_PAR_POWER_STATE,

        .val = 0,

    },

};

/* duplex: nodes */

static const desc_node duplex_nodes[] = {

    {

        .nid     = AC_NODE_ROOT,

        .name    = "root",

        .params  = duplex_params_root,

        .nparams = ARRAY_SIZE(duplex_params_root),

    },{

        .nid     = 1,

        .name    = "func",

        .params  = duplex_params_audio_func,

        .nparams = ARRAY_SIZE(duplex_params_audio_func),

    },{

        .nid     = 2,

        .name    = "dac",

        .params  = common_params_audio_dac,

        .nparams = ARRAY_SIZE(common_params_audio_dac),

        .stindex = 0,

    },{

        .nid     = 3,

        .name    = "out",

        .params  = common_params_audio_lineout,

        .nparams = ARRAY_SIZE(common_params_audio_lineout),

        .config  = ((AC_JACK_PORT_COMPLEX << AC_DEFCFG_PORT_CONN_SHIFT) |

                    (AC_JACK_LINE_OUT     << AC_DEFCFG_DEVICE_SHIFT)    |

                    (AC_JACK_CONN_UNKNOWN << AC_DEFCFG_CONN_TYPE_SHIFT) |

                    (AC_JACK_COLOR_GREEN  << AC_DEFCFG_COLOR_SHIFT)     |

                    0x10),

        .pinctl  = AC_PINCTL_OUT_EN,

        .conn    = (uint32_t[]) { 2 },

    },{

        .nid     = 4,

        .name    = "adc",

        .params  = common_params_audio_adc,

        .nparams = ARRAY_SIZE(common_params_audio_adc),

        .stindex = 1,

        .conn    = (uint32_t[]) { 5 },

    },{

        .nid     = 5,

        .name    = "in",

        .params  = common_params_audio_linein,

        .nparams = ARRAY_SIZE(common_params_audio_linein),

        .config  = ((AC_JACK_PORT_COMPLEX << AC_DEFCFG_PORT_CONN_SHIFT) |

                    (AC_JACK_LINE_IN      << AC_DEFCFG_DEVICE_SHIFT)    |

                    (AC_JACK_CONN_UNKNOWN << AC_DEFCFG_CONN_TYPE_SHIFT) |

                    (AC_JACK_COLOR_RED    << AC_DEFCFG_COLOR_SHIFT)     |

                    0x20),

        .pinctl  = AC_PINCTL_IN_EN,

    }

};

/* duplex: codec */

static const desc_codec duplex = {

    .name   = "duplex",

    .iid    = QEMU_HDA_ID_DUPLEX,

    .nodes  = duplex_nodes,

    .nnodes = ARRAY_SIZE(duplex_nodes),

};

/* micro: root node */

static const desc_param micro_params_root[] = {

    {

        .id  = AC_PAR_VENDOR_ID,

        .val = QEMU_HDA_ID_MICRO,

    },{

        .id  = AC_PAR_SUBSYSTEM_ID,

        .val = QEMU_HDA_ID_MICRO,

    },{

        .id  = AC_PAR_REV_ID,

        .val = 0x00100101,

    },{

        .id  = AC_PAR_NODE_COUNT,

        .val = 0x00010001,

    },

};

/* micro: audio function */

static const desc_param micro_params_audio_func[] = {

    {

        .id  = AC_PAR_FUNCTION_TYPE,

        .val = AC_GRP_AUDIO_FUNCTION,

    },{

        .id  = AC_PAR_SUBSYSTEM_ID,

        .val = QEMU_HDA_ID_MICRO,

    },{

        .id  = AC_PAR_NODE_COUNT,

        .val = 0x00020004,

    },{

        .id  = AC_PAR_PCM,

        .val = QEMU_HDA_PCM_FORMATS,

    },{

        .id  = AC_PAR_STREAM,

        .val = AC_SUPFMT_PCM,

    },{

        .id  = AC_PAR_AMP_IN_CAP,

        .val = QEMU_HDA_AMP_NONE,

    },{

        .id  = AC_PAR_AMP_OUT_CAP,

        .val = QEMU_HDA_AMP_NONE,

    },{

        .id  = AC_PAR_GPIO_CAP,

        .val = 0,

    },{

        .id  = AC_PAR_AUDIO_FG_CAP,

        .val = 0x00000808,

    },{

        .id  = AC_PAR_POWER_STATE,

        .val = 0,

    },

};

/* micro: nodes */

static const desc_node micro_nodes[] = {

    {

        .nid     = AC_NODE_ROOT,

        .name    = "root",

        .params  = micro_params_root,

        .nparams = ARRAY_SIZE(micro_params_root),

    },{

        .nid     = 1,

        .name    = "func",

        .params  = micro_params_audio_func,

        .nparams = ARRAY_SIZE(micro_params_audio_func),

    },{

        .nid     = 2,

        .name    = "dac",

        .params  = common_params_audio_dac,

        .nparams = ARRAY_SIZE(common_params_audio_dac),

        .stindex = 0,

    },{

        .nid     = 3,

        .name    = "out",

        .params  = common_params_audio_lineout,

        .nparams = ARRAY_SIZE(common_params_audio_lineout),

        .config  = ((AC_JACK_PORT_COMPLEX << AC_DEFCFG_PORT_CONN_SHIFT) |

                    (AC_JACK_SPEAKER      << AC_DEFCFG_DEVICE_SHIFT)    |

                    (AC_JACK_CONN_UNKNOWN << AC_DEFCFG_CONN_TYPE_SHIFT) |

                    (AC_JACK_COLOR_GREEN  << AC_DEFCFG_COLOR_SHIFT)     |

                    0x10),

        .pinctl  = AC_PINCTL_OUT_EN,

        .conn    = (uint32_t[]) { 2 },

    },{

        .nid     = 4,

        .name    = "adc",

        .params  = common_params_audio_adc,

        .nparams = ARRAY_SIZE(common_params_audio_adc),

        .stindex = 1,

        .conn    = (uint32_t[]) { 5 },

    },{

        .nid     = 5,

        .name    = "in",

        .params  = common_params_audio_linein,

        .nparams = ARRAY_SIZE(common_params_audio_linein),

        .config  = ((AC_JACK_PORT_COMPLEX << AC_DEFCFG_PORT_CONN_SHIFT) |

                    (AC_JACK_MIC_IN       << AC_DEFCFG_DEVICE_SHIFT)    |

                    (AC_JACK_CONN_UNKNOWN << AC_DEFCFG_CONN_TYPE_SHIFT) |

                    (AC_JACK_COLOR_RED    << AC_DEFCFG_COLOR_SHIFT)     |

                    0x20),

        .pinctl  = AC_PINCTL_IN_EN,

    }

};

/* micro: codec */

static const desc_codec micro = {

    .name   = "micro",

    .iid    = QEMU_HDA_ID_MICRO,

    .nodes  = micro_nodes,

    .nnodes = ARRAY_SIZE(micro_nodes),

};

/* -------------------------------------------------------------------------- */

static const char *fmt2name[] = {

    [ AUD_FMT_U8  ] = "PCM-U8",

    [ AUD_FMT_S8  ] = "PCM-S8",

    [ AUD_FMT_U16 ] = "PCM-U16",

    [ AUD_FMT_S16 ] = "PCM-S16",

    [ AUD_FMT_U32 ] = "PCM-U32",

    [ AUD_FMT_S32 ] = "PCM-S32",

};

typedef struct HDAAudioState HDAAudioState;

typedef struct HDAAudioStream HDAAudioStream;

struct HDAAudioStream {

    HDAAudioState *state;

    const desc_node *node;

    bool output, running;

    uint32_t stream;

    uint32_t channel;

    uint32_t format;

    uint32_t gain_left, gain_right;

    bool mute_left, mute_right;

    struct audsettings as;

    union {

        SWVoiceIn *in;

        SWVoiceOut *out;

    } voice;

    uint8_t buf[HDA_BUFFER_SIZE];

    uint32_t bpos;

};

struct HDAAudioState {

    HDACodecDevice hda;

    const char *name;

    QEMUSoundCard card;

    const desc_codec *desc;

    HDAAudioStream st[4];

    bool running_compat[16];

    bool running_real[2 * 16];

    /* properties */

    uint32_t debug;

};

static void hda_audio_input_cb(void *opaque, int avail)

{

    HDAAudioStream *st = opaque;

    int recv = 0;

    int len;

    bool rc;

    while (avail - recv >= sizeof(st->buf)) {

        if (st->bpos != sizeof(st->buf)) {

            len = AUD_read(st->voice.in, st->buf + st->bpos,

                           sizeof(st->buf) - st->bpos);

            st->bpos += len;

            recv += len;

            if (st->bpos != sizeof(st->buf)) {

                break;

            }

        }

        rc = hda_codec_xfer(&st->state->hda, st->stream, false,

                            st->buf, sizeof(st->buf));

        if (!rc) {

            break;

        }

        st->bpos = 0;

    }

}

static void hda_audio_output_cb(void *opaque, int avail)

{

    HDAAudioStream *st = opaque;

    int sent = 0;

    int len;

    bool rc;

    while (avail - sent >= sizeof(st->buf)) {

        if (st->bpos == sizeof(st->buf)) {

            rc = hda_codec_xfer(&st->state->hda, st->stream, true,

                                st->buf, sizeof(st->buf));

            if (!rc) {

                break;

            }

            st->bpos = 0;

        }

        len = AUD_write(st->voice.out, st->buf + st->bpos,

                        sizeof(st->buf) - st->bpos);

        st->bpos += len;

        sent += len;

        if (st->bpos != sizeof(st->buf)) {

            break;

        }

    }

}

static void hda_audio_set_running(HDAAudioStream *st, bool running)

{

    if (st->node == NULL) {

        return;

    }

    if (st->running == running) {

        return;

    }

    st->running = running;

    dprint(st->state, 1, "%s: %s (stream %d)\n", st->node->name,

           st->running ? "on" : "off", st->stream);

    if (st->output) {

        AUD_set_active_out(st->voice.out, st->running);

    } else {

        AUD_set_active_in(st->voice.in, st->running);

    }

}

static void hda_audio_set_amp(HDAAudioStream *st)

{

    bool muted;

    uint32_t left, right;

    if (st->node == NULL) {

        return;

    }

    muted = st->mute_left && st->mute_right;

    left  = st->mute_left  ? 0 : st->gain_left;

    right = st->mute_right ? 0 : st->gain_right;

    left = left * 255 / QEMU_HDA_AMP_STEPS;

    right = right * 255 / QEMU_HDA_AMP_STEPS;

    if (st->output) {

        AUD_set_volume_out(st->voice.out, muted, left, right);

    } else {

        AUD_set_volume_in(st->voice.in, muted, left, right);

    }

}

static void hda_audio_setup(HDAAudioStream *st)

{

    if (st->node == NULL) {

        return;

    }

    dprint(st->state, 1, "%s: format: %d x %s @ %d Hz\n",

           st->node->name, st->as.nchannels,

           fmt2name[st->as.fmt], st->as.freq);

    if (st->output) {

        st->voice.out = AUD_open_out(&st->state->card, st->voice.out,

                                     st->node->name, st,

                                     hda_audio_output_cb, &st->as);

    } else {

        st->voice.in = AUD_open_in(&st->state->card, st->voice.in,

                                   st->node->name, st,

                                   hda_audio_input_cb, &st->as);

    }

}

static void hda_audio_command(HDACodecDevice *hda, uint32_t nid, uint32_t data)

{

    HDAAudioState *a = DO_UPCAST(HDAAudioState, hda, hda);

    HDAAudioStream *st;

    const desc_node *node = NULL;

    const desc_param *param;

    uint32_t verb, payload, response, count, shift;

    if ((data & 0x70000) == 0x70000) {

        /* 12/8 id/payload */

        verb = (data >> 8) & 0xfff;

        payload = data & 0x00ff;

    } else {

        /* 4/16 id/payload */

        verb = (data >> 8) & 0xf00;

        payload = data & 0xffff;

    }

    node = hda_codec_find_node(a->desc, nid);

    if (node == NULL) {

        goto fail;

    }

    dprint(a, 2, "%s: nid %d (%s), verb 0x%x, payload 0x%x\n",

           __FUNCTION__, nid, node->name, verb, payload);

    switch (verb) {

    /* all nodes */

    case AC_VERB_PARAMETERS:

        param = hda_codec_find_param(node, payload);

        if (param == NULL) {

            goto fail;

        }

        hda_codec_response(hda, true, param->val);

        break;

    case AC_VERB_GET_SUBSYSTEM_ID:

        hda_codec_response(hda, true, a->desc->iid);

        break;

    /* all functions */

    case AC_VERB_GET_CONNECT_LIST:

        param = hda_codec_find_param(node, AC_PAR_CONNLIST_LEN);

        count = param ? param->val : 0;

        response = 0;

        shift = 0;

        while (payload < count && shift < 32) {

            response |= node->conn[payload] << shift;

            payload++;

            shift += 8;

        }

        hda_codec_response(hda, true, response);

        break;

    /* pin widget */

    case AC_VERB_GET_CONFIG_DEFAULT:

        hda_codec_response(hda, true, node->config);

        break;

    case AC_VERB_GET_PIN_WIDGET_CONTROL:

        hda_codec_response(hda, true, node->pinctl);

        break;

    case AC_VERB_SET_PIN_WIDGET_CONTROL:

        if (node->pinctl != payload) {

            dprint(a, 1, "unhandled pin control bit\n");

        }

        hda_codec_response(hda, true, 0);

        break;

    /* audio in/out widget */

    case AC_VERB_SET_CHANNEL_STREAMID:

        st = a->st + node->stindex;

        if (st->node == NULL) {

            goto fail;

        }

        hda_audio_set_running(st, false);

        st->stream = (payload >> 4) & 0x0f;

        st->channel = payload & 0x0f;

        dprint(a, 2, "%s: stream %d, channel %d\n",

               st->node->name, st->stream, st->channel);

        hda_audio_set_running(st, a->running_real[st->output * 16 + st->stream]);

        hda_codec_response(hda, true, 0);

        break;

    case AC_VERB_GET_CONV:

        st = a->st + node->stindex;

        if (st->node == NULL) {

            goto fail;

        }

        response = st->stream << 4 | st->channel;

        hda_codec_response(hda, true, response);

        break;

    case AC_VERB_SET_STREAM_FORMAT:

        st = a->st + node->stindex;

        if (st->node == NULL) {

            goto fail;

        }

        st->format = payload;

        hda_codec_parse_fmt(st->format, &st->as);

        hda_audio_setup(st);

        hda_codec_response(hda, true, 0);

        break;

    case AC_VERB_GET_STREAM_FORMAT:

        st = a->st + node->stindex;

        if (st->node == NULL) {

            goto fail;

        }

        hda_codec_response(hda, true, st->format);

        break;

    case AC_VERB_GET_AMP_GAIN_MUTE:

        st = a->st + node->stindex;

        if (st->node == NULL) {

            goto fail;

        }

        if (payload & AC_AMP_GET_LEFT) {

            response = st->gain_left | (st->mute_left ? AC_AMP_MUTE : 0);

        } else {

            response = st->gain_right | (st->mute_right ? AC_AMP_MUTE : 0);

        }

        hda_codec_response(hda, true, response);

        break;

    case AC_VERB_SET_AMP_GAIN_MUTE:

        st = a->st + node->stindex;

        if (st->node == NULL) {

            goto fail;

        }

        dprint(a, 1, "amp (%s): %s%s%s%s index %d  gain %3d %s\n",

               st->node->name,

               (payload & AC_AMP_SET_OUTPUT) ? "o" : "-",

               (payload & AC_AMP_SET_INPUT)  ? "i" : "-",

               (payload & AC_AMP_SET_LEFT)   ? "l" : "-",

               (payload & AC_AMP_SET_RIGHT)  ? "r" : "-",

               (payload & AC_AMP_SET_INDEX) >> AC_AMP_SET_INDEX_SHIFT,

               (payload & AC_AMP_GAIN),

               (payload & AC_AMP_MUTE) ? "muted" : "");

        if (payload & AC_AMP_SET_LEFT) {

            st->gain_left = payload & AC_AMP_GAIN;

            st->mute_left = payload & AC_AMP_MUTE;

        }

        if (payload & AC_AMP_SET_RIGHT) {

            st->gain_right = payload & AC_AMP_GAIN;

            st->mute_right = payload & AC_AMP_MUTE;

        }

        hda_audio_set_amp(st);

        hda_codec_response(hda, true, 0);

        break;

    /* not supported */

    case AC_VERB_SET_POWER_STATE:

    case AC_VERB_GET_POWER_STATE:

    case AC_VERB_GET_SDI_SELECT:

        hda_codec_response(hda, true, 0);

        break;

    default:

        goto fail;

    }

    return;

fail:

    dprint(a, 1, "%s: not handled: nid %d (%s), verb 0x%x, payload 0x%x\n",

           __FUNCTION__, nid, node ? node->name : "?", verb, payload);

    hda_codec_response(hda, true, 0);

}

static void hda_audio_stream(HDACodecDevice *hda, uint32_t stnr, bool running, bool output)

{

    HDAAudioState *a = DO_UPCAST(HDAAudioState, hda, hda);

    int s;

    a->running_compat[stnr] = running;

    a->running_real[output * 16 + stnr] = running;

    for (s = 0; s < ARRAY_SIZE(a->st); s++) {

        if (a->st[s].node == NULL) {

            continue;

        }

        if (a->st[s].output != output) {

            continue;

        }

        if (a->st[s].stream != stnr) {

            continue;

        }

        hda_audio_set_running(&a->st[s], running);

    }

}

static int hda_audio_init(HDACodecDevice *hda, const struct desc_codec *desc)

{

    HDAAudioState *a = DO_UPCAST(HDAAudioState, hda, hda);

    HDAAudioStream *st;

    const desc_node *node;

    const desc_param *param;

    uint32_t i, type;

    a->desc = desc;

    a->name = object_get_typename(OBJECT(a));

    dprint(a, 1, "%s: cad %d\n", __FUNCTION__, a->hda.cad);

    AUD_register_card("hda", &a->card);

    for (i = 0; i < a->desc->nnodes; i++) {

        node = a->desc->nodes + i;

        param = hda_codec_find_param(node, AC_PAR_AUDIO_WIDGET_CAP);

        if (NULL == param)

            continue;

        type = (param->val & AC_WCAP_TYPE) >> AC_WCAP_TYPE_SHIFT;

        switch (type) {