[ALSA] hda-codec - Minor rewrites

[deliverable/linux.git] / sound / pci / hda / hda_codec.c

/*
 * Universal Interface for Intel High Definition Audio Codec
 *
 * Copyright (c) 2004 Takashi Iwai <tiwai@suse.de>
 *
 *
 *  This driver 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 of the License, or
 *  (at your option) any later version.
 *
 *  This driver 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, write to the Free Software
 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
 */

#include <sound/driver.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/slab.h>
#include <linux/pci.h>
#include <linux/moduleparam.h>
#include <sound/core.h>
#include "hda_codec.h"
#include <sound/asoundef.h>
#include <sound/initval.h>
#include "hda_local.h"


MODULE_AUTHOR("Takashi Iwai <tiwai@suse.de>");
MODULE_DESCRIPTION("Universal interface for High Definition Audio Codec");
MODULE_LICENSE("GPL");


/*
 * vendor / preset table
 */

struct hda_vendor_id {
        unsigned int id;
        const char *name;
};

/* codec vendor labels */
static struct hda_vendor_id hda_vendor_ids[] = {
        { 0x10ec, "Realtek" },
        { 0x11d4, "Analog Devices" },
        { 0x13f6, "C-Media" },
        { 0x434d, "C-Media" },
        { 0x8384, "SigmaTel" },
        {} /* terminator */
};

/* codec presets */
#include "hda_patch.h"


/**
 * snd_hda_codec_read - send a command and get the response
 * @codec: the HDA codec
 * @nid: NID to send the command
 * @direct: direct flag
 * @verb: the verb to send
 * @parm: the parameter for the verb
 *
 * Send a single command and read the corresponding response.
 *
 * Returns the obtained response value, or -1 for an error.
 */
unsigned int snd_hda_codec_read(struct hda_codec *codec, hda_nid_t nid, int direct,
                                unsigned int verb, unsigned int parm)
{
        unsigned int res;
        down(&codec->bus->cmd_mutex);
        if (! codec->bus->ops.command(codec, nid, direct, verb, parm))
                res = codec->bus->ops.get_response(codec);
        else
                res = (unsigned int)-1;
        up(&codec->bus->cmd_mutex);
        return res;
}

/**
 * snd_hda_codec_write - send a single command without waiting for response
 * @codec: the HDA codec
 * @nid: NID to send the command
 * @direct: direct flag
 * @verb: the verb to send
 * @parm: the parameter for the verb
 *
 * Send a single command without waiting for response.
 *
 * Returns 0 if successful, or a negative error code.
 */
int snd_hda_codec_write(struct hda_codec *codec, hda_nid_t nid, int direct,
                         unsigned int verb, unsigned int parm)
{
        int err;
        down(&codec->bus->cmd_mutex);
        err = codec->bus->ops.command(codec, nid, direct, verb, parm);
        up(&codec->bus->cmd_mutex);
        return err;
}

/**
 * snd_hda_sequence_write - sequence writes
 * @codec: the HDA codec
 * @seq: VERB array to send
 *
 * Send the commands sequentially from the given array.
 * The array must be terminated with NID=0.
 */
void snd_hda_sequence_write(struct hda_codec *codec, const struct hda_verb *seq)
{
        for (; seq->nid; seq++)
                snd_hda_codec_write(codec, seq->nid, 0, seq->verb, seq->param);
}

/**
 * snd_hda_get_sub_nodes - get the range of sub nodes
 * @codec: the HDA codec
 * @nid: NID to parse
 * @start_id: the pointer to store the start NID
 *
 * Parse the NID and store the start NID of its sub-nodes.
 * Returns the number of sub-nodes.
 */
int snd_hda_get_sub_nodes(struct hda_codec *codec, hda_nid_t nid, hda_nid_t *start_id)
{
        unsigned int parm;

        parm = snd_hda_param_read(codec, nid, AC_PAR_NODE_COUNT);
        *start_id = (parm >> 16) & 0x7fff;
        return (int)(parm & 0x7fff);
}

/**
 * snd_hda_get_connections - get connection list
 * @codec: the HDA codec
 * @nid: NID to parse
 * @conn_list: connection list array
 * @max_conns: max. number of connections to store
 *
 * Parses the connection list of the given widget and stores the list
 * of NIDs.
 *
 * Returns the number of connections, or a negative error code.
 */
int snd_hda_get_connections(struct hda_codec *codec, hda_nid_t nid,
                            hda_nid_t *conn_list, int max_conns)
{
        unsigned int parm;
        int i, j, conn_len, num_tupples, conns;
        unsigned int shift, num_elems, mask;

        snd_assert(conn_list && max_conns > 0, return -EINVAL);

        parm = snd_hda_param_read(codec, nid, AC_PAR_CONNLIST_LEN);
        if (parm & AC_CLIST_LONG) {
                /* long form */
                shift = 16;
                num_elems = 2;
        } else {
                /* short form */
                shift = 8;
                num_elems = 4;
        }
        conn_len = parm & AC_CLIST_LENGTH;
        num_tupples = num_elems / 2;
        mask = (1 << (shift-1)) - 1;

        if (! conn_len)
                return 0; /* no connection */

        if (conn_len == 1) {
                /* single connection */
                parm = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_CONNECT_LIST, 0);
                conn_list[0] = parm & mask;
                return 1;
        }

        /* multi connection */
        conns = 0;
        for (i = 0; i < conn_len; i += num_elems) {
                parm = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_CONNECT_LIST, i);
                for (j = 0; j < num_tupples; j++) {
                        int range_val;
                        hda_nid_t val1, val2, n;
                        range_val = parm & (1 << (shift-1)); /* ranges */
                        val1 = parm & mask;
                        parm >>= shift;
                        val2 = parm & mask;
                        parm >>= shift;
                        if (range_val) {
                                /* ranges between val1 and val2 */
                                if (val1 > val2) {
                                        snd_printk(KERN_WARNING "hda_codec: invalid dep_range_val %x:%x\n", val1, val2);
                                        continue;
                                }
                                for (n = val1; n <= val2; n++) {
                                        if (conns >= max_conns)
                                                return -EINVAL;
                                        conn_list[conns++] = n;
                                }
                        } else {
                                if (! val1)
                                        break;
                                if (conns >= max_conns)
                                        return -EINVAL;
                                conn_list[conns++] = val1;
                                if (! val2)
                                        break;
                                if (conns >= max_conns)
                                        return -EINVAL;
                                conn_list[conns++] = val2;
                        }
                }
        }
        return conns;
}


/**
 * snd_hda_queue_unsol_event - add an unsolicited event to queue
 * @bus: the BUS
 * @res: unsolicited event (lower 32bit of RIRB entry)
 * @res_ex: codec addr and flags (upper 32bit or RIRB entry)
 *
 * Adds the given event to the queue.  The events are processed in
 * the workqueue asynchronously.  Call this function in the interrupt
 * hanlder when RIRB receives an unsolicited event.
 *
 * Returns 0 if successful, or a negative error code.
 */
int snd_hda_queue_unsol_event(struct hda_bus *bus, u32 res, u32 res_ex)
{
        struct hda_bus_unsolicited *unsol;
        unsigned int wp;

        if ((unsol = bus->unsol) == NULL)
                return 0;

        wp = (unsol->wp + 1) % HDA_UNSOL_QUEUE_SIZE;
        unsol->wp = wp;

        wp <<= 1;
        unsol->queue[wp] = res;
        unsol->queue[wp + 1] = res_ex;

        queue_work(unsol->workq, &unsol->work);

        return 0;
}

/*
 * process queueud unsolicited events
 */
static void process_unsol_events(void *data)
{
        struct hda_bus *bus = data;
        struct hda_bus_unsolicited *unsol = bus->unsol;
        struct hda_codec *codec;
        unsigned int rp, caddr, res;

        while (unsol->rp != unsol->wp) {
                rp = (unsol->rp + 1) % HDA_UNSOL_QUEUE_SIZE;
                unsol->rp = rp;
                rp <<= 1;
                res = unsol->queue[rp];
                caddr = unsol->queue[rp + 1];
                if (! (caddr & (1 << 4))) /* no unsolicited event? */
                        continue;
                codec = bus->caddr_tbl[caddr & 0x0f];
                if (codec && codec->patch_ops.unsol_event)
                        codec->patch_ops.unsol_event(codec, res);
        }
}

/*
 * initialize unsolicited queue
 */
