| /* |
| * soc-core.c -- ALSA SoC Audio Layer |
| * |
| * Copyright 2005 Wolfson Microelectronics PLC. |
| * Copyright 2005 Openedhand Ltd. |
| * Copyright (C) 2010 Slimlogic Ltd. |
| * Copyright (C) 2010 Texas Instruments Inc. |
| * |
| * Author: Liam Girdwood <lrg@slimlogic.co.uk> |
| * with code, comments and ideas from :- |
| * Richard Purdie <richard@openedhand.com> |
| * |
| * This program is free software; you can redistribute it and/or modify it |
| * under the terms of the GNU General Public License as published by the |
| * Free Software Foundation; either version 2 of the License, or (at your |
| * option) any later version. |
| * |
| * TODO: |
| * o Add hw rules to enforce rates, etc. |
| * o More testing with other codecs/machines. |
| * o Add more codecs and platforms to ensure good API coverage. |
| * o Support TDM on PCM and I2S |
| */ |
| |
| #include <linux/module.h> |
| #include <linux/moduleparam.h> |
| #include <linux/init.h> |
| #include <linux/delay.h> |
| #include <linux/pm.h> |
| #include <linux/bitops.h> |
| #include <linux/debugfs.h> |
| #include <linux/platform_device.h> |
| #include <linux/pinctrl/consumer.h> |
| #include <linux/ctype.h> |
| #include <linux/slab.h> |
| #include <linux/of.h> |
| #include <linux/gpio.h> |
| #include <linux/of_gpio.h> |
| #include <sound/ac97_codec.h> |
| #include <sound/core.h> |
| #include <sound/jack.h> |
| #include <sound/pcm.h> |
| #include <sound/pcm_params.h> |
| #include <sound/soc.h> |
| #include <sound/soc-dpcm.h> |
| #include <sound/initval.h> |
| |
| #define CREATE_TRACE_POINTS |
| #include <trace/events/asoc.h> |
| |
| #define NAME_SIZE 32 |
| |
| #ifdef CONFIG_DEBUG_FS |
| struct dentry *snd_soc_debugfs_root; |
| EXPORT_SYMBOL_GPL(snd_soc_debugfs_root); |
| #endif |
| |
| static DEFINE_MUTEX(client_mutex); |
| static LIST_HEAD(platform_list); |
| static LIST_HEAD(codec_list); |
| static LIST_HEAD(component_list); |
| |
| /* |
| * This is a timeout to do a DAPM powerdown after a stream is closed(). |
| * It can be used to eliminate pops between different playback streams, e.g. |
| * between two audio tracks. |
| */ |
| static int pmdown_time = 5000; |
| module_param(pmdown_time, int, 0); |
| MODULE_PARM_DESC(pmdown_time, "DAPM stream powerdown time (msecs)"); |
| |
| struct snd_ac97_reset_cfg { |
| struct pinctrl *pctl; |
| struct pinctrl_state *pstate_reset; |
| struct pinctrl_state *pstate_warm_reset; |
| struct pinctrl_state *pstate_run; |
| int gpio_sdata; |
| int gpio_sync; |
| int gpio_reset; |
| }; |
| |
| /* returns the minimum number of bytes needed to represent |
| * a particular given value */ |
| static int min_bytes_needed(unsigned long val) |
| { |
| int c = 0; |
| int i; |
| |
| for (i = (sizeof val * 8) - 1; i >= 0; --i, ++c) |
| if (val & (1UL << i)) |
| break; |
| c = (sizeof val * 8) - c; |
| if (!c || (c % 8)) |
| c = (c + 8) / 8; |
| else |
| c /= 8; |
| return c; |
| } |
| |
| /* fill buf which is 'len' bytes with a formatted |
| * string of the form 'reg: value\n' */ |
| static int format_register_str(struct snd_soc_codec *codec, |
| unsigned int reg, char *buf, size_t len) |
| { |
| int wordsize = min_bytes_needed(codec->driver->reg_cache_size) * 2; |
| int regsize = codec->driver->reg_word_size * 2; |
| int ret; |
| char tmpbuf[len + 1]; |
| char regbuf[regsize + 1]; |
| |
| /* since tmpbuf is allocated on the stack, warn the callers if they |
| * try to abuse this function */ |
| WARN_ON(len > 63); |
| |
| /* +2 for ': ' and + 1 for '\n' */ |
| if (wordsize + regsize + 2 + 1 != len) |
| return -EINVAL; |
| |
| ret = snd_soc_read(codec, reg); |
| if (ret < 0) { |
| memset(regbuf, 'X', regsize); |
| regbuf[regsize] = '\0'; |
| } else { |
| snprintf(regbuf, regsize + 1, "%.*x", regsize, ret); |
| } |
| |
| /* prepare the buffer */ |
| snprintf(tmpbuf, len + 1, "%.*x: %s\n", wordsize, reg, regbuf); |
| /* copy it back to the caller without the '\0' */ |
| memcpy(buf, tmpbuf, len); |
| |
| return 0; |
| } |
| |
| /* codec register dump */ |
| static ssize_t soc_codec_reg_show(struct snd_soc_codec *codec, char *buf, |
| size_t count, loff_t pos) |
| { |
| int i, step = 1; |
| int wordsize, regsize; |
| int len; |
| size_t total = 0; |
| loff_t p = 0; |
| |
| wordsize = min_bytes_needed(codec->driver->reg_cache_size) * 2; |
| regsize = codec->driver->reg_word_size * 2; |
| |
| len = wordsize + regsize + 2 + 1; |
| |
| if (!codec->driver->reg_cache_size) |
| return 0; |
| |
| if (codec->driver->reg_cache_step) |
| step = codec->driver->reg_cache_step; |
| |
| for (i = 0; i < codec->driver->reg_cache_size; i += step) { |
| /* only support larger than PAGE_SIZE bytes debugfs |
| * entries for the default case */ |
| if (p >= pos) { |
| if (total + len >= count - 1) |
| break; |
| format_register_str(codec, i, buf + total, len); |
| total += len; |
| } |
| p += len; |
| } |
| |
| total = min(total, count - 1); |
| |
| return total; |
| } |
| |
| static ssize_t codec_reg_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev); |
| |
| return soc_codec_reg_show(rtd->codec, buf, PAGE_SIZE, 0); |
| } |
| |
| static DEVICE_ATTR(codec_reg, 0444, codec_reg_show, NULL); |
| |
| static ssize_t pmdown_time_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev); |
| |
| return sprintf(buf, "%ld\n", rtd->pmdown_time); |
| } |
| |
| static ssize_t pmdown_time_set(struct device *dev, |
| struct device_attribute *attr, |
| const char *buf, size_t count) |
| { |
| struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev); |
| int ret; |
| |
| ret = kstrtol(buf, 10, &rtd->pmdown_time); |
| if (ret) |
| return ret; |
| |
| return count; |
| } |
| |
| static DEVICE_ATTR(pmdown_time, 0644, pmdown_time_show, pmdown_time_set); |
| |
| #ifdef CONFIG_DEBUG_FS |
| static ssize_t codec_reg_read_file(struct file *file, char __user *user_buf, |
| size_t count, loff_t *ppos) |
| { |
| ssize_t ret; |
| struct snd_soc_codec *codec = file->private_data; |
| char *buf; |
| |
| if (*ppos < 0 || !count) |
| return -EINVAL; |
| |
| buf = kmalloc(count, GFP_KERNEL); |
| if (!buf) |
| return -ENOMEM; |
| |
| ret = soc_codec_reg_show(codec, buf, count, *ppos); |
| if (ret >= 0) { |
| if (copy_to_user(user_buf, buf, ret)) { |
| kfree(buf); |
| return -EFAULT; |
| } |
| *ppos += ret; |
| } |
| |
| kfree(buf); |
| return ret; |
| } |
| |
| static ssize_t codec_reg_write_file(struct file *file, |
| const char __user *user_buf, size_t count, loff_t *ppos) |
| { |
| char buf[32]; |
| size_t buf_size; |
| char *start = buf; |
| unsigned long reg, value; |
| struct snd_soc_codec *codec = file->private_data; |
| int ret; |
| |
| buf_size = min(count, (sizeof(buf)-1)); |
| if (copy_from_user(buf, user_buf, buf_size)) |
| return -EFAULT; |
| buf[buf_size] = 0; |
| |
| while (*start == ' ') |
| start++; |
| reg = simple_strtoul(start, &start, 16); |
| while (*start == ' ') |
| start++; |
| ret = kstrtoul(start, 16, &value); |
| if (ret) |
| return ret; |
| |
| /* Userspace has been fiddling around behind the kernel's back */ |
| add_taint(TAINT_USER, LOCKDEP_NOW_UNRELIABLE); |
| |
| snd_soc_write(codec, reg, value); |
| return buf_size; |
| } |
| |
| static const struct file_operations codec_reg_fops = { |
| .open = simple_open, |
| .read = codec_reg_read_file, |
| .write = codec_reg_write_file, |
| .llseek = default_llseek, |
| }; |
| |
| static void soc_init_component_debugfs(struct snd_soc_component *component) |
| { |
| if (component->debugfs_prefix) { |
| char *name; |
| |
| name = kasprintf(GFP_KERNEL, "%s:%s", |
| component->debugfs_prefix, component->name); |
| if (name) { |
| component->debugfs_root = debugfs_create_dir(name, |
| component->card->debugfs_card_root); |
| kfree(name); |
| } |
| } else { |
| component->debugfs_root = debugfs_create_dir(component->name, |
| component->card->debugfs_card_root); |
| } |
| |
| if (!component->debugfs_root) { |
| dev_warn(component->dev, |
| "ASoC: Failed to create component debugfs directory\n"); |
| return; |
| } |
| |
| snd_soc_dapm_debugfs_init(snd_soc_component_get_dapm(component), |
| component->debugfs_root); |
| |
| if (component->init_debugfs) |
| component->init_debugfs(component); |
| } |
| |
| static void soc_cleanup_component_debugfs(struct snd_soc_component *component) |
| { |
| debugfs_remove_recursive(component->debugfs_root); |
| } |
| |
| static void soc_init_codec_debugfs(struct snd_soc_component *component) |
| { |
| struct snd_soc_codec *codec = snd_soc_component_to_codec(component); |
| |
| debugfs_create_bool("cache_sync", 0444, codec->component.debugfs_root, |
| &codec->cache_sync); |
| |
| codec->debugfs_reg = debugfs_create_file("codec_reg", 0644, |
| codec->component.debugfs_root, |
| codec, &codec_reg_fops); |
| if (!codec->debugfs_reg) |
| dev_warn(codec->dev, |
| "ASoC: Failed to create codec register debugfs file\n"); |
| } |
| |
| static ssize_t codec_list_read_file(struct file *file, char __user *user_buf, |
| size_t count, loff_t *ppos) |
| { |
| char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL); |
| ssize_t len, ret = 0; |
| struct snd_soc_codec *codec; |
| |
| if (!buf) |
| return -ENOMEM; |
| |
| list_for_each_entry(codec, &codec_list, list) { |
| len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n", |
| codec->component.name); |
| if (len >= 0) |
| ret += len; |
| if (ret > PAGE_SIZE) { |
| ret = PAGE_SIZE; |
| break; |
| } |
| } |
| |
| if (ret >= 0) |
| ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret); |
| |
| kfree(buf); |
| |
| return ret; |
| } |
| |
| static const struct file_operations codec_list_fops = { |
| .read = codec_list_read_file, |
| .llseek = default_llseek,/* read accesses f_pos */ |
| }; |
| |
| static ssize_t dai_list_read_file(struct file *file, char __user *user_buf, |
| size_t count, loff_t *ppos) |
| { |
| char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL); |
| ssize_t len, ret = 0; |
| struct snd_soc_component *component; |
| struct snd_soc_dai *dai; |
| |
| if (!buf) |
| return -ENOMEM; |
| |
| list_for_each_entry(component, &component_list, list) { |
| list_for_each_entry(dai, &component->dai_list, list) { |
| len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n", |
| dai->name); |
| if (len >= 0) |
| ret += len; |
| if (ret > PAGE_SIZE) { |
| ret = PAGE_SIZE; |
| break; |
| } |
| } |
| } |
| |
| ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret); |
| |
| kfree(buf); |
| |
| return ret; |
| } |
| |
| static const struct file_operations dai_list_fops = { |
| .read = dai_list_read_file, |
| .llseek = default_llseek,/* read accesses f_pos */ |
| }; |
| |
| static ssize_t platform_list_read_file(struct file *file, |
| char __user *user_buf, |
| size_t count, loff_t *ppos) |
| { |
| char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL); |
| ssize_t len, ret = 0; |
| struct snd_soc_platform *platform; |
| |
| if (!buf) |
| return -ENOMEM; |
| |
| list_for_each_entry(platform, &platform_list, list) { |
| len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n", |
| platform->component.name); |
| if (len >= 0) |
| ret += len; |
| if (ret > PAGE_SIZE) { |
| ret = PAGE_SIZE; |
| break; |
| } |
| } |
| |
| ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret); |
| |
| kfree(buf); |
| |
| return ret; |
| } |
| |
| static const struct file_operations platform_list_fops = { |
| .read = platform_list_read_file, |
| .llseek = default_llseek,/* read accesses f_pos */ |
| }; |
| |
| static void soc_init_card_debugfs(struct snd_soc_card *card) |
| { |
| card->debugfs_card_root = debugfs_create_dir(card->name, |
| snd_soc_debugfs_root); |
| if (!card->debugfs_card_root) { |
| dev_warn(card->dev, |
| "ASoC: Failed to create card debugfs directory\n"); |
| return; |
| } |
| |
| card->debugfs_pop_time = debugfs_create_u32("dapm_pop_time", 0644, |
| card->debugfs_card_root, |
| &card->pop_time); |
| if (!card->debugfs_pop_time) |
| dev_warn(card->dev, |
| "ASoC: Failed to create pop time debugfs file\n"); |
| } |
| |
| static void soc_cleanup_card_debugfs(struct snd_soc_card *card) |
| { |
| debugfs_remove_recursive(card->debugfs_card_root); |
| } |
| |
| #else |
| |
| #define soc_init_codec_debugfs NULL |
| |
| static inline void soc_init_component_debugfs( |
| struct snd_soc_component *component) |
| { |
| } |
| |
| static inline void soc_cleanup_component_debugfs( |
| struct snd_soc_component *component) |
| { |
| } |
| |
| static inline void soc_init_card_debugfs(struct snd_soc_card *card) |
| { |
| } |
| |
| static inline void soc_cleanup_card_debugfs(struct snd_soc_card *card) |
| { |
| } |
| #endif |
| |
| struct snd_pcm_substream *snd_soc_get_dai_substream(struct snd_soc_card *card, |
| const char *dai_link, int stream) |
| { |
| int i; |
| |
| for (i = 0; i < card->num_links; i++) { |
| if (card->rtd[i].dai_link->no_pcm && |
| !strcmp(card->rtd[i].dai_link->name, dai_link)) |
| return card->rtd[i].pcm->streams[stream].substream; |
| } |
| dev_dbg(card->dev, "ASoC: failed to find dai link %s\n", dai_link); |
| return NULL; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_get_dai_substream); |
| |
| struct snd_soc_pcm_runtime *snd_soc_get_pcm_runtime(struct snd_soc_card *card, |
| const char *dai_link) |
| { |
| int i; |
| |
| for (i = 0; i < card->num_links; i++) { |
| if (!strcmp(card->rtd[i].dai_link->name, dai_link)) |
| return &card->rtd[i]; |
| } |
| dev_dbg(card->dev, "ASoC: failed to find rtd %s\n", dai_link); |
| return NULL; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_get_pcm_runtime); |
| |
| #ifdef CONFIG_SND_SOC_AC97_BUS |
| /* unregister ac97 codec */ |
| static int soc_ac97_dev_unregister(struct snd_soc_codec *codec) |
| { |
| if (codec->ac97->dev.bus) |
| device_unregister(&codec->ac97->dev); |
| return 0; |
| } |
| |
| /* stop no dev release warning */ |
| static void soc_ac97_device_release(struct device *dev){} |
| |
| /* register ac97 codec to bus */ |
| static int soc_ac97_dev_register(struct snd_soc_codec *codec) |
| { |
| int err; |
| |
| codec->ac97->dev.bus = &ac97_bus_type; |
| codec->ac97->dev.parent = codec->component.card->dev; |
| codec->ac97->dev.release = soc_ac97_device_release; |
| |
| dev_set_name(&codec->ac97->dev, "%d-%d:%s", |
| codec->component.card->snd_card->number, 0, |
| codec->component.name); |
| err = device_register(&codec->ac97->dev); |
| if (err < 0) { |
| dev_err(codec->dev, "ASoC: Can't register ac97 bus\n"); |
| codec->ac97->dev.bus = NULL; |
| return err; |
| } |
| return 0; |
| } |
| #endif |
| |
| static void codec2codec_close_delayed_work(struct work_struct *work) |
| { |
| /* Currently nothing to do for c2c links |
| * Since c2c links are internal nodes in the DAPM graph and |
| * don't interface with the outside world or application layer |
| * we don't have to do any special handling on close. |
| */ |
| } |
| |
| #ifdef CONFIG_PM_SLEEP |
| /* powers down audio subsystem for suspend */ |
| int snd_soc_suspend(struct device *dev) |
| { |
| struct snd_soc_card *card = dev_get_drvdata(dev); |
| struct snd_soc_codec *codec; |
| int i, j; |
| |
| /* If the card is not initialized yet there is nothing to do */ |
| if (!card->instantiated) |
| return 0; |
| |
| /* Due to the resume being scheduled into a workqueue we could |
| * suspend before that's finished - wait for it to complete. |
| */ |
| snd_power_lock(card->snd_card); |
| snd_power_wait(card->snd_card, SNDRV_CTL_POWER_D0); |
| snd_power_unlock(card->snd_card); |
| |
| /* we're going to block userspace touching us until resume completes */ |
| snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D3hot); |
| |
| /* mute any active DACs */ |
| for (i = 0; i < card->num_rtd; i++) { |
| |
| if (card->rtd[i].dai_link->ignore_suspend) |
| continue; |
| |
| for (j = 0; j < card->rtd[i].num_codecs; j++) { |
| struct snd_soc_dai *dai = card->rtd[i].codec_dais[j]; |
| struct snd_soc_dai_driver *drv = dai->driver; |
| |
| if (drv->ops->digital_mute && dai->playback_active) |
| drv->ops->digital_mute(dai, 1); |
| } |
| } |
| |
| /* suspend all pcms */ |
| for (i = 0; i < card->num_rtd; i++) { |
| if (card->rtd[i].dai_link->ignore_suspend) |
| continue; |
| |
| snd_pcm_suspend_all(card->rtd[i].pcm); |
| } |
| |
| if (card->suspend_pre) |
| card->suspend_pre(card); |
| |
| for (i = 0; i < card->num_rtd; i++) { |
| struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai; |
| struct snd_soc_platform *platform = card->rtd[i].platform; |
| |
| if (card->rtd[i].dai_link->ignore_suspend) |
| continue; |
| |
| if (cpu_dai->driver->suspend && !cpu_dai->driver->ac97_control) |
| cpu_dai->driver->suspend(cpu_dai); |
| if (platform->driver->suspend && !platform->suspended) { |
| platform->driver->suspend(cpu_dai); |
| platform->suspended = 1; |
| } |
| } |
| |
| /* close any waiting streams and save state */ |
| for (i = 0; i < card->num_rtd; i++) { |
| struct snd_soc_dai **codec_dais = card->rtd[i].codec_dais; |
| flush_delayed_work(&card->rtd[i].delayed_work); |
| for (j = 0; j < card->rtd[i].num_codecs; j++) { |
| codec_dais[j]->codec->dapm.suspend_bias_level = |
| codec_dais[j]->codec->dapm.bias_level; |
| } |
| } |
| |
| for (i = 0; i < card->num_rtd; i++) { |
| |
| if (card->rtd[i].dai_link->ignore_suspend) |
| continue; |
| |
| snd_soc_dapm_stream_event(&card->rtd[i], |
| SNDRV_PCM_STREAM_PLAYBACK, |
| SND_SOC_DAPM_STREAM_SUSPEND); |
| |
| snd_soc_dapm_stream_event(&card->rtd[i], |
| SNDRV_PCM_STREAM_CAPTURE, |
| SND_SOC_DAPM_STREAM_SUSPEND); |
| } |
| |
| /* Recheck all analogue paths too */ |
| dapm_mark_io_dirty(&card->dapm); |
| snd_soc_dapm_sync(&card->dapm); |
| |
| /* suspend all CODECs */ |
| list_for_each_entry(codec, &card->codec_dev_list, card_list) { |
| /* If there are paths active then the CODEC will be held with |
| * bias _ON and should not be suspended. */ |
| if (!codec->suspended) { |
| switch (codec->dapm.bias_level) { |
| case SND_SOC_BIAS_STANDBY: |
| /* |
| * If the CODEC is capable of idle |
| * bias off then being in STANDBY |
| * means it's doing something, |
| * otherwise fall through. |
| */ |
| if (codec->dapm.idle_bias_off) { |
| dev_dbg(codec->dev, |
| "ASoC: idle_bias_off CODEC on over suspend\n"); |
| break; |
| } |
| |
| case SND_SOC_BIAS_OFF: |
| if (codec->driver->suspend) |
| codec->driver->suspend(codec); |
| codec->suspended = 1; |
| codec->cache_sync = 1; |
| if (codec->component.regmap) |
| regcache_mark_dirty(codec->component.regmap); |
| /* deactivate pins to sleep state */ |
| pinctrl_pm_select_sleep_state(codec->dev); |
| break; |
| default: |
| dev_dbg(codec->dev, |
| "ASoC: CODEC is on over suspend\n"); |
| break; |
| } |
| } |
| } |
| |
| for (i = 0; i < card->num_rtd; i++) { |
| struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai; |
| |
| if (card->rtd[i].dai_link->ignore_suspend) |
| continue; |
| |
| if (cpu_dai->driver->suspend && cpu_dai->driver->ac97_control) |
| cpu_dai->driver->suspend(cpu_dai); |
| |
| /* deactivate pins to sleep state */ |
| pinctrl_pm_select_sleep_state(cpu_dai->dev); |
| } |
| |
| if (card->suspend_post) |
| card->suspend_post(card); |
| |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_suspend); |
| |
| /* deferred resume work, so resume can complete before we finished |
| * setting our codec back up, which can be very slow on I2C |
| */ |
| static void soc_resume_deferred(struct work_struct *work) |
| { |
| struct snd_soc_card *card = |
| container_of(work, struct snd_soc_card, deferred_resume_work); |
| struct snd_soc_codec *codec; |
| int i, j; |
| |
| /* our power state is still SNDRV_CTL_POWER_D3hot from suspend time, |
| * so userspace apps are blocked from touching us |
| */ |
| |
| dev_dbg(card->dev, "ASoC: starting resume work\n"); |
| |
| /* Bring us up into D2 so that DAPM starts enabling things */ |
| snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D2); |
| |
| if (card->resume_pre) |
| card->resume_pre(card); |
| |
| /* resume AC97 DAIs */ |
| for (i = 0; i < card->num_rtd; i++) { |
| struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai; |
| |
| if (card->rtd[i].dai_link->ignore_suspend) |
| continue; |
| |
| if (cpu_dai->driver->resume && cpu_dai->driver->ac97_control) |
| cpu_dai->driver->resume(cpu_dai); |
| } |
| |
| list_for_each_entry(codec, &card->codec_dev_list, card_list) { |
| /* If the CODEC was idle over suspend then it will have been |
| * left with bias OFF or STANDBY and suspended so we must now |
| * resume. Otherwise the suspend was suppressed. |
| */ |
| if (codec->suspended) { |
| switch (codec->dapm.bias_level) { |
| case SND_SOC_BIAS_STANDBY: |
| case SND_SOC_BIAS_OFF: |
| if (codec->driver->resume) |
| codec->driver->resume(codec); |
| codec->suspended = 0; |
| break; |
| default: |
| dev_dbg(codec->dev, |
| "ASoC: CODEC was on over suspend\n"); |
| break; |
| } |
| } |
| } |
| |
| for (i = 0; i < card->num_rtd; i++) { |
| |
| if (card->rtd[i].dai_link->ignore_suspend) |
| continue; |
| |
| snd_soc_dapm_stream_event(&card->rtd[i], |
| SNDRV_PCM_STREAM_PLAYBACK, |
| SND_SOC_DAPM_STREAM_RESUME); |
| |
| snd_soc_dapm_stream_event(&card->rtd[i], |
| SNDRV_PCM_STREAM_CAPTURE, |
| SND_SOC_DAPM_STREAM_RESUME); |
| } |
| |
| /* unmute any active DACs */ |
| for (i = 0; i < card->num_rtd; i++) { |
| |
| if (card->rtd[i].dai_link->ignore_suspend) |
| continue; |
| |
| for (j = 0; j < card->rtd[i].num_codecs; j++) { |
| struct snd_soc_dai *dai = card->rtd[i].codec_dais[j]; |
| struct snd_soc_dai_driver *drv = dai->driver; |
| |
| if (drv->ops->digital_mute && dai->playback_active) |
| drv->ops->digital_mute(dai, 0); |
| } |
| } |
| |
| for (i = 0; i < card->num_rtd; i++) { |
| struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai; |
| struct snd_soc_platform *platform = card->rtd[i].platform; |
| |
| if (card->rtd[i].dai_link->ignore_suspend) |
| continue; |
| |
| if (cpu_dai->driver->resume && !cpu_dai->driver->ac97_control) |
| cpu_dai->driver->resume(cpu_dai); |
| if (platform->driver->resume && platform->suspended) { |
| platform->driver->resume(cpu_dai); |
| platform->suspended = 0; |
| } |
| } |
| |
| if (card->resume_post) |
| card->resume_post(card); |
| |
| dev_dbg(card->dev, "ASoC: resume work completed\n"); |
| |
| /* userspace can access us now we are back as we were before */ |
| snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D0); |
| |
| /* Recheck all analogue paths too */ |
| dapm_mark_io_dirty(&card->dapm); |
| snd_soc_dapm_sync(&card->dapm); |
| } |
| |
| /* powers up audio subsystem after a suspend */ |
| int snd_soc_resume(struct device *dev) |
| { |
| struct snd_soc_card *card = dev_get_drvdata(dev); |
| int i, ac97_control = 0; |
| |
| /* If the card is not initialized yet there is nothing to do */ |
| if (!card->instantiated) |
| return 0; |
| |
| /* activate pins from sleep state */ |
| for (i = 0; i < card->num_rtd; i++) { |
| struct snd_soc_pcm_runtime *rtd = &card->rtd[i]; |
| struct snd_soc_dai **codec_dais = rtd->codec_dais; |
| struct snd_soc_dai *cpu_dai = rtd->cpu_dai; |
| int j; |
| |
| if (cpu_dai->active) |
| pinctrl_pm_select_default_state(cpu_dai->dev); |
| |
| for (j = 0; j < rtd->num_codecs; j++) { |
| struct snd_soc_dai *codec_dai = codec_dais[j]; |
| if (codec_dai->active) |
| pinctrl_pm_select_default_state(codec_dai->dev); |
| } |
| } |
| |
| /* AC97 devices might have other drivers hanging off them so |
| * need to resume immediately. Other drivers don't have that |
| * problem and may take a substantial amount of time to resume |
| * due to I/O costs and anti-pop so handle them out of line. |
| */ |
| for (i = 0; i < card->num_rtd; i++) { |
| struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai; |
| ac97_control |= cpu_dai->driver->ac97_control; |
| } |
| if (ac97_control) { |
| dev_dbg(dev, "ASoC: Resuming AC97 immediately\n"); |
| soc_resume_deferred(&card->deferred_resume_work); |
| } else { |
| dev_dbg(dev, "ASoC: Scheduling resume work\n"); |
| if (!schedule_work(&card->deferred_resume_work)) |
| dev_err(dev, "ASoC: resume work item may be lost\n"); |
| } |
| |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_resume); |
| #else |
| #define snd_soc_suspend NULL |
| #define snd_soc_resume NULL |
| #endif |
| |
| static const struct snd_soc_dai_ops null_dai_ops = { |
| }; |
| |
| static struct snd_soc_component *soc_find_component( |
| const struct device_node *of_node, const char *name) |
| { |
| struct snd_soc_component *component; |
| |
| list_for_each_entry(component, &component_list, list) { |
| if (of_node) { |
| if (component->dev->of_node == of_node) |
| return component; |
| } else if (strcmp(component->name, name) == 0) { |
| return component; |
| } |
| } |
| |
| return NULL; |
| } |
| |
| static struct snd_soc_dai *snd_soc_find_dai( |
| const struct snd_soc_dai_link_component *dlc) |
| { |
| struct snd_soc_component *component; |
| struct snd_soc_dai *dai; |
| |
| /* Find CPU DAI from registered DAIs*/ |
| list_for_each_entry(component, &component_list, list) { |
| if (dlc->of_node && component->dev->of_node != dlc->of_node) |
| continue; |
| if (dlc->name && strcmp(component->name, dlc->name)) |
| continue; |
| list_for_each_entry(dai, &component->dai_list, list) { |
| if (dlc->dai_name && strcmp(dai->name, dlc->dai_name)) |
| continue; |
| |
| return dai; |
| } |
| } |
| |
| return NULL; |
| } |
| |
| static int soc_bind_dai_link(struct snd_soc_card *card, int num) |
| { |
| struct snd_soc_dai_link *dai_link = &card->dai_link[num]; |
| struct snd_soc_pcm_runtime *rtd = &card->rtd[num]; |
| struct snd_soc_dai_link_component *codecs = dai_link->codecs; |
| struct snd_soc_dai_link_component cpu_dai_component; |
| struct snd_soc_dai **codec_dais = rtd->codec_dais; |
| struct snd_soc_platform *platform; |
| const char *platform_name; |
| int i; |
| |
| dev_dbg(card->dev, "ASoC: binding %s at idx %d\n", dai_link->name, num); |
| |
| cpu_dai_component.name = dai_link->cpu_name; |
| cpu_dai_component.of_node = dai_link->cpu_of_node; |
| cpu_dai_component.dai_name = dai_link->cpu_dai_name; |
| rtd->cpu_dai = snd_soc_find_dai(&cpu_dai_component); |
| if (!rtd->cpu_dai) { |
| dev_err(card->dev, "ASoC: CPU DAI %s not registered\n", |
| dai_link->cpu_dai_name); |
| return -EPROBE_DEFER; |
| } |
| |
| rtd->num_codecs = dai_link->num_codecs; |
| |
| /* Find CODEC from registered CODECs */ |
| for (i = 0; i < rtd->num_codecs; i++) { |
| codec_dais[i] = snd_soc_find_dai(&codecs[i]); |
| if (!codec_dais[i]) { |
| dev_err(card->dev, "ASoC: CODEC DAI %s not registered\n", |
| codecs[i].dai_name); |
| return -EPROBE_DEFER; |
| } |
| } |
| |
| /* Single codec links expect codec and codec_dai in runtime data */ |
| rtd->codec_dai = codec_dais[0]; |
| rtd->codec = rtd->codec_dai->codec; |
| |
| /* if there's no platform we match on the empty platform */ |
| platform_name = dai_link->platform_name; |
| if (!platform_name && !dai_link->platform_of_node) |
| platform_name = "snd-soc-dummy"; |
| |
| /* find one from the set of registered platforms */ |
| list_for_each_entry(platform, &platform_list, list) { |
| if (dai_link->platform_of_node) { |
| if (platform->dev->of_node != |
| dai_link->platform_of_node) |
| continue; |
| } else { |
| if (strcmp(platform->component.name, platform_name)) |
| continue; |
| } |
| |
| rtd->platform = platform; |
| } |
| if (!rtd->platform) { |
| dev_err(card->dev, "ASoC: platform %s not registered\n", |
| dai_link->platform_name); |
| return -EPROBE_DEFER; |
| } |
| |
| card->num_rtd++; |
| |
| return 0; |
| } |
| |
| static void soc_remove_component(struct snd_soc_component *component) |
| { |
| if (!component->probed) |
| return; |
| |
| /* This is a HACK and will be removed soon */ |
| if (component->codec) |
| list_del(&component->codec->card_list); |
| |
| if (component->remove) |
| component->remove(component); |
| |
| snd_soc_dapm_free(snd_soc_component_get_dapm(component)); |
| |
| soc_cleanup_component_debugfs(component); |
| component->probed = 0; |
| module_put(component->dev->driver->owner); |
| } |
| |
| static void soc_remove_dai(struct snd_soc_dai *dai, int order) |
| { |
| int err; |
| |
| if (dai && dai->probed && |
| dai->driver->remove_order == order) { |
| if (dai->driver->remove) { |
| err = dai->driver->remove(dai); |
| if (err < 0) |
| dev_err(dai->dev, |
| "ASoC: failed to remove %s: %d\n", |
| dai->name, err); |
| } |
| dai->probed = 0; |
| } |
| } |
| |
| static void soc_remove_link_dais(struct snd_soc_card *card, int num, int order) |
| { |
| struct snd_soc_pcm_runtime *rtd = &card->rtd[num]; |
| int i; |
| |
| /* unregister the rtd device */ |
| if (rtd->dev_registered) { |
| device_remove_file(rtd->dev, &dev_attr_pmdown_time); |
| device_remove_file(rtd->dev, &dev_attr_codec_reg); |
| device_unregister(rtd->dev); |
| rtd->dev_registered = 0; |
| } |
| |
| /* remove the CODEC DAI */ |
| for (i = 0; i < rtd->num_codecs; i++) |
| soc_remove_dai(rtd->codec_dais[i], order); |
| |
| soc_remove_dai(rtd->cpu_dai, order); |
| } |
| |
| static void soc_remove_link_components(struct snd_soc_card *card, int num, |
| int order) |
| { |
| struct snd_soc_pcm_runtime *rtd = &card->rtd[num]; |
| struct snd_soc_dai *cpu_dai = rtd->cpu_dai; |
| struct snd_soc_platform *platform = rtd->platform; |
| struct snd_soc_component *component; |
| int i; |
| |
| /* remove the platform */ |
| if (platform && platform->component.driver->remove_order == order) |
| soc_remove_component(&platform->component); |
| |
| /* remove the CODEC-side CODEC */ |
| for (i = 0; i < rtd->num_codecs; i++) { |
| component = rtd->codec_dais[i]->component; |
| if (component->driver->remove_order == order) |
| soc_remove_component(component); |
| } |
| |
| /* remove any CPU-side CODEC */ |
| if (cpu_dai) { |
| if (cpu_dai->component->driver->remove_order == order) |
| soc_remove_component(cpu_dai->component); |
| } |
| } |
| |
| static void soc_remove_dai_links(struct snd_soc_card *card) |
| { |
| int dai, order; |
| |
| for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST; |
| order++) { |
| for (dai = 0; dai < card->num_rtd; dai++) |
| soc_remove_link_dais(card, dai, order); |
| } |
| |
| for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST; |
| order++) { |
| for (dai = 0; dai < card->num_rtd; dai++) |
| soc_remove_link_components(card, dai, order); |
| } |
| |
| card->num_rtd = 0; |
| } |
| |
| static void soc_set_name_prefix(struct snd_soc_card *card, |
| struct snd_soc_component *component) |
| { |
| int i; |
| |
| if (card->codec_conf == NULL) |
| return; |
| |
| for (i = 0; i < card->num_configs; i++) { |
| struct snd_soc_codec_conf *map = &card->codec_conf[i]; |
| if (map->of_node && component->dev->of_node != map->of_node) |
| continue; |
| if (map->dev_name && strcmp(component->name, map->dev_name)) |
| continue; |
| component->name_prefix = map->name_prefix; |
| break; |
| } |
| } |
| |
| static int soc_probe_component(struct snd_soc_card *card, |
| struct snd_soc_component *component) |
| { |
| struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component); |
| struct snd_soc_dai *dai; |
| int ret; |
| |
| if (component->probed) |
| return 0; |
| |
| component->card = card; |
| dapm->card = card; |
| soc_set_name_prefix(card, component); |
| |
| if (!try_module_get(component->dev->driver->owner)) |
| return -ENODEV; |
| |
| soc_init_component_debugfs(component); |
| |
| if (component->dapm_widgets) { |
| ret = snd_soc_dapm_new_controls(dapm, component->dapm_widgets, |
| component->num_dapm_widgets); |
| |
| if (ret != 0) { |
| dev_err(component->dev, |
| "Failed to create new controls %d\n", ret); |
| goto err_probe; |
| } |
| } |
| |
| list_for_each_entry(dai, &component->dai_list, list) { |
| ret = snd_soc_dapm_new_dai_widgets(dapm, dai); |
| if (ret != 0) { |
| dev_err(component->dev, |
| "Failed to create DAI widgets %d\n", ret); |
| goto err_probe; |
| } |
| } |
| |
| if (component->probe) { |
| ret = component->probe(component); |
| if (ret < 0) { |
| dev_err(component->dev, |
| "ASoC: failed to probe component %d\n", ret); |
| goto err_probe; |
| } |
| |
| WARN(dapm->idle_bias_off && |
| dapm->bias_level != SND_SOC_BIAS_OFF, |
| "codec %s can not start from non-off bias with idle_bias_off==1\n", |
| component->name); |
| } |
| |
| if (component->controls) |
| snd_soc_add_component_controls(component, component->controls, |
| component->num_controls); |
| if (component->dapm_routes) |
| snd_soc_dapm_add_routes(dapm, component->dapm_routes, |
| component->num_dapm_routes); |
| |
| component->probed = 1; |
| list_add(&dapm->list, &card->dapm_list); |
| |
| /* This is a HACK and will be removed soon */ |
| if (component->codec) |
| list_add(&component->codec->card_list, &card->codec_dev_list); |
| |
| return 0; |
| |
| err_probe: |
| soc_cleanup_component_debugfs(component); |
| module_put(component->dev->driver->owner); |
| |
| return ret; |
| } |
| |
| static void rtd_release(struct device *dev) |
| { |
| kfree(dev); |
| } |
| |
| static int soc_post_component_init(struct snd_soc_pcm_runtime *rtd, |
| const char *name) |
| { |
| int ret = 0; |
| |
| /* register the rtd device */ |
| rtd->dev = kzalloc(sizeof(struct device), GFP_KERNEL); |
| if (!rtd->dev) |
| return -ENOMEM; |
| device_initialize(rtd->dev); |
| rtd->dev->parent = rtd->card->dev; |
| rtd->dev->release = rtd_release; |
| dev_set_name(rtd->dev, "%s", name); |
| dev_set_drvdata(rtd->dev, rtd); |
| mutex_init(&rtd->pcm_mutex); |
| INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_PLAYBACK].be_clients); |
| INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_CAPTURE].be_clients); |
| INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_PLAYBACK].fe_clients); |
| INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_CAPTURE].fe_clients); |
| ret = device_add(rtd->dev); |
| if (ret < 0) { |
| /* calling put_device() here to free the rtd->dev */ |
| put_device(rtd->dev); |
| dev_err(rtd->card->dev, |
| "ASoC: failed to register runtime device: %d\n", ret); |
| return ret; |
| } |
| rtd->dev_registered = 1; |
| |
| if (rtd->codec) { |
| /* add DAPM sysfs entries for this codec */ |
| ret = snd_soc_dapm_sys_add(rtd->dev); |
| if (ret < 0) |
| dev_err(rtd->dev, |
| "ASoC: failed to add codec dapm sysfs entries: %d\n", |
| ret); |
| |
| /* add codec sysfs entries */ |
| ret = device_create_file(rtd->dev, &dev_attr_codec_reg); |
| if (ret < 0) |
| dev_err(rtd->dev, |
| "ASoC: failed to add codec sysfs files: %d\n", |
| ret); |
| } |
| |
| return 0; |
| } |
| |
| static int soc_probe_link_components(struct snd_soc_card *card, int num, |
| int order) |
| { |
| struct snd_soc_pcm_runtime *rtd = &card->rtd[num]; |
| struct snd_soc_platform *platform = rtd->platform; |
| struct snd_soc_component *component; |
| int i, ret; |
| |
| /* probe the CPU-side component, if it is a CODEC */ |
| component = rtd->cpu_dai->component; |
| if (component->driver->probe_order == order) { |
| ret = soc_probe_component(card, component); |
| if (ret < 0) |
| return ret; |
| } |
| |
| /* probe the CODEC-side components */ |
| for (i = 0; i < rtd->num_codecs; i++) { |
| component = rtd->codec_dais[i]->component; |
| if (component->driver->probe_order == order) { |
| ret = soc_probe_component(card, component); |
| if (ret < 0) |
| return ret; |
| } |
| } |
| |
| /* probe the platform */ |
| if (platform->component.driver->probe_order == order) { |
| ret = soc_probe_component(card, &platform->component); |
| if (ret < 0) |
| return ret; |
| } |
| |
| return 0; |
| } |
| |
| static int soc_probe_codec_dai(struct snd_soc_card *card, |
| struct snd_soc_dai *codec_dai, |
| int order) |
| { |
| int ret; |
| |
| if (!codec_dai->probed && codec_dai->driver->probe_order == order) { |
| if (codec_dai->driver->probe) { |
| ret = codec_dai->driver->probe(codec_dai); |
| if (ret < 0) { |
| dev_err(codec_dai->dev, |
| "ASoC: failed to probe CODEC DAI %s: %d\n", |
| codec_dai->name, ret); |
| return ret; |
| } |
| } |
| |
| /* mark codec_dai as probed and add to card dai list */ |
| codec_dai->probed = 1; |
| } |
| |
| return 0; |
| } |
| |
| static int soc_link_dai_widgets(struct snd_soc_card *card, |
| struct snd_soc_dai_link *dai_link, |
| struct snd_soc_pcm_runtime *rtd) |
| { |
| struct snd_soc_dai *cpu_dai = rtd->cpu_dai; |
| struct snd_soc_dai *codec_dai = rtd->codec_dai; |
| struct snd_soc_dapm_widget *play_w, *capture_w; |
| int ret; |
| |
| if (rtd->num_codecs > 1) |
| dev_warn(card->dev, "ASoC: Multiple codecs not supported yet\n"); |
| |
| /* link the DAI widgets */ |
| play_w = codec_dai->playback_widget; |
| capture_w = cpu_dai->capture_widget; |
| if (play_w && capture_w) { |
| ret = snd_soc_dapm_new_pcm(card, dai_link->params, |
| capture_w, play_w); |
| if (ret != 0) { |
| dev_err(card->dev, "ASoC: Can't link %s to %s: %d\n", |
| play_w->name, capture_w->name, ret); |
| return ret; |
| } |
| } |
| |
| play_w = cpu_dai->playback_widget; |
| capture_w = codec_dai->capture_widget; |
| if (play_w && capture_w) { |
| ret = snd_soc_dapm_new_pcm(card, dai_link->params, |
| capture_w, play_w); |
| if (ret != 0) { |
| dev_err(card->dev, "ASoC: Can't link %s to %s: %d\n", |
| play_w->name, capture_w->name, ret); |
| return ret; |
| } |
| } |
| |
| return 0; |
| } |
| |
| static int soc_probe_link_dais(struct snd_soc_card *card, int num, int order) |
| { |
| struct snd_soc_dai_link *dai_link = &card->dai_link[num]; |
| struct snd_soc_pcm_runtime *rtd = &card->rtd[num]; |
| struct snd_soc_platform *platform = rtd->platform; |
| struct snd_soc_dai *cpu_dai = rtd->cpu_dai; |
| int i, ret; |
| |
| dev_dbg(card->dev, "ASoC: probe %s dai link %d late %d\n", |
| card->name, num, order); |
| |
| /* config components */ |
| cpu_dai->platform = platform; |
| cpu_dai->card = card; |
| for (i = 0; i < rtd->num_codecs; i++) |
| rtd->codec_dais[i]->card = card; |
| |
| /* set default power off timeout */ |
| rtd->pmdown_time = pmdown_time; |
| |
| /* probe the cpu_dai */ |
| if (!cpu_dai->probed && |
| cpu_dai->driver->probe_order == order) { |
| if (cpu_dai->driver->probe) { |
| ret = cpu_dai->driver->probe(cpu_dai); |
| if (ret < 0) { |
| dev_err(cpu_dai->dev, |
| "ASoC: failed to probe CPU DAI %s: %d\n", |
| cpu_dai->name, ret); |
| return ret; |
| } |
| } |
| cpu_dai->probed = 1; |
| } |
| |
| /* probe the CODEC DAI */ |
| for (i = 0; i < rtd->num_codecs; i++) { |
| ret = soc_probe_codec_dai(card, rtd->codec_dais[i], order); |
| if (ret) |
| return ret; |
| } |
| |
| /* complete DAI probe during last probe */ |
| if (order != SND_SOC_COMP_ORDER_LAST) |
| return 0; |
| |
| /* do machine specific initialization */ |
| if (dai_link->init) { |
| ret = dai_link->init(rtd); |
| if (ret < 0) { |
| dev_err(card->dev, "ASoC: failed to init %s: %d\n", |
| dai_link->name, ret); |
| return ret; |
| } |
| } |
| |
| ret = soc_post_component_init(rtd, dai_link->name); |
| if (ret) |
| return ret; |
| |
| #ifdef CONFIG_DEBUG_FS |
| /* add DPCM sysfs entries */ |
| if (dai_link->dynamic) { |
| ret = soc_dpcm_debugfs_add(rtd); |
| if (ret < 0) { |
| dev_err(rtd->dev, |
| "ASoC: failed to add dpcm sysfs entries: %d\n", |
| ret); |
| return ret; |
| } |
| } |
| #endif |
| |
| ret = device_create_file(rtd->dev, &dev_attr_pmdown_time); |
| if (ret < 0) |
| dev_warn(rtd->dev, "ASoC: failed to add pmdown_time sysfs: %d\n", |
| ret); |
| |
| if (cpu_dai->driver->compress_dai) { |
| /*create compress_device"*/ |
| ret = soc_new_compress(rtd, num); |
| if (ret < 0) { |
| dev_err(card->dev, "ASoC: can't create compress %s\n", |
| dai_link->stream_name); |
| return ret; |
| } |
| } else { |
| |
| if (!dai_link->params) { |
| /* create the pcm */ |
| ret = soc_new_pcm(rtd, num); |
| if (ret < 0) { |
| dev_err(card->dev, "ASoC: can't create pcm %s :%d\n", |
| dai_link->stream_name, ret); |
| return ret; |
| } |
| } else { |
| INIT_DELAYED_WORK(&rtd->delayed_work, |
| codec2codec_close_delayed_work); |
| |
| /* link the DAI widgets */ |
| ret = soc_link_dai_widgets(card, dai_link, rtd); |
| if (ret) |
| return ret; |
| } |
| } |
| |
| /* add platform data for AC97 devices */ |
| for (i = 0; i < rtd->num_codecs; i++) { |
| if (rtd->codec_dais[i]->driver->ac97_control) |
| snd_ac97_dev_add_pdata(rtd->codec_dais[i]->codec->ac97, |
| rtd->cpu_dai->ac97_pdata); |
| } |
| |
| return 0; |
| } |
| |
| #ifdef CONFIG_SND_SOC_AC97_BUS |
| static int soc_register_ac97_codec(struct snd_soc_codec *codec, |
| struct snd_soc_dai *codec_dai) |
| { |
| int ret; |
| |
| /* Only instantiate AC97 if not already done by the adaptor |
| * for the generic AC97 subsystem. |
| */ |
| if (codec_dai->driver->ac97_control && !codec->ac97_registered) { |
| /* |
| * It is possible that the AC97 device is already registered to |
| * the device subsystem. This happens when the device is created |
| * via snd_ac97_mixer(). Currently only SoC codec that does so |
| * is the generic AC97 glue but others migh emerge. |
| * |
| * In those cases we don't try to register the device again. |
| */ |
| if (!codec->ac97_created) |
| return 0; |
| |
| ret = soc_ac97_dev_register(codec); |
| if (ret < 0) { |
| dev_err(codec->dev, |
| "ASoC: AC97 device register failed: %d\n", ret); |
| return ret; |
| } |
| |
| codec->ac97_registered = 1; |
| } |
| return 0; |
| } |
| |
| static void soc_unregister_ac97_codec(struct snd_soc_codec *codec) |
| { |
| if (codec->ac97_registered) { |
| soc_ac97_dev_unregister(codec); |
| codec->ac97_registered = 0; |
| } |
| } |
| |
| static int soc_register_ac97_dai_link(struct snd_soc_pcm_runtime *rtd) |
| { |
| int i, ret; |
| |
| for (i = 0; i < rtd->num_codecs; i++) { |
| struct snd_soc_dai *codec_dai = rtd->codec_dais[i]; |
| |
| ret = soc_register_ac97_codec(codec_dai->codec, codec_dai); |
| if (ret) { |
| while (--i >= 0) |
| soc_unregister_ac97_codec(codec_dai->codec); |
| return ret; |
| } |
| } |
| |
| return 0; |
| } |
| |
| static void soc_unregister_ac97_dai_link(struct snd_soc_pcm_runtime *rtd) |
| { |
| int i; |
| |
| for (i = 0; i < rtd->num_codecs; i++) |
| soc_unregister_ac97_codec(rtd->codec_dais[i]->codec); |
| } |
| #endif |
| |
| static int soc_bind_aux_dev(struct snd_soc_card *card, int num) |
| { |
| struct snd_soc_pcm_runtime *rtd = &card->rtd_aux[num]; |
| struct snd_soc_aux_dev *aux_dev = &card->aux_dev[num]; |
| const char *name = aux_dev->codec_name; |
| |
| rtd->component = soc_find_component(aux_dev->codec_of_node, name); |
| if (!rtd->component) { |
| if (aux_dev->codec_of_node) |
| name = of_node_full_name(aux_dev->codec_of_node); |
| |
| dev_err(card->dev, "ASoC: %s not registered\n", name); |
| return -EPROBE_DEFER; |
| } |
| |
| /* |
| * Some places still reference rtd->codec, so we have to keep that |
| * initialized if the component is a CODEC. Once all those references |
| * have been removed, this code can be removed as well. |
| */ |
| rtd->codec = rtd->component->codec; |
| |
| return 0; |
| } |
| |
| static int soc_probe_aux_dev(struct snd_soc_card *card, int num) |
| { |
| struct snd_soc_pcm_runtime *rtd = &card->rtd_aux[num]; |
| struct snd_soc_aux_dev *aux_dev = &card->aux_dev[num]; |
| int ret; |
| |
| ret = soc_probe_component(card, rtd->component); |
| if (ret < 0) |
| return ret; |
| |
| /* do machine specific initialization */ |
| if (aux_dev->init) { |
| ret = aux_dev->init(rtd->component); |
| if (ret < 0) { |
| dev_err(card->dev, "ASoC: failed to init %s: %d\n", |
| aux_dev->name, ret); |
| return ret; |
| } |
| } |
| |
| return soc_post_component_init(rtd, aux_dev->name); |
| } |
| |
| static void soc_remove_aux_dev(struct snd_soc_card *card, int num) |
| { |
| struct snd_soc_pcm_runtime *rtd = &card->rtd_aux[num]; |
| struct snd_soc_component *component = rtd->component; |
| |
| /* unregister the rtd device */ |
| if (rtd->dev_registered) { |
| device_remove_file(rtd->dev, &dev_attr_codec_reg); |
| device_unregister(rtd->dev); |
| rtd->dev_registered = 0; |
| } |
| |
| if (component && component->probed) |
| soc_remove_component(component); |
| } |
| |
| static int snd_soc_init_codec_cache(struct snd_soc_codec *codec) |
| { |
| int ret; |
| |
| if (codec->cache_init) |
| return 0; |
| |
| ret = snd_soc_cache_init(codec); |
| if (ret < 0) { |
| dev_err(codec->dev, |
| "ASoC: Failed to set cache compression type: %d\n", |
| ret); |
| return ret; |
| } |
| codec->cache_init = 1; |
| return 0; |
| } |
| |
| static int snd_soc_instantiate_card(struct snd_soc_card *card) |
| { |
| struct snd_soc_codec *codec; |
| struct snd_soc_dai_link *dai_link; |
| int ret, i, order, dai_fmt; |
| |
| mutex_lock_nested(&card->mutex, SND_SOC_CARD_CLASS_INIT); |
| |
| /* bind DAIs */ |
| for (i = 0; i < card->num_links; i++) { |
| ret = soc_bind_dai_link(card, i); |
| if (ret != 0) |
| goto base_error; |
| } |
| |
| /* bind aux_devs too */ |
| for (i = 0; i < card->num_aux_devs; i++) { |
| ret = soc_bind_aux_dev(card, i); |
| if (ret != 0) |
| goto base_error; |
| } |
| |
| /* initialize the register cache for each available codec */ |
| list_for_each_entry(codec, &codec_list, list) { |
| if (codec->cache_init) |
| continue; |
| ret = snd_soc_init_codec_cache(codec); |
| if (ret < 0) |
| goto base_error; |
| } |
| |
| /* card bind complete so register a sound card */ |
| ret = snd_card_new(card->dev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1, |
| card->owner, 0, &card->snd_card); |
| if (ret < 0) { |
| dev_err(card->dev, |
| "ASoC: can't create sound card for card %s: %d\n", |
| card->name, ret); |
| goto base_error; |
| } |
| |
| card->dapm.bias_level = SND_SOC_BIAS_OFF; |
| card->dapm.dev = card->dev; |
| card->dapm.card = card; |
| list_add(&card->dapm.list, &card->dapm_list); |
| |
| #ifdef CONFIG_DEBUG_FS |
| snd_soc_dapm_debugfs_init(&card->dapm, card->debugfs_card_root); |
| #endif |
| |
| #ifdef CONFIG_PM_SLEEP |
| /* deferred resume work */ |
| INIT_WORK(&card->deferred_resume_work, soc_resume_deferred); |
| #endif |
| |
| if (card->dapm_widgets) |
| snd_soc_dapm_new_controls(&card->dapm, card->dapm_widgets, |
| card->num_dapm_widgets); |
| |
| /* initialise the sound card only once */ |
| if (card->probe) { |
| ret = card->probe(card); |
| if (ret < 0) |
| goto card_probe_error; |
| } |
| |
| /* probe all components used by DAI links on this card */ |
| for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST; |
| order++) { |
| for (i = 0; i < card->num_links; i++) { |
| ret = soc_probe_link_components(card, i, order); |
| if (ret < 0) { |
| dev_err(card->dev, |
| "ASoC: failed to instantiate card %d\n", |
| ret); |
| goto probe_dai_err; |
| } |
| } |
| } |
| |
| /* probe all DAI links on this card */ |
| for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST; |
| order++) { |
| for (i = 0; i < card->num_links; i++) { |
| ret = soc_probe_link_dais(card, i, order); |
| if (ret < 0) { |
| dev_err(card->dev, |
| "ASoC: failed to instantiate card %d\n", |
| ret); |
| goto probe_dai_err; |
| } |
| } |
| } |
| |
| for (i = 0; i < card->num_aux_devs; i++) { |
| ret = soc_probe_aux_dev(card, i); |
| if (ret < 0) { |
| dev_err(card->dev, |
| "ASoC: failed to add auxiliary devices %d\n", |
| ret); |
| goto probe_aux_dev_err; |
| } |
| } |
| |
| snd_soc_dapm_link_dai_widgets(card); |
| snd_soc_dapm_connect_dai_link_widgets(card); |
| |
| if (card->controls) |
| snd_soc_add_card_controls(card, card->controls, card->num_controls); |
| |
| if (card->dapm_routes) |
| snd_soc_dapm_add_routes(&card->dapm, card->dapm_routes, |
| card->num_dapm_routes); |
| |
| for (i = 0; i < card->num_links; i++) { |
| struct snd_soc_pcm_runtime *rtd = &card->rtd[i]; |
| dai_link = &card->dai_link[i]; |
| dai_fmt = dai_link->dai_fmt; |
| |
| if (dai_fmt) { |
| struct snd_soc_dai **codec_dais = rtd->codec_dais; |
| int j; |
| |
| for (j = 0; j < rtd->num_codecs; j++) { |
| struct snd_soc_dai *codec_dai = codec_dais[j]; |
| |
| ret = snd_soc_dai_set_fmt(codec_dai, dai_fmt); |
| if (ret != 0 && ret != -ENOTSUPP) |
| dev_warn(codec_dai->dev, |
| "ASoC: Failed to set DAI format: %d\n", |
| ret); |
| } |
| } |
| |
| /* If this is a regular CPU link there will be a platform */ |
| if (dai_fmt && |
| (dai_link->platform_name || dai_link->platform_of_node)) { |
| ret = snd_soc_dai_set_fmt(card->rtd[i].cpu_dai, |
| dai_fmt); |
| if (ret != 0 && ret != -ENOTSUPP) |
| dev_warn(card->rtd[i].cpu_dai->dev, |
| "ASoC: Failed to set DAI format: %d\n", |
| ret); |
| } else if (dai_fmt) { |
| /* Flip the polarity for the "CPU" end */ |
| dai_fmt &= ~SND_SOC_DAIFMT_MASTER_MASK; |
| switch (dai_link->dai_fmt & |
| SND_SOC_DAIFMT_MASTER_MASK) { |
| case SND_SOC_DAIFMT_CBM_CFM: |
| dai_fmt |= SND_SOC_DAIFMT_CBS_CFS; |
| break; |
| case SND_SOC_DAIFMT_CBM_CFS: |
| dai_fmt |= SND_SOC_DAIFMT_CBS_CFM; |
| break; |
| case SND_SOC_DAIFMT_CBS_CFM: |
| dai_fmt |= SND_SOC_DAIFMT_CBM_CFS; |
| break; |
| case SND_SOC_DAIFMT_CBS_CFS: |
| dai_fmt |= SND_SOC_DAIFMT_CBM_CFM; |
| break; |
| } |
| |
| ret = snd_soc_dai_set_fmt(card->rtd[i].cpu_dai, |
| dai_fmt); |
| if (ret != 0 && ret != -ENOTSUPP) |
| dev_warn(card->rtd[i].cpu_dai->dev, |
| "ASoC: Failed to set DAI format: %d\n", |
| ret); |
| } |
| } |
| |
| snprintf(card->snd_card->shortname, sizeof(card->snd_card->shortname), |
| "%s", card->name); |
| snprintf(card->snd_card->longname, sizeof(card->snd_card->longname), |
| "%s", card->long_name ? card->long_name : card->name); |
| snprintf(card->snd_card->driver, sizeof(card->snd_card->driver), |
| "%s", card->driver_name ? card->driver_name : card->name); |
| for (i = 0; i < ARRAY_SIZE(card->snd_card->driver); i++) { |
| switch (card->snd_card->driver[i]) { |
| case '_': |
| case '-': |
| case '\0': |
| break; |
| default: |
| if (!isalnum(card->snd_card->driver[i])) |
| card->snd_card->driver[i] = '_'; |
| break; |
| } |
| } |
| |
| if (card->late_probe) { |
| ret = card->late_probe(card); |
| if (ret < 0) { |
| dev_err(card->dev, "ASoC: %s late_probe() failed: %d\n", |
| card->name, ret); |
| goto probe_aux_dev_err; |
| } |
| } |
| |
| if (card->fully_routed) |
| snd_soc_dapm_auto_nc_pins(card); |
| |
| snd_soc_dapm_new_widgets(card); |
| |
| ret = snd_card_register(card->snd_card); |
| if (ret < 0) { |
| dev_err(card->dev, "ASoC: failed to register soundcard %d\n", |
| ret); |
| goto probe_aux_dev_err; |
| } |
| |
| #ifdef CONFIG_SND_SOC_AC97_BUS |
| /* register any AC97 codecs */ |
| for (i = 0; i < card->num_rtd; i++) { |
| ret = soc_register_ac97_dai_link(&card->rtd[i]); |
| if (ret < 0) { |
| dev_err(card->dev, |
| "ASoC: failed to register AC97: %d\n", ret); |
| while (--i >= 0) |
| soc_unregister_ac97_dai_link(&card->rtd[i]); |
| goto probe_aux_dev_err; |
| } |
| } |
| #endif |
| |
| card->instantiated = 1; |
| snd_soc_dapm_sync(&card->dapm); |
| mutex_unlock(&card->mutex); |
| |
| return 0; |
| |
| probe_aux_dev_err: |
| for (i = 0; i < card->num_aux_devs; i++) |
| soc_remove_aux_dev(card, i); |
| |
| probe_dai_err: |
| soc_remove_dai_links(card); |
| |
| card_probe_error: |
| if (card->remove) |
| card->remove(card); |
| |
| snd_card_free(card->snd_card); |
| |
| base_error: |
| mutex_unlock(&card->mutex); |
| |
| return ret; |
| } |
| |
| /* probes a new socdev */ |
| static int soc_probe(struct platform_device *pdev) |
| { |
| struct snd_soc_card *card = platform_get_drvdata(pdev); |
| |
| /* |
| * no card, so machine driver should be registering card |
| * we should not be here in that case so ret error |
| */ |
| if (!card) |
| return -EINVAL; |
| |
| dev_warn(&pdev->dev, |
| "ASoC: machine %s should use snd_soc_register_card()\n", |
| card->name); |
| |
| /* Bodge while we unpick instantiation */ |
| card->dev = &pdev->dev; |
| |
| return snd_soc_register_card(card); |
| } |
| |
| static int soc_cleanup_card_resources(struct snd_soc_card *card) |
| { |
| int i; |
| |
| /* make sure any delayed work runs */ |
| for (i = 0; i < card->num_rtd; i++) { |
| struct snd_soc_pcm_runtime *rtd = &card->rtd[i]; |
| flush_delayed_work(&rtd->delayed_work); |
| } |
| |
| /* remove auxiliary devices */ |
| for (i = 0; i < card->num_aux_devs; i++) |
| soc_remove_aux_dev(card, i); |
| |
| /* remove and free each DAI */ |
| soc_remove_dai_links(card); |
| |
| soc_cleanup_card_debugfs(card); |
| |
| /* remove the card */ |
| if (card->remove) |
| card->remove(card); |
| |
| snd_soc_dapm_free(&card->dapm); |
| |
| snd_card_free(card->snd_card); |
| return 0; |
| |
| } |
| |
| /* removes a socdev */ |
| static int soc_remove(struct platform_device *pdev) |
| { |
| struct snd_soc_card *card = platform_get_drvdata(pdev); |
| |
| snd_soc_unregister_card(card); |
| return 0; |
| } |
| |
| int snd_soc_poweroff(struct device *dev) |
| { |
| struct snd_soc_card *card = dev_get_drvdata(dev); |
| int i; |
| |
| if (!card->instantiated) |
| return 0; |
| |
| /* Flush out pmdown_time work - we actually do want to run it |
| * now, we're shutting down so no imminent restart. */ |
| for (i = 0; i < card->num_rtd; i++) { |
| struct snd_soc_pcm_runtime *rtd = &card->rtd[i]; |
| flush_delayed_work(&rtd->delayed_work); |
| } |
| |
| snd_soc_dapm_shutdown(card); |
| |
| /* deactivate pins to sleep state */ |
| for (i = 0; i < card->num_rtd; i++) { |
| struct snd_soc_pcm_runtime *rtd = &card->rtd[i]; |
| struct snd_soc_dai *cpu_dai = rtd->cpu_dai; |
| int j; |
| |
| pinctrl_pm_select_sleep_state(cpu_dai->dev); |
| for (j = 0; j < rtd->num_codecs; j++) { |
| struct snd_soc_dai *codec_dai = rtd->codec_dais[j]; |
| pinctrl_pm_select_sleep_state(codec_dai->dev); |
| } |
| } |
| |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_poweroff); |
| |
| const struct dev_pm_ops snd_soc_pm_ops = { |
| .suspend = snd_soc_suspend, |
| .resume = snd_soc_resume, |
| .freeze = snd_soc_suspend, |
| .thaw = snd_soc_resume, |
| .poweroff = snd_soc_poweroff, |
| .restore = snd_soc_resume, |
| }; |
| EXPORT_SYMBOL_GPL(snd_soc_pm_ops); |
| |
| /* ASoC platform driver */ |
| static struct platform_driver soc_driver = { |
| .driver = { |
| .name = "soc-audio", |
| .owner = THIS_MODULE, |
| .pm = &snd_soc_pm_ops, |
| }, |
| .probe = soc_probe, |
| .remove = soc_remove, |
| }; |
| |
| /** |
| * snd_soc_new_ac97_codec - initailise AC97 device |
| * @codec: audio codec |
| * @ops: AC97 bus operations |
| * @num: AC97 codec number |
| * |
| * Initialises AC97 codec resources for use by ad-hoc devices only. |
| */ |
| int snd_soc_new_ac97_codec(struct snd_soc_codec *codec, |
| struct snd_ac97_bus_ops *ops, int num) |
| { |
| codec->ac97 = kzalloc(sizeof(struct snd_ac97), GFP_KERNEL); |
| if (codec->ac97 == NULL) |
| return -ENOMEM; |
| |
| codec->ac97->bus = kzalloc(sizeof(struct snd_ac97_bus), GFP_KERNEL); |
| if (codec->ac97->bus == NULL) { |
| kfree(codec->ac97); |
| codec->ac97 = NULL; |
| return -ENOMEM; |
| } |
| |
| codec->ac97->bus->ops = ops; |
| codec->ac97->num = num; |
| |
| /* |
| * Mark the AC97 device to be created by us. This way we ensure that the |
| * device will be registered with the device subsystem later on. |
| */ |
| codec->ac97_created = 1; |
| |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_new_ac97_codec); |
| |
| static struct snd_ac97_reset_cfg snd_ac97_rst_cfg; |
| |
| static void snd_soc_ac97_warm_reset(struct snd_ac97 *ac97) |
| { |
| struct pinctrl *pctl = snd_ac97_rst_cfg.pctl; |
| |
| pinctrl_select_state(pctl, snd_ac97_rst_cfg.pstate_warm_reset); |
| |
| gpio_direction_output(snd_ac97_rst_cfg.gpio_sync, 1); |
| |
| udelay(10); |
| |
| gpio_direction_output(snd_ac97_rst_cfg.gpio_sync, 0); |
| |
| pinctrl_select_state(pctl, snd_ac97_rst_cfg.pstate_run); |
| msleep(2); |
| } |
| |
| static void snd_soc_ac97_reset(struct snd_ac97 *ac97) |
| { |
| struct pinctrl *pctl = snd_ac97_rst_cfg.pctl; |
| |
| pinctrl_select_state(pctl, snd_ac97_rst_cfg.pstate_reset); |
| |
| gpio_direction_output(snd_ac97_rst_cfg.gpio_sync, 0); |
| gpio_direction_output(snd_ac97_rst_cfg.gpio_sdata, 0); |
| gpio_direction_output(snd_ac97_rst_cfg.gpio_reset, 0); |
| |
| udelay(10); |
| |
| gpio_direction_output(snd_ac97_rst_cfg.gpio_reset, 1); |
| |
| pinctrl_select_state(pctl, snd_ac97_rst_cfg.pstate_run); |
| msleep(2); |
| } |
| |
| static int snd_soc_ac97_parse_pinctl(struct device *dev, |
| struct snd_ac97_reset_cfg *cfg) |
| { |
| struct pinctrl *p; |
| struct pinctrl_state *state; |
| int gpio; |
| int ret; |
| |
| p = devm_pinctrl_get(dev); |
| if (IS_ERR(p)) { |
| dev_err(dev, "Failed to get pinctrl\n"); |
| return PTR_ERR(p); |
| } |
| cfg->pctl = p; |
| |
| state = pinctrl_lookup_state(p, "ac97-reset"); |
| if (IS_ERR(state)) { |
| dev_err(dev, "Can't find pinctrl state ac97-reset\n"); |
| return PTR_ERR(state); |
| } |
| cfg->pstate_reset = state; |
| |
| state = pinctrl_lookup_state(p, "ac97-warm-reset"); |
| if (IS_ERR(state)) { |
| dev_err(dev, "Can't find pinctrl state ac97-warm-reset\n"); |
| return PTR_ERR(state); |
| } |
| cfg->pstate_warm_reset = state; |
| |
| state = pinctrl_lookup_state(p, "ac97-running"); |
| if (IS_ERR(state)) { |
| dev_err(dev, "Can't find pinctrl state ac97-running\n"); |
| return PTR_ERR(state); |
| } |
| cfg->pstate_run = state; |
| |
| gpio = of_get_named_gpio(dev->of_node, "ac97-gpios", 0); |
| if (gpio < 0) { |
| dev_err(dev, "Can't find ac97-sync gpio\n"); |
| return gpio; |
| } |
| ret = devm_gpio_request(dev, gpio, "AC97 link sync"); |
| if (ret) { |
| dev_err(dev, "Failed requesting ac97-sync gpio\n"); |
| return ret; |
| } |
| cfg->gpio_sync = gpio; |
| |
| gpio = of_get_named_gpio(dev->of_node, "ac97-gpios", 1); |
| if (gpio < 0) { |
| dev_err(dev, "Can't find ac97-sdata gpio %d\n", gpio); |
| return gpio; |
| } |
| ret = devm_gpio_request(dev, gpio, "AC97 link sdata"); |
| if (ret) { |
| dev_err(dev, "Failed requesting ac97-sdata gpio\n"); |
| return ret; |
| } |
| cfg->gpio_sdata = gpio; |
| |
| gpio = of_get_named_gpio(dev->of_node, "ac97-gpios", 2); |
| if (gpio < 0) { |
| dev_err(dev, "Can't find ac97-reset gpio\n"); |
| return gpio; |
| } |
| ret = devm_gpio_request(dev, gpio, "AC97 link reset"); |
| if (ret) { |
| dev_err(dev, "Failed requesting ac97-reset gpio\n"); |
| return ret; |
| } |
| cfg->gpio_reset = gpio; |
| |
| return 0; |
| } |
| |
| struct snd_ac97_bus_ops *soc_ac97_ops; |
| EXPORT_SYMBOL_GPL(soc_ac97_ops); |
| |
| int snd_soc_set_ac97_ops(struct snd_ac97_bus_ops *ops) |
| { |
| if (ops == soc_ac97_ops) |
| return 0; |
| |
| if (soc_ac97_ops && ops) |
| return -EBUSY; |
| |
| soc_ac97_ops = ops; |
| |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_set_ac97_ops); |
| |
| /** |
| * snd_soc_set_ac97_ops_of_reset - Set ac97 ops with generic ac97 reset functions |
| * |
| * This function sets the reset and warm_reset properties of ops and parses |
| * the device node of pdev to get pinctrl states and gpio numbers to use. |
| */ |
| int snd_soc_set_ac97_ops_of_reset(struct snd_ac97_bus_ops *ops, |
| struct platform_device *pdev) |
| { |
| struct device *dev = &pdev->dev; |
| struct snd_ac97_reset_cfg cfg; |
| int ret; |
| |
| ret = snd_soc_ac97_parse_pinctl(dev, &cfg); |
| if (ret) |
| return ret; |
| |
| ret = snd_soc_set_ac97_ops(ops); |
| if (ret) |
| return ret; |
| |
| ops->warm_reset = snd_soc_ac97_warm_reset; |
| ops->reset = snd_soc_ac97_reset; |
| |
| snd_ac97_rst_cfg = cfg; |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_set_ac97_ops_of_reset); |
| |
| /** |
| * snd_soc_free_ac97_codec - free AC97 codec device |
| * @codec: audio codec |
| * |
| * Frees AC97 codec device resources. |
| */ |
| void snd_soc_free_ac97_codec(struct snd_soc_codec *codec) |
| { |
| #ifdef CONFIG_SND_SOC_AC97_BUS |
| soc_unregister_ac97_codec(codec); |
| #endif |
| kfree(codec->ac97->bus); |
| kfree(codec->ac97); |
| codec->ac97 = NULL; |
| codec->ac97_created = 0; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_free_ac97_codec); |
| |
| /** |
| * snd_soc_cnew - create new control |
| * @_template: control template |
| * @data: control private data |
| * @long_name: control long name |
| * @prefix: control name prefix |
| * |
| * Create a new mixer control from a template control. |
| * |
| * Returns 0 for success, else error. |
| */ |
| struct snd_kcontrol *snd_soc_cnew(const struct snd_kcontrol_new *_template, |
| void *data, const char *long_name, |
| const char *prefix) |
| { |
| struct snd_kcontrol_new template; |
| struct snd_kcontrol *kcontrol; |
| char *name = NULL; |
| |
| memcpy(&template, _template, sizeof(template)); |
| template.index = 0; |
| |
| if (!long_name) |
| long_name = template.name; |
| |
| if (prefix) { |
| name = kasprintf(GFP_KERNEL, "%s %s", prefix, long_name); |
| if (!name) |
| return NULL; |
| |
| template.name = name; |
| } else { |
| template.name = long_name; |
| } |
| |
| kcontrol = snd_ctl_new1(&template, data); |
| |
| kfree(name); |
| |
| return kcontrol; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_cnew); |
| |
| static int snd_soc_add_controls(struct snd_card *card, struct device *dev, |
| const struct snd_kcontrol_new *controls, int num_controls, |
| const char *prefix, void *data) |
| { |
| int err, i; |
| |
| for (i = 0; i < num_controls; i++) { |
| const struct snd_kcontrol_new *control = &controls[i]; |
| err = snd_ctl_add(card, snd_soc_cnew(control, data, |
| control->name, prefix)); |
| if (err < 0) { |
| dev_err(dev, "ASoC: Failed to add %s: %d\n", |
| control->name, err); |
| return err; |
| } |
| } |
| |
| return 0; |
| } |
| |
| struct snd_kcontrol *snd_soc_card_get_kcontrol(struct snd_soc_card *soc_card, |
| const char *name) |
| { |
| struct snd_card *card = soc_card->snd_card; |
| struct snd_kcontrol *kctl; |
| |
| if (unlikely(!name)) |
| return NULL; |
| |
| list_for_each_entry(kctl, &card->controls, list) |
| if (!strncmp(kctl->id.name, name, sizeof(kctl->id.name))) |
| return kctl; |
| return NULL; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_card_get_kcontrol); |
| |
| /** |
| * snd_soc_add_component_controls - Add an array of controls to a component. |
| * |
| * @component: Component to add controls to |
| * @controls: Array of controls to add |
| * @num_controls: Number of elements in the array |
| * |
| * Return: 0 for success, else error. |
| */ |
| int snd_soc_add_component_controls(struct snd_soc_component *component, |
| const struct snd_kcontrol_new *controls, unsigned int num_controls) |
| { |
| struct snd_card *card = component->card->snd_card; |
| |
| return snd_soc_add_controls(card, component->dev, controls, |
| num_controls, component->name_prefix, component); |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_add_component_controls); |
| |
| /** |
| * snd_soc_add_codec_controls - add an array of controls to a codec. |
| * Convenience function to add a list of controls. Many codecs were |
| * duplicating this code. |
| * |
| * @codec: codec to add controls to |
| * @controls: array of controls to add |
| * @num_controls: number of elements in the array |
| * |
| * Return 0 for success, else error. |
| */ |
| int snd_soc_add_codec_controls(struct snd_soc_codec *codec, |
| const struct snd_kcontrol_new *controls, unsigned int num_controls) |
| { |
| return snd_soc_add_component_controls(&codec->component, controls, |
| num_controls); |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_add_codec_controls); |
| |
| /** |
| * snd_soc_add_platform_controls - add an array of controls to a platform. |
| * Convenience function to add a list of controls. |
| * |
| * @platform: platform to add controls to |
| * @controls: array of controls to add |
| * @num_controls: number of elements in the array |
| * |
| * Return 0 for success, else error. |
| */ |
| int snd_soc_add_platform_controls(struct snd_soc_platform *platform, |
| const struct snd_kcontrol_new *controls, unsigned int num_controls) |
| { |
| return snd_soc_add_component_controls(&platform->component, controls, |
| num_controls); |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_add_platform_controls); |
| |
| /** |
| * snd_soc_add_card_controls - add an array of controls to a SoC card. |
| * Convenience function to add a list of controls. |
| * |
| * @soc_card: SoC card to add controls to |
| * @controls: array of controls to add |
| * @num_controls: number of elements in the array |
| * |
| * Return 0 for success, else error. |
| */ |
| int snd_soc_add_card_controls(struct snd_soc_card *soc_card, |
| const struct snd_kcontrol_new *controls, int num_controls) |
| { |
| struct snd_card *card = soc_card->snd_card; |
| |
| return snd_soc_add_controls(card, soc_card->dev, controls, num_controls, |
| NULL, soc_card); |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_add_card_controls); |
| |
| /** |
| * snd_soc_add_dai_controls - add an array of controls to a DAI. |
| * Convienience function to add a list of controls. |
| * |
| * @dai: DAI to add controls to |
| * @controls: array of controls to add |
| * @num_controls: number of elements in the array |
| * |
| * Return 0 for success, else error. |
| */ |
| int snd_soc_add_dai_controls(struct snd_soc_dai *dai, |
| const struct snd_kcontrol_new *controls, int num_controls) |
| { |
| struct snd_card *card = dai->card->snd_card; |
| |
| return snd_soc_add_controls(card, dai->dev, controls, num_controls, |
| NULL, dai); |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_add_dai_controls); |
| |
| /** |
| * snd_soc_info_enum_double - enumerated double mixer info callback |
| * @kcontrol: mixer control |
| * @uinfo: control element information |
| * |
| * Callback to provide information about a double enumerated |
| * mixer control. |
| * |
| * Returns 0 for success. |
| */ |
| int snd_soc_info_enum_double(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_info *uinfo) |
| { |
| struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; |
| |
| uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED; |
| uinfo->count = e->shift_l == e->shift_r ? 1 : 2; |
| uinfo->value.enumerated.items = e->items; |
| |
| if (uinfo->value.enumerated.item >= e->items) |
| uinfo->value.enumerated.item = e->items - 1; |
| strlcpy(uinfo->value.enumerated.name, |
| e->texts[uinfo->value.enumerated.item], |
| sizeof(uinfo->value.enumerated.name)); |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_info_enum_double); |
| |
| /** |
| * snd_soc_get_enum_double - enumerated double mixer get callback |
| * @kcontrol: mixer control |
| * @ucontrol: control element information |
| * |
| * Callback to get the value of a double enumerated mixer. |
| * |
| * Returns 0 for success. |
| */ |
| int snd_soc_get_enum_double(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); |
| struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; |
| unsigned int val, item; |
| unsigned int reg_val; |
| int ret; |
| |
| ret = snd_soc_component_read(component, e->reg, ®_val); |
| if (ret) |
| return ret; |
| val = (reg_val >> e->shift_l) & e->mask; |
| item = snd_soc_enum_val_to_item(e, val); |
| ucontrol->value.enumerated.item[0] = item; |
| if (e->shift_l != e->shift_r) { |
| val = (reg_val >> e->shift_l) & e->mask; |
| item = snd_soc_enum_val_to_item(e, val); |
| ucontrol->value.enumerated.item[1] = item; |
| } |
| |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_get_enum_double); |
| |
| /** |
| * snd_soc_put_enum_double - enumerated double mixer put callback |
| * @kcontrol: mixer control |
| * @ucontrol: control element information |
| * |
| * Callback to set the value of a double enumerated mixer. |
| * |
| * Returns 0 for success. |
| */ |
| int snd_soc_put_enum_double(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); |
| struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; |
| unsigned int *item = ucontrol->value.enumerated.item; |
| unsigned int val; |
| unsigned int mask; |
| |
| if (item[0] >= e->items) |
| return -EINVAL; |
| val = snd_soc_enum_item_to_val(e, item[0]) << e->shift_l; |
| mask = e->mask << e->shift_l; |
| if (e->shift_l != e->shift_r) { |
| if (item[1] >= e->items) |
| return -EINVAL; |
| val |= snd_soc_enum_item_to_val(e, item[1]) << e->shift_r; |
| mask |= e->mask << e->shift_r; |
| } |
| |
| return snd_soc_component_update_bits(component, e->reg, mask, val); |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_put_enum_double); |
| |
| /** |
| * snd_soc_read_signed - Read a codec register and interprete as signed value |
| * @component: component |
| * @reg: Register to read |
| * @mask: Mask to use after shifting the register value |
| * @shift: Right shift of register value |
| * @sign_bit: Bit that describes if a number is negative or not. |
| * @signed_val: Pointer to where the read value should be stored |
| * |
| * This functions reads a codec register. The register value is shifted right |
| * by 'shift' bits and masked with the given 'mask'. Afterwards it translates |
| * the given registervalue into a signed integer if sign_bit is non-zero. |
| * |
| * Returns 0 on sucess, otherwise an error value |
| */ |
| static int snd_soc_read_signed(struct snd_soc_component *component, |
| unsigned int reg, unsigned int mask, unsigned int shift, |
| unsigned int sign_bit, int *signed_val) |
| { |
| int ret; |
| unsigned int val; |
| |
| ret = snd_soc_component_read(component, reg, &val); |
| if (ret < 0) |
| return ret; |
| |
| val = (val >> shift) & mask; |
| |
| if (!sign_bit) { |
| *signed_val = val; |
| return 0; |
| } |
| |
| /* non-negative number */ |
| if (!(val & BIT(sign_bit))) { |
| *signed_val = val; |
| return 0; |
| } |
| |
| ret = val; |
| |
| /* |
| * The register most probably does not contain a full-sized int. |
| * Instead we have an arbitrary number of bits in a signed |
| * representation which has to be translated into a full-sized int. |
| * This is done by filling up all bits above the sign-bit. |
| */ |
| ret |= ~((int)(BIT(sign_bit) - 1)); |
| |
| *signed_val = ret; |
| |
| return 0; |
| } |
| |
| /** |
| * snd_soc_info_volsw - single mixer info callback |
| * @kcontrol: mixer control |
| * @uinfo: control element information |
| * |
| * Callback to provide information about a single mixer control, or a double |
| * mixer control that spans 2 registers. |
| * |
| * Returns 0 for success. |
| */ |
| int snd_soc_info_volsw(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_info *uinfo) |
| { |
| struct soc_mixer_control *mc = |
| (struct soc_mixer_control *)kcontrol->private_value; |
| int platform_max; |
| |
| if (!mc->platform_max) |
| mc->platform_max = mc->max; |
| platform_max = mc->platform_max; |
| |
| if (platform_max == 1 && !strstr(kcontrol->id.name, " Volume")) |
| uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN; |
| else |
| uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; |
| |
| uinfo->count = snd_soc_volsw_is_stereo(mc) ? 2 : 1; |
| uinfo->value.integer.min = 0; |
| uinfo->value.integer.max = platform_max - mc->min; |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_info_volsw); |
| |
| /** |
| * snd_soc_get_volsw - single mixer get callback |
| * @kcontrol: mixer control |
| * @ucontrol: control element information |
| * |
| * Callback to get the value of a single mixer control, or a double mixer |
| * control that spans 2 registers. |
| * |
| * Returns 0 for success. |
| */ |
| int snd_soc_get_volsw(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); |
| struct soc_mixer_control *mc = |
| (struct soc_mixer_control *)kcontrol->private_value; |
| unsigned int reg = mc->reg; |
| unsigned int reg2 = mc->rreg; |
| unsigned int shift = mc->shift; |
| unsigned int rshift = mc->rshift; |
| int max = mc->max; |
| int min = mc->min; |
| int sign_bit = mc->sign_bit; |
| unsigned int mask = (1 << fls(max)) - 1; |
| unsigned int invert = mc->invert; |
| int val; |
| int ret; |
| |
| if (sign_bit) |
| mask = BIT(sign_bit + 1) - 1; |
| |
| ret = snd_soc_read_signed(component, reg, mask, shift, sign_bit, &val); |
| if (ret) |
| return ret; |
| |
| ucontrol->value.integer.value[0] = val - min; |
| if (invert) |
| ucontrol->value.integer.value[0] = |
| max - ucontrol->value.integer.value[0]; |
| |
| if (snd_soc_volsw_is_stereo(mc)) { |
| if (reg == reg2) |
| ret = snd_soc_read_signed(component, reg, mask, rshift, |
| sign_bit, &val); |
| else |
| ret = snd_soc_read_signed(component, reg2, mask, shift, |
| sign_bit, &val); |
| if (ret) |
| return ret; |
| |
| ucontrol->value.integer.value[1] = val - min; |
| if (invert) |
| ucontrol->value.integer.value[1] = |
| max - ucontrol->value.integer.value[1]; |
| } |
| |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_get_volsw); |
| |
| /** |
| * snd_soc_put_volsw - single mixer put callback |
| * @kcontrol: mixer control |
| * @ucontrol: control element information |
| * |
| * Callback to set the value of a single mixer control, or a double mixer |
| * control that spans 2 registers. |
| * |
| * Returns 0 for success. |
| */ |
| int snd_soc_put_volsw(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); |
| struct soc_mixer_control *mc = |
| (struct soc_mixer_control *)kcontrol->private_value; |
| unsigned int reg = mc->reg; |
| unsigned int reg2 = mc->rreg; |
| unsigned int shift = mc->shift; |
| unsigned int rshift = mc->rshift; |
| int max = mc->max; |
| int min = mc->min; |
| unsigned int sign_bit = mc->sign_bit; |
| unsigned int mask = (1 << fls(max)) - 1; |
| unsigned int invert = mc->invert; |
| int err; |
| bool type_2r = false; |
| unsigned int val2 = 0; |
| unsigned int val, val_mask; |
| |
| if (sign_bit) |
| mask = BIT(sign_bit + 1) - 1; |
| |
| val = ((ucontrol->value.integer.value[0] + min) & mask); |
| if (invert) |
| val = max - val; |
| val_mask = mask << shift; |
| val = val << shift; |
| if (snd_soc_volsw_is_stereo(mc)) { |
| val2 = ((ucontrol->value.integer.value[1] + min) & mask); |
| if (invert) |
| val2 = max - val2; |
| if (reg == reg2) { |
| val_mask |= mask << rshift; |
| val |= val2 << rshift; |
| } else { |
| val2 = val2 << shift; |
| type_2r = true; |
| } |
| } |
| err = snd_soc_component_update_bits(component, reg, val_mask, val); |
| if (err < 0) |
| return err; |
| |
| if (type_2r) |
| err = snd_soc_component_update_bits(component, reg2, val_mask, |
| val2); |
| |
| return err; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_put_volsw); |
| |
| /** |
| * snd_soc_get_volsw_sx - single mixer get callback |
| * @kcontrol: mixer control |
| * @ucontrol: control element information |
| * |
| * Callback to get the value of a single mixer control, or a double mixer |
| * control that spans 2 registers. |
| * |
| * Returns 0 for success. |
| */ |
| int snd_soc_get_volsw_sx(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); |
| struct soc_mixer_control *mc = |
| (struct soc_mixer_control *)kcontrol->private_value; |
| unsigned int reg = mc->reg; |
| unsigned int reg2 = mc->rreg; |
| unsigned int shift = mc->shift; |
| unsigned int rshift = mc->rshift; |
| int max = mc->max; |
| int min = mc->min; |
| int mask = (1 << (fls(min + max) - 1)) - 1; |
| unsigned int val; |
| int ret; |
| |
| ret = snd_soc_component_read(component, reg, &val); |
| if (ret < 0) |
| return ret; |
| |
| ucontrol->value.integer.value[0] = ((val >> shift) - min) & mask; |
| |
| if (snd_soc_volsw_is_stereo(mc)) { |
| ret = snd_soc_component_read(component, reg2, &val); |
| if (ret < 0) |
| return ret; |
| |
| val = ((val >> rshift) - min) & mask; |
| ucontrol->value.integer.value[1] = val; |
| } |
| |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_get_volsw_sx); |
| |
| /** |
| * snd_soc_put_volsw_sx - double mixer set callback |
| * @kcontrol: mixer control |
| * @uinfo: control element information |
| * |
| * Callback to set the value of a double mixer control that spans 2 registers. |
| * |
| * Returns 0 for success. |
| */ |
| int snd_soc_put_volsw_sx(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); |
| struct soc_mixer_control *mc = |
| (struct soc_mixer_control *)kcontrol->private_value; |
| |
| unsigned int reg = mc->reg; |
| unsigned int reg2 = mc->rreg; |
| unsigned int shift = mc->shift; |
| unsigned int rshift = mc->rshift; |
| int max = mc->max; |
| int min = mc->min; |
| int mask = (1 << (fls(min + max) - 1)) - 1; |
| int err = 0; |
| unsigned int val, val_mask, val2 = 0; |
| |
| val_mask = mask << shift; |
| val = (ucontrol->value.integer.value[0] + min) & mask; |
| val = val << shift; |
| |
| err = snd_soc_component_update_bits(component, reg, val_mask, val); |
| if (err < 0) |
| return err; |
| |
| if (snd_soc_volsw_is_stereo(mc)) { |
| val_mask = mask << rshift; |
| val2 = (ucontrol->value.integer.value[1] + min) & mask; |
| val2 = val2 << rshift; |
| |
| err = snd_soc_component_update_bits(component, reg2, val_mask, |
| val2); |
| } |
| return err; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_put_volsw_sx); |
| |
| /** |
| * snd_soc_info_volsw_s8 - signed mixer info callback |
| * @kcontrol: mixer control |
| * @uinfo: control element information |
| * |
| * Callback to provide information about a signed mixer control. |
| * |
| * Returns 0 for success. |
| */ |
| int snd_soc_info_volsw_s8(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_info *uinfo) |
| { |
| struct soc_mixer_control *mc = |
| (struct soc_mixer_control *)kcontrol->private_value; |
| int platform_max; |
| int min = mc->min; |
| |
| if (!mc->platform_max) |
| mc->platform_max = mc->max; |
| platform_max = mc->platform_max; |
| |
| uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; |
| uinfo->count = 2; |
| uinfo->value.integer.min = 0; |
| uinfo->value.integer.max = platform_max - min; |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_info_volsw_s8); |
| |
| /** |
| * snd_soc_get_volsw_s8 - signed mixer get callback |
| * @kcontrol: mixer control |
| * @ucontrol: control element information |
| * |
| * Callback to get the value of a signed mixer control. |
| * |
| * Returns 0 for success. |
| */ |
| int snd_soc_get_volsw_s8(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct soc_mixer_control *mc = |
| (struct soc_mixer_control *)kcontrol->private_value; |
| struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); |
| unsigned int reg = mc->reg; |
| unsigned int val; |
| int min = mc->min; |
| int ret; |
| |
| ret = snd_soc_component_read(component, reg, &val); |
| if (ret) |
| return ret; |
| |
| ucontrol->value.integer.value[0] = |
| ((signed char)(val & 0xff))-min; |
| ucontrol->value.integer.value[1] = |
| ((signed char)((val >> 8) & 0xff))-min; |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_get_volsw_s8); |
| |
| /** |
| * snd_soc_put_volsw_sgn - signed mixer put callback |
| * @kcontrol: mixer control |
| * @ucontrol: control element information |
| * |
| * Callback to set the value of a signed mixer control. |
| * |
| * Returns 0 for success. |
| */ |
| int snd_soc_put_volsw_s8(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct soc_mixer_control *mc = |
| (struct soc_mixer_control *)kcontrol->private_value; |
| struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); |
| unsigned int reg = mc->reg; |
| int min = mc->min; |
| unsigned int val; |
| |
| val = (ucontrol->value.integer.value[0]+min) & 0xff; |
| val |= ((ucontrol->value.integer.value[1]+min) & 0xff) << 8; |
| |
| return snd_soc_component_update_bits(component, reg, 0xffff, val); |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_put_volsw_s8); |
| |
| /** |
| * snd_soc_info_volsw_range - single mixer info callback with range. |
| * @kcontrol: mixer control |
| * @uinfo: control element information |
| * |
| * Callback to provide information, within a range, about a single |
| * mixer control. |
| * |
| * returns 0 for success. |
| */ |
| int snd_soc_info_volsw_range(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_info *uinfo) |
| { |
| struct soc_mixer_control *mc = |
| (struct soc_mixer_control *)kcontrol->private_value; |
| int platform_max; |
| int min = mc->min; |
| |
| if (!mc->platform_max) |
| mc->platform_max = mc->max; |
| platform_max = mc->platform_max; |
| |
| uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; |
| uinfo->count = snd_soc_volsw_is_stereo(mc) ? 2 : 1; |
| uinfo->value.integer.min = 0; |
| uinfo->value.integer.max = platform_max - min; |
| |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_info_volsw_range); |
| |
| /** |
| * snd_soc_put_volsw_range - single mixer put value callback with range. |
| * @kcontrol: mixer control |
| * @ucontrol: control element information |
| * |
| * Callback to set the value, within a range, for a single mixer control. |
| * |
| * Returns 0 for success. |
| */ |
| int snd_soc_put_volsw_range(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct soc_mixer_control *mc = |
| (struct soc_mixer_control *)kcontrol->private_value; |
| struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); |
| unsigned int reg = mc->reg; |
| unsigned int rreg = mc->rreg; |
| unsigned int shift = mc->shift; |
| int min = mc->min; |
| int max = mc->max; |
| unsigned int mask = (1 << fls(max)) - 1; |
| unsigned int invert = mc->invert; |
| unsigned int val, val_mask; |
| int ret; |
| |
| if (invert) |
| val = (max - ucontrol->value.integer.value[0]) & mask; |
| else |
| val = ((ucontrol->value.integer.value[0] + min) & mask); |
| val_mask = mask << shift; |
| val = val << shift; |
| |
| ret = snd_soc_component_update_bits(component, reg, val_mask, val); |
| if (ret < 0) |
| return ret; |
| |
| if (snd_soc_volsw_is_stereo(mc)) { |
| if (invert) |
| val = (max - ucontrol->value.integer.value[1]) & mask; |
| else |
| val = ((ucontrol->value.integer.value[1] + min) & mask); |
| val_mask = mask << shift; |
| val = val << shift; |
| |
| ret = snd_soc_component_update_bits(component, rreg, val_mask, |
| val); |
| } |
| |
| return ret; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_put_volsw_range); |
| |
| /** |
| * snd_soc_get_volsw_range - single mixer get callback with range |
| * @kcontrol: mixer control |
| * @ucontrol: control element information |
| * |
| * Callback to get the value, within a range, of a single mixer control. |
| * |
| * Returns 0 for success. |
| */ |
| int snd_soc_get_volsw_range(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); |
| struct soc_mixer_control *mc = |
| (struct soc_mixer_control *)kcontrol->private_value; |
| unsigned int reg = mc->reg; |
| unsigned int rreg = mc->rreg; |
| unsigned int shift = mc->shift; |
| int min = mc->min; |
| int max = mc->max; |
| unsigned int mask = (1 << fls(max)) - 1; |
| unsigned int invert = mc->invert; |
| unsigned int val; |
| int ret; |
| |
| ret = snd_soc_component_read(component, reg, &val); |
| if (ret) |
| return ret; |
| |
| ucontrol->value.integer.value[0] = (val >> shift) & mask; |
| if (invert) |
| ucontrol->value.integer.value[0] = |
| max - ucontrol->value.integer.value[0]; |
| else |
| ucontrol->value.integer.value[0] = |
| ucontrol->value.integer.value[0] - min; |
| |
| if (snd_soc_volsw_is_stereo(mc)) { |
| ret = snd_soc_component_read(component, rreg, &val); |
| if (ret) |
| return ret; |
| |
| ucontrol->value.integer.value[1] = (val >> shift) & mask; |
| if (invert) |
| ucontrol->value.integer.value[1] = |
| max - ucontrol->value.integer.value[1]; |
| else |
| ucontrol->value.integer.value[1] = |
| ucontrol->value.integer.value[1] - min; |
| } |
| |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_get_volsw_range); |
| |
| /** |
| * snd_soc_limit_volume - Set new limit to an existing volume control. |
| * |
| * @codec: where to look for the control |
| * @name: Name of the control |
| * @max: new maximum limit |
| * |
| * Return 0 for success, else error. |
| */ |
| int snd_soc_limit_volume(struct snd_soc_codec *codec, |
| const char *name, int max) |
| { |
| struct snd_card *card = codec->component.card->snd_card; |
| struct snd_kcontrol *kctl; |
| struct soc_mixer_control *mc; |
| int found = 0; |
| int ret = -EINVAL; |
| |
| /* Sanity check for name and max */ |
| if (unlikely(!name || max <= 0)) |
| return -EINVAL; |
| |
| list_for_each_entry(kctl, &card->controls, list) { |
| if (!strncmp(kctl->id.name, name, sizeof(kctl->id.name))) { |
| found = 1; |
| break; |
| } |
| } |
| if (found) { |
| mc = (struct soc_mixer_control *)kctl->private_value; |
| if (max <= mc->max) { |
| mc->platform_max = max; |
| ret = 0; |
| } |
| } |
| return ret; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_limit_volume); |
| |
| int snd_soc_bytes_info(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_info *uinfo) |
| { |
| struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); |
| struct soc_bytes *params = (void *)kcontrol->private_value; |
| |
| uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES; |
| uinfo->count = params->num_regs * component->val_bytes; |
| |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(snd_soc_bytes_info); |
| |
| int snd_soc_bytes_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); |
| struct soc_bytes *params = (void *)kcontrol->private_value; |
| int ret; |
| |
| if (component->regmap) |
| ret = regmap_raw_read(component->regmap, params->base, |
| ucontrol->value.bytes.data, |
| params->num_regs * component->val_bytes); |
| else |
| ret = -EINVAL; |
| |
| /* Hide any masked bytes to ensure consistent data reporting */ |
| if (ret == 0 && params->mask) { |
| switch (component->val_bytes) { |
| case 1: |
| ucontrol->value.bytes.data[0] &= ~params->mask; |
| break; |
| |