| /* |
| * 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" }, |
| { 0x13f6, "C-Media" }, |
| { 0x434d, "C-Media" }, |
| {} /* 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 = kcalloc(1, 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 = kcalloc(1, 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 node |
| * |
| * return 0 if not found |
| */ |
| static int look_for_afg_node(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++) { |
| if ((snd_hda_param_read(codec, nid, AC_PAR_FUNCTION_TYPE) & 0xff) == |
| AC_GRP_AUDIO_FUNCTION) |
| return nid; |
| } |
| return 0; |
| } |
| |
| /* |
| * 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 = kcalloc(1, 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); |
| |
| /* FIXME: support for multiple AFGs? */ |
| codec->afg = look_for_afg_node(codec); |
| if (! codec->afg) { |
| snd_printk(KERN_ERR "hda_codec: no AFG node found\n"); |
| snd_hda_codec_free(codec); |
| return -ENODEV; |
| } |
| |
| 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) |
| { |
| 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 |
| */ |
| |
| #define HDA_HASH_KEY(nid,dir,idx) (u32)((nid) + (idx) * 32 + (dir) * 64) |
| #define INFO_AMP_CAPS (1<<0) |
| #define INFO_AMP_VOL (1<<1) |
| |
| /* 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 from the cache. |
| */ |
| static void 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; |
| |
| 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; |
| } |
| |
| /* |
| * write the current volume in info to the h/w |
| */ |
| static void put_vol_mute(struct hda_codec *codec, |
| 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); |
| } |
| |
| /* |
| * read/write AMP value. The volume is between 0 to 0x7f, 0x80 = mute bit. |
| */ |
| 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; |
| get_vol_mute(codec, info, nid, ch, direction, index); |
| return info->vol[ch]; |
| } |
| |
| int snd_hda_codec_amp_write(struct hda_codec *codec, hda_nid_t nid, int ch, int direction, int idx, int val) |
| { |
| struct hda_amp_info *info = get_alloc_amp_hash(codec, HDA_HASH_KEY(nid, direction, idx)); |
| if (! info) |
| return 0; |
| get_vol_mute(codec, info, nid, ch, direction, idx); |
| if (info->vol[ch] == val && ! codec->in_resume) |
| return 0; |
| put_vol_mute(codec, nid, ch, direction, idx, val); |
| info->vol[ch] = 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); |
| int val; |
| long *valp = ucontrol->value.integer.value; |
| int change = 0; |
| |
| if (chs & 1) { |
| val = *valp & 0x7f; |
| val |= snd_hda_codec_amp_read(codec, nid, 0, dir, idx) & 0x80; |
| change = snd_hda_codec_amp_write(codec, nid, 0, dir, idx, val); |
| valp++; |
| } |
| if (chs & 2) { |
| val = *valp & 0x7f; |
| val |= snd_hda_codec_amp_read(codec, nid, 1, dir, idx) & 0x80; |
| change |= snd_hda_codec_amp_write(codec, nid, 1, dir, idx, val); |
| } |
| 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); |
| int val; |
| long *valp = ucontrol->value.integer.value; |
| int change = 0; |
| |
| if (chs & 1) { |
| val = snd_hda_codec_amp_read(codec, nid, 0, dir, idx) & 0x7f; |
| val |= *valp ? 0 : 0x80; |
| change = snd_hda_codec_amp_write(codec, nid, 0, dir, idx, val); |
| valp++; |
| } |
| if (chs & 2) { |
| val = snd_hda_codec_amp_read(codec, nid, 1, dir, idx) & 0x7f; |
| val |= *valp ? 0 : 0x80; |
| change = snd_hda_codec_amp_write(codec, nid, 1, dir, idx, val); |
| } |
| return 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 |
| */ |
| static unsigned int rate_bits[][3] = { |
| /* rate in Hz, ALSA rate bitmask, HDA format value */ |
| { 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 */ |
| { 0 } |
| }; |
| |
| /** |
| * 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][0]; i++) |
| if (rate_bits[i][0] == rate) { |
| val = rate_bits[i][2]; |
| break; |
| } |
| if (! rate_bits[i][0]) { |
| 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][0]; i++) { |
| if (val & (1 << i)) |
| rates |= rate_bits[i][1]; |
| } |
| *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][0]; i++) |
| if (rate_bits[i][2] == rate) { |
| if (val & (1 << i)) |
| break; |
| return 0; |
| } |
| if (! rate_bits[i][0]) |
| 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.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, struct hda_board_config *tbl) |
| { |
| struct hda_board_config *c; |
| |
| if (codec->bus->modelname) { |
| for (c = tbl; c->modelname || c->pci_vendor; 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_vendor; c++) { |
| if (c->pci_vendor == subsystem_vendor && |
| c->pci_device == subsystem_device) |
| 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 (i == HDA_REAR && chs == 2) /* copy front to rear */ |
| snd_hda_codec_setup_stream(codec, nids[i], stream_tag, 0, format); |
| else if (chs >= (i + 1) * 2) /* independent out */ |
| snd_hda_codec_setup_stream(codec, nids[i], stream_tag, i * 2, |
| 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; |
| } |
| |
| #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) |