static int init_unsol_queue(struct hda_bus *bus)
{
        struct hda_bus_unsolicited *unsol;

        unsol = kzalloc(sizeof(*unsol), GFP_KERNEL);
        if (! unsol) {
                snd_printk(KERN_ERR "hda_codec: can't allocate unsolicited queue\n");
                return -ENOMEM;
        }
        unsol->workq = create_workqueue("hda_codec");
        if (! unsol->workq) {
                snd_printk(KERN_ERR "hda_codec: can't create workqueue\n");
                kfree(unsol);
                return -ENOMEM;
        }
        INIT_WORK(&unsol->work, process_unsol_events, bus);
        bus->unsol = unsol;
        return 0;
}

/*
 * destructor
 */
static void snd_hda_codec_free(struct hda_codec *codec);

static int snd_hda_bus_free(struct hda_bus *bus)
{
        struct list_head *p, *n;

        if (! bus)
                return 0;
        if (bus->unsol) {
                destroy_workqueue(bus->unsol->workq);
                kfree(bus->unsol);
        }
        list_for_each_safe(p, n, &bus->codec_list) {
                struct hda_codec *codec = list_entry(p, struct hda_codec, list);
                snd_hda_codec_free(codec);
        }
        if (bus->ops.private_free)
                bus->ops.private_free(bus);
        kfree(bus);
        return 0;
}

static int snd_hda_bus_dev_free(snd_device_t *device)
{
        struct hda_bus *bus = device->device_data;
        return snd_hda_bus_free(bus);
}

/**
 * snd_hda_bus_new - create a HDA bus
 * @card: the card entry
 * @temp: the template for hda_bus information
 * @busp: the pointer to store the created bus instance
 *
 * Returns 0 if successful, or a negative error code.
 */
int snd_hda_bus_new(snd_card_t *card, const struct hda_bus_template *temp,
                    struct hda_bus **busp)
{
        struct hda_bus *bus;
        int err;
        static snd_device_ops_t dev_ops = {
                .dev_free = snd_hda_bus_dev_free,
        };

        snd_assert(temp, return -EINVAL);
        snd_assert(temp->ops.command && temp->ops.get_response, return -EINVAL);

        if (busp)
                *busp = NULL;

        bus = kzalloc(sizeof(*bus), GFP_KERNEL);
        if (bus == NULL) {
                snd_printk(KERN_ERR "can't allocate struct hda_bus\n");
                return -ENOMEM;
        }

        bus->card = card;
        bus->private_data = temp->private_data;
        bus->pci = temp->pci;
        bus->modelname = temp->modelname;
        bus->ops = temp->ops;

        init_MUTEX(&bus->cmd_mutex);
        INIT_LIST_HEAD(&bus->codec_list);

        init_unsol_queue(bus);

        if ((err = snd_device_new(card, SNDRV_DEV_BUS, bus, &dev_ops)) < 0) {
                snd_hda_bus_free(bus);
                return err;
        }
        if (busp)
                *busp = bus;
        return 0;
}


/*
 * find a matching codec preset
 */
static const struct hda_codec_preset *find_codec_preset(struct hda_codec *codec)
{
        const struct hda_codec_preset **tbl, *preset;

        for (tbl = hda_preset_tables; *tbl; tbl++) {
                for (preset = *tbl; preset->id; preset++) {
                        u32 mask = preset->mask;
                        if (! mask)
                                mask = ~0;
                        if (preset->id == (codec->vendor_id & mask))
                                return preset;
                }
        }
        return NULL;
}

/*
 * snd_hda_get_codec_name - store the codec name
 */
void snd_hda_get_codec_name(struct hda_codec *codec,
                            char *name, int namelen)
{
        const struct hda_vendor_id *c;
        const char *vendor = NULL;
        u16 vendor_id = codec->vendor_id >> 16;
        char tmp[16];

        for (c = hda_vendor_ids; c->id; c++) {
                if (c->id == vendor_id) {
                        vendor = c->name;
                        break;
                }
        }
        if (! vendor) {
                sprintf(tmp, "Generic %04x", vendor_id);
                vendor = tmp;
        }
        if (codec->preset && codec->preset->name)
                snprintf(name, namelen, "%s %s", vendor, codec->preset->name);
        else
                snprintf(name, namelen, "%s ID %x", vendor, codec->vendor_id & 0xffff);
}

/*
 * look for an AFG and MFG nodes
 */
static void setup_fg_nodes(struct hda_codec *codec)
{
        int i, total_nodes;
        hda_nid_t nid;

        total_nodes = snd_hda_get_sub_nodes(codec, AC_NODE_ROOT, &nid);
        for (i = 0; i < total_nodes; i++, nid++) {
                switch((snd_hda_param_read(codec, nid, AC_PAR_FUNCTION_TYPE) & 0xff)) {
                case AC_GRP_AUDIO_FUNCTION:
                        codec->afg = nid;
                        break;
                case AC_GRP_MODEM_FUNCTION:
                        codec->mfg = nid;
                        break;
                default:
                        break;
                }
        }
}

/*
 * codec destructor
 */
static void snd_hda_codec_free(struct hda_codec *codec)
{
        if (! codec)
                return;
        list_del(&codec->list);
        codec->bus->caddr_tbl[codec->addr] = NULL;
        if (codec->patch_ops.free)
                codec->patch_ops.free(codec);
        kfree(codec);
}

static void init_amp_hash(struct hda_codec *codec);

/**
 * snd_hda_codec_new - create a HDA codec
 * @bus: the bus to assign
 * @codec_addr: the codec address
 * @codecp: the pointer to store the generated codec
 *
 * Returns 0 if successful, or a negative error code.
 */
int snd_hda_codec_new(struct hda_bus *bus, unsigned int codec_addr,
                      struct hda_codec **codecp)
{
        struct hda_codec *codec;
        char component[13];
        int err;

        snd_assert(bus, return -EINVAL);
        snd_assert(codec_addr <= HDA_MAX_CODEC_ADDRESS, return -EINVAL);

        if (bus->caddr_tbl[codec_addr]) {
                snd_printk(KERN_ERR "hda_codec: address 0x%x is already occupied\n", codec_addr);
                return -EBUSY;
        }

        codec = kzalloc(sizeof(*codec), GFP_KERNEL);
        if (codec == NULL) {
                snd_printk(KERN_ERR "can't allocate struct hda_codec\n");
                return -ENOMEM;
        }

        codec->bus = bus;
        codec->addr = codec_addr;
        init_MUTEX(&codec->spdif_mutex);
        init_amp_hash(codec);

        list_add_tail(&codec->list, &bus->codec_list);
        bus->caddr_tbl[codec_addr] = codec;

        codec->vendor_id = snd_hda_param_read(codec, AC_NODE_ROOT, AC_PAR_VENDOR_ID);
        codec->subsystem_id = snd_hda_param_read(codec, AC_NODE_ROOT, AC_PAR_SUBSYSTEM_ID);
        codec->revision_id = snd_hda_param_read(codec, AC_NODE_ROOT, AC_PAR_REV_ID);

        setup_fg_nodes(codec);
        if (! codec->afg && ! codec->mfg) {
                snd_printdd("hda_codec: no AFG or MFG node found\n");
                snd_hda_codec_free(codec);
                return -ENODEV;
        }

        if (! codec->subsystem_id) {
                hda_nid_t nid = codec->afg ? codec->afg : codec->mfg;
                codec->subsystem_id = snd_hda_codec_read(codec, nid, 0,
                                                         AC_VERB_GET_SUBSYSTEM_ID,
                                                         0);
        }

        codec->preset = find_codec_preset(codec);
        if (! *bus->card->mixername)
                snd_hda_get_codec_name(codec, bus->card->mixername,
                                       sizeof(bus->card->mixername));

        if (codec->preset && codec->preset->patch)
                err = codec->preset->patch(codec);
        else
                err = snd_hda_parse_generic_codec(codec);
        if (err < 0) {
                snd_hda_codec_free(codec);
                return err;
        }

        snd_hda_codec_proc_new(codec);

        sprintf(component, "HDA:%08x", codec->vendor_id);
        snd_component_add(codec->bus->card, component);

        if (codecp)
                *codecp = codec;
        return 0;
}

/**
 * snd_hda_codec_setup_stream - set up the codec for streaming
 * @codec: the CODEC to set up
 * @nid: the NID to set up
 * @stream_tag: stream tag to pass, it's between 0x1 and 0xf.
 * @channel_id: channel id to pass, zero based.
 * @format: stream format.
 */
void snd_hda_codec_setup_stream(struct hda_codec *codec, hda_nid_t nid, u32 stream_tag,
                                int channel_id, int format)
{
        if (! nid)
                return;

        snd_printdd("hda_codec_setup_stream: NID=0x%x, stream=0x%x, channel=%d, format=0x%x\n",
                    nid, stream_tag, channel_id, format);
        snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_CHANNEL_STREAMID,
                            (stream_tag << 4) | channel_id);
        msleep(1);
        snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_STREAM_FORMAT, format);
}


/*
 * amp access functions
 */

/* FIXME: more better hash key? */
#define HDA_HASH_KEY(nid,dir,idx) (u32)((nid) + ((idx) << 16) + ((dir) << 24))
#define INFO_AMP_CAPS   (1<<0)
#define INFO_AMP_VOL(ch)        (1 << (1 + (ch)))

/* initialize the hash table */
static void init_amp_hash(struct hda_codec *codec)
{
        memset(codec->amp_hash, 0xff, sizeof(codec->amp_hash));
        codec->num_amp_entries = 0;
}

/* query the hash.  allocate an entry if not found. */
static struct hda_amp_info *get_alloc_amp_hash(struct hda_codec *codec, u32 key)
{
        u16 idx = key % (u16)ARRAY_SIZE(codec->amp_hash);
        u16 cur = codec->amp_hash[idx];
        struct hda_amp_info *info;

        while (cur != 0xffff) {
                info = &codec->amp_info[cur];
                if (info->key == key)
                        return info;
                cur = info->next;
        }

        /* add a new hash entry */
        if (codec->num_amp_entries >= ARRAY_SIZE(codec->amp_info)) {
                snd_printk(KERN_ERR "hda_codec: Tooooo many amps!\n");
                return NULL;
        }
        cur = codec->num_amp_entries++;
        info = &codec->amp_info[cur];
        info->key = key;
        info->status = 0; /* not initialized yet */
        info->next = codec->amp_hash[idx];
        codec->amp_hash[idx] = cur;

        return info;
}

/*
 * query AMP capabilities for the given widget and direction
 */
static u32 query_amp_caps(struct hda_codec *codec, hda_nid_t nid, int direction)
{
        struct hda_amp_info *info = get_alloc_amp_hash(codec, HDA_HASH_KEY(nid, direction, 0));

        if (! info)
                return 0;
        if (! (info->status & INFO_AMP_CAPS)) {
                if (!(snd_hda_param_read(codec, nid, AC_PAR_AUDIO_WIDGET_CAP) & AC_WCAP_AMP_OVRD))
                        nid = codec->afg;
                info->amp_caps = snd_hda_param_read(codec, nid, direction == HDA_OUTPUT ?
                                                    AC_PAR_AMP_OUT_CAP : AC_PAR_AMP_IN_CAP);
                info->status |= INFO_AMP_CAPS;
        }
        return info->amp_caps;
}

/*
 * read the current volume to info
 * if the cache exists, read the cache value.
 */
static unsigned int get_vol_mute(struct hda_codec *codec, struct hda_amp_info *info,
                         hda_nid_t nid, int ch, int direction, int index)
{
        u32 val, parm;

        if (info->status & INFO_AMP_VOL(ch))
                return info->vol[ch];

        parm = ch ? AC_AMP_GET_RIGHT : AC_AMP_GET_LEFT;
        parm |= direction == HDA_OUTPUT ? AC_AMP_GET_OUTPUT : AC_AMP_GET_INPUT;
        parm |= index;
        val = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_AMP_GAIN_MUTE, parm);
        info->vol[ch] = val & 0xff;
        info->status |= INFO_AMP_VOL(ch);
        return info->vol[ch];
}

/*
 * write the current volume in info to the h/w and update the cache
 */
static void put_vol_mute(struct hda_codec *codec, struct hda_amp_info *info,
                         hda_nid_t nid, int ch, int direction, int index, int val)
{
        u32 parm;

        parm = ch ? AC_AMP_SET_RIGHT : AC_AMP_SET_LEFT;
        parm |= direction == HDA_OUTPUT ? AC_AMP_SET_OUTPUT : AC_AMP_SET_INPUT;
        parm |= index << AC_AMP_SET_INDEX_SHIFT;
        parm |= val;
        snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_AMP_GAIN_MUTE, parm);
        info->vol[ch] = val;
}

/*
 * read AMP value.  The volume is between 0 to 0x7f, 0x80 = mute bit.
 */
static int snd_hda_codec_amp_read(struct hda_codec *codec, hda_nid_t nid, int ch, int direction, int index)
{
        struct hda_amp_info *info = get_alloc_amp_hash(codec, HDA_HASH_KEY(nid, direction, index));
        if (! info)
                return 0;
        return get_vol_mute(codec, info, nid, ch, direction, index);
}

/*
 * update the AMP value, mask = bit mask to set, val = the value
 */
static int snd_hda_codec_amp_update(struct hda_codec *codec, hda_nid_t nid, int ch, int direction, int idx, int mask, int val)
{
        struct hda_amp_info *info = get_alloc_amp_hash(codec, HDA_HASH_KEY(nid, direction, idx));

        if (! info)
                return 0;
        val &= mask;
        val |= get_vol_mute(codec, info, nid, ch, direction, idx) & ~mask;
        if (info->vol[ch] == val && ! codec->in_resume)
                return 0;
        put_vol_mute(codec, info, nid, ch, direction, idx, val);
        return 1;
}


/*
 * AMP control callbacks
 */
/* retrieve parameters from private_value */
#define get_amp_nid(kc)         ((kc)->private_value & 0xffff)
#define get_amp_channels(kc)    (((kc)->private_value >> 16) & 0x3)
#define get_amp_direction(kc)   (((kc)->private_value >> 18) & 0x1)
#define get_amp_index(kc)       (((kc)->private_value >> 19) & 0xf)

/* volume */
int snd_hda_mixer_amp_volume_info(snd_kcontrol_t *kcontrol, snd_ctl_elem_info_t *uinfo)
{
        struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
        u16 nid = get_amp_nid(kcontrol);
        u8 chs = get_amp_channels(kcontrol);
        int dir = get_amp_direction(kcontrol);
        u32 caps;

        caps = query_amp_caps(codec, nid, dir);
        caps = (caps & AC_AMPCAP_NUM_STEPS) >> AC_AMPCAP_NUM_STEPS_SHIFT; /* num steps */
        if (! caps) {
                printk(KERN_WARNING "hda_codec: num_steps = 0 for NID=0x%x\n", nid);
                return -EINVAL;
        }
        uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
        uinfo->count = chs == 3 ? 2 : 1;
        uinfo->value.integer.min = 0;
        uinfo->value.integer.max = caps;
        return 0;
}

int snd_hda_mixer_amp_volume_get(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
{
        struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
        hda_nid_t nid = get_amp_nid(kcontrol);
        int chs = get_amp_channels(kcontrol);
        int dir = get_amp_direction(kcontrol);
        int idx = get_amp_index(kcontrol);
        long *valp = ucontrol->value.integer.value;

        if (chs & 1)
                *valp++ = snd_hda_codec_amp_read(codec, nid, 0, dir, idx) & 0x7f;
        if (chs & 2)
                *valp = snd_hda_codec_amp_read(codec, nid, 1, dir, idx) & 0x7f;
        return 0;
}

int snd_hda_mixer_amp_volume_put(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
{
        struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
        hda_nid_t nid = get_amp_nid(kcontrol);
        int chs = get_amp_channels(kcontrol);
        int dir = get_amp_direction(kcontrol);
        int idx = get_amp_index(kcontrol);
        long *valp = ucontrol->value.integer.value;
        int change = 0;

        if (chs & 1) {
                change = snd_hda_codec_amp_update(codec, nid, 0, dir, idx,
                                                  0x7f, *valp);
                valp++;
        }
        if (chs & 2)
                change |= snd_hda_codec_amp_update(codec, nid, 1, dir, idx,
                                                   0x7f, *valp);
        return change;
}

/* switch */
int snd_hda_mixer_amp_switch_info(snd_kcontrol_t *kcontrol, snd_ctl_elem_info_t *uinfo)
{
        int chs = get_amp_channels(kcontrol);

        uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
        uinfo->count = chs == 3 ? 2 : 1;
        uinfo->value.integer.min = 0;
        uinfo->value.integer.max = 1;
        return 0;
}

int snd_hda_mixer_amp_switch_get(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
{
        struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
        hda_nid_t nid = get_amp_nid(kcontrol);
        int chs = get_amp_channels(kcontrol);
        int dir = get_amp_direction(kcontrol);
        int idx = get_amp_index(kcontrol);
        long *valp = ucontrol->value.integer.value;

        if (chs & 1)
                *valp++ = (snd_hda_codec_amp_read(codec, nid, 0, dir, idx) & 0x80) ? 0 : 1;
        if (chs & 2)
                *valp = (snd_hda_codec_amp_read(codec, nid, 1, dir, idx) & 0x80) ? 0 : 1;
        return 0;
}

int snd_hda_mixer_amp_switch_put(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
{
        struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
        hda_nid_t nid = get_amp_nid(kcontrol);
        int chs = get_amp_channels(kcontrol);
        int dir = get_amp_direction(kcontrol);
        int idx = get_amp_index(kcontrol);
        long *valp = ucontrol->value.integer.value;
        int change = 0;

        if (chs & 1) {
                change = snd_hda_codec_amp_update(codec, nid, 0, dir, idx,
                                                  0x80, *valp ? 0 : 0x80);
                valp++;
        }
        if (chs & 2)
                change |= snd_hda_codec_amp_update(codec, nid, 1, dir, idx,
                                                   0x80, *valp ? 0 : 0x80);
        
        return change;
}

/*
 * bound volume controls
 *
 * bind multiple volumes (# indices, from 0)
 */

#define AMP_VAL_IDX_SHIFT       19
#define AMP_VAL_IDX_MASK        (0x0f<<19)

int snd_hda_mixer_bind_switch_get(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
{
        struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
        unsigned long pval;
        int err;

        down(&codec->spdif_mutex); /* reuse spdif_mutex */
        pval = kcontrol->private_value;
        kcontrol->private_value = pval & ~AMP_VAL_IDX_MASK; /* index 0 */
        err = snd_hda_mixer_amp_switch_get(kcontrol, ucontrol);
        kcontrol->private_value = pval;
        up(&codec->spdif_mutex);
        return err;
}

int snd_hda_mixer_bind_switch_put(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
{
        struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
        unsigned long pval;
        int i, indices, err = 0, change = 0;

        down(&codec->spdif_mutex); /* reuse spdif_mutex */
        pval = kcontrol->private_value;
        indices = (pval & AMP_VAL_IDX_MASK) >> AMP_VAL_IDX_SHIFT;
        for (i = 0; i < indices; i++) {
                kcontrol->private_value = (pval & ~AMP_VAL_IDX_MASK) | (i << AMP_VAL_IDX_SHIFT);
                err = snd_hda_mixer_amp_switch_put(kcontrol, ucontrol);
                if (err < 0)
                        break;
                change |= err;
        }
        kcontrol->private_value = pval;
        up(&codec->spdif_mutex);
        return err < 0 ? err : change;
}

/*
 * SPDIF out controls
 */

static int snd_hda_spdif_mask_info(snd_kcontrol_t *kcontrol, snd_ctl_elem_info_t *uinfo)
{
        uinfo->type = SNDRV_CTL_ELEM_TYPE_IEC958;
        uinfo->count = 1;
        return 0;
}

static int snd_hda_spdif_cmask_get(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
{
        ucontrol->value.iec958.status[0] = IEC958_AES0_PROFESSIONAL |
                                           IEC958_AES0_NONAUDIO |
                                           IEC958_AES0_CON_EMPHASIS_5015 |
                                           IEC958_AES0_CON_NOT_COPYRIGHT;
        ucontrol->value.iec958.status[1] = IEC958_AES1_CON_CATEGORY |
                                           IEC958_AES1_CON_ORIGINAL;
        return 0;
}

static int snd_hda_spdif_pmask_get(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
{
        ucontrol->value.iec958.status[0] = IEC958_AES0_PROFESSIONAL |
                                           IEC958_AES0_NONAUDIO |
                                           IEC958_AES0_PRO_EMPHASIS_5015;
        return 0;
}

static int snd_hda_spdif_default_get(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
{
        struct hda_codec *codec = snd_kcontrol_chip(kcontrol);

        ucontrol->value.iec958.status[0] = codec->spdif_status & 0xff;
        ucontrol->value.iec958.status[1] = (codec->spdif_status >> 8) & 0xff;
        ucontrol->value.iec958.status[2] = (codec->spdif_status >> 16) & 0xff;
        ucontrol->value.iec958.status[3] = (codec->spdif_status >> 24) & 0xff;

        return 0;
}

/* convert from SPDIF status bits to HDA SPDIF bits
 * bit 0 (DigEn) is always set zero (to be filled later)
 */
static unsigned short convert_from_spdif_status(unsigned int sbits)
{
        unsigned short val = 0;

        if (sbits & IEC958_AES0_PROFESSIONAL)
                val |= 1 << 6;
        if (sbits & IEC958_AES0_NONAUDIO)
                val |= 1 << 5;
        if (sbits & IEC958_AES0_PROFESSIONAL) {
                if ((sbits & IEC958_AES0_PRO_EMPHASIS) == IEC958_AES0_PRO_EMPHASIS_5015)
                        val |= 1 << 3;
        } else {
                if ((sbits & IEC958_AES0_CON_EMPHASIS) == IEC958_AES0_CON_EMPHASIS_5015)
                        val |= 1 << 3;
                if (! (sbits & IEC958_AES0_CON_NOT_COPYRIGHT))
                        val |= 1 << 4;
                if (sbits & (IEC958_AES1_CON_ORIGINAL << 8))
                        val |= 1 << 7;
                val |= sbits & (IEC958_AES1_CON_CATEGORY << 8);
        }
        return val;
}

/* convert to SPDIF status bits from HDA SPDIF bits
 */
static unsigned int convert_to_spdif_status(unsigned short val)
{
        unsigned int sbits = 0;

        if (val & (1 << 5))
                sbits |= IEC958_AES0_NONAUDIO;
        if (val & (1 << 6))
                sbits |= IEC958_AES0_PROFESSIONAL;
        if (sbits & IEC958_AES0_PROFESSIONAL) {
                if (sbits & (1 << 3))
                        sbits |= IEC958_AES0_PRO_EMPHASIS_5015;
        } else {
                if (val & (1 << 3))
                        sbits |= IEC958_AES0_CON_EMPHASIS_5015;
                if (! (val & (1 << 4)))
                        sbits |= IEC958_AES0_CON_NOT_COPYRIGHT;
                if (val & (1 << 7))
                        sbits |= (IEC958_AES1_CON_ORIGINAL << 8);
                sbits |= val & (0x7f << 8);
        }
        return sbits;
}

static int snd_hda_spdif_default_put(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
{
        struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
        hda_nid_t nid = kcontrol->private_value;
        unsigned short val;
        int change;

        down(&codec->spdif_mutex);
        codec->spdif_status = ucontrol->value.iec958.status[0] |
                ((unsigned int)ucontrol->value.iec958.status[1] << 8) |
                ((unsigned int)ucontrol->value.iec958.status[2] << 16) |
                ((unsigned int)ucontrol->value.iec958.status[3] << 24);
        val = convert_from_spdif_status(codec->spdif_status);
        val |= codec->spdif_ctls & 1;
        change = codec->spdif_ctls != val;
        codec->spdif_ctls = val;

        if (change || codec->in_resume) {
                snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_DIGI_CONVERT_1, val & 0xff);
                snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_DIGI_CONVERT_2, val >> 8);
        }

        up(&codec->spdif_mutex);
        return change;
}

static int snd_hda_spdif_out_switch_info(snd_kcontrol_t *kcontrol, snd_ctl_elem_info_t *uinfo)
{
        uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
        uinfo->count = 1;
        uinfo->value.integer.min = 0;
        uinfo->value.integer.max = 1;
        return 0;
}

static int snd_hda_spdif_out_switch_get(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
{
        struct hda_codec *codec = snd_kcontrol_chip(kcontrol);

        ucontrol->value.integer.value[0] = codec->spdif_ctls & 1;
        return 0;
}

static int snd_hda_spdif_out_switch_put(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
{
        struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
        hda_nid_t nid = kcontrol->private_value;
        unsigned short val;
        int change;

        down(&codec->spdif_mutex);
        val = codec->spdif_ctls & ~1;
        if (ucontrol->value.integer.value[0])
                val |= 1;
        change = codec->spdif_ctls != val;
        if (change || codec->in_resume) {
                codec->spdif_ctls = val;
                snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_DIGI_CONVERT_1, val & 0xff);
                snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_AMP_GAIN_MUTE,
                                    AC_AMP_SET_RIGHT | AC_AMP_SET_LEFT |
                                    AC_AMP_SET_OUTPUT | ((val & 1) ? 0 : 0x80));
        }
        up(&codec->spdif_mutex);
        return change;
}

static snd_kcontrol_new_t dig_mixes[] = {
        {
                .access = SNDRV_CTL_ELEM_ACCESS_READ,
                .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
                .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,CON_MASK),
                .info = snd_hda_spdif_mask_info,
                .get = snd_hda_spdif_cmask_get,
        },
        {
                .access = SNDRV_CTL_ELEM_ACCESS_READ,
                .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
                .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,PRO_MASK),
                .info = snd_hda_spdif_mask_info,
                .get = snd_hda_spdif_pmask_get,
        },
        {
                .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
                .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,DEFAULT),
                .info = snd_hda_spdif_mask_info,
                .get = snd_hda_spdif_default_get,
                .put = snd_hda_spdif_default_put,
        },
        {
                .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
                .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,SWITCH),
                .info = snd_hda_spdif_out_switch_info,
                .get = snd_hda_spdif_out_switch_get,
                .put = snd_hda_spdif_out_switch_put,
        },
        { } /* end */
};

/**
 * snd_hda_create_spdif_out_ctls - create Output SPDIF-related controls
 * @codec: the HDA codec
 * @nid: audio out widget NID
 *
 * Creates controls related with the SPDIF output.
 * Called from each patch supporting the SPDIF out.
 *
 * Returns 0 if successful, or a negative error code.
 */
int snd_hda_create_spdif_out_ctls(struct hda_codec *codec, hda_nid_t nid)
{
        int err;
        snd_kcontrol_t *kctl;
        snd_kcontrol_new_t *dig_mix;

        for (dig_mix = dig_mixes; dig_mix->name; dig_mix++) {
                kctl = snd_ctl_new1(dig_mix, codec);
                kctl->private_value = nid;
                if ((err = snd_ctl_add(codec->bus->card, kctl)) < 0)
                        return err;
        }
        codec->spdif_ctls = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_DIGI_CONVERT, 0);
        codec->spdif_status = convert_to_spdif_status(codec->spdif_ctls);
        return 0;
}

/*
 * SPDIF input
 */

#define snd_hda_spdif_in_switch_info    snd_hda_spdif_out_switch_info

static int snd_hda_spdif_in_switch_get(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
{
        struct hda_codec *codec = snd_kcontrol_chip(kcontrol);

        ucontrol->value.integer.value[0] = codec->spdif_in_enable;
        return 0;
}

static int snd_hda_spdif_in_switch_put(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
{
        struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
        hda_nid_t nid = kcontrol->private_value;
        unsigned int val = !!ucontrol->value.integer.value[0];
        int change;

        down(&codec->spdif_mutex);
        change = codec->spdif_in_enable != val;
        if (change || codec->in_resume) {
                codec->spdif_in_enable = val;
                snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_DIGI_CONVERT_1, val);
        }
        up(&codec->spdif_mutex);
        return change;
}

static int snd_hda_spdif_in_status_get(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
{
        struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
        hda_nid_t nid = kcontrol->private_value;
        unsigned short val;
        unsigned int sbits;

        val = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_DIGI_CONVERT, 0);
        sbits = convert_to_spdif_status(val);
        ucontrol->value.iec958.status[0] = sbits;
        ucontrol->value.iec958.status[1] = sbits >> 8;
        ucontrol->value.iec958.status[2] = sbits >> 16;
        ucontrol->value.iec958.status[3] = sbits >> 24;
        return 0;
}

static snd_kcontrol_new_t dig_in_ctls[] = {
        {
                .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
                .name = SNDRV_CTL_NAME_IEC958("",CAPTURE,SWITCH),
                .info = snd_hda_spdif_in_switch_info,
                .get = snd_hda_spdif_in_switch_get,
                .put = snd_hda_spdif_in_switch_put,
        },
        {
                .access = SNDRV_CTL_ELEM_ACCESS_READ,
                .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
                .name = SNDRV_CTL_NAME_IEC958("",CAPTURE,DEFAULT),
                .info = snd_hda_spdif_mask_info,
                .get = snd_hda_spdif_in_status_get,
        },
        { } /* end */
};

/**
 * snd_hda_create_spdif_in_ctls - create Input SPDIF-related controls
 * @codec: the HDA codec
 * @nid: audio in widget NID
 *
 * Creates controls related with the SPDIF input.
 * Called from each patch supporting the SPDIF in.
 *
 * Returns 0 if successful, or a negative error code.
 */
int snd_hda_create_spdif_in_ctls(struct hda_codec *codec, hda_nid_t nid)
{
        int err;
        snd_kcontrol_t *kctl;
        snd_kcontrol_new_t *dig_mix;

        for (dig_mix = dig_in_ctls; dig_mix->name; dig_mix++) {
                kctl = snd_ctl_new1(dig_mix, codec);
                kctl->private_value = nid;
                if ((err = snd_ctl_add(codec->bus->card, kctl)) < 0)
                        return err;
        }
        codec->spdif_in_enable = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_DIGI_CONVERT, 0) & 1;
        return 0;
}


/**
 * snd_hda_build_controls - build mixer controls
 * @bus: the BUS
 *
 * Creates mixer controls for each codec included in the bus.
 *
 * Returns 0 if successful, otherwise a negative error code.
 */
int snd_hda_build_controls(struct hda_bus *bus)
{
        struct list_head *p;

        /* build controls */
        list_for_each(p, &bus->codec_list) {
                struct hda_codec *codec = list_entry(p, struct hda_codec, list);
                int err;
                if (! codec->patch_ops.build_controls)
                        continue;
                err = codec->patch_ops.build_controls(codec);
                if (err < 0)
                        return err;
        }

        /* initialize */
        list_for_each(p, &bus->codec_list) {
                struct hda_codec *codec = list_entry(p, struct hda_codec, list);
                int err;
                if (! codec->patch_ops.init)
                        continue;
                err = codec->patch_ops.init(codec);
                if (err < 0)
                        return err;
        }
        return 0;
}


/*
 * stream formats
 */
struct hda_rate_tbl {
        unsigned int hz;
        unsigned int alsa_bits;
        unsigned int hda_fmt;
};

static struct hda_rate_tbl rate_bits[] = {
        /* rate in Hz, ALSA rate bitmask, HDA format value */

        /* autodetected value used in snd_hda_query_supported_pcm */
        { 8000, SNDRV_PCM_RATE_8000, 0x0500 }, /* 1/6 x 48 */
        { 11025, SNDRV_PCM_RATE_11025, 0x4300 }, /* 1/4 x 44 */
        { 16000, SNDRV_PCM_RATE_16000, 0x0200 }, /* 1/3 x 48 */
        { 22050, SNDRV_PCM_RATE_22050, 0x4100 }, /* 1/2 x 44 */
        { 32000, SNDRV_PCM_RATE_32000, 0x0a00 }, /* 2/3 x 48 */
        { 44100, SNDRV_PCM_RATE_44100, 0x4000 }, /* 44 */
        { 48000, SNDRV_PCM_RATE_48000, 0x0000 }, /* 48 */
        { 88200, SNDRV_PCM_RATE_88200, 0x4800 }, /* 2 x 44 */
        { 96000, SNDRV_PCM_RATE_96000, 0x0800 }, /* 2 x 48 */
        { 176400, SNDRV_PCM_RATE_176400, 0x5800 },/* 4 x 44 */
        { 192000, SNDRV_PCM_RATE_192000, 0x1800 }, /* 4 x 48 */

        /* not autodetected value */
        { 9600, SNDRV_PCM_RATE_KNOT, 0x0400 }, /* 1/5 x 48 */

        { 0 } /* terminator */
};

/**
 * snd_hda_calc_stream_format - calculate format bitset
 * @rate: the sample rate
 * @channels: the number of channels
 * @format: the PCM format (SNDRV_PCM_FORMAT_XXX)
 * @maxbps: the max. bps
 *
 * Calculate the format bitset from the given rate, channels and th PCM format.
 *
 * Return zero if invalid.
 */
unsigned int snd_hda_calc_stream_format(unsigned int rate,
                                        unsigned int channels,
                                        unsigned int format,
                                        unsigned int maxbps)
{
        int i;
        unsigned int val = 0;

        for (i = 0; rate_bits[i].hz; i++)
                if (rate_bits[i].hz == rate) {
                        val = rate_bits[i].hda_fmt;
                        break;
                }
        if (! rate_bits[i].hz) {
                snd_printdd("invalid rate %d\n", rate);
                return 0;
        }

        if (channels == 0 || channels > 8) {
                snd_printdd("invalid channels %d\n", channels);
                return 0;
        }
        val |= channels - 1;

        switch (snd_pcm_format_width(format)) {
        case 8:  val |= 0x00; break;
        case 16: val |= 0x10; break;
        case 20:
        case 24:
        case 32:
                if (maxbps >= 32)
                        val |= 0x40;
                else if (maxbps >= 24)
                        val |= 0x30;
                else
                        val |= 0x20;
                break;
        default:
                snd_printdd("invalid format width %d\n", snd_pcm_format_width(format));
                return 0;
        }

        return val;
}

/**
 * snd_hda_query_supported_pcm - query the supported PCM rates and formats
 * @codec: the HDA codec
 * @nid: NID to query
 * @ratesp: the pointer to store the detected rate bitflags
 * @formatsp: the pointer to store the detected formats
 * @bpsp: the pointer to store the detected format widths
 *
 * Queries the supported PCM rates and formats.  The NULL @ratesp, @formatsp
 * or @bsps argument is ignored.
 *
 * Returns 0 if successful, otherwise a negative error code.
 */
int snd_hda_query_supported_pcm(struct hda_codec *codec, hda_nid_t nid,
                                u32 *ratesp, u64 *formatsp, unsigned int *bpsp)
{
        int i;
        unsigned int val, streams;

        val = 0;
        if (nid != codec->afg &&
            snd_hda_param_read(codec, nid, AC_PAR_AUDIO_WIDGET_CAP) & AC_WCAP_FORMAT_OVRD) {
                val = snd_hda_param_read(codec, nid, AC_PAR_PCM);
                if (val == -1)
                        return -EIO;
        }
        if (! val)
                val = snd_hda_param_read(codec, codec->afg, AC_PAR_PCM);

        if (ratesp) {
                u32 rates = 0;
                for (i = 0; rate_bits[i].hz; i++) {
                        if (val & (1 << i))
                                rates |= rate_bits[i].alsa_bits;
                }
                *ratesp = rates;
        }

        if (formatsp || bpsp) {
                u64 formats = 0;
                unsigned int bps;
                unsigned int wcaps;

                wcaps = snd_hda_param_read(codec, nid, AC_PAR_AUDIO_WIDGET_CAP);
                streams = snd_hda_param_read(codec, nid, AC_PAR_STREAM);
                if (streams == -1)
                        return -EIO;
                if (! streams) {
                        streams = snd_hda_param_read(codec, codec->afg, AC_PAR_STREAM);
                        if (streams == -1)
                                return -EIO;
                }

                bps = 0;
                if (streams & AC_SUPFMT_PCM) {
                        if (val & AC_SUPPCM_BITS_8) {
                                formats |= SNDRV_PCM_FMTBIT_U8;
                                bps = 8;
                        }
                        if (val & AC_SUPPCM_BITS_16) {
                                formats |= SNDRV_PCM_FMTBIT_S16_LE;
                                bps = 16;
                        }
                        if (wcaps & AC_WCAP_DIGITAL) {
                                if (val & AC_SUPPCM_BITS_32)
                                        formats |= SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE;
                                if (val & (AC_SUPPCM_BITS_20|AC_SUPPCM_BITS_24))
                                        formats |= SNDRV_PCM_FMTBIT_S32_LE;
                                if (val & AC_SUPPCM_BITS_24)
                                        bps = 24;
                                else if (val & AC_SUPPCM_BITS_20)
                                        bps = 20;
                        } else if (val & (AC_SUPPCM_BITS_20|AC_SUPPCM_BITS_24|AC_SUPPCM_BITS_32)) {
                                formats |= SNDRV_PCM_FMTBIT_S32_LE;
                                if (val & AC_SUPPCM_BITS_32)
                                        bps = 32;
                                else if (val & AC_SUPPCM_BITS_20)
                                        bps = 20;
                                else if (val & AC_SUPPCM_BITS_24)
                                        bps = 24;
                        }
                }
                else if (streams == AC_SUPFMT_FLOAT32) { /* should be exclusive */
                        formats |= SNDRV_PCM_FMTBIT_FLOAT_LE;
                        bps = 32;
                } else if (streams == AC_SUPFMT_AC3) { /* should be exclusive */
                        /* temporary hack: we have still no proper support
                         * for the direct AC3 stream...
                         */
                        formats |= SNDRV_PCM_FMTBIT_U8;
                        bps = 8;
                }
                if (formatsp)
                        *formatsp = formats;
                if (bpsp)
                        *bpsp = bps;
        }

        return 0;
}

/**
 * snd_hda_is_supported_format - check whether the given node supports the format val
 *
 * Returns 1 if supported, 0 if not.
 */
int snd_hda_is_supported_format(struct hda_codec *codec, hda_nid_t nid,
                                unsigned int format)
{
        int i;
        unsigned int val = 0, rate, stream;

        if (nid != codec->afg &&
            snd_hda_param_read(codec, nid, AC_PAR_AUDIO_WIDGET_CAP) & AC_WCAP_FORMAT_OVRD) {
                val = snd_hda_param_read(codec, nid, AC_PAR_PCM);
                if (val == -1)
                        return 0;
        }
        if (! val) {
                val = snd_hda_param_read(codec, codec->afg, AC_PAR_PCM);
                if (val == -1)
                        return 0;
        }

        rate = format & 0xff00;
        for (i = 0; rate_bits[i].hz; i++)
                if (rate_bits[i].hda_fmt == rate) {
                        if (val & (1 << i))
                                break;
                        return 0;
                }
        if (! rate_bits[i].hz)
                return 0;

        stream = snd_hda_param_read(codec, nid, AC_PAR_STREAM);
        if (stream == -1)
                return 0;
        if (! stream && nid != codec->afg)
                stream = snd_hda_param_read(codec, codec->afg, AC_PAR_STREAM);
        if (! stream || stream == -1)
                return 0;

        if (stream & AC_SUPFMT_PCM) {
                switch (format & 0xf0) {
                case 0x00:
                        if (! (val & AC_SUPPCM_BITS_8))
                                return 0;
                        break;
                case 0x10:
                        if (! (val & AC_SUPPCM_BITS_16))
                                return 0;
                        break;
                case 0x20:
                        if (! (val & AC_SUPPCM_BITS_20))
                                return 0;
                        break;
                case 0x30:
                        if (! (val & AC_SUPPCM_BITS_24))
                                return 0;
                        break;
                case 0x40:
                        if (! (val & AC_SUPPCM_BITS_32))
                                return 0;
                        break;
                default:
                        return 0;
                }
        } else {
                /* FIXME: check for float32 and AC3? */
        }

        return 1;
}

/*
 * PCM stuff
 */
static int hda_pcm_default_open_close(struct hda_pcm_stream *hinfo,
                                      struct hda_codec *codec,
                                      snd_pcm_substream_t *substream)
{
        return 0;
}

static int hda_pcm_default_prepare(struct hda_pcm_stream *hinfo,
                                   struct hda_codec *codec,
                                   unsigned int stream_tag,
                                   unsigned int format,
                                   snd_pcm_substream_t *substream)
{
        snd_hda_codec_setup_stream(codec, hinfo->nid, stream_tag, 0, format);
        return 0;
}

static int hda_pcm_default_cleanup(struct hda_pcm_stream *hinfo,
                                   struct hda_codec *codec,
                                   snd_pcm_substream_t *substream)
{
        snd_hda_codec_setup_stream(codec, hinfo->nid, 0, 0, 0);
        return 0;
}

static int set_pcm_default_values(struct hda_codec *codec, struct hda_pcm_stream *info)
{
        if (info->nid) {
                /* query support PCM information from the given NID */
                if (! info->rates || ! info->formats)
                        snd_hda_query_supported_pcm(codec, info->nid,
                                                    info->rates ? NULL : &info->rates,
                                                    info->formats ? NULL : &info->formats,
                                                    info->maxbps ? NULL : &info->maxbps);
        }
        if (info->ops.open == NULL)
                info->ops.open = hda_pcm_default_open_close;
        if (info->ops.close == NULL)
                info->ops.close = hda_pcm_default_open_close;
        if (info->ops.prepare == NULL) {
                snd_assert(info->nid, return -EINVAL);
                info->ops.prepare = hda_pcm_default_prepare;
        }
        if (info->ops.cleanup == NULL) {
                snd_assert(info->nid, return -EINVAL);
                info->ops.cleanup = hda_pcm_default_cleanup;
        }
        return 0;
}

/**
 * snd_hda_build_pcms - build PCM information
 * @bus: the BUS
 *
 * Create PCM information for each codec included in the bus.
 *
 * The build_pcms codec patch is requested to set up codec->num_pcms and
 * codec->pcm_info properly.  The array is referred by the top-level driver
 * to create its PCM instances.
 * The allocated codec->pcm_info should be released in codec->patch_ops.free
 * callback.
 *
 * At least, substreams, channels_min and channels_max must be filled for
 * each stream.  substreams = 0 indicates that the stream doesn't exist.
 * When rates and/or formats are zero, the supported values are queried
 * from the given nid.  The nid is used also by the default ops.prepare
 * and ops.cleanup callbacks.
 *
 * The driver needs to call ops.open in its open callback.  Similarly,
 * ops.close is supposed to be called in the close callback.
 * ops.prepare should be called in the prepare or hw_params callback
 * with the proper parameters for set up.
 * ops.cleanup should be called in hw_free for clean up of streams.
 *
 * This function returns 0 if successfull, or a negative error code.
 */
int snd_hda_build_pcms(struct hda_bus *bus)
{
        struct list_head *p;

        list_for_each(p, &bus->codec_list) {
                struct hda_codec *codec = list_entry(p, struct hda_codec, list);
                unsigned int pcm, s;
                int err;
                if (! codec->patch_ops.build_pcms)
                        continue;
                err = codec->patch_ops.build_pcms(codec);
                if (err < 0)
                        return err;
                for (pcm = 0; pcm < codec->num_pcms; pcm++) {
                        for (s = 0; s < 2; s++) {
                                struct hda_pcm_stream *info;
                                info = &codec->pcm_info[pcm].stream[s];
                                if (! info->substreams)
                                        continue;
                                err = set_pcm_default_values(codec, info);
                                if (err < 0)
                                        return err;
                        }
                }
        }
        return 0;
}


/**
 * snd_hda_check_board_config - compare the current codec with the config table
 * @codec: the HDA codec
 * @tbl: configuration table, terminated by null entries
 *
 * Compares the modelname or PCI subsystem id of the current codec with the
 * given configuration table.  If a matching entry is found, returns its
 * config value (supposed to be 0 or positive).
 *
 * If no entries are matching, the function returns a negative value.
 */
int snd_hda_check_board_config(struct hda_codec *codec, const struct hda_board_config *tbl)
{
        const struct hda_board_config *c;

        if (codec->bus->modelname) {
                for (c = tbl; c->modelname || c->pci_subvendor; c++) {
                        if (c->modelname &&
                            ! strcmp(codec->bus->modelname, c->modelname)) {
                                snd_printd(KERN_INFO "hda_codec: model '%s' is selected\n", c->modelname);
                                return c->config;
                        }
                }
        }

        if (codec->bus->pci) {
                u16 subsystem_vendor, subsystem_device;
                pci_read_config_word(codec->bus->pci, PCI_SUBSYSTEM_VENDOR_ID, &subsystem_vendor);
                pci_read_config_word(codec->bus->pci, PCI_SUBSYSTEM_ID, &subsystem_device);
                for (c = tbl; c->modelname || c->pci_subvendor; c++) {
                        if (c->pci_subvendor == subsystem_vendor &&
                            (! c->pci_subdevice /* all match */||
                             (c->pci_subdevice == subsystem_device))) {
                                snd_printdd(KERN_INFO "hda_codec: PCI %x:%x, codec config %d is selected\n",
                                            subsystem_vendor, subsystem_device, c->config);
                                return c->config;
                        }
                }
        }
        return -1;
}

/**
 * snd_hda_add_new_ctls - create controls from the array
 * @codec: the HDA codec
 * @knew: the array of snd_kcontrol_new_t
 *
 * This helper function creates and add new controls in the given array.
 * The array must be terminated with an empty entry as terminator.
 *
 * Returns 0 if successful, or a negative error code.
 */
int snd_hda_add_new_ctls(struct hda_codec *codec, snd_kcontrol_new_t *knew)
{
        int err;

        for (; knew->name; knew++) {
                err = snd_ctl_add(codec->bus->card, snd_ctl_new1(knew, codec));
                if (err < 0)
                        return err;
        }
        return 0;
}


/*
 * input MUX helper
 */
int snd_hda_input_mux_info(const struct hda_input_mux *imux, snd_ctl_elem_info_t *uinfo)
{
        unsigned int index;

        uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
        uinfo->count = 1;
        uinfo->value.enumerated.items = imux->num_items;
        index = uinfo->value.enumerated.item;
        if (index >= imux->num_items)
                index = imux->num_items - 1;
        strcpy(uinfo->value.enumerated.name, imux->items[index].label);
        return 0;
}

int snd_hda_input_mux_put(struct hda_codec *codec, const struct hda_input_mux *imux,
                          snd_ctl_elem_value_t *ucontrol, hda_nid_t nid,
                          unsigned int *cur_val)
{
        unsigned int idx;

        idx = ucontrol->value.enumerated.item[0];
        if (idx >= imux->num_items)
                idx = imux->num_items - 1;
        if (*cur_val == idx && ! codec->in_resume)
                return 0;
        snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_CONNECT_SEL,
                            imux->items[idx].index);
        *cur_val = idx;
        return 1;
}


/*
 * Multi-channel / digital-out PCM helper functions
 */

/*
 * open the digital out in the exclusive mode
 */
int snd_hda_multi_out_dig_open(struct hda_codec *codec, struct hda_multi_out *mout)
{
        down(&codec->spdif_mutex);
        if (mout->dig_out_used) {
                up(&codec->spdif_mutex);
                return -EBUSY; /* already being used */
        }
        mout->dig_out_used = HDA_DIG_EXCLUSIVE;
        up(&codec->spdif_mutex);
        return 0;
}

/*
 * release the digital out
 */
int snd_hda_multi_out_dig_close(struct hda_codec *codec, struct hda_multi_out *mout)
{
        down(&codec->spdif_mutex);
        mout->dig_out_used = 0;
        up(&codec->spdif_mutex);
        return 0;
}

/*
 * set up more restrictions for analog out
 */
int snd_hda_multi_out_analog_open(struct hda_codec *codec, struct hda_multi_out *mout,
                                  snd_pcm_substream_t *substream)
{
        substream->runtime->hw.channels_max = mout->max_channels;
        return snd_pcm_hw_constraint_step(substream->runtime, 0,
                                          SNDRV_PCM_HW_PARAM_CHANNELS, 2);
}

/*
 * set up the i/o for analog out
 * when the digital out is available, copy the front out to digital out, too.
 */
int snd_hda_multi_out_analog_prepare(struct hda_codec *codec, struct hda_multi_out *mout,
                                     unsigned int stream_tag,
                                     unsigned int format,
                                     snd_pcm_substream_t *substream)
{
        hda_nid_t *nids = mout->dac_nids;
        int chs = substream->runtime->channels;
        int i;

        down(&codec->spdif_mutex);
        if (mout->dig_out_nid && mout->dig_out_used != HDA_DIG_EXCLUSIVE) {
                if (chs == 2 &&
                    snd_hda_is_supported_format(codec, mout->dig_out_nid, format) &&
                    ! (codec->spdif_status & IEC958_AES0_NONAUDIO)) {
                        mout->dig_out_used = HDA_DIG_ANALOG_DUP;
                        /* setup digital receiver */
                        snd_hda_codec_setup_stream(codec, mout->dig_out_nid,
                                                   stream_tag, 0, format);
                } else {
                        mout->dig_out_used = 0;
                        snd_hda_codec_setup_stream(codec, mout->dig_out_nid, 0, 0, 0);
                }
        }
        up(&codec->spdif_mutex);

        /* front */
        snd_hda_codec_setup_stream(codec, nids[HDA_FRONT], stream_tag, 0, format);
        if (mout->hp_nid)
                /* headphone out will just decode front left/right (stereo) */
                snd_hda_codec_setup_stream(codec, mout->hp_nid, stream_tag, 0, format);
        /* surrounds */
        for (i = 1; i < mout->num_dacs; i++) {
                if (chs >= (i + 1) * 2) /* independent out */
                        snd_hda_codec_setup_stream(codec, nids[i], stream_tag, i * 2,
                                                   format);
                else /* copy front */
                        snd_hda_codec_setup_stream(codec, nids[i], stream_tag, 0,
                                                   format);
        }
        return 0;
}

/*
 * clean up the setting for analog out
 */
int snd_hda_multi_out_analog_cleanup(struct hda_codec *codec, struct hda_multi_out *mout)
{
        hda_nid_t *nids = mout->dac_nids;
        int i;

        for (i = 0; i < mout->num_dacs; i++)
                snd_hda_codec_setup_stream(codec, nids[i], 0, 0, 0);
        if (mout->hp_nid)
                snd_hda_codec_setup_stream(codec, mout->hp_nid, 0, 0, 0);
        down(&codec->spdif_mutex);
        if (mout->dig_out_nid && mout->dig_out_used == HDA_DIG_ANALOG_DUP) {
                snd_hda_codec_setup_stream(codec, mout->dig_out_nid, 0, 0, 0);
                mout->dig_out_used = 0;
        }
        up(&codec->spdif_mutex);
        return 0;
}

/*
 * Helper for automatic ping configuration
 */
/* parse all pin widgets and store the useful pin nids to cfg */
int snd_hda_parse_pin_def_config(struct hda_codec *codec, struct auto_pin_cfg *cfg)
{
        hda_nid_t nid, nid_start;
        int i, j, nodes;
        short seq, sequences[4], assoc_line_out;

        memset(cfg, 0, sizeof(*cfg));

        memset(sequences, 0, sizeof(sequences));
        assoc_line_out = 0;

        nodes = snd_hda_get_sub_nodes(codec, codec->afg, &nid_start);
        for (nid = nid_start; nid < nodes + nid_start; nid++) {
                unsigned int wid_caps = snd_hda_param_read(codec, nid,
                                                           AC_PAR_AUDIO_WIDGET_CAP);
                unsigned int wid_type = (wid_caps & AC_WCAP_TYPE) >> AC_WCAP_TYPE_SHIFT;
                unsigned int def_conf;
                short assoc, loc;

                /* read all default configuration for pin complex */
                if (wid_type != AC_WID_PIN)
                        continue;
                def_conf = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_CONFIG_DEFAULT, 0);
                if (get_defcfg_connect(def_conf) == AC_JACK_PORT_NONE)
                        continue;
                loc = get_defcfg_location(def_conf);
                switch (get_defcfg_device(def_conf)) {
                case AC_JACK_LINE_OUT:
                case AC_JACK_SPEAKER:
                        seq = get_defcfg_sequence(def_conf);
                        assoc = get_defcfg_association(def_conf);
                        if (! assoc)
                                continue;
                        if (! assoc_line_out)
                                assoc_line_out = assoc;
                        else if (assoc_line_out != assoc)
                                continue;
                        if (cfg->line_outs >= ARRAY_SIZE(cfg->line_out_pins))
                                continue;
                        cfg->line_out_pins[cfg->line_outs] = nid;
                        sequences[cfg->line_outs] = seq;
                        cfg->line_outs++;
                        break;
                case AC_JACK_HP_OUT:
                        cfg->hp_pin = nid;
                        break;
                case AC_JACK_MIC_IN:
                        if (loc == AC_JACK_LOC_FRONT)
                                cfg->input_pins[AUTO_PIN_FRONT_MIC] = nid;
                        else
                                cfg->input_pins[AUTO_PIN_MIC] = nid;
                        break;
                case AC_JACK_LINE_IN:
                        if (loc == AC_JACK_LOC_FRONT)
                                cfg->input_pins[AUTO_PIN_FRONT_LINE] = nid;
                        else
                                cfg->input_pins[AUTO_PIN_LINE] = nid;
                        break;
                case AC_JACK_CD:
                        cfg->input_pins[AUTO_PIN_CD] = nid;
                        break;
                case AC_JACK_AUX:
                        cfg->input_pins[AUTO_PIN_AUX] = nid;
                        break;
                case AC_JACK_SPDIF_OUT:
                        cfg->dig_out_pin = nid;
                        break;
                case AC_JACK_SPDIF_IN:
                        cfg->dig_in_pin = nid;
                        break;
                }
        }

        /* sort by sequence */
        for (i = 0; i < cfg->line_outs; i++)
                for (j = i + 1; j < cfg->line_outs; j++)
                        if (sequences[i] > sequences[j]) {
                                seq = sequences[i];
                                sequences[i] = sequences[j];
                                sequences[j] = seq;
                                nid = cfg->line_out_pins[i];
                                cfg->line_out_pins[i] = cfg->line_out_pins[j];
                                cfg->line_out_pins[j] = nid;
                        }

        /* Reorder the surround channels
         * ALSA sequence is front/surr/clfe/side
         * HDA sequence is:
         *    4-ch: front/surr  =>  OK as it is
         *    6-ch: front/clfe/surr
         *    8-ch: front/clfe/side/surr
         */
        switch (cfg->line_outs) {
        case 3:
                nid = cfg->line_out_pins[1];
                cfg->line_out_pins[1] = cfg->line_out_pins[2];
                cfg->line_out_pins[2] = nid;
                break;
        case 4:
                nid = cfg->line_out_pins[1];
                cfg->line_out_pins[1] = cfg->line_out_pins[3];
                cfg->line_out_pins[3] = cfg->line_out_pins[2];
                cfg->line_out_pins[2] = nid;
                break;
        }

        return 0;
}

#ifdef CONFIG_PM
/*
 * power management
 */

/**
 * snd_hda_suspend - suspend the codecs
 * @bus: the HDA bus
 * @state: suspsend state
 *
 * Returns 0 if successful.
 */
int snd_hda_suspend(struct hda_bus *bus, pm_message_t state)
{
        struct list_head *p;

        /* FIXME: should handle power widget capabilities */
        list_for_each(p, &bus->codec_list) {
                struct hda_codec *codec = list_entry(p, struct hda_codec, list);
                if (codec->patch_ops.suspend)
                        codec->patch_ops.suspend(codec, state);
        }
        return 0;
}

/**
 * snd_hda_resume - resume the codecs
 * @bus: the HDA bus
 * @state: resume state
 *
 * Returns 0 if successful.
 */
int snd_hda_resume(struct hda_bus *bus)
{
        struct list_head *p;

        list_for_each(p, &bus->codec_list) {
                struct hda_codec *codec = list_entry(p, struct hda_codec, list);
                if (codec->patch_ops.resume)
                        codec->patch_ops.resume(codec);
        }
        return 0;
}

/**
 * snd_hda_resume_ctls - resume controls in the new control list
 * @codec: the HDA codec
 * @knew: the array of snd_kcontrol_new_t
 *
 * This function resumes the mixer controls in the snd_kcontrol_new_t array,
 * originally for snd_hda_add_new_ctls().
 * The array must be terminated with an empty entry as terminator.
 */
int snd_hda_resume_ctls(struct hda_codec *codec, snd_kcontrol_new_t *knew)
{
        snd_ctl_elem_value_t *val;

        val = kmalloc(sizeof(*val), GFP_KERNEL);
        if (! val)
                return -ENOMEM;
        codec->in_resume = 1;
        for (; knew->name; knew++) {
                int i, count;
                count = knew->count ? knew->count : 1;
                for (i = 0; i < count; i++) {
                        memset(val, 0, sizeof(*val));
                        val->id.iface = knew->iface;
                        val->id.device = knew->device;
                        val->id.subdevice = knew->subdevice;
                        strcpy(val->id.name, knew->name);
                        val->id.index = knew->index ? knew->index : i;
                        /* Assume that get callback reads only from cache,
                         * not accessing to the real hardware
                         */
                        if (snd_ctl_elem_read(codec->bus->card, val) < 0)
                                continue;
                        snd_ctl_elem_write(codec->bus->card, NULL, val);
                }
        }
        codec->in_resume = 0;
        kfree(val);
        return 0;
}

/**
 * snd_hda_resume_spdif_out - resume the digital out
 * @codec: the HDA codec
 */
int snd_hda_resume_spdif_out(struct hda_codec *codec)
{
        return snd_hda_resume_ctls(codec, dig_mixes);
}

/**
 * snd_hda_resume_spdif_in - resume the digital in
 * @codec: the HDA codec
 */
int snd_hda_resume_spdif_in(struct hda_codec *codec)
{
        return snd_hda_resume_ctls(codec, dig_in_ctls);
}
#endif

/*
 * symbols exported for controller modules
 */
EXPORT_SYMBOL(snd_hda_codec_read);
EXPORT_SYMBOL(snd_hda_codec_write);
EXPORT_SYMBOL(snd_hda_sequence_write);
EXPORT_SYMBOL(snd_hda_get_sub_nodes);
EXPORT_SYMBOL(snd_hda_queue_unsol_event);
EXPORT_SYMBOL(snd_hda_bus_new);
EXPORT_SYMBOL(snd_hda_codec_new);
EXPORT_SYMBOL(snd_hda_codec_setup_stream);
EXPORT_SYMBOL(snd_hda_calc_stream_format);
EXPORT_SYMBOL(snd_hda_build_pcms);
EXPORT_SYMBOL(snd_hda_build_controls);
#ifdef CONFIG_PM
EXPORT_SYMBOL(snd_hda_suspend);
EXPORT_SYMBOL(snd_hda_resume);
#endif

/*
 *  INIT part
 */

static int __init alsa_hda_init(void)
{
        return 0;
}

static void __exit alsa_hda_exit(void)
{
}

module_init(alsa_hda_init)
module_exit(alsa_hda_exit)