1db2a4165SFrank Mandarino /* 2db2a4165SFrank Mandarino * soc-core.c -- ALSA SoC Audio Layer 3db2a4165SFrank Mandarino * 4db2a4165SFrank Mandarino * Copyright 2005 Wolfson Microelectronics PLC. 50664d888SLiam Girdwood * Copyright 2005 Openedhand Ltd. 6*f0fba2adSLiam Girdwood * Copyright (C) 2010 Slimlogic Ltd. 7*f0fba2adSLiam Girdwood * Copyright (C) 2010 Texas Instruments Inc. 80664d888SLiam Girdwood * 9d331124dSLiam Girdwood * Author: Liam Girdwood <lrg@slimlogic.co.uk> 100664d888SLiam Girdwood * with code, comments and ideas from :- 110664d888SLiam Girdwood * Richard Purdie <richard@openedhand.com> 12db2a4165SFrank Mandarino * 13db2a4165SFrank Mandarino * This program is free software; you can redistribute it and/or modify it 14db2a4165SFrank Mandarino * under the terms of the GNU General Public License as published by the 15db2a4165SFrank Mandarino * Free Software Foundation; either version 2 of the License, or (at your 16db2a4165SFrank Mandarino * option) any later version. 17db2a4165SFrank Mandarino * 18db2a4165SFrank Mandarino * TODO: 19db2a4165SFrank Mandarino * o Add hw rules to enforce rates, etc. 20db2a4165SFrank Mandarino * o More testing with other codecs/machines. 21db2a4165SFrank Mandarino * o Add more codecs and platforms to ensure good API coverage. 22db2a4165SFrank Mandarino * o Support TDM on PCM and I2S 23db2a4165SFrank Mandarino */ 24db2a4165SFrank Mandarino 25db2a4165SFrank Mandarino #include <linux/module.h> 26db2a4165SFrank Mandarino #include <linux/moduleparam.h> 27db2a4165SFrank Mandarino #include <linux/init.h> 28db2a4165SFrank Mandarino #include <linux/delay.h> 29db2a4165SFrank Mandarino #include <linux/pm.h> 30db2a4165SFrank Mandarino #include <linux/bitops.h> 3112ef193dSTroy Kisky #include <linux/debugfs.h> 32db2a4165SFrank Mandarino #include <linux/platform_device.h> 335a0e3ad6STejun Heo #include <linux/slab.h> 34474828a4SMarek Vasut #include <sound/ac97_codec.h> 35db2a4165SFrank Mandarino #include <sound/core.h> 36db2a4165SFrank Mandarino #include <sound/pcm.h> 37db2a4165SFrank Mandarino #include <sound/pcm_params.h> 38db2a4165SFrank Mandarino #include <sound/soc.h> 39db2a4165SFrank Mandarino #include <sound/soc-dapm.h> 40db2a4165SFrank Mandarino #include <sound/initval.h> 41db2a4165SFrank Mandarino 42*f0fba2adSLiam Girdwood #define NAME_SIZE 32 43*f0fba2adSLiam Girdwood 44db2a4165SFrank Mandarino static DEFINE_MUTEX(pcm_mutex); 45db2a4165SFrank Mandarino static DECLARE_WAIT_QUEUE_HEAD(soc_pm_waitq); 46db2a4165SFrank Mandarino 47384c89e2SMark Brown #ifdef CONFIG_DEBUG_FS 48384c89e2SMark Brown static struct dentry *debugfs_root; 49384c89e2SMark Brown #endif 50384c89e2SMark Brown 51c5af3a2eSMark Brown static DEFINE_MUTEX(client_mutex); 52c5af3a2eSMark Brown static LIST_HEAD(card_list); 539115171aSMark Brown static LIST_HEAD(dai_list); 5412a48a8cSMark Brown static LIST_HEAD(platform_list); 550d0cf00aSMark Brown static LIST_HEAD(codec_list); 56c5af3a2eSMark Brown 57c5af3a2eSMark Brown static int snd_soc_register_card(struct snd_soc_card *card); 58c5af3a2eSMark Brown static int snd_soc_unregister_card(struct snd_soc_card *card); 59*f0fba2adSLiam Girdwood static int soc_new_pcm(struct snd_soc_pcm_runtime *rtd, int num); 60c5af3a2eSMark Brown 61db2a4165SFrank Mandarino /* 62db2a4165SFrank Mandarino * This is a timeout to do a DAPM powerdown after a stream is closed(). 63db2a4165SFrank Mandarino * It can be used to eliminate pops between different playback streams, e.g. 64db2a4165SFrank Mandarino * between two audio tracks. 65db2a4165SFrank Mandarino */ 66db2a4165SFrank Mandarino static int pmdown_time = 5000; 67db2a4165SFrank Mandarino module_param(pmdown_time, int, 0); 68db2a4165SFrank Mandarino MODULE_PARM_DESC(pmdown_time, "DAPM stream powerdown time (msecs)"); 69db2a4165SFrank Mandarino 70965ac42cSLiam Girdwood /* 71965ac42cSLiam Girdwood * This function forces any delayed work to be queued and run. 72965ac42cSLiam Girdwood */ 73965ac42cSLiam Girdwood static int run_delayed_work(struct delayed_work *dwork) 74965ac42cSLiam Girdwood { 75965ac42cSLiam Girdwood int ret; 76965ac42cSLiam Girdwood 77965ac42cSLiam Girdwood /* cancel any work waiting to be queued. */ 78965ac42cSLiam Girdwood ret = cancel_delayed_work(dwork); 79965ac42cSLiam Girdwood 80965ac42cSLiam Girdwood /* if there was any work waiting then we run it now and 81965ac42cSLiam Girdwood * wait for it's completion */ 82965ac42cSLiam Girdwood if (ret) { 83965ac42cSLiam Girdwood schedule_delayed_work(dwork, 0); 84965ac42cSLiam Girdwood flush_scheduled_work(); 85965ac42cSLiam Girdwood } 86965ac42cSLiam Girdwood return ret; 87965ac42cSLiam Girdwood } 88965ac42cSLiam Girdwood 892624d5faSMark Brown /* codec register dump */ 902624d5faSMark Brown static ssize_t soc_codec_reg_show(struct snd_soc_codec *codec, char *buf) 912624d5faSMark Brown { 925164d74dSMark Brown int ret, i, step = 1, count = 0; 932624d5faSMark Brown 94*f0fba2adSLiam Girdwood if (!codec->driver->reg_cache_size) 952624d5faSMark Brown return 0; 962624d5faSMark Brown 97*f0fba2adSLiam Girdwood if (codec->driver->reg_cache_step) 98*f0fba2adSLiam Girdwood step = codec->driver->reg_cache_step; 992624d5faSMark Brown 1002624d5faSMark Brown count += sprintf(buf, "%s registers\n", codec->name); 101*f0fba2adSLiam Girdwood for (i = 0; i < codec->driver->reg_cache_size; i += step) { 102*f0fba2adSLiam Girdwood if (codec->driver->readable_register && !codec->driver->readable_register(i)) 1032624d5faSMark Brown continue; 1042624d5faSMark Brown 1052624d5faSMark Brown count += sprintf(buf + count, "%2x: ", i); 1062624d5faSMark Brown if (count >= PAGE_SIZE - 1) 1072624d5faSMark Brown break; 1082624d5faSMark Brown 109*f0fba2adSLiam Girdwood if (codec->driver->display_register) { 110*f0fba2adSLiam Girdwood count += codec->driver->display_register(codec, buf + count, 1112624d5faSMark Brown PAGE_SIZE - count, i); 1125164d74dSMark Brown } else { 1135164d74dSMark Brown /* If the read fails it's almost certainly due to 1145164d74dSMark Brown * the register being volatile and the device being 1155164d74dSMark Brown * powered off. 1165164d74dSMark Brown */ 117*f0fba2adSLiam Girdwood ret = codec->driver->read(codec, i); 1185164d74dSMark Brown if (ret >= 0) 1195164d74dSMark Brown count += snprintf(buf + count, 1205164d74dSMark Brown PAGE_SIZE - count, 1215164d74dSMark Brown "%4x", ret); 1222624d5faSMark Brown else 1235164d74dSMark Brown count += snprintf(buf + count, 1245164d74dSMark Brown PAGE_SIZE - count, 1255164d74dSMark Brown "<no data: %d>", ret); 1265164d74dSMark Brown } 1272624d5faSMark Brown 1282624d5faSMark Brown if (count >= PAGE_SIZE - 1) 1292624d5faSMark Brown break; 1302624d5faSMark Brown 1312624d5faSMark Brown count += snprintf(buf + count, PAGE_SIZE - count, "\n"); 1322624d5faSMark Brown if (count >= PAGE_SIZE - 1) 1332624d5faSMark Brown break; 1342624d5faSMark Brown } 1352624d5faSMark Brown 1362624d5faSMark Brown /* Truncate count; min() would cause a warning */ 1372624d5faSMark Brown if (count >= PAGE_SIZE) 1382624d5faSMark Brown count = PAGE_SIZE - 1; 1392624d5faSMark Brown 1402624d5faSMark Brown return count; 1412624d5faSMark Brown } 1422624d5faSMark Brown static ssize_t codec_reg_show(struct device *dev, 1432624d5faSMark Brown struct device_attribute *attr, char *buf) 1442624d5faSMark Brown { 145*f0fba2adSLiam Girdwood struct snd_soc_pcm_runtime *rtd = 146*f0fba2adSLiam Girdwood container_of(dev, struct snd_soc_pcm_runtime, dev); 147*f0fba2adSLiam Girdwood 148*f0fba2adSLiam Girdwood return soc_codec_reg_show(rtd->codec, buf); 1492624d5faSMark Brown } 1502624d5faSMark Brown 1512624d5faSMark Brown static DEVICE_ATTR(codec_reg, 0444, codec_reg_show, NULL); 1522624d5faSMark Brown 153dbe21408SMark Brown static ssize_t pmdown_time_show(struct device *dev, 154dbe21408SMark Brown struct device_attribute *attr, char *buf) 155dbe21408SMark Brown { 156*f0fba2adSLiam Girdwood struct snd_soc_pcm_runtime *rtd = 157*f0fba2adSLiam Girdwood container_of(dev, struct snd_soc_pcm_runtime, dev); 158dbe21408SMark Brown 159*f0fba2adSLiam Girdwood return sprintf(buf, "%ld\n", rtd->pmdown_time); 160dbe21408SMark Brown } 161dbe21408SMark Brown 162dbe21408SMark Brown static ssize_t pmdown_time_set(struct device *dev, 163dbe21408SMark Brown struct device_attribute *attr, 164dbe21408SMark Brown const char *buf, size_t count) 165dbe21408SMark Brown { 166*f0fba2adSLiam Girdwood struct snd_soc_pcm_runtime *rtd = 167*f0fba2adSLiam Girdwood container_of(dev, struct snd_soc_pcm_runtime, dev); 168dbe21408SMark Brown 169*f0fba2adSLiam Girdwood strict_strtol(buf, 10, &rtd->pmdown_time); 170dbe21408SMark Brown 171dbe21408SMark Brown return count; 172dbe21408SMark Brown } 173dbe21408SMark Brown 174dbe21408SMark Brown static DEVICE_ATTR(pmdown_time, 0644, pmdown_time_show, pmdown_time_set); 175dbe21408SMark Brown 1762624d5faSMark Brown #ifdef CONFIG_DEBUG_FS 1772624d5faSMark Brown static int codec_reg_open_file(struct inode *inode, struct file *file) 1782624d5faSMark Brown { 1792624d5faSMark Brown file->private_data = inode->i_private; 1802624d5faSMark Brown return 0; 1812624d5faSMark Brown } 1822624d5faSMark Brown 1832624d5faSMark Brown static ssize_t codec_reg_read_file(struct file *file, char __user *user_buf, 1842624d5faSMark Brown size_t count, loff_t *ppos) 1852624d5faSMark Brown { 1862624d5faSMark Brown ssize_t ret; 1872624d5faSMark Brown struct snd_soc_codec *codec = file->private_data; 1882624d5faSMark Brown char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL); 1892624d5faSMark Brown if (!buf) 1902624d5faSMark Brown return -ENOMEM; 1912624d5faSMark Brown ret = soc_codec_reg_show(codec, buf); 1922624d5faSMark Brown if (ret >= 0) 1932624d5faSMark Brown ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret); 1942624d5faSMark Brown kfree(buf); 1952624d5faSMark Brown return ret; 1962624d5faSMark Brown } 1972624d5faSMark Brown 1982624d5faSMark Brown static ssize_t codec_reg_write_file(struct file *file, 1992624d5faSMark Brown const char __user *user_buf, size_t count, loff_t *ppos) 2002624d5faSMark Brown { 2012624d5faSMark Brown char buf[32]; 2022624d5faSMark Brown int buf_size; 2032624d5faSMark Brown char *start = buf; 2042624d5faSMark Brown unsigned long reg, value; 2052624d5faSMark Brown int step = 1; 2062624d5faSMark Brown struct snd_soc_codec *codec = file->private_data; 2072624d5faSMark Brown 2082624d5faSMark Brown buf_size = min(count, (sizeof(buf)-1)); 2092624d5faSMark Brown if (copy_from_user(buf, user_buf, buf_size)) 2102624d5faSMark Brown return -EFAULT; 2112624d5faSMark Brown buf[buf_size] = 0; 2122624d5faSMark Brown 213*f0fba2adSLiam Girdwood if (codec->driver->reg_cache_step) 214*f0fba2adSLiam Girdwood step = codec->driver->reg_cache_step; 2152624d5faSMark Brown 2162624d5faSMark Brown while (*start == ' ') 2172624d5faSMark Brown start++; 2182624d5faSMark Brown reg = simple_strtoul(start, &start, 16); 219*f0fba2adSLiam Girdwood if ((reg >= codec->driver->reg_cache_size) || (reg % step)) 2202624d5faSMark Brown return -EINVAL; 2212624d5faSMark Brown while (*start == ' ') 2222624d5faSMark Brown start++; 2232624d5faSMark Brown if (strict_strtoul(start, 16, &value)) 2242624d5faSMark Brown return -EINVAL; 225*f0fba2adSLiam Girdwood codec->driver->write(codec, reg, value); 2262624d5faSMark Brown return buf_size; 2272624d5faSMark Brown } 2282624d5faSMark Brown 2292624d5faSMark Brown static const struct file_operations codec_reg_fops = { 2302624d5faSMark Brown .open = codec_reg_open_file, 2312624d5faSMark Brown .read = codec_reg_read_file, 2322624d5faSMark Brown .write = codec_reg_write_file, 2332624d5faSMark Brown }; 2342624d5faSMark Brown 2352624d5faSMark Brown static void soc_init_codec_debugfs(struct snd_soc_codec *codec) 2362624d5faSMark Brown { 2372624d5faSMark Brown char codec_root[128]; 2382624d5faSMark Brown 2392624d5faSMark Brown if (codec->dev) 2402624d5faSMark Brown snprintf(codec_root, sizeof(codec_root), 2412624d5faSMark Brown "%s.%s", codec->name, dev_name(codec->dev)); 2422624d5faSMark Brown else 2432624d5faSMark Brown snprintf(codec_root, sizeof(codec_root), 2442624d5faSMark Brown "%s", codec->name); 2452624d5faSMark Brown 2462624d5faSMark Brown codec->debugfs_codec_root = debugfs_create_dir(codec_root, 2472624d5faSMark Brown debugfs_root); 2482624d5faSMark Brown if (!codec->debugfs_codec_root) { 2492624d5faSMark Brown printk(KERN_WARNING 2502624d5faSMark Brown "ASoC: Failed to create codec debugfs directory\n"); 2512624d5faSMark Brown return; 2522624d5faSMark Brown } 2532624d5faSMark Brown 2542624d5faSMark Brown codec->debugfs_reg = debugfs_create_file("codec_reg", 0644, 2552624d5faSMark Brown codec->debugfs_codec_root, 2562624d5faSMark Brown codec, &codec_reg_fops); 2572624d5faSMark Brown if (!codec->debugfs_reg) 2582624d5faSMark Brown printk(KERN_WARNING 2592624d5faSMark Brown "ASoC: Failed to create codec register debugfs file\n"); 2602624d5faSMark Brown 2612624d5faSMark Brown codec->debugfs_pop_time = debugfs_create_u32("dapm_pop_time", 0744, 2622624d5faSMark Brown codec->debugfs_codec_root, 2632624d5faSMark Brown &codec->pop_time); 2642624d5faSMark Brown if (!codec->debugfs_pop_time) 2652624d5faSMark Brown printk(KERN_WARNING 2662624d5faSMark Brown "Failed to create pop time debugfs file\n"); 2672624d5faSMark Brown 2682624d5faSMark Brown codec->debugfs_dapm = debugfs_create_dir("dapm", 2692624d5faSMark Brown codec->debugfs_codec_root); 2702624d5faSMark Brown if (!codec->debugfs_dapm) 2712624d5faSMark Brown printk(KERN_WARNING 2722624d5faSMark Brown "Failed to create DAPM debugfs directory\n"); 2732624d5faSMark Brown 2742624d5faSMark Brown snd_soc_dapm_debugfs_init(codec); 2752624d5faSMark Brown } 2762624d5faSMark Brown 2772624d5faSMark Brown static void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec) 2782624d5faSMark Brown { 2792624d5faSMark Brown debugfs_remove_recursive(codec->debugfs_codec_root); 2802624d5faSMark Brown } 2812624d5faSMark Brown 2822624d5faSMark Brown #else 2832624d5faSMark Brown 2842624d5faSMark Brown static inline void soc_init_codec_debugfs(struct snd_soc_codec *codec) 2852624d5faSMark Brown { 2862624d5faSMark Brown } 2872624d5faSMark Brown 2882624d5faSMark Brown static inline void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec) 2892624d5faSMark Brown { 2902624d5faSMark Brown } 2912624d5faSMark Brown #endif 2922624d5faSMark Brown 293db2a4165SFrank Mandarino #ifdef CONFIG_SND_SOC_AC97_BUS 294db2a4165SFrank Mandarino /* unregister ac97 codec */ 295db2a4165SFrank Mandarino static int soc_ac97_dev_unregister(struct snd_soc_codec *codec) 296db2a4165SFrank Mandarino { 297db2a4165SFrank Mandarino if (codec->ac97->dev.bus) 298db2a4165SFrank Mandarino device_unregister(&codec->ac97->dev); 299db2a4165SFrank Mandarino return 0; 300db2a4165SFrank Mandarino } 301db2a4165SFrank Mandarino 302db2a4165SFrank Mandarino /* stop no dev release warning */ 303db2a4165SFrank Mandarino static void soc_ac97_device_release(struct device *dev){} 304db2a4165SFrank Mandarino 305db2a4165SFrank Mandarino /* register ac97 codec to bus */ 306db2a4165SFrank Mandarino static int soc_ac97_dev_register(struct snd_soc_codec *codec) 307db2a4165SFrank Mandarino { 308db2a4165SFrank Mandarino int err; 309db2a4165SFrank Mandarino 310db2a4165SFrank Mandarino codec->ac97->dev.bus = &ac97_bus_type; 3114ac5c61fSMark Brown codec->ac97->dev.parent = codec->card->dev; 312db2a4165SFrank Mandarino codec->ac97->dev.release = soc_ac97_device_release; 313db2a4165SFrank Mandarino 314bb072bf0SKay Sievers dev_set_name(&codec->ac97->dev, "%d-%d:%s", 315*f0fba2adSLiam Girdwood codec->card->snd_card->number, 0, codec->name); 316db2a4165SFrank Mandarino err = device_register(&codec->ac97->dev); 317db2a4165SFrank Mandarino if (err < 0) { 318db2a4165SFrank Mandarino snd_printk(KERN_ERR "Can't register ac97 bus\n"); 319db2a4165SFrank Mandarino codec->ac97->dev.bus = NULL; 320db2a4165SFrank Mandarino return err; 321db2a4165SFrank Mandarino } 322db2a4165SFrank Mandarino return 0; 323db2a4165SFrank Mandarino } 324db2a4165SFrank Mandarino #endif 325db2a4165SFrank Mandarino 32606f409d7SMark Brown static int soc_pcm_apply_symmetry(struct snd_pcm_substream *substream) 32706f409d7SMark Brown { 32806f409d7SMark Brown struct snd_soc_pcm_runtime *rtd = substream->private_data; 329*f0fba2adSLiam Girdwood struct snd_soc_dai *cpu_dai = rtd->cpu_dai; 330*f0fba2adSLiam Girdwood struct snd_soc_dai *codec_dai = rtd->codec_dai; 33106f409d7SMark Brown int ret; 33206f409d7SMark Brown 333*f0fba2adSLiam Girdwood if (codec_dai->driver->symmetric_rates || cpu_dai->driver->symmetric_rates || 334*f0fba2adSLiam Girdwood rtd->dai_link->symmetric_rates) { 335*f0fba2adSLiam Girdwood dev_dbg(&rtd->dev, "Symmetry forces %dHz rate\n", 336*f0fba2adSLiam Girdwood rtd->rate); 33706f409d7SMark Brown 33806f409d7SMark Brown ret = snd_pcm_hw_constraint_minmax(substream->runtime, 33906f409d7SMark Brown SNDRV_PCM_HW_PARAM_RATE, 340*f0fba2adSLiam Girdwood rtd->rate, 341*f0fba2adSLiam Girdwood rtd->rate); 34206f409d7SMark Brown if (ret < 0) { 343*f0fba2adSLiam Girdwood dev_err(&rtd->dev, 34406f409d7SMark Brown "Unable to apply rate symmetry constraint: %d\n", ret); 34506f409d7SMark Brown return ret; 34606f409d7SMark Brown } 34706f409d7SMark Brown } 34806f409d7SMark Brown 34906f409d7SMark Brown return 0; 35006f409d7SMark Brown } 35106f409d7SMark Brown 352db2a4165SFrank Mandarino /* 353db2a4165SFrank Mandarino * Called by ALSA when a PCM substream is opened, the runtime->hw record is 354db2a4165SFrank Mandarino * then initialized and any private data can be allocated. This also calls 355db2a4165SFrank Mandarino * startup for the cpu DAI, platform, machine and codec DAI. 356db2a4165SFrank Mandarino */ 357db2a4165SFrank Mandarino static int soc_pcm_open(struct snd_pcm_substream *substream) 358db2a4165SFrank Mandarino { 359db2a4165SFrank Mandarino struct snd_soc_pcm_runtime *rtd = substream->private_data; 360db2a4165SFrank Mandarino struct snd_pcm_runtime *runtime = substream->runtime; 361*f0fba2adSLiam Girdwood struct snd_soc_platform *platform = rtd->platform; 362*f0fba2adSLiam Girdwood struct snd_soc_dai *cpu_dai = rtd->cpu_dai; 363*f0fba2adSLiam Girdwood struct snd_soc_dai *codec_dai = rtd->codec_dai; 364*f0fba2adSLiam Girdwood struct snd_soc_dai_driver *cpu_dai_drv = cpu_dai->driver; 365*f0fba2adSLiam Girdwood struct snd_soc_dai_driver *codec_dai_drv = codec_dai->driver; 366db2a4165SFrank Mandarino int ret = 0; 367db2a4165SFrank Mandarino 368db2a4165SFrank Mandarino mutex_lock(&pcm_mutex); 369db2a4165SFrank Mandarino 370db2a4165SFrank Mandarino /* startup the audio subsystem */ 371*f0fba2adSLiam Girdwood if (cpu_dai->driver->ops->startup) { 372*f0fba2adSLiam Girdwood ret = cpu_dai->driver->ops->startup(substream, cpu_dai); 373db2a4165SFrank Mandarino if (ret < 0) { 374db2a4165SFrank Mandarino printk(KERN_ERR "asoc: can't open interface %s\n", 375cb666e5bSLiam Girdwood cpu_dai->name); 376db2a4165SFrank Mandarino goto out; 377db2a4165SFrank Mandarino } 378db2a4165SFrank Mandarino } 379db2a4165SFrank Mandarino 380*f0fba2adSLiam Girdwood if (platform->driver->ops->open) { 381*f0fba2adSLiam Girdwood ret = platform->driver->ops->open(substream); 382db2a4165SFrank Mandarino if (ret < 0) { 383db2a4165SFrank Mandarino printk(KERN_ERR "asoc: can't open platform %s\n", platform->name); 384db2a4165SFrank Mandarino goto platform_err; 385db2a4165SFrank Mandarino } 386db2a4165SFrank Mandarino } 387db2a4165SFrank Mandarino 388*f0fba2adSLiam Girdwood if (codec_dai->driver->ops->startup) { 389*f0fba2adSLiam Girdwood ret = codec_dai->driver->ops->startup(substream, codec_dai); 390cb666e5bSLiam Girdwood if (ret < 0) { 391cb666e5bSLiam Girdwood printk(KERN_ERR "asoc: can't open codec %s\n", 392cb666e5bSLiam Girdwood codec_dai->name); 393cb666e5bSLiam Girdwood goto codec_dai_err; 394cb666e5bSLiam Girdwood } 395cb666e5bSLiam Girdwood } 396cb666e5bSLiam Girdwood 397*f0fba2adSLiam Girdwood if (rtd->dai_link->ops && rtd->dai_link->ops->startup) { 398*f0fba2adSLiam Girdwood ret = rtd->dai_link->ops->startup(substream); 399db2a4165SFrank Mandarino if (ret < 0) { 400*f0fba2adSLiam Girdwood printk(KERN_ERR "asoc: %s startup failed\n", rtd->dai_link->name); 401db2a4165SFrank Mandarino goto machine_err; 402db2a4165SFrank Mandarino } 403db2a4165SFrank Mandarino } 404db2a4165SFrank Mandarino 405db2a4165SFrank Mandarino /* Check that the codec and cpu DAI's are compatible */ 406db2a4165SFrank Mandarino if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { 407db2a4165SFrank Mandarino runtime->hw.rate_min = 408*f0fba2adSLiam Girdwood max(codec_dai_drv->playback.rate_min, 409*f0fba2adSLiam Girdwood cpu_dai_drv->playback.rate_min); 410db2a4165SFrank Mandarino runtime->hw.rate_max = 411*f0fba2adSLiam Girdwood min(codec_dai_drv->playback.rate_max, 412*f0fba2adSLiam Girdwood cpu_dai_drv->playback.rate_max); 413db2a4165SFrank Mandarino runtime->hw.channels_min = 414*f0fba2adSLiam Girdwood max(codec_dai_drv->playback.channels_min, 415*f0fba2adSLiam Girdwood cpu_dai_drv->playback.channels_min); 416db2a4165SFrank Mandarino runtime->hw.channels_max = 417*f0fba2adSLiam Girdwood min(codec_dai_drv->playback.channels_max, 418*f0fba2adSLiam Girdwood cpu_dai_drv->playback.channels_max); 419cb666e5bSLiam Girdwood runtime->hw.formats = 420*f0fba2adSLiam Girdwood codec_dai_drv->playback.formats & cpu_dai_drv->playback.formats; 421cb666e5bSLiam Girdwood runtime->hw.rates = 422*f0fba2adSLiam Girdwood codec_dai_drv->playback.rates & cpu_dai_drv->playback.rates; 423*f0fba2adSLiam Girdwood if (codec_dai_drv->playback.rates 424d9ad6296SJassi Brar & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS)) 425*f0fba2adSLiam Girdwood runtime->hw.rates |= cpu_dai_drv->playback.rates; 426*f0fba2adSLiam Girdwood if (cpu_dai_drv->playback.rates 427d9ad6296SJassi Brar & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS)) 428*f0fba2adSLiam Girdwood runtime->hw.rates |= codec_dai_drv->playback.rates; 429db2a4165SFrank Mandarino } else { 430db2a4165SFrank Mandarino runtime->hw.rate_min = 431*f0fba2adSLiam Girdwood max(codec_dai_drv->capture.rate_min, 432*f0fba2adSLiam Girdwood cpu_dai_drv->capture.rate_min); 433db2a4165SFrank Mandarino runtime->hw.rate_max = 434*f0fba2adSLiam Girdwood min(codec_dai_drv->capture.rate_max, 435*f0fba2adSLiam Girdwood cpu_dai_drv->capture.rate_max); 436db2a4165SFrank Mandarino runtime->hw.channels_min = 437*f0fba2adSLiam Girdwood max(codec_dai_drv->capture.channels_min, 438*f0fba2adSLiam Girdwood cpu_dai_drv->capture.channels_min); 439db2a4165SFrank Mandarino runtime->hw.channels_max = 440*f0fba2adSLiam Girdwood min(codec_dai_drv->capture.channels_max, 441*f0fba2adSLiam Girdwood cpu_dai_drv->capture.channels_max); 442cb666e5bSLiam Girdwood runtime->hw.formats = 443*f0fba2adSLiam Girdwood codec_dai_drv->capture.formats & cpu_dai_drv->capture.formats; 444cb666e5bSLiam Girdwood runtime->hw.rates = 445*f0fba2adSLiam Girdwood codec_dai_drv->capture.rates & cpu_dai_drv->capture.rates; 446*f0fba2adSLiam Girdwood if (codec_dai_drv->capture.rates 447d9ad6296SJassi Brar & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS)) 448*f0fba2adSLiam Girdwood runtime->hw.rates |= cpu_dai_drv->capture.rates; 449*f0fba2adSLiam Girdwood if (cpu_dai_drv->capture.rates 450d9ad6296SJassi Brar & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS)) 451*f0fba2adSLiam Girdwood runtime->hw.rates |= codec_dai_drv->capture.rates; 452db2a4165SFrank Mandarino } 453db2a4165SFrank Mandarino 454db2a4165SFrank Mandarino snd_pcm_limit_hw_rates(runtime); 455db2a4165SFrank Mandarino if (!runtime->hw.rates) { 456db2a4165SFrank Mandarino printk(KERN_ERR "asoc: %s <-> %s No matching rates\n", 457cb666e5bSLiam Girdwood codec_dai->name, cpu_dai->name); 458bb1c0478SJassi Brar goto config_err; 459db2a4165SFrank Mandarino } 460db2a4165SFrank Mandarino if (!runtime->hw.formats) { 461db2a4165SFrank Mandarino printk(KERN_ERR "asoc: %s <-> %s No matching formats\n", 462cb666e5bSLiam Girdwood codec_dai->name, cpu_dai->name); 463bb1c0478SJassi Brar goto config_err; 464db2a4165SFrank Mandarino } 465db2a4165SFrank Mandarino if (!runtime->hw.channels_min || !runtime->hw.channels_max) { 466db2a4165SFrank Mandarino printk(KERN_ERR "asoc: %s <-> %s No matching channels\n", 467cb666e5bSLiam Girdwood codec_dai->name, cpu_dai->name); 468bb1c0478SJassi Brar goto config_err; 469db2a4165SFrank Mandarino } 470db2a4165SFrank Mandarino 47106f409d7SMark Brown /* Symmetry only applies if we've already got an active stream. */ 47206f409d7SMark Brown if (cpu_dai->active || codec_dai->active) { 47306f409d7SMark Brown ret = soc_pcm_apply_symmetry(substream); 47406f409d7SMark Brown if (ret != 0) 475bb1c0478SJassi Brar goto config_err; 47606f409d7SMark Brown } 47706f409d7SMark Brown 478*f0fba2adSLiam Girdwood pr_debug("asoc: %s <-> %s info:\n", 479*f0fba2adSLiam Girdwood codec_dai->name, cpu_dai->name); 480f24368c2SMark Brown pr_debug("asoc: rate mask 0x%x\n", runtime->hw.rates); 481f24368c2SMark Brown pr_debug("asoc: min ch %d max ch %d\n", runtime->hw.channels_min, 482b5c5fd24SLiam Girdwood runtime->hw.channels_max); 483f24368c2SMark Brown pr_debug("asoc: min rate %d max rate %d\n", runtime->hw.rate_min, 484b5c5fd24SLiam Girdwood runtime->hw.rate_max); 485db2a4165SFrank Mandarino 48614dc5734SJassi Brar if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { 487*f0fba2adSLiam Girdwood cpu_dai->playback_active++; 488*f0fba2adSLiam Girdwood codec_dai->playback_active++; 48914dc5734SJassi Brar } else { 490*f0fba2adSLiam Girdwood cpu_dai->capture_active++; 491*f0fba2adSLiam Girdwood codec_dai->capture_active++; 49214dc5734SJassi Brar } 49314dc5734SJassi Brar cpu_dai->active++; 49414dc5734SJassi Brar codec_dai->active++; 495*f0fba2adSLiam Girdwood rtd->codec->active++; 496db2a4165SFrank Mandarino mutex_unlock(&pcm_mutex); 497db2a4165SFrank Mandarino return 0; 498db2a4165SFrank Mandarino 499bb1c0478SJassi Brar config_err: 500*f0fba2adSLiam Girdwood if (rtd->dai_link->ops && rtd->dai_link->ops->shutdown) 501*f0fba2adSLiam Girdwood rtd->dai_link->ops->shutdown(substream); 502db2a4165SFrank Mandarino 503bb1c0478SJassi Brar machine_err: 504*f0fba2adSLiam Girdwood if (codec_dai->driver->ops->shutdown) 505*f0fba2adSLiam Girdwood codec_dai->driver->ops->shutdown(substream, codec_dai); 506bb1c0478SJassi Brar 507cb666e5bSLiam Girdwood codec_dai_err: 508*f0fba2adSLiam Girdwood if (platform->driver->ops->close) 509*f0fba2adSLiam Girdwood platform->driver->ops->close(substream); 510db2a4165SFrank Mandarino 511db2a4165SFrank Mandarino platform_err: 512*f0fba2adSLiam Girdwood if (cpu_dai->driver->ops->shutdown) 513*f0fba2adSLiam Girdwood cpu_dai->driver->ops->shutdown(substream, cpu_dai); 514db2a4165SFrank Mandarino out: 515db2a4165SFrank Mandarino mutex_unlock(&pcm_mutex); 516db2a4165SFrank Mandarino return ret; 517db2a4165SFrank Mandarino } 518db2a4165SFrank Mandarino 519db2a4165SFrank Mandarino /* 5203a4fa0a2SRobert P. J. Day * Power down the audio subsystem pmdown_time msecs after close is called. 521db2a4165SFrank Mandarino * This is to ensure there are no pops or clicks in between any music tracks 522db2a4165SFrank Mandarino * due to DAPM power cycling. 523db2a4165SFrank Mandarino */ 5244484bb2eSAndrew Morton static void close_delayed_work(struct work_struct *work) 525db2a4165SFrank Mandarino { 526*f0fba2adSLiam Girdwood struct snd_soc_pcm_runtime *rtd = 527*f0fba2adSLiam Girdwood container_of(work, struct snd_soc_pcm_runtime, delayed_work.work); 528*f0fba2adSLiam Girdwood struct snd_soc_dai *codec_dai = rtd->codec_dai; 529db2a4165SFrank Mandarino 530db2a4165SFrank Mandarino mutex_lock(&pcm_mutex); 531db2a4165SFrank Mandarino 532f24368c2SMark Brown pr_debug("pop wq checking: %s status: %s waiting: %s\n", 533*f0fba2adSLiam Girdwood codec_dai->driver->playback.stream_name, 534*f0fba2adSLiam Girdwood codec_dai->playback_active ? "active" : "inactive", 535db2a4165SFrank Mandarino codec_dai->pop_wait ? "yes" : "no"); 536db2a4165SFrank Mandarino 537db2a4165SFrank Mandarino /* are we waiting on this codec DAI stream */ 538db2a4165SFrank Mandarino if (codec_dai->pop_wait == 1) { 539db2a4165SFrank Mandarino codec_dai->pop_wait = 0; 540*f0fba2adSLiam Girdwood snd_soc_dapm_stream_event(rtd, 541*f0fba2adSLiam Girdwood codec_dai->driver->playback.stream_name, 542db2a4165SFrank Mandarino SND_SOC_DAPM_STREAM_STOP); 543db2a4165SFrank Mandarino } 544*f0fba2adSLiam Girdwood 545db2a4165SFrank Mandarino mutex_unlock(&pcm_mutex); 546db2a4165SFrank Mandarino } 547db2a4165SFrank Mandarino 548db2a4165SFrank Mandarino /* 549db2a4165SFrank Mandarino * Called by ALSA when a PCM substream is closed. Private data can be 550db2a4165SFrank Mandarino * freed here. The cpu DAI, codec DAI, machine and platform are also 551db2a4165SFrank Mandarino * shutdown. 552db2a4165SFrank Mandarino */ 553db2a4165SFrank Mandarino static int soc_codec_close(struct snd_pcm_substream *substream) 554db2a4165SFrank Mandarino { 555db2a4165SFrank Mandarino struct snd_soc_pcm_runtime *rtd = substream->private_data; 556*f0fba2adSLiam Girdwood struct snd_soc_platform *platform = rtd->platform; 557*f0fba2adSLiam Girdwood struct snd_soc_dai *cpu_dai = rtd->cpu_dai; 558*f0fba2adSLiam Girdwood struct snd_soc_dai *codec_dai = rtd->codec_dai; 559*f0fba2adSLiam Girdwood struct snd_soc_codec *codec = rtd->codec; 560db2a4165SFrank Mandarino 561db2a4165SFrank Mandarino mutex_lock(&pcm_mutex); 562db2a4165SFrank Mandarino 56314dc5734SJassi Brar if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { 564*f0fba2adSLiam Girdwood cpu_dai->playback_active--; 565*f0fba2adSLiam Girdwood codec_dai->playback_active--; 56614dc5734SJassi Brar } else { 567*f0fba2adSLiam Girdwood cpu_dai->capture_active--; 568*f0fba2adSLiam Girdwood codec_dai->capture_active--; 569db2a4165SFrank Mandarino } 57014dc5734SJassi Brar 57114dc5734SJassi Brar cpu_dai->active--; 57214dc5734SJassi Brar codec_dai->active--; 573db2a4165SFrank Mandarino codec->active--; 574db2a4165SFrank Mandarino 5756010b2daSMark Brown /* Muting the DAC suppresses artifacts caused during digital 5766010b2daSMark Brown * shutdown, for example from stopping clocks. 5776010b2daSMark Brown */ 5786010b2daSMark Brown if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 5796010b2daSMark Brown snd_soc_dai_digital_mute(codec_dai, 1); 5806010b2daSMark Brown 581*f0fba2adSLiam Girdwood if (cpu_dai->driver->ops->shutdown) 582*f0fba2adSLiam Girdwood cpu_dai->driver->ops->shutdown(substream, cpu_dai); 583db2a4165SFrank Mandarino 584*f0fba2adSLiam Girdwood if (codec_dai->driver->ops->shutdown) 585*f0fba2adSLiam Girdwood codec_dai->driver->ops->shutdown(substream, codec_dai); 586db2a4165SFrank Mandarino 587*f0fba2adSLiam Girdwood if (rtd->dai_link->ops && rtd->dai_link->ops->shutdown) 588*f0fba2adSLiam Girdwood rtd->dai_link->ops->shutdown(substream); 589db2a4165SFrank Mandarino 590*f0fba2adSLiam Girdwood if (platform->driver->ops->close) 591*f0fba2adSLiam Girdwood platform->driver->ops->close(substream); 592*f0fba2adSLiam Girdwood cpu_dai->runtime = NULL; 593db2a4165SFrank Mandarino 594db2a4165SFrank Mandarino if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { 595db2a4165SFrank Mandarino /* start delayed pop wq here for playback streams */ 596cb666e5bSLiam Girdwood codec_dai->pop_wait = 1; 597*f0fba2adSLiam Girdwood schedule_delayed_work(&rtd->delayed_work, 598*f0fba2adSLiam Girdwood msecs_to_jiffies(rtd->pmdown_time)); 599db2a4165SFrank Mandarino } else { 600db2a4165SFrank Mandarino /* capture streams can be powered down now */ 601*f0fba2adSLiam Girdwood snd_soc_dapm_stream_event(rtd, 602*f0fba2adSLiam Girdwood codec_dai->driver->capture.stream_name, 6030b4d221bSLiam Girdwood SND_SOC_DAPM_STREAM_STOP); 604db2a4165SFrank Mandarino } 605db2a4165SFrank Mandarino 606db2a4165SFrank Mandarino mutex_unlock(&pcm_mutex); 607db2a4165SFrank Mandarino return 0; 608db2a4165SFrank Mandarino } 609db2a4165SFrank Mandarino 610db2a4165SFrank Mandarino /* 611db2a4165SFrank Mandarino * Called by ALSA when the PCM substream is prepared, can set format, sample 612db2a4165SFrank Mandarino * rate, etc. This function is non atomic and can be called multiple times, 613db2a4165SFrank Mandarino * it can refer to the runtime info. 614db2a4165SFrank Mandarino */ 615db2a4165SFrank Mandarino static int soc_pcm_prepare(struct snd_pcm_substream *substream) 616db2a4165SFrank Mandarino { 617db2a4165SFrank Mandarino struct snd_soc_pcm_runtime *rtd = substream->private_data; 618*f0fba2adSLiam Girdwood struct snd_soc_platform *platform = rtd->platform; 619*f0fba2adSLiam Girdwood struct snd_soc_dai *cpu_dai = rtd->cpu_dai; 620*f0fba2adSLiam Girdwood struct snd_soc_dai *codec_dai = rtd->codec_dai; 621db2a4165SFrank Mandarino int ret = 0; 622db2a4165SFrank Mandarino 623db2a4165SFrank Mandarino mutex_lock(&pcm_mutex); 624cb666e5bSLiam Girdwood 625*f0fba2adSLiam Girdwood if (rtd->dai_link->ops && rtd->dai_link->ops->prepare) { 626*f0fba2adSLiam Girdwood ret = rtd->dai_link->ops->prepare(substream); 627cb666e5bSLiam Girdwood if (ret < 0) { 628cb666e5bSLiam Girdwood printk(KERN_ERR "asoc: machine prepare error\n"); 629cb666e5bSLiam Girdwood goto out; 630cb666e5bSLiam Girdwood } 631cb666e5bSLiam Girdwood } 632cb666e5bSLiam Girdwood 633*f0fba2adSLiam Girdwood if (platform->driver->ops->prepare) { 634*f0fba2adSLiam Girdwood ret = platform->driver->ops->prepare(substream); 635a71a468aSLiam Girdwood if (ret < 0) { 636a71a468aSLiam Girdwood printk(KERN_ERR "asoc: platform prepare error\n"); 637db2a4165SFrank Mandarino goto out; 638db2a4165SFrank Mandarino } 639a71a468aSLiam Girdwood } 640db2a4165SFrank Mandarino 641*f0fba2adSLiam Girdwood if (codec_dai->driver->ops->prepare) { 642*f0fba2adSLiam Girdwood ret = codec_dai->driver->ops->prepare(substream, codec_dai); 643a71a468aSLiam Girdwood if (ret < 0) { 644a71a468aSLiam Girdwood printk(KERN_ERR "asoc: codec DAI prepare error\n"); 645db2a4165SFrank Mandarino goto out; 646db2a4165SFrank Mandarino } 647a71a468aSLiam Girdwood } 648db2a4165SFrank Mandarino 649*f0fba2adSLiam Girdwood if (cpu_dai->driver->ops->prepare) { 650*f0fba2adSLiam Girdwood ret = cpu_dai->driver->ops->prepare(substream, cpu_dai); 651cb666e5bSLiam Girdwood if (ret < 0) { 652cb666e5bSLiam Girdwood printk(KERN_ERR "asoc: cpu DAI prepare error\n"); 653cb666e5bSLiam Girdwood goto out; 654cb666e5bSLiam Girdwood } 655cb666e5bSLiam Girdwood } 656db2a4165SFrank Mandarino 657d45f6219SMark Brown /* cancel any delayed stream shutdown that is pending */ 658d45f6219SMark Brown if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK && 659d45f6219SMark Brown codec_dai->pop_wait) { 660cb666e5bSLiam Girdwood codec_dai->pop_wait = 0; 661*f0fba2adSLiam Girdwood cancel_delayed_work(&rtd->delayed_work); 662db2a4165SFrank Mandarino } 663db2a4165SFrank Mandarino 664db2a4165SFrank Mandarino if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 665*f0fba2adSLiam Girdwood snd_soc_dapm_stream_event(rtd, 666*f0fba2adSLiam Girdwood codec_dai->driver->playback.stream_name, 667db2a4165SFrank Mandarino SND_SOC_DAPM_STREAM_START); 668db2a4165SFrank Mandarino else 669*f0fba2adSLiam Girdwood snd_soc_dapm_stream_event(rtd, 670*f0fba2adSLiam Girdwood codec_dai->driver->capture.stream_name, 671db2a4165SFrank Mandarino SND_SOC_DAPM_STREAM_START); 6728c6529dbSLiam Girdwood 6738c6529dbSLiam Girdwood snd_soc_dai_digital_mute(codec_dai, 0); 674db2a4165SFrank Mandarino 675db2a4165SFrank Mandarino out: 676db2a4165SFrank Mandarino mutex_unlock(&pcm_mutex); 677db2a4165SFrank Mandarino return ret; 678db2a4165SFrank Mandarino } 679db2a4165SFrank Mandarino 680db2a4165SFrank Mandarino /* 681db2a4165SFrank Mandarino * Called by ALSA when the hardware params are set by application. This 682db2a4165SFrank Mandarino * function can also be called multiple times and can allocate buffers 683db2a4165SFrank Mandarino * (using snd_pcm_lib_* ). It's non-atomic. 684db2a4165SFrank Mandarino */ 685db2a4165SFrank Mandarino static int soc_pcm_hw_params(struct snd_pcm_substream *substream, 686db2a4165SFrank Mandarino struct snd_pcm_hw_params *params) 687db2a4165SFrank Mandarino { 688db2a4165SFrank Mandarino struct snd_soc_pcm_runtime *rtd = substream->private_data; 689*f0fba2adSLiam Girdwood struct snd_soc_platform *platform = rtd->platform; 690*f0fba2adSLiam Girdwood struct snd_soc_dai *cpu_dai = rtd->cpu_dai; 691*f0fba2adSLiam Girdwood struct snd_soc_dai *codec_dai = rtd->codec_dai; 692db2a4165SFrank Mandarino int ret = 0; 693db2a4165SFrank Mandarino 694db2a4165SFrank Mandarino mutex_lock(&pcm_mutex); 695db2a4165SFrank Mandarino 696*f0fba2adSLiam Girdwood if (rtd->dai_link->ops && rtd->dai_link->ops->hw_params) { 697*f0fba2adSLiam Girdwood ret = rtd->dai_link->ops->hw_params(substream, params); 698cb666e5bSLiam Girdwood if (ret < 0) { 699cb666e5bSLiam Girdwood printk(KERN_ERR "asoc: machine hw_params failed\n"); 700db2a4165SFrank Mandarino goto out; 701db2a4165SFrank Mandarino } 702cb666e5bSLiam Girdwood } 703db2a4165SFrank Mandarino 704*f0fba2adSLiam Girdwood if (codec_dai->driver->ops->hw_params) { 705*f0fba2adSLiam Girdwood ret = codec_dai->driver->ops->hw_params(substream, params, codec_dai); 706db2a4165SFrank Mandarino if (ret < 0) { 707db2a4165SFrank Mandarino printk(KERN_ERR "asoc: can't set codec %s hw params\n", 708cb666e5bSLiam Girdwood codec_dai->name); 709cb666e5bSLiam Girdwood goto codec_err; 710db2a4165SFrank Mandarino } 711db2a4165SFrank Mandarino } 712db2a4165SFrank Mandarino 713*f0fba2adSLiam Girdwood if (cpu_dai->driver->ops->hw_params) { 714*f0fba2adSLiam Girdwood ret = cpu_dai->driver->ops->hw_params(substream, params, cpu_dai); 715db2a4165SFrank Mandarino if (ret < 0) { 7163ff3f64bSMark Brown printk(KERN_ERR "asoc: interface %s hw params failed\n", 717cb666e5bSLiam Girdwood cpu_dai->name); 718db2a4165SFrank Mandarino goto interface_err; 719db2a4165SFrank Mandarino } 720db2a4165SFrank Mandarino } 721db2a4165SFrank Mandarino 722*f0fba2adSLiam Girdwood if (platform->driver->ops->hw_params) { 723*f0fba2adSLiam Girdwood ret = platform->driver->ops->hw_params(substream, params); 724db2a4165SFrank Mandarino if (ret < 0) { 7253ff3f64bSMark Brown printk(KERN_ERR "asoc: platform %s hw params failed\n", 726db2a4165SFrank Mandarino platform->name); 727db2a4165SFrank Mandarino goto platform_err; 728db2a4165SFrank Mandarino } 729db2a4165SFrank Mandarino } 730db2a4165SFrank Mandarino 731*f0fba2adSLiam Girdwood rtd->rate = params_rate(params); 73206f409d7SMark Brown 733db2a4165SFrank Mandarino out: 734db2a4165SFrank Mandarino mutex_unlock(&pcm_mutex); 735db2a4165SFrank Mandarino return ret; 736db2a4165SFrank Mandarino 737db2a4165SFrank Mandarino platform_err: 738*f0fba2adSLiam Girdwood if (cpu_dai->driver->ops->hw_free) 739*f0fba2adSLiam Girdwood cpu_dai->driver->ops->hw_free(substream, cpu_dai); 740db2a4165SFrank Mandarino 741db2a4165SFrank Mandarino interface_err: 742*f0fba2adSLiam Girdwood if (codec_dai->driver->ops->hw_free) 743*f0fba2adSLiam Girdwood codec_dai->driver->ops->hw_free(substream, codec_dai); 744cb666e5bSLiam Girdwood 745cb666e5bSLiam Girdwood codec_err: 746*f0fba2adSLiam Girdwood if (rtd->dai_link->ops && rtd->dai_link->ops->hw_free) 747*f0fba2adSLiam Girdwood rtd->dai_link->ops->hw_free(substream); 748db2a4165SFrank Mandarino 749db2a4165SFrank Mandarino mutex_unlock(&pcm_mutex); 750db2a4165SFrank Mandarino return ret; 751db2a4165SFrank Mandarino } 752db2a4165SFrank Mandarino 753db2a4165SFrank Mandarino /* 754db2a4165SFrank Mandarino * Free's resources allocated by hw_params, can be called multiple times 755db2a4165SFrank Mandarino */ 756db2a4165SFrank Mandarino static int soc_pcm_hw_free(struct snd_pcm_substream *substream) 757db2a4165SFrank Mandarino { 758db2a4165SFrank Mandarino struct snd_soc_pcm_runtime *rtd = substream->private_data; 759*f0fba2adSLiam Girdwood struct snd_soc_platform *platform = rtd->platform; 760*f0fba2adSLiam Girdwood struct snd_soc_dai *cpu_dai = rtd->cpu_dai; 761*f0fba2adSLiam Girdwood struct snd_soc_dai *codec_dai = rtd->codec_dai; 762*f0fba2adSLiam Girdwood struct snd_soc_codec *codec = rtd->codec; 763db2a4165SFrank Mandarino 764db2a4165SFrank Mandarino mutex_lock(&pcm_mutex); 765db2a4165SFrank Mandarino 766db2a4165SFrank Mandarino /* apply codec digital mute */ 7678c6529dbSLiam Girdwood if (!codec->active) 7688c6529dbSLiam Girdwood snd_soc_dai_digital_mute(codec_dai, 1); 769db2a4165SFrank Mandarino 770db2a4165SFrank Mandarino /* free any machine hw params */ 771*f0fba2adSLiam Girdwood if (rtd->dai_link->ops && rtd->dai_link->ops->hw_free) 772*f0fba2adSLiam Girdwood rtd->dai_link->ops->hw_free(substream); 773db2a4165SFrank Mandarino 774db2a4165SFrank Mandarino /* free any DMA resources */ 775*f0fba2adSLiam Girdwood if (platform->driver->ops->hw_free) 776*f0fba2adSLiam Girdwood platform->driver->ops->hw_free(substream); 777db2a4165SFrank Mandarino 778db2a4165SFrank Mandarino /* now free hw params for the DAI's */ 779*f0fba2adSLiam Girdwood if (codec_dai->driver->ops->hw_free) 780*f0fba2adSLiam Girdwood codec_dai->driver->ops->hw_free(substream, codec_dai); 781db2a4165SFrank Mandarino 782*f0fba2adSLiam Girdwood if (cpu_dai->driver->ops->hw_free) 783*f0fba2adSLiam Girdwood cpu_dai->driver->ops->hw_free(substream, cpu_dai); 784db2a4165SFrank Mandarino 785db2a4165SFrank Mandarino mutex_unlock(&pcm_mutex); 786db2a4165SFrank Mandarino return 0; 787db2a4165SFrank Mandarino } 788db2a4165SFrank Mandarino 789db2a4165SFrank Mandarino static int soc_pcm_trigger(struct snd_pcm_substream *substream, int cmd) 790db2a4165SFrank Mandarino { 791db2a4165SFrank Mandarino struct snd_soc_pcm_runtime *rtd = substream->private_data; 792*f0fba2adSLiam Girdwood struct snd_soc_platform *platform = rtd->platform; 793*f0fba2adSLiam Girdwood struct snd_soc_dai *cpu_dai = rtd->cpu_dai; 794*f0fba2adSLiam Girdwood struct snd_soc_dai *codec_dai = rtd->codec_dai; 795db2a4165SFrank Mandarino int ret; 796db2a4165SFrank Mandarino 797*f0fba2adSLiam Girdwood if (codec_dai->driver->ops->trigger) { 798*f0fba2adSLiam Girdwood ret = codec_dai->driver->ops->trigger(substream, cmd, codec_dai); 799db2a4165SFrank Mandarino if (ret < 0) 800db2a4165SFrank Mandarino return ret; 801db2a4165SFrank Mandarino } 802db2a4165SFrank Mandarino 803*f0fba2adSLiam Girdwood if (platform->driver->ops->trigger) { 804*f0fba2adSLiam Girdwood ret = platform->driver->ops->trigger(substream, cmd); 805db2a4165SFrank Mandarino if (ret < 0) 806db2a4165SFrank Mandarino return ret; 807db2a4165SFrank Mandarino } 808db2a4165SFrank Mandarino 809*f0fba2adSLiam Girdwood if (cpu_dai->driver->ops->trigger) { 810*f0fba2adSLiam Girdwood ret = cpu_dai->driver->ops->trigger(substream, cmd, cpu_dai); 811db2a4165SFrank Mandarino if (ret < 0) 812db2a4165SFrank Mandarino return ret; 813db2a4165SFrank Mandarino } 814db2a4165SFrank Mandarino return 0; 815db2a4165SFrank Mandarino } 816db2a4165SFrank Mandarino 817377b6f62SPeter Ujfalusi /* 818377b6f62SPeter Ujfalusi * soc level wrapper for pointer callback 819258020d0SPeter Ujfalusi * If cpu_dai, codec_dai, platform driver has the delay callback, than 820258020d0SPeter Ujfalusi * the runtime->delay will be updated accordingly. 821377b6f62SPeter Ujfalusi */ 822377b6f62SPeter Ujfalusi static snd_pcm_uframes_t soc_pcm_pointer(struct snd_pcm_substream *substream) 823377b6f62SPeter Ujfalusi { 824377b6f62SPeter Ujfalusi struct snd_soc_pcm_runtime *rtd = substream->private_data; 825*f0fba2adSLiam Girdwood struct snd_soc_platform *platform = rtd->platform; 826*f0fba2adSLiam Girdwood struct snd_soc_dai *cpu_dai = rtd->cpu_dai; 827*f0fba2adSLiam Girdwood struct snd_soc_dai *codec_dai = rtd->codec_dai; 828258020d0SPeter Ujfalusi struct snd_pcm_runtime *runtime = substream->runtime; 829377b6f62SPeter Ujfalusi snd_pcm_uframes_t offset = 0; 830258020d0SPeter Ujfalusi snd_pcm_sframes_t delay = 0; 831377b6f62SPeter Ujfalusi 832*f0fba2adSLiam Girdwood if (platform->driver->ops->pointer) 833*f0fba2adSLiam Girdwood offset = platform->driver->ops->pointer(substream); 834377b6f62SPeter Ujfalusi 835*f0fba2adSLiam Girdwood if (cpu_dai->driver->ops->delay) 836*f0fba2adSLiam Girdwood delay += cpu_dai->driver->ops->delay(substream, cpu_dai); 837258020d0SPeter Ujfalusi 838*f0fba2adSLiam Girdwood if (codec_dai->driver->ops->delay) 839*f0fba2adSLiam Girdwood delay += codec_dai->driver->ops->delay(substream, codec_dai); 840258020d0SPeter Ujfalusi 841*f0fba2adSLiam Girdwood if (platform->driver->delay) 842*f0fba2adSLiam Girdwood delay += platform->driver->delay(substream, codec_dai); 843258020d0SPeter Ujfalusi 844258020d0SPeter Ujfalusi runtime->delay = delay; 845258020d0SPeter Ujfalusi 846377b6f62SPeter Ujfalusi return offset; 847377b6f62SPeter Ujfalusi } 848377b6f62SPeter Ujfalusi 849db2a4165SFrank Mandarino /* ASoC PCM operations */ 850db2a4165SFrank Mandarino static struct snd_pcm_ops soc_pcm_ops = { 851db2a4165SFrank Mandarino .open = soc_pcm_open, 852db2a4165SFrank Mandarino .close = soc_codec_close, 853db2a4165SFrank Mandarino .hw_params = soc_pcm_hw_params, 854db2a4165SFrank Mandarino .hw_free = soc_pcm_hw_free, 855db2a4165SFrank Mandarino .prepare = soc_pcm_prepare, 856db2a4165SFrank Mandarino .trigger = soc_pcm_trigger, 857377b6f62SPeter Ujfalusi .pointer = soc_pcm_pointer, 858db2a4165SFrank Mandarino }; 859db2a4165SFrank Mandarino 860db2a4165SFrank Mandarino #ifdef CONFIG_PM 861db2a4165SFrank Mandarino /* powers down audio subsystem for suspend */ 862416356fcSMark Brown static int soc_suspend(struct device *dev) 863db2a4165SFrank Mandarino { 864416356fcSMark Brown struct platform_device *pdev = to_platform_device(dev); 865*f0fba2adSLiam Girdwood struct snd_soc_card *card = platform_get_drvdata(pdev); 866db2a4165SFrank Mandarino int i; 867db2a4165SFrank Mandarino 868e3509ff0SDaniel Mack /* If the initialization of this soc device failed, there is no codec 869e3509ff0SDaniel Mack * associated with it. Just bail out in this case. 870e3509ff0SDaniel Mack */ 871*f0fba2adSLiam Girdwood if (list_empty(&card->codec_dev_list)) 872e3509ff0SDaniel Mack return 0; 873e3509ff0SDaniel Mack 8746ed25978SAndy Green /* Due to the resume being scheduled into a workqueue we could 8756ed25978SAndy Green * suspend before that's finished - wait for it to complete. 8766ed25978SAndy Green */ 877*f0fba2adSLiam Girdwood snd_power_lock(card->snd_card); 878*f0fba2adSLiam Girdwood snd_power_wait(card->snd_card, SNDRV_CTL_POWER_D0); 879*f0fba2adSLiam Girdwood snd_power_unlock(card->snd_card); 8806ed25978SAndy Green 8816ed25978SAndy Green /* we're going to block userspace touching us until resume completes */ 882*f0fba2adSLiam Girdwood snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D3hot); 8836ed25978SAndy Green 884db2a4165SFrank Mandarino /* mute any active DAC's */ 885*f0fba2adSLiam Girdwood for (i = 0; i < card->num_rtd; i++) { 886*f0fba2adSLiam Girdwood struct snd_soc_dai *dai = card->rtd[i].codec_dai; 887*f0fba2adSLiam Girdwood struct snd_soc_dai_driver *drv = dai->driver; 8883efab7dcSMark Brown 889*f0fba2adSLiam Girdwood if (card->rtd[i].dai_link->ignore_suspend) 8903efab7dcSMark Brown continue; 8913efab7dcSMark Brown 892*f0fba2adSLiam Girdwood if (drv->ops->digital_mute && dai->playback_active) 893*f0fba2adSLiam Girdwood drv->ops->digital_mute(dai, 1); 894db2a4165SFrank Mandarino } 895db2a4165SFrank Mandarino 8964ccab3e7SLiam Girdwood /* suspend all pcms */ 897*f0fba2adSLiam Girdwood for (i = 0; i < card->num_rtd; i++) { 898*f0fba2adSLiam Girdwood if (card->rtd[i].dai_link->ignore_suspend) 8993efab7dcSMark Brown continue; 9003efab7dcSMark Brown 901*f0fba2adSLiam Girdwood snd_pcm_suspend_all(card->rtd[i].pcm); 9023efab7dcSMark Brown } 9034ccab3e7SLiam Girdwood 90487506549SMark Brown if (card->suspend_pre) 905416356fcSMark Brown card->suspend_pre(pdev, PMSG_SUSPEND); 906db2a4165SFrank Mandarino 907*f0fba2adSLiam Girdwood for (i = 0; i < card->num_rtd; i++) { 908*f0fba2adSLiam Girdwood struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai; 909*f0fba2adSLiam Girdwood struct snd_soc_platform *platform = card->rtd[i].platform; 9103efab7dcSMark Brown 911*f0fba2adSLiam Girdwood if (card->rtd[i].dai_link->ignore_suspend) 9123efab7dcSMark Brown continue; 9133efab7dcSMark Brown 914*f0fba2adSLiam Girdwood if (cpu_dai->driver->suspend && !cpu_dai->driver->ac97_control) 915*f0fba2adSLiam Girdwood cpu_dai->driver->suspend(cpu_dai); 916*f0fba2adSLiam Girdwood if (platform->driver->suspend && !platform->suspended) { 917*f0fba2adSLiam Girdwood platform->driver->suspend(cpu_dai); 918*f0fba2adSLiam Girdwood platform->suspended = 1; 919*f0fba2adSLiam Girdwood } 920db2a4165SFrank Mandarino } 921db2a4165SFrank Mandarino 922db2a4165SFrank Mandarino /* close any waiting streams and save state */ 923*f0fba2adSLiam Girdwood for (i = 0; i < card->num_rtd; i++) { 924*f0fba2adSLiam Girdwood run_delayed_work(&card->rtd[i].delayed_work); 925*f0fba2adSLiam Girdwood card->rtd[i].codec->suspend_bias_level = card->rtd[i].codec->bias_level; 926*f0fba2adSLiam Girdwood } 927db2a4165SFrank Mandarino 928*f0fba2adSLiam Girdwood for (i = 0; i < card->num_rtd; i++) { 929*f0fba2adSLiam Girdwood struct snd_soc_dai_driver *driver = card->rtd[i].codec_dai->driver; 9303efab7dcSMark Brown 931*f0fba2adSLiam Girdwood if (card->rtd[i].dai_link->ignore_suspend) 9323efab7dcSMark Brown continue; 9333efab7dcSMark Brown 934*f0fba2adSLiam Girdwood if (driver->playback.stream_name != NULL) 935*f0fba2adSLiam Girdwood snd_soc_dapm_stream_event(&card->rtd[i], driver->playback.stream_name, 936db2a4165SFrank Mandarino SND_SOC_DAPM_STREAM_SUSPEND); 937*f0fba2adSLiam Girdwood 938*f0fba2adSLiam Girdwood if (driver->capture.stream_name != NULL) 939*f0fba2adSLiam Girdwood snd_soc_dapm_stream_event(&card->rtd[i], driver->capture.stream_name, 940db2a4165SFrank Mandarino SND_SOC_DAPM_STREAM_SUSPEND); 941db2a4165SFrank Mandarino } 942db2a4165SFrank Mandarino 943*f0fba2adSLiam Girdwood /* suspend all CODECs */ 944*f0fba2adSLiam Girdwood for (i = 0; i < card->num_rtd; i++) { 945*f0fba2adSLiam Girdwood struct snd_soc_codec *codec = card->rtd[i].codec; 9461547aba9SMark Brown /* If there are paths active then the CODEC will be held with 9471547aba9SMark Brown * bias _ON and should not be suspended. */ 948*f0fba2adSLiam Girdwood if (!codec->suspended && codec->driver->suspend) { 9491547aba9SMark Brown switch (codec->bias_level) { 9501547aba9SMark Brown case SND_SOC_BIAS_STANDBY: 9511547aba9SMark Brown case SND_SOC_BIAS_OFF: 952*f0fba2adSLiam Girdwood codec->driver->suspend(codec, PMSG_SUSPEND); 953*f0fba2adSLiam Girdwood codec->suspended = 1; 9541547aba9SMark Brown break; 9551547aba9SMark Brown default: 956*f0fba2adSLiam Girdwood dev_dbg(codec->dev, "CODEC is on over suspend\n"); 9571547aba9SMark Brown break; 9581547aba9SMark Brown } 9591547aba9SMark Brown } 960*f0fba2adSLiam Girdwood } 961db2a4165SFrank Mandarino 962*f0fba2adSLiam Girdwood for (i = 0; i < card->num_rtd; i++) { 963*f0fba2adSLiam Girdwood struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai; 9643efab7dcSMark Brown 965*f0fba2adSLiam Girdwood if (card->rtd[i].dai_link->ignore_suspend) 9663efab7dcSMark Brown continue; 9673efab7dcSMark Brown 968*f0fba2adSLiam Girdwood if (cpu_dai->driver->suspend && cpu_dai->driver->ac97_control) 969*f0fba2adSLiam Girdwood cpu_dai->driver->suspend(cpu_dai); 970db2a4165SFrank Mandarino } 971db2a4165SFrank Mandarino 97287506549SMark Brown if (card->suspend_post) 973416356fcSMark Brown card->suspend_post(pdev, PMSG_SUSPEND); 974db2a4165SFrank Mandarino 975db2a4165SFrank Mandarino return 0; 976db2a4165SFrank Mandarino } 977db2a4165SFrank Mandarino 9786ed25978SAndy Green /* deferred resume work, so resume can complete before we finished 9796ed25978SAndy Green * setting our codec back up, which can be very slow on I2C 9806ed25978SAndy Green */ 9816ed25978SAndy Green static void soc_resume_deferred(struct work_struct *work) 982db2a4165SFrank Mandarino { 983*f0fba2adSLiam Girdwood struct snd_soc_card *card = 984*f0fba2adSLiam Girdwood container_of(work, struct snd_soc_card, deferred_resume_work); 985*f0fba2adSLiam Girdwood struct platform_device *pdev = to_platform_device(card->dev); 986db2a4165SFrank Mandarino int i; 987db2a4165SFrank Mandarino 9886ed25978SAndy Green /* our power state is still SNDRV_CTL_POWER_D3hot from suspend time, 9896ed25978SAndy Green * so userspace apps are blocked from touching us 9906ed25978SAndy Green */ 9916ed25978SAndy Green 992*f0fba2adSLiam Girdwood dev_dbg(card->dev, "starting resume work\n"); 9936ed25978SAndy Green 9949949788bSMark Brown /* Bring us up into D2 so that DAPM starts enabling things */ 995*f0fba2adSLiam Girdwood snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D2); 9969949788bSMark Brown 99787506549SMark Brown if (card->resume_pre) 99887506549SMark Brown card->resume_pre(pdev); 999db2a4165SFrank Mandarino 1000*f0fba2adSLiam Girdwood /* resume AC97 DAIs */ 1001*f0fba2adSLiam Girdwood for (i = 0; i < card->num_rtd; i++) { 1002*f0fba2adSLiam Girdwood struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai; 10033efab7dcSMark Brown 1004*f0fba2adSLiam Girdwood if (card->rtd[i].dai_link->ignore_suspend) 10053efab7dcSMark Brown continue; 10063efab7dcSMark Brown 1007*f0fba2adSLiam Girdwood if (cpu_dai->driver->resume && cpu_dai->driver->ac97_control) 1008*f0fba2adSLiam Girdwood cpu_dai->driver->resume(cpu_dai); 1009db2a4165SFrank Mandarino } 1010db2a4165SFrank Mandarino 1011*f0fba2adSLiam Girdwood for (i = 0; i < card->num_rtd; i++) { 1012*f0fba2adSLiam Girdwood struct snd_soc_codec *codec = card->rtd[i].codec; 10131547aba9SMark Brown /* If the CODEC was idle over suspend then it will have been 10141547aba9SMark Brown * left with bias OFF or STANDBY and suspended so we must now 10151547aba9SMark Brown * resume. Otherwise the suspend was suppressed. 10161547aba9SMark Brown */ 1017*f0fba2adSLiam Girdwood if (codec->driver->resume && codec->suspended) { 10181547aba9SMark Brown switch (codec->bias_level) { 10191547aba9SMark Brown case SND_SOC_BIAS_STANDBY: 10201547aba9SMark Brown case SND_SOC_BIAS_OFF: 1021*f0fba2adSLiam Girdwood codec->driver->resume(codec); 1022*f0fba2adSLiam Girdwood codec->suspended = 0; 10231547aba9SMark Brown break; 10241547aba9SMark Brown default: 1025*f0fba2adSLiam Girdwood dev_dbg(codec->dev, "CODEC was on over suspend\n"); 10261547aba9SMark Brown break; 10271547aba9SMark Brown } 10281547aba9SMark Brown } 1029*f0fba2adSLiam Girdwood } 1030db2a4165SFrank Mandarino 1031*f0fba2adSLiam Girdwood for (i = 0; i < card->num_rtd; i++) { 1032*f0fba2adSLiam Girdwood struct snd_soc_dai_driver *driver = card->rtd[i].codec_dai->driver; 10333efab7dcSMark Brown 1034*f0fba2adSLiam Girdwood if (card->rtd[i].dai_link->ignore_suspend) 10353efab7dcSMark Brown continue; 10363efab7dcSMark Brown 1037*f0fba2adSLiam Girdwood if (driver->playback.stream_name != NULL) 1038*f0fba2adSLiam Girdwood snd_soc_dapm_stream_event(&card->rtd[i], driver->playback.stream_name, 1039db2a4165SFrank Mandarino SND_SOC_DAPM_STREAM_RESUME); 1040*f0fba2adSLiam Girdwood 1041*f0fba2adSLiam Girdwood if (driver->capture.stream_name != NULL) 1042*f0fba2adSLiam Girdwood snd_soc_dapm_stream_event(&card->rtd[i], driver->capture.stream_name, 1043db2a4165SFrank Mandarino SND_SOC_DAPM_STREAM_RESUME); 1044db2a4165SFrank Mandarino } 1045db2a4165SFrank Mandarino 10463ff3f64bSMark Brown /* unmute any active DACs */ 1047*f0fba2adSLiam Girdwood for (i = 0; i < card->num_rtd; i++) { 1048*f0fba2adSLiam Girdwood struct snd_soc_dai *dai = card->rtd[i].codec_dai; 1049*f0fba2adSLiam Girdwood struct snd_soc_dai_driver *drv = dai->driver; 10503efab7dcSMark Brown 1051*f0fba2adSLiam Girdwood if (card->rtd[i].dai_link->ignore_suspend) 10523efab7dcSMark Brown continue; 10533efab7dcSMark Brown 1054*f0fba2adSLiam Girdwood if (drv->ops->digital_mute && dai->playback_active) 1055*f0fba2adSLiam Girdwood drv->ops->digital_mute(dai, 0); 1056db2a4165SFrank Mandarino } 1057db2a4165SFrank Mandarino 1058*f0fba2adSLiam Girdwood for (i = 0; i < card->num_rtd; i++) { 1059*f0fba2adSLiam Girdwood struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai; 1060*f0fba2adSLiam Girdwood struct snd_soc_platform *platform = card->rtd[i].platform; 10613efab7dcSMark Brown 1062*f0fba2adSLiam Girdwood if (card->rtd[i].dai_link->ignore_suspend) 10633efab7dcSMark Brown continue; 10643efab7dcSMark Brown 1065*f0fba2adSLiam Girdwood if (cpu_dai->driver->resume && !cpu_dai->driver->ac97_control) 1066*f0fba2adSLiam Girdwood cpu_dai->driver->resume(cpu_dai); 1067*f0fba2adSLiam Girdwood if (platform->driver->resume && platform->suspended) { 1068*f0fba2adSLiam Girdwood platform->driver->resume(cpu_dai); 1069*f0fba2adSLiam Girdwood platform->suspended = 0; 1070*f0fba2adSLiam Girdwood } 1071db2a4165SFrank Mandarino } 1072db2a4165SFrank Mandarino 107387506549SMark Brown if (card->resume_post) 107487506549SMark Brown card->resume_post(pdev); 1075db2a4165SFrank Mandarino 1076*f0fba2adSLiam Girdwood dev_dbg(card->dev, "resume work completed\n"); 10776ed25978SAndy Green 10786ed25978SAndy Green /* userspace can access us now we are back as we were before */ 1079*f0fba2adSLiam Girdwood snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D0); 10806ed25978SAndy Green } 10816ed25978SAndy Green 10826ed25978SAndy Green /* powers up audio subsystem after a suspend */ 1083416356fcSMark Brown static int soc_resume(struct device *dev) 10846ed25978SAndy Green { 1085416356fcSMark Brown struct platform_device *pdev = to_platform_device(dev); 1086*f0fba2adSLiam Girdwood struct snd_soc_card *card = platform_get_drvdata(pdev); 1087*f0fba2adSLiam Girdwood int i; 1088b9dd94a8SPeter Ujfalusi 108964ab9baaSMark Brown /* AC97 devices might have other drivers hanging off them so 109064ab9baaSMark Brown * need to resume immediately. Other drivers don't have that 109164ab9baaSMark Brown * problem and may take a substantial amount of time to resume 109264ab9baaSMark Brown * due to I/O costs and anti-pop so handle them out of line. 109364ab9baaSMark Brown */ 1094*f0fba2adSLiam Girdwood for (i = 0; i < card->num_rtd; i++) { 1095*f0fba2adSLiam Girdwood struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai; 1096*f0fba2adSLiam Girdwood if (cpu_dai->driver->ac97_control) { 1097*f0fba2adSLiam Girdwood dev_dbg(dev, "Resuming AC97 immediately\n"); 109864ab9baaSMark Brown soc_resume_deferred(&card->deferred_resume_work); 109964ab9baaSMark Brown } else { 1100*f0fba2adSLiam Girdwood dev_dbg(dev, "Scheduling resume work\n"); 11016308419aSMark Brown if (!schedule_work(&card->deferred_resume_work)) 1102*f0fba2adSLiam Girdwood dev_err(dev, "resume work item may be lost\n"); 1103*f0fba2adSLiam Girdwood } 110464ab9baaSMark Brown } 11056ed25978SAndy Green 1106db2a4165SFrank Mandarino return 0; 1107db2a4165SFrank Mandarino } 1108db2a4165SFrank Mandarino #else 1109db2a4165SFrank Mandarino #define soc_suspend NULL 1110db2a4165SFrank Mandarino #define soc_resume NULL 1111db2a4165SFrank Mandarino #endif 1112db2a4165SFrank Mandarino 111302a06d30SBarry Song static struct snd_soc_dai_ops null_dai_ops = { 111402a06d30SBarry Song }; 111502a06d30SBarry Song 1116*f0fba2adSLiam Girdwood static int soc_bind_dai_link(struct snd_soc_card *card, int num) 1117db2a4165SFrank Mandarino { 1118*f0fba2adSLiam Girdwood struct snd_soc_dai_link *dai_link = &card->dai_link[num]; 1119*f0fba2adSLiam Girdwood struct snd_soc_pcm_runtime *rtd = &card->rtd[num]; 1120fe3e78e0SMark Brown struct snd_soc_codec *codec; 1121435c5e25SMark Brown struct snd_soc_platform *platform; 1122*f0fba2adSLiam Girdwood struct snd_soc_dai *codec_dai, *cpu_dai; 1123db2a4165SFrank Mandarino 1124*f0fba2adSLiam Girdwood if (rtd->complete) 1125*f0fba2adSLiam Girdwood return 1; 1126*f0fba2adSLiam Girdwood dev_dbg(card->dev, "binding %s at idx %d\n", dai_link->name, num); 11276308419aSMark Brown 1128*f0fba2adSLiam Girdwood /* do we already have the CPU DAI for this link ? */ 1129*f0fba2adSLiam Girdwood if (rtd->cpu_dai) { 1130*f0fba2adSLiam Girdwood goto find_codec; 1131435c5e25SMark Brown } 1132*f0fba2adSLiam Girdwood /* no, then find CPU DAI from registered DAIs*/ 1133*f0fba2adSLiam Girdwood list_for_each_entry(cpu_dai, &dai_list, list) { 1134*f0fba2adSLiam Girdwood if (!strcmp(cpu_dai->name, dai_link->cpu_dai_name)) { 1135*f0fba2adSLiam Girdwood 1136*f0fba2adSLiam Girdwood if (!try_module_get(cpu_dai->dev->driver->owner)) 1137*f0fba2adSLiam Girdwood return -ENODEV; 1138*f0fba2adSLiam Girdwood 1139*f0fba2adSLiam Girdwood rtd->cpu_dai = cpu_dai; 1140*f0fba2adSLiam Girdwood goto find_codec; 1141*f0fba2adSLiam Girdwood } 1142*f0fba2adSLiam Girdwood } 1143*f0fba2adSLiam Girdwood dev_dbg(card->dev, "CPU DAI %s not registered\n", 1144*f0fba2adSLiam Girdwood dai_link->cpu_dai_name); 1145*f0fba2adSLiam Girdwood 1146*f0fba2adSLiam Girdwood find_codec: 1147*f0fba2adSLiam Girdwood /* do we already have the CODEC for this link ? */ 1148*f0fba2adSLiam Girdwood if (rtd->codec) { 1149*f0fba2adSLiam Girdwood goto find_platform; 1150c5af3a2eSMark Brown } 1151c5af3a2eSMark Brown 1152*f0fba2adSLiam Girdwood /* no, then find CODEC from registered CODECs*/ 1153*f0fba2adSLiam Girdwood list_for_each_entry(codec, &codec_list, list) { 1154*f0fba2adSLiam Girdwood if (!strcmp(codec->name, dai_link->codec_name)) { 1155*f0fba2adSLiam Girdwood rtd->codec = codec; 1156*f0fba2adSLiam Girdwood 1157*f0fba2adSLiam Girdwood if (!try_module_get(codec->dev->driver->owner)) 1158*f0fba2adSLiam Girdwood return -ENODEV; 1159*f0fba2adSLiam Girdwood 1160*f0fba2adSLiam Girdwood /* CODEC found, so find CODEC DAI from registered DAIs from this CODEC*/ 1161*f0fba2adSLiam Girdwood list_for_each_entry(codec_dai, &dai_list, list) { 1162*f0fba2adSLiam Girdwood if (codec->dev == codec_dai->dev && 1163*f0fba2adSLiam Girdwood !strcmp(codec_dai->name, dai_link->codec_dai_name)) { 1164*f0fba2adSLiam Girdwood rtd->codec_dai = codec_dai; 1165*f0fba2adSLiam Girdwood goto find_platform; 1166435c5e25SMark Brown } 1167*f0fba2adSLiam Girdwood } 1168*f0fba2adSLiam Girdwood dev_dbg(card->dev, "CODEC DAI %s not registered\n", 1169*f0fba2adSLiam Girdwood dai_link->codec_dai_name); 1170*f0fba2adSLiam Girdwood 1171*f0fba2adSLiam Girdwood goto find_platform; 1172*f0fba2adSLiam Girdwood } 1173*f0fba2adSLiam Girdwood } 1174*f0fba2adSLiam Girdwood dev_dbg(card->dev, "CODEC %s not registered\n", 1175*f0fba2adSLiam Girdwood dai_link->codec_name); 1176*f0fba2adSLiam Girdwood 1177*f0fba2adSLiam Girdwood find_platform: 1178*f0fba2adSLiam Girdwood /* do we already have the CODEC DAI for this link ? */ 1179*f0fba2adSLiam Girdwood if (rtd->platform) { 1180*f0fba2adSLiam Girdwood goto out; 1181*f0fba2adSLiam Girdwood } 1182*f0fba2adSLiam Girdwood /* no, then find CPU DAI from registered DAIs*/ 1183*f0fba2adSLiam Girdwood list_for_each_entry(platform, &platform_list, list) { 1184*f0fba2adSLiam Girdwood if (!strcmp(platform->name, dai_link->platform_name)) { 1185*f0fba2adSLiam Girdwood 1186*f0fba2adSLiam Girdwood if (!try_module_get(platform->dev->driver->owner)) 1187*f0fba2adSLiam Girdwood return -ENODEV; 1188*f0fba2adSLiam Girdwood 1189*f0fba2adSLiam Girdwood rtd->platform = platform; 1190*f0fba2adSLiam Girdwood goto out; 1191*f0fba2adSLiam Girdwood } 1192435c5e25SMark Brown } 11936b05eda6SMark Brown 1194*f0fba2adSLiam Girdwood dev_dbg(card->dev, "platform %s not registered\n", 1195*f0fba2adSLiam Girdwood dai_link->platform_name); 1196*f0fba2adSLiam Girdwood return 0; 1197*f0fba2adSLiam Girdwood 1198*f0fba2adSLiam Girdwood out: 1199*f0fba2adSLiam Girdwood /* mark rtd as complete if we found all 4 of our client devices */ 1200*f0fba2adSLiam Girdwood if (rtd->codec && rtd->codec_dai && rtd->platform && rtd->cpu_dai) { 1201*f0fba2adSLiam Girdwood rtd->complete = 1; 1202*f0fba2adSLiam Girdwood card->num_rtd++; 1203*f0fba2adSLiam Girdwood } 1204*f0fba2adSLiam Girdwood return 1; 12056b05eda6SMark Brown } 12066b05eda6SMark Brown 1207*f0fba2adSLiam Girdwood static void soc_remove_dai_link(struct snd_soc_card *card, int num) 1208*f0fba2adSLiam Girdwood { 1209*f0fba2adSLiam Girdwood struct snd_soc_pcm_runtime *rtd = &card->rtd[num]; 1210*f0fba2adSLiam Girdwood struct snd_soc_codec *codec = rtd->codec; 1211*f0fba2adSLiam Girdwood struct snd_soc_platform *platform = rtd->platform; 1212*f0fba2adSLiam Girdwood struct snd_soc_dai *codec_dai = rtd->codec_dai, *cpu_dai = rtd->cpu_dai; 1213*f0fba2adSLiam Girdwood int err; 1214*f0fba2adSLiam Girdwood 1215*f0fba2adSLiam Girdwood /* unregister the rtd device */ 1216*f0fba2adSLiam Girdwood if (rtd->dev_registered) { 1217*f0fba2adSLiam Girdwood device_remove_file(&rtd->dev, &dev_attr_pmdown_time); 1218*f0fba2adSLiam Girdwood device_unregister(&rtd->dev); 1219*f0fba2adSLiam Girdwood rtd->dev_registered = 0; 122002a06d30SBarry Song } 122102a06d30SBarry Song 1222*f0fba2adSLiam Girdwood /* remove the CODEC DAI */ 1223*f0fba2adSLiam Girdwood if (codec_dai && codec_dai->probed) { 1224*f0fba2adSLiam Girdwood if (codec_dai->driver->remove) { 1225*f0fba2adSLiam Girdwood err = codec_dai->driver->remove(codec_dai); 1226*f0fba2adSLiam Girdwood if (err < 0) 1227*f0fba2adSLiam Girdwood printk(KERN_ERR "asoc: failed to remove %s\n", codec_dai->name); 1228*f0fba2adSLiam Girdwood } 1229*f0fba2adSLiam Girdwood codec_dai->probed = 0; 1230*f0fba2adSLiam Girdwood list_del(&codec_dai->card_list); 1231*f0fba2adSLiam Girdwood } 1232*f0fba2adSLiam Girdwood 1233*f0fba2adSLiam Girdwood /* remove the platform */ 1234*f0fba2adSLiam Girdwood if (platform && platform->probed) { 1235*f0fba2adSLiam Girdwood if (platform->driver->remove) { 1236*f0fba2adSLiam Girdwood err = platform->driver->remove(platform); 1237*f0fba2adSLiam Girdwood if (err < 0) 1238*f0fba2adSLiam Girdwood printk(KERN_ERR "asoc: failed to remove %s\n", platform->name); 1239*f0fba2adSLiam Girdwood } 1240*f0fba2adSLiam Girdwood platform->probed = 0; 1241*f0fba2adSLiam Girdwood list_del(&platform->card_list); 1242*f0fba2adSLiam Girdwood module_put(platform->dev->driver->owner); 1243*f0fba2adSLiam Girdwood } 1244*f0fba2adSLiam Girdwood 1245*f0fba2adSLiam Girdwood /* remove the CODEC */ 1246*f0fba2adSLiam Girdwood if (codec && codec->probed) { 1247*f0fba2adSLiam Girdwood if (codec->driver->remove) { 1248*f0fba2adSLiam Girdwood err = codec->driver->remove(codec); 1249*f0fba2adSLiam Girdwood if (err < 0) 1250*f0fba2adSLiam Girdwood printk(KERN_ERR "asoc: failed to remove %s\n", codec->name); 1251*f0fba2adSLiam Girdwood } 1252*f0fba2adSLiam Girdwood 1253*f0fba2adSLiam Girdwood /* Make sure all DAPM widgets are freed */ 1254*f0fba2adSLiam Girdwood snd_soc_dapm_free(codec); 1255*f0fba2adSLiam Girdwood 1256*f0fba2adSLiam Girdwood soc_cleanup_codec_debugfs(codec); 1257*f0fba2adSLiam Girdwood device_remove_file(&rtd->dev, &dev_attr_codec_reg); 1258*f0fba2adSLiam Girdwood codec->probed = 0; 1259*f0fba2adSLiam Girdwood list_del(&codec->card_list); 1260*f0fba2adSLiam Girdwood module_put(codec->dev->driver->owner); 1261*f0fba2adSLiam Girdwood } 1262*f0fba2adSLiam Girdwood 1263*f0fba2adSLiam Girdwood /* remove the cpu_dai */ 1264*f0fba2adSLiam Girdwood if (cpu_dai && cpu_dai->probed) { 1265*f0fba2adSLiam Girdwood if (cpu_dai->driver->remove) { 1266*f0fba2adSLiam Girdwood err = cpu_dai->driver->remove(cpu_dai); 1267*f0fba2adSLiam Girdwood if (err < 0) 1268*f0fba2adSLiam Girdwood printk(KERN_ERR "asoc: failed to remove %s\n", cpu_dai->name); 1269*f0fba2adSLiam Girdwood } 1270*f0fba2adSLiam Girdwood cpu_dai->probed = 0; 1271*f0fba2adSLiam Girdwood list_del(&cpu_dai->card_list); 1272*f0fba2adSLiam Girdwood module_put(cpu_dai->dev->driver->owner); 1273*f0fba2adSLiam Girdwood } 1274*f0fba2adSLiam Girdwood } 1275*f0fba2adSLiam Girdwood 1276*f0fba2adSLiam Girdwood static void rtd_release(struct device *dev) {} 1277*f0fba2adSLiam Girdwood 1278*f0fba2adSLiam Girdwood static int soc_probe_dai_link(struct snd_soc_card *card, int num) 1279*f0fba2adSLiam Girdwood { 1280*f0fba2adSLiam Girdwood struct snd_soc_dai_link *dai_link = &card->dai_link[num]; 1281*f0fba2adSLiam Girdwood struct snd_soc_pcm_runtime *rtd = &card->rtd[num]; 1282*f0fba2adSLiam Girdwood struct snd_soc_codec *codec = rtd->codec; 1283*f0fba2adSLiam Girdwood struct snd_soc_platform *platform = rtd->platform; 1284*f0fba2adSLiam Girdwood struct snd_soc_dai *codec_dai = rtd->codec_dai, *cpu_dai = rtd->cpu_dai; 1285*f0fba2adSLiam Girdwood int ret; 1286*f0fba2adSLiam Girdwood 1287*f0fba2adSLiam Girdwood dev_dbg(card->dev, "probe %s dai link %d\n", card->name, num); 1288*f0fba2adSLiam Girdwood 1289*f0fba2adSLiam Girdwood /* config components */ 1290*f0fba2adSLiam Girdwood codec_dai->codec = codec; 1291*f0fba2adSLiam Girdwood codec->card = card; 1292*f0fba2adSLiam Girdwood cpu_dai->platform = platform; 1293*f0fba2adSLiam Girdwood rtd->card = card; 1294*f0fba2adSLiam Girdwood rtd->dev.parent = card->dev; 1295*f0fba2adSLiam Girdwood codec_dai->card = card; 1296*f0fba2adSLiam Girdwood cpu_dai->card = card; 1297*f0fba2adSLiam Girdwood 1298*f0fba2adSLiam Girdwood /* set default power off timeout */ 1299*f0fba2adSLiam Girdwood rtd->pmdown_time = pmdown_time; 1300*f0fba2adSLiam Girdwood 1301*f0fba2adSLiam Girdwood /* probe the cpu_dai */ 1302*f0fba2adSLiam Girdwood if (!cpu_dai->probed) { 1303*f0fba2adSLiam Girdwood if (cpu_dai->driver->probe) { 1304*f0fba2adSLiam Girdwood ret = cpu_dai->driver->probe(cpu_dai); 1305*f0fba2adSLiam Girdwood if (ret < 0) { 1306*f0fba2adSLiam Girdwood printk(KERN_ERR "asoc: failed to probe CPU DAI %s\n", 1307*f0fba2adSLiam Girdwood cpu_dai->name); 1308*f0fba2adSLiam Girdwood return ret; 1309*f0fba2adSLiam Girdwood } 1310*f0fba2adSLiam Girdwood } 1311*f0fba2adSLiam Girdwood cpu_dai->probed = 1; 1312*f0fba2adSLiam Girdwood /* mark cpu_dai as probed and add to card cpu_dai list */ 1313*f0fba2adSLiam Girdwood list_add(&cpu_dai->card_list, &card->dai_dev_list); 1314*f0fba2adSLiam Girdwood } 1315*f0fba2adSLiam Girdwood 1316*f0fba2adSLiam Girdwood /* probe the CODEC */ 1317*f0fba2adSLiam Girdwood if (!codec->probed) { 1318*f0fba2adSLiam Girdwood if (codec->driver->probe) { 1319*f0fba2adSLiam Girdwood ret = codec->driver->probe(codec); 1320*f0fba2adSLiam Girdwood if (ret < 0) { 1321*f0fba2adSLiam Girdwood printk(KERN_ERR "asoc: failed to probe CODEC %s\n", 1322*f0fba2adSLiam Girdwood codec->name); 1323*f0fba2adSLiam Girdwood return ret; 1324*f0fba2adSLiam Girdwood } 1325*f0fba2adSLiam Girdwood } 1326*f0fba2adSLiam Girdwood /* mark codec as probed and add to card codec list */ 1327*f0fba2adSLiam Girdwood codec->probed = 1; 1328*f0fba2adSLiam Girdwood list_add(&codec->card_list, &card->codec_dev_list); 1329*f0fba2adSLiam Girdwood } 1330*f0fba2adSLiam Girdwood 1331*f0fba2adSLiam Girdwood /* probe the platform */ 1332*f0fba2adSLiam Girdwood if (!platform->probed) { 1333*f0fba2adSLiam Girdwood if (platform->driver->probe) { 1334*f0fba2adSLiam Girdwood ret = platform->driver->probe(platform); 1335*f0fba2adSLiam Girdwood if (ret < 0) { 1336*f0fba2adSLiam Girdwood printk(KERN_ERR "asoc: failed to probe platform %s\n", 1337*f0fba2adSLiam Girdwood platform->name); 1338*f0fba2adSLiam Girdwood return ret; 1339*f0fba2adSLiam Girdwood } 1340*f0fba2adSLiam Girdwood } 1341*f0fba2adSLiam Girdwood /* mark platform as probed and add to card platform list */ 1342*f0fba2adSLiam Girdwood platform->probed = 1; 1343*f0fba2adSLiam Girdwood list_add(&platform->card_list, &card->platform_dev_list); 1344*f0fba2adSLiam Girdwood } 1345*f0fba2adSLiam Girdwood 1346*f0fba2adSLiam Girdwood /* probe the CODEC DAI */ 1347*f0fba2adSLiam Girdwood if (!codec_dai->probed) { 1348*f0fba2adSLiam Girdwood if (codec_dai->driver->probe) { 1349*f0fba2adSLiam Girdwood ret = codec_dai->driver->probe(codec_dai); 1350*f0fba2adSLiam Girdwood if (ret < 0) { 1351*f0fba2adSLiam Girdwood printk(KERN_ERR "asoc: failed to probe CODEC DAI %s\n", 1352*f0fba2adSLiam Girdwood codec_dai->name); 1353*f0fba2adSLiam Girdwood return ret; 1354*f0fba2adSLiam Girdwood } 1355*f0fba2adSLiam Girdwood } 1356*f0fba2adSLiam Girdwood 1357*f0fba2adSLiam Girdwood /* mark cpu_dai as probed and add to card cpu_dai list */ 1358*f0fba2adSLiam Girdwood codec_dai->probed = 1; 1359*f0fba2adSLiam Girdwood list_add(&codec_dai->card_list, &card->dai_dev_list); 1360*f0fba2adSLiam Girdwood } 1361*f0fba2adSLiam Girdwood 1362*f0fba2adSLiam Girdwood /* DAPM dai link stream work */ 1363*f0fba2adSLiam Girdwood INIT_DELAYED_WORK(&rtd->delayed_work, close_delayed_work); 1364*f0fba2adSLiam Girdwood 1365*f0fba2adSLiam Girdwood /* now that all clients have probed, initialise the DAI link */ 1366*f0fba2adSLiam Girdwood if (dai_link->init) { 1367*f0fba2adSLiam Girdwood ret = dai_link->init(rtd); 1368*f0fba2adSLiam Girdwood if (ret < 0) { 1369*f0fba2adSLiam Girdwood printk(KERN_ERR "asoc: failed to init %s\n", dai_link->stream_name); 1370*f0fba2adSLiam Girdwood return ret; 1371*f0fba2adSLiam Girdwood } 1372*f0fba2adSLiam Girdwood } 1373*f0fba2adSLiam Girdwood 1374*f0fba2adSLiam Girdwood /* Make sure all DAPM widgets are instantiated */ 1375*f0fba2adSLiam Girdwood snd_soc_dapm_new_widgets(codec); 1376*f0fba2adSLiam Girdwood snd_soc_dapm_sync(codec); 1377*f0fba2adSLiam Girdwood 1378*f0fba2adSLiam Girdwood /* register the rtd device */ 1379*f0fba2adSLiam Girdwood rtd->dev.init_name = rtd->dai_link->stream_name; 1380*f0fba2adSLiam Girdwood rtd->dev.release = rtd_release; 1381*f0fba2adSLiam Girdwood rtd->dev.init_name = dai_link->name; 1382*f0fba2adSLiam Girdwood ret = device_register(&rtd->dev); 1383*f0fba2adSLiam Girdwood if (ret < 0) { 1384*f0fba2adSLiam Girdwood printk(KERN_ERR "asoc: failed to register DAI runtime device %d\n", ret); 1385*f0fba2adSLiam Girdwood return ret; 1386*f0fba2adSLiam Girdwood } 1387*f0fba2adSLiam Girdwood 1388*f0fba2adSLiam Girdwood rtd->dev_registered = 1; 1389*f0fba2adSLiam Girdwood ret = device_create_file(&rtd->dev, &dev_attr_pmdown_time); 1390*f0fba2adSLiam Girdwood if (ret < 0) 1391*f0fba2adSLiam Girdwood printk(KERN_WARNING "asoc: failed to add pmdown_time sysfs\n"); 1392*f0fba2adSLiam Girdwood 1393*f0fba2adSLiam Girdwood /* add DAPM sysfs entries for this codec */ 1394*f0fba2adSLiam Girdwood ret = snd_soc_dapm_sys_add(&rtd->dev); 1395*f0fba2adSLiam Girdwood if (ret < 0) 1396*f0fba2adSLiam Girdwood printk(KERN_WARNING "asoc: failed to add codec dapm sysfs entries\n"); 1397*f0fba2adSLiam Girdwood 1398*f0fba2adSLiam Girdwood /* add codec sysfs entries */ 1399*f0fba2adSLiam Girdwood ret = device_create_file(&rtd->dev, &dev_attr_codec_reg); 1400*f0fba2adSLiam Girdwood if (ret < 0) 1401*f0fba2adSLiam Girdwood printk(KERN_WARNING "asoc: failed to add codec sysfs files\n"); 1402*f0fba2adSLiam Girdwood 1403*f0fba2adSLiam Girdwood soc_init_codec_debugfs(codec); 1404*f0fba2adSLiam Girdwood 1405*f0fba2adSLiam Girdwood /* create the pcm */ 1406*f0fba2adSLiam Girdwood ret = soc_new_pcm(rtd, num); 1407*f0fba2adSLiam Girdwood if (ret < 0) { 1408*f0fba2adSLiam Girdwood printk(KERN_ERR "asoc: can't create pcm %s\n", dai_link->stream_name); 1409*f0fba2adSLiam Girdwood return ret; 1410*f0fba2adSLiam Girdwood } 1411*f0fba2adSLiam Girdwood 1412*f0fba2adSLiam Girdwood /* add platform data for AC97 devices */ 1413*f0fba2adSLiam Girdwood if (rtd->codec_dai->driver->ac97_control) 1414*f0fba2adSLiam Girdwood snd_ac97_dev_add_pdata(codec->ac97, rtd->cpu_dai->ac97_pdata); 1415*f0fba2adSLiam Girdwood 1416*f0fba2adSLiam Girdwood return 0; 1417*f0fba2adSLiam Girdwood } 1418*f0fba2adSLiam Girdwood 1419*f0fba2adSLiam Girdwood #ifdef CONFIG_SND_SOC_AC97_BUS 1420*f0fba2adSLiam Girdwood static int soc_register_ac97_dai_link(struct snd_soc_pcm_runtime *rtd) 1421*f0fba2adSLiam Girdwood { 1422*f0fba2adSLiam Girdwood int ret; 1423*f0fba2adSLiam Girdwood 1424*f0fba2adSLiam Girdwood /* Only instantiate AC97 if not already done by the adaptor 1425*f0fba2adSLiam Girdwood * for the generic AC97 subsystem. 14266b05eda6SMark Brown */ 1427*f0fba2adSLiam Girdwood if (rtd->codec_dai->driver->ac97_control && !rtd->codec->ac97_registered) { 1428*f0fba2adSLiam Girdwood 1429*f0fba2adSLiam Girdwood ret = soc_ac97_dev_register(rtd->codec); 1430*f0fba2adSLiam Girdwood if (ret < 0) { 1431*f0fba2adSLiam Girdwood printk(KERN_ERR "asoc: AC97 device register failed\n"); 1432*f0fba2adSLiam Girdwood return ret; 1433435c5e25SMark Brown } 1434435c5e25SMark Brown 1435*f0fba2adSLiam Girdwood rtd->codec->ac97_registered = 1; 1436*f0fba2adSLiam Girdwood } 1437*f0fba2adSLiam Girdwood return 0; 1438*f0fba2adSLiam Girdwood } 1439435c5e25SMark Brown 1440*f0fba2adSLiam Girdwood static void soc_unregister_ac97_dai_link(struct snd_soc_codec *codec) 1441*f0fba2adSLiam Girdwood { 1442*f0fba2adSLiam Girdwood if (codec->ac97_registered) { 1443*f0fba2adSLiam Girdwood soc_ac97_dev_unregister(codec); 1444*f0fba2adSLiam Girdwood codec->ac97_registered = 0; 1445*f0fba2adSLiam Girdwood } 1446*f0fba2adSLiam Girdwood } 1447*f0fba2adSLiam Girdwood #endif 1448435c5e25SMark Brown 1449*f0fba2adSLiam Girdwood static void snd_soc_instantiate_card(struct snd_soc_card *card) 1450*f0fba2adSLiam Girdwood { 1451*f0fba2adSLiam Girdwood struct platform_device *pdev = to_platform_device(card->dev); 1452*f0fba2adSLiam Girdwood int ret, i; 145396dd3622SMark Brown 1454*f0fba2adSLiam Girdwood mutex_lock(&card->mutex); 1455*f0fba2adSLiam Girdwood 1456*f0fba2adSLiam Girdwood if (card->instantiated) { 1457*f0fba2adSLiam Girdwood mutex_unlock(&card->mutex); 1458435c5e25SMark Brown return; 1459db2a4165SFrank Mandarino } 1460db2a4165SFrank Mandarino 1461*f0fba2adSLiam Girdwood /* bind DAIs */ 1462*f0fba2adSLiam Girdwood for (i = 0; i < card->num_links; i++) 1463*f0fba2adSLiam Girdwood soc_bind_dai_link(card, i); 1464*f0fba2adSLiam Girdwood 1465*f0fba2adSLiam Girdwood /* bind completed ? */ 1466*f0fba2adSLiam Girdwood if (card->num_rtd != card->num_links) { 1467*f0fba2adSLiam Girdwood mutex_unlock(&card->mutex); 1468*f0fba2adSLiam Girdwood return; 1469db2a4165SFrank Mandarino } 1470db2a4165SFrank Mandarino 1471*f0fba2adSLiam Girdwood /* card bind complete so register a sound card */ 1472*f0fba2adSLiam Girdwood ret = snd_card_create(SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1, 1473*f0fba2adSLiam Girdwood card->owner, 0, &card->snd_card); 1474*f0fba2adSLiam Girdwood if (ret < 0) { 1475*f0fba2adSLiam Girdwood printk(KERN_ERR "asoc: can't create sound card for card %s\n", 1476*f0fba2adSLiam Girdwood card->name); 1477*f0fba2adSLiam Girdwood mutex_unlock(&card->mutex); 1478*f0fba2adSLiam Girdwood return; 1479db2a4165SFrank Mandarino } 1480*f0fba2adSLiam Girdwood card->snd_card->dev = card->dev; 1481db2a4165SFrank Mandarino 14821301a964SRandy Dunlap #ifdef CONFIG_PM 14836ed25978SAndy Green /* deferred resume work */ 14846308419aSMark Brown INIT_WORK(&card->deferred_resume_work, soc_resume_deferred); 14851301a964SRandy Dunlap #endif 14866ed25978SAndy Green 1487*f0fba2adSLiam Girdwood /* initialise the sound card only once */ 1488*f0fba2adSLiam Girdwood if (card->probe) { 1489*f0fba2adSLiam Girdwood ret = card->probe(pdev); 1490*f0fba2adSLiam Girdwood if (ret < 0) 1491*f0fba2adSLiam Girdwood goto card_probe_error; 1492*f0fba2adSLiam Girdwood } 1493*f0fba2adSLiam Girdwood 1494fe3e78e0SMark Brown for (i = 0; i < card->num_links; i++) { 1495*f0fba2adSLiam Girdwood ret = soc_probe_dai_link(card, i); 1496fe3e78e0SMark Brown if (ret < 0) { 1497*f0fba2adSLiam Girdwood printk(KERN_ERR "asoc: failed to instanciate card %s\n", card->name); 1498*f0fba2adSLiam Girdwood goto probe_dai_err; 1499fe3e78e0SMark Brown } 1500fe3e78e0SMark Brown } 1501fe3e78e0SMark Brown 1502*f0fba2adSLiam Girdwood snprintf(card->snd_card->shortname, sizeof(card->snd_card->shortname), 1503fe3e78e0SMark Brown "%s", card->name); 1504*f0fba2adSLiam Girdwood snprintf(card->snd_card->longname, sizeof(card->snd_card->longname), 1505*f0fba2adSLiam Girdwood "%s", card->name); 1506fe3e78e0SMark Brown 1507*f0fba2adSLiam Girdwood ret = snd_card_register(card->snd_card); 1508fe3e78e0SMark Brown if (ret < 0) { 1509*f0fba2adSLiam Girdwood printk(KERN_ERR "asoc: failed to register soundcard for %s\n", card->name); 1510*f0fba2adSLiam Girdwood goto probe_dai_err; 1511fe3e78e0SMark Brown } 1512fe3e78e0SMark Brown 1513fe3e78e0SMark Brown #ifdef CONFIG_SND_SOC_AC97_BUS 1514*f0fba2adSLiam Girdwood /* register any AC97 codecs */ 1515*f0fba2adSLiam Girdwood for (i = 0; i < card->num_rtd; i++) { 1516*f0fba2adSLiam Girdwood ret = soc_register_ac97_dai_link(&card->rtd[i]); 1517fe3e78e0SMark Brown if (ret < 0) { 1518*f0fba2adSLiam Girdwood printk(KERN_ERR "asoc: failed to register AC97 %s\n", card->name); 1519*f0fba2adSLiam Girdwood goto probe_dai_err; 1520fe3e78e0SMark Brown } 1521fe3e78e0SMark Brown } 1522fe3e78e0SMark Brown #endif 1523fe3e78e0SMark Brown 1524435c5e25SMark Brown card->instantiated = 1; 1525*f0fba2adSLiam Girdwood mutex_unlock(&card->mutex); 1526435c5e25SMark Brown return; 1527db2a4165SFrank Mandarino 1528*f0fba2adSLiam Girdwood probe_dai_err: 1529*f0fba2adSLiam Girdwood for (i = 0; i < card->num_links; i++) 1530*f0fba2adSLiam Girdwood soc_remove_dai_link(card, i); 1531fe3e78e0SMark Brown 1532*f0fba2adSLiam Girdwood card_probe_error: 153387506549SMark Brown if (card->remove) 153487506549SMark Brown card->remove(pdev); 1535*f0fba2adSLiam Girdwood 1536*f0fba2adSLiam Girdwood snd_card_free(card->snd_card); 1537*f0fba2adSLiam Girdwood 1538*f0fba2adSLiam Girdwood mutex_unlock(&card->mutex); 1539435c5e25SMark Brown } 1540db2a4165SFrank Mandarino 1541435c5e25SMark Brown /* 1542435c5e25SMark Brown * Attempt to initialise any uninitalised cards. Must be called with 1543435c5e25SMark Brown * client_mutex. 1544435c5e25SMark Brown */ 1545435c5e25SMark Brown static void snd_soc_instantiate_cards(void) 1546435c5e25SMark Brown { 1547435c5e25SMark Brown struct snd_soc_card *card; 1548435c5e25SMark Brown list_for_each_entry(card, &card_list, list) 1549435c5e25SMark Brown snd_soc_instantiate_card(card); 1550435c5e25SMark Brown } 1551435c5e25SMark Brown 1552435c5e25SMark Brown /* probes a new socdev */ 1553435c5e25SMark Brown static int soc_probe(struct platform_device *pdev) 1554435c5e25SMark Brown { 1555*f0fba2adSLiam Girdwood struct snd_soc_card *card = platform_get_drvdata(pdev); 1556435c5e25SMark Brown int ret = 0; 1557435c5e25SMark Brown 1558435c5e25SMark Brown /* Bodge while we unpick instantiation */ 1559435c5e25SMark Brown card->dev = &pdev->dev; 1560*f0fba2adSLiam Girdwood INIT_LIST_HEAD(&card->dai_dev_list); 1561*f0fba2adSLiam Girdwood INIT_LIST_HEAD(&card->codec_dev_list); 1562*f0fba2adSLiam Girdwood INIT_LIST_HEAD(&card->platform_dev_list); 1563*f0fba2adSLiam Girdwood 1564435c5e25SMark Brown ret = snd_soc_register_card(card); 1565435c5e25SMark Brown if (ret != 0) { 1566435c5e25SMark Brown dev_err(&pdev->dev, "Failed to register card\n"); 1567db2a4165SFrank Mandarino return ret; 1568db2a4165SFrank Mandarino } 1569db2a4165SFrank Mandarino 1570435c5e25SMark Brown return 0; 1571435c5e25SMark Brown } 1572435c5e25SMark Brown 1573db2a4165SFrank Mandarino /* removes a socdev */ 1574db2a4165SFrank Mandarino static int soc_remove(struct platform_device *pdev) 1575db2a4165SFrank Mandarino { 1576*f0fba2adSLiam Girdwood struct snd_soc_card *card = platform_get_drvdata(pdev); 1577db2a4165SFrank Mandarino int i; 1578db2a4165SFrank Mandarino 1579b2dfa62cSGuennadi Liakhovetski if (card->instantiated) { 1580965ac42cSLiam Girdwood 1581*f0fba2adSLiam Girdwood /* make sure any delayed work runs */ 1582*f0fba2adSLiam Girdwood for (i = 0; i < card->num_rtd; i++) { 1583*f0fba2adSLiam Girdwood struct snd_soc_pcm_runtime *rtd = &card->rtd[i]; 1584*f0fba2adSLiam Girdwood run_delayed_work(&rtd->delayed_work); 1585db2a4165SFrank Mandarino } 1586db2a4165SFrank Mandarino 1587*f0fba2adSLiam Girdwood /* remove and free each DAI */ 1588*f0fba2adSLiam Girdwood for (i = 0; i < card->num_rtd; i++) 1589*f0fba2adSLiam Girdwood soc_remove_dai_link(card, i); 1590*f0fba2adSLiam Girdwood 1591*f0fba2adSLiam Girdwood /* remove the card */ 159287506549SMark Brown if (card->remove) 159387506549SMark Brown card->remove(pdev); 1594*f0fba2adSLiam Girdwood 1595*f0fba2adSLiam Girdwood kfree(card->rtd); 1596*f0fba2adSLiam Girdwood snd_card_free(card->snd_card); 1597b2dfa62cSGuennadi Liakhovetski } 1598c5af3a2eSMark Brown snd_soc_unregister_card(card); 1599db2a4165SFrank Mandarino return 0; 1600db2a4165SFrank Mandarino } 1601db2a4165SFrank Mandarino 1602416356fcSMark Brown static int soc_poweroff(struct device *dev) 160351737470SMark Brown { 1604416356fcSMark Brown struct platform_device *pdev = to_platform_device(dev); 1605*f0fba2adSLiam Girdwood struct snd_soc_card *card = platform_get_drvdata(pdev); 1606*f0fba2adSLiam Girdwood int i; 160751737470SMark Brown 160851737470SMark Brown if (!card->instantiated) 1609416356fcSMark Brown return 0; 161051737470SMark Brown 161151737470SMark Brown /* Flush out pmdown_time work - we actually do want to run it 161251737470SMark Brown * now, we're shutting down so no imminent restart. */ 1613*f0fba2adSLiam Girdwood for (i = 0; i < card->num_rtd; i++) { 1614*f0fba2adSLiam Girdwood struct snd_soc_pcm_runtime *rtd = &card->rtd[i]; 1615*f0fba2adSLiam Girdwood run_delayed_work(&rtd->delayed_work); 1616*f0fba2adSLiam Girdwood } 161751737470SMark Brown 1618*f0fba2adSLiam Girdwood snd_soc_dapm_shutdown(card); 1619416356fcSMark Brown 1620416356fcSMark Brown return 0; 162151737470SMark Brown } 162251737470SMark Brown 162347145210SAlexey Dobriyan static const struct dev_pm_ops soc_pm_ops = { 1624416356fcSMark Brown .suspend = soc_suspend, 1625416356fcSMark Brown .resume = soc_resume, 1626416356fcSMark Brown .poweroff = soc_poweroff, 1627416356fcSMark Brown }; 1628416356fcSMark Brown 1629db2a4165SFrank Mandarino /* ASoC platform driver */ 1630db2a4165SFrank Mandarino static struct platform_driver soc_driver = { 1631db2a4165SFrank Mandarino .driver = { 1632db2a4165SFrank Mandarino .name = "soc-audio", 16338b45a209SKay Sievers .owner = THIS_MODULE, 1634416356fcSMark Brown .pm = &soc_pm_ops, 1635db2a4165SFrank Mandarino }, 1636db2a4165SFrank Mandarino .probe = soc_probe, 1637db2a4165SFrank Mandarino .remove = soc_remove, 1638db2a4165SFrank Mandarino }; 1639db2a4165SFrank Mandarino 1640db2a4165SFrank Mandarino /* create a new pcm */ 1641*f0fba2adSLiam Girdwood static int soc_new_pcm(struct snd_soc_pcm_runtime *rtd, int num) 1642db2a4165SFrank Mandarino { 1643*f0fba2adSLiam Girdwood struct snd_soc_codec *codec = rtd->codec; 1644*f0fba2adSLiam Girdwood struct snd_soc_platform *platform = rtd->platform; 1645*f0fba2adSLiam Girdwood struct snd_soc_dai *codec_dai = rtd->codec_dai; 1646*f0fba2adSLiam Girdwood struct snd_soc_dai *cpu_dai = rtd->cpu_dai; 1647db2a4165SFrank Mandarino struct snd_pcm *pcm; 1648db2a4165SFrank Mandarino char new_name[64]; 1649db2a4165SFrank Mandarino int ret = 0, playback = 0, capture = 0; 1650db2a4165SFrank Mandarino 1651db2a4165SFrank Mandarino /* check client and interface hw capabilities */ 165240ca1142SMark Brown snprintf(new_name, sizeof(new_name), "%s %s-%d", 1653*f0fba2adSLiam Girdwood rtd->dai_link->stream_name, codec_dai->name, num); 1654db2a4165SFrank Mandarino 1655*f0fba2adSLiam Girdwood if (codec_dai->driver->playback.channels_min) 1656db2a4165SFrank Mandarino playback = 1; 1657*f0fba2adSLiam Girdwood if (codec_dai->driver->capture.channels_min) 1658db2a4165SFrank Mandarino capture = 1; 1659db2a4165SFrank Mandarino 1660*f0fba2adSLiam Girdwood dev_dbg(rtd->card->dev, "registered pcm #%d %s\n",num,new_name); 1661*f0fba2adSLiam Girdwood ret = snd_pcm_new(rtd->card->snd_card, new_name, 1662*f0fba2adSLiam Girdwood num, playback, capture, &pcm); 1663db2a4165SFrank Mandarino if (ret < 0) { 1664*f0fba2adSLiam Girdwood printk(KERN_ERR "asoc: can't create pcm for codec %s\n", codec->name); 1665db2a4165SFrank Mandarino return ret; 1666db2a4165SFrank Mandarino } 1667db2a4165SFrank Mandarino 1668*f0fba2adSLiam Girdwood rtd->pcm = pcm; 1669db2a4165SFrank Mandarino pcm->private_data = rtd; 1670*f0fba2adSLiam Girdwood soc_pcm_ops.mmap = platform->driver->ops->mmap; 1671*f0fba2adSLiam Girdwood soc_pcm_ops.pointer = platform->driver->ops->pointer; 1672*f0fba2adSLiam Girdwood soc_pcm_ops.ioctl = platform->driver->ops->ioctl; 1673*f0fba2adSLiam Girdwood soc_pcm_ops.copy = platform->driver->ops->copy; 1674*f0fba2adSLiam Girdwood soc_pcm_ops.silence = platform->driver->ops->silence; 1675*f0fba2adSLiam Girdwood soc_pcm_ops.ack = platform->driver->ops->ack; 1676*f0fba2adSLiam Girdwood soc_pcm_ops.page = platform->driver->ops->page; 1677db2a4165SFrank Mandarino 1678db2a4165SFrank Mandarino if (playback) 1679db2a4165SFrank Mandarino snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &soc_pcm_ops); 1680db2a4165SFrank Mandarino 1681db2a4165SFrank Mandarino if (capture) 1682db2a4165SFrank Mandarino snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &soc_pcm_ops); 1683db2a4165SFrank Mandarino 1684*f0fba2adSLiam Girdwood ret = platform->driver->pcm_new(rtd->card->snd_card, codec_dai, pcm); 1685db2a4165SFrank Mandarino if (ret < 0) { 1686db2a4165SFrank Mandarino printk(KERN_ERR "asoc: platform pcm constructor failed\n"); 1687db2a4165SFrank Mandarino return ret; 1688db2a4165SFrank Mandarino } 1689db2a4165SFrank Mandarino 1690*f0fba2adSLiam Girdwood pcm->private_free = platform->driver->pcm_free; 1691db2a4165SFrank Mandarino printk(KERN_INFO "asoc: %s <-> %s mapping ok\n", codec_dai->name, 1692db2a4165SFrank Mandarino cpu_dai->name); 1693db2a4165SFrank Mandarino return ret; 1694db2a4165SFrank Mandarino } 1695db2a4165SFrank Mandarino 1696096e49d5SMark Brown /** 1697096e49d5SMark Brown * snd_soc_codec_volatile_register: Report if a register is volatile. 1698096e49d5SMark Brown * 1699096e49d5SMark Brown * @codec: CODEC to query. 1700096e49d5SMark Brown * @reg: Register to query. 1701096e49d5SMark Brown * 1702096e49d5SMark Brown * Boolean function indiciating if a CODEC register is volatile. 1703096e49d5SMark Brown */ 1704096e49d5SMark Brown int snd_soc_codec_volatile_register(struct snd_soc_codec *codec, int reg) 1705096e49d5SMark Brown { 1706*f0fba2adSLiam Girdwood if (codec->driver->volatile_register) 1707*f0fba2adSLiam Girdwood return codec->driver->volatile_register(reg); 1708096e49d5SMark Brown else 1709096e49d5SMark Brown return 0; 1710096e49d5SMark Brown } 1711096e49d5SMark Brown EXPORT_SYMBOL_GPL(snd_soc_codec_volatile_register); 1712096e49d5SMark Brown 1713db2a4165SFrank Mandarino /** 1714db2a4165SFrank Mandarino * snd_soc_new_ac97_codec - initailise AC97 device 1715db2a4165SFrank Mandarino * @codec: audio codec 1716db2a4165SFrank Mandarino * @ops: AC97 bus operations 1717db2a4165SFrank Mandarino * @num: AC97 codec number 1718db2a4165SFrank Mandarino * 1719db2a4165SFrank Mandarino * Initialises AC97 codec resources for use by ad-hoc devices only. 1720db2a4165SFrank Mandarino */ 1721db2a4165SFrank Mandarino int snd_soc_new_ac97_codec(struct snd_soc_codec *codec, 1722db2a4165SFrank Mandarino struct snd_ac97_bus_ops *ops, int num) 1723db2a4165SFrank Mandarino { 1724db2a4165SFrank Mandarino mutex_lock(&codec->mutex); 1725db2a4165SFrank Mandarino 1726db2a4165SFrank Mandarino codec->ac97 = kzalloc(sizeof(struct snd_ac97), GFP_KERNEL); 1727db2a4165SFrank Mandarino if (codec->ac97 == NULL) { 1728db2a4165SFrank Mandarino mutex_unlock(&codec->mutex); 1729db2a4165SFrank Mandarino return -ENOMEM; 1730db2a4165SFrank Mandarino } 1731db2a4165SFrank Mandarino 1732db2a4165SFrank Mandarino codec->ac97->bus = kzalloc(sizeof(struct snd_ac97_bus), GFP_KERNEL); 1733db2a4165SFrank Mandarino if (codec->ac97->bus == NULL) { 1734db2a4165SFrank Mandarino kfree(codec->ac97); 1735db2a4165SFrank Mandarino codec->ac97 = NULL; 1736db2a4165SFrank Mandarino mutex_unlock(&codec->mutex); 1737db2a4165SFrank Mandarino return -ENOMEM; 1738db2a4165SFrank Mandarino } 1739db2a4165SFrank Mandarino 1740db2a4165SFrank Mandarino codec->ac97->bus->ops = ops; 1741db2a4165SFrank Mandarino codec->ac97->num = num; 1742db2a4165SFrank Mandarino mutex_unlock(&codec->mutex); 1743db2a4165SFrank Mandarino return 0; 1744db2a4165SFrank Mandarino } 1745db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_new_ac97_codec); 1746db2a4165SFrank Mandarino 1747db2a4165SFrank Mandarino /** 1748db2a4165SFrank Mandarino * snd_soc_free_ac97_codec - free AC97 codec device 1749db2a4165SFrank Mandarino * @codec: audio codec 1750db2a4165SFrank Mandarino * 1751db2a4165SFrank Mandarino * Frees AC97 codec device resources. 1752db2a4165SFrank Mandarino */ 1753db2a4165SFrank Mandarino void snd_soc_free_ac97_codec(struct snd_soc_codec *codec) 1754db2a4165SFrank Mandarino { 1755db2a4165SFrank Mandarino mutex_lock(&codec->mutex); 1756*f0fba2adSLiam Girdwood #ifdef CONFIG_SND_SOC_AC97_BUS 1757*f0fba2adSLiam Girdwood soc_unregister_ac97_dai_link(codec); 1758*f0fba2adSLiam Girdwood #endif 1759db2a4165SFrank Mandarino kfree(codec->ac97->bus); 1760db2a4165SFrank Mandarino kfree(codec->ac97); 1761db2a4165SFrank Mandarino codec->ac97 = NULL; 1762db2a4165SFrank Mandarino mutex_unlock(&codec->mutex); 1763db2a4165SFrank Mandarino } 1764db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_free_ac97_codec); 1765db2a4165SFrank Mandarino 1766db2a4165SFrank Mandarino /** 1767db2a4165SFrank Mandarino * snd_soc_update_bits - update codec register bits 1768db2a4165SFrank Mandarino * @codec: audio codec 1769db2a4165SFrank Mandarino * @reg: codec register 1770db2a4165SFrank Mandarino * @mask: register mask 1771db2a4165SFrank Mandarino * @value: new value 1772db2a4165SFrank Mandarino * 1773db2a4165SFrank Mandarino * Writes new register value. 1774db2a4165SFrank Mandarino * 1775db2a4165SFrank Mandarino * Returns 1 for change else 0. 1776db2a4165SFrank Mandarino */ 1777db2a4165SFrank Mandarino int snd_soc_update_bits(struct snd_soc_codec *codec, unsigned short reg, 177846f5822fSDaniel Ribeiro unsigned int mask, unsigned int value) 1779db2a4165SFrank Mandarino { 1780db2a4165SFrank Mandarino int change; 178146f5822fSDaniel Ribeiro unsigned int old, new; 1782db2a4165SFrank Mandarino 1783db2a4165SFrank Mandarino old = snd_soc_read(codec, reg); 1784db2a4165SFrank Mandarino new = (old & ~mask) | value; 1785db2a4165SFrank Mandarino change = old != new; 1786db2a4165SFrank Mandarino if (change) 1787db2a4165SFrank Mandarino snd_soc_write(codec, reg, new); 1788db2a4165SFrank Mandarino 1789db2a4165SFrank Mandarino return change; 1790db2a4165SFrank Mandarino } 1791db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_update_bits); 1792db2a4165SFrank Mandarino 1793db2a4165SFrank Mandarino /** 17946c508c62SEero Nurkkala * snd_soc_update_bits_locked - update codec register bits 17956c508c62SEero Nurkkala * @codec: audio codec 17966c508c62SEero Nurkkala * @reg: codec register 17976c508c62SEero Nurkkala * @mask: register mask 17986c508c62SEero Nurkkala * @value: new value 17996c508c62SEero Nurkkala * 18006c508c62SEero Nurkkala * Writes new register value, and takes the codec mutex. 18016c508c62SEero Nurkkala * 18026c508c62SEero Nurkkala * Returns 1 for change else 0. 18036c508c62SEero Nurkkala */ 1804dd1b3d53SMark Brown int snd_soc_update_bits_locked(struct snd_soc_codec *codec, 18056c508c62SEero Nurkkala unsigned short reg, unsigned int mask, 18066c508c62SEero Nurkkala unsigned int value) 18076c508c62SEero Nurkkala { 18086c508c62SEero Nurkkala int change; 18096c508c62SEero Nurkkala 18106c508c62SEero Nurkkala mutex_lock(&codec->mutex); 18116c508c62SEero Nurkkala change = snd_soc_update_bits(codec, reg, mask, value); 18126c508c62SEero Nurkkala mutex_unlock(&codec->mutex); 18136c508c62SEero Nurkkala 18146c508c62SEero Nurkkala return change; 18156c508c62SEero Nurkkala } 1816dd1b3d53SMark Brown EXPORT_SYMBOL_GPL(snd_soc_update_bits_locked); 18176c508c62SEero Nurkkala 18186c508c62SEero Nurkkala /** 1819db2a4165SFrank Mandarino * snd_soc_test_bits - test register for change 1820db2a4165SFrank Mandarino * @codec: audio codec 1821db2a4165SFrank Mandarino * @reg: codec register 1822db2a4165SFrank Mandarino * @mask: register mask 1823db2a4165SFrank Mandarino * @value: new value 1824db2a4165SFrank Mandarino * 1825db2a4165SFrank Mandarino * Tests a register with a new value and checks if the new value is 1826db2a4165SFrank Mandarino * different from the old value. 1827db2a4165SFrank Mandarino * 1828db2a4165SFrank Mandarino * Returns 1 for change else 0. 1829db2a4165SFrank Mandarino */ 1830db2a4165SFrank Mandarino int snd_soc_test_bits(struct snd_soc_codec *codec, unsigned short reg, 183146f5822fSDaniel Ribeiro unsigned int mask, unsigned int value) 1832db2a4165SFrank Mandarino { 1833db2a4165SFrank Mandarino int change; 183446f5822fSDaniel Ribeiro unsigned int old, new; 1835db2a4165SFrank Mandarino 1836db2a4165SFrank Mandarino old = snd_soc_read(codec, reg); 1837db2a4165SFrank Mandarino new = (old & ~mask) | value; 1838db2a4165SFrank Mandarino change = old != new; 1839db2a4165SFrank Mandarino 1840db2a4165SFrank Mandarino return change; 1841db2a4165SFrank Mandarino } 1842db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_test_bits); 1843db2a4165SFrank Mandarino 1844db2a4165SFrank Mandarino /** 1845db2a4165SFrank Mandarino * snd_soc_set_runtime_hwparams - set the runtime hardware parameters 1846db2a4165SFrank Mandarino * @substream: the pcm substream 1847db2a4165SFrank Mandarino * @hw: the hardware parameters 1848db2a4165SFrank Mandarino * 1849db2a4165SFrank Mandarino * Sets the substream runtime hardware parameters. 1850db2a4165SFrank Mandarino */ 1851db2a4165SFrank Mandarino int snd_soc_set_runtime_hwparams(struct snd_pcm_substream *substream, 1852db2a4165SFrank Mandarino const struct snd_pcm_hardware *hw) 1853db2a4165SFrank Mandarino { 1854db2a4165SFrank Mandarino struct snd_pcm_runtime *runtime = substream->runtime; 1855db2a4165SFrank Mandarino runtime->hw.info = hw->info; 1856db2a4165SFrank Mandarino runtime->hw.formats = hw->formats; 1857db2a4165SFrank Mandarino runtime->hw.period_bytes_min = hw->period_bytes_min; 1858db2a4165SFrank Mandarino runtime->hw.period_bytes_max = hw->period_bytes_max; 1859db2a4165SFrank Mandarino runtime->hw.periods_min = hw->periods_min; 1860db2a4165SFrank Mandarino runtime->hw.periods_max = hw->periods_max; 1861db2a4165SFrank Mandarino runtime->hw.buffer_bytes_max = hw->buffer_bytes_max; 1862db2a4165SFrank Mandarino runtime->hw.fifo_size = hw->fifo_size; 1863db2a4165SFrank Mandarino return 0; 1864db2a4165SFrank Mandarino } 1865db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_set_runtime_hwparams); 1866db2a4165SFrank Mandarino 1867db2a4165SFrank Mandarino /** 1868db2a4165SFrank Mandarino * snd_soc_cnew - create new control 1869db2a4165SFrank Mandarino * @_template: control template 1870db2a4165SFrank Mandarino * @data: control private data 1871ac11a2b3SMark Brown * @long_name: control long name 1872db2a4165SFrank Mandarino * 1873db2a4165SFrank Mandarino * Create a new mixer control from a template control. 1874db2a4165SFrank Mandarino * 1875db2a4165SFrank Mandarino * Returns 0 for success, else error. 1876db2a4165SFrank Mandarino */ 1877db2a4165SFrank Mandarino struct snd_kcontrol *snd_soc_cnew(const struct snd_kcontrol_new *_template, 1878db2a4165SFrank Mandarino void *data, char *long_name) 1879db2a4165SFrank Mandarino { 1880db2a4165SFrank Mandarino struct snd_kcontrol_new template; 1881db2a4165SFrank Mandarino 1882db2a4165SFrank Mandarino memcpy(&template, _template, sizeof(template)); 1883db2a4165SFrank Mandarino if (long_name) 1884db2a4165SFrank Mandarino template.name = long_name; 1885db2a4165SFrank Mandarino template.index = 0; 1886db2a4165SFrank Mandarino 1887db2a4165SFrank Mandarino return snd_ctl_new1(&template, data); 1888db2a4165SFrank Mandarino } 1889db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_cnew); 1890db2a4165SFrank Mandarino 1891db2a4165SFrank Mandarino /** 18923e8e1952SIan Molton * snd_soc_add_controls - add an array of controls to a codec. 18933e8e1952SIan Molton * Convienience function to add a list of controls. Many codecs were 18943e8e1952SIan Molton * duplicating this code. 18953e8e1952SIan Molton * 18963e8e1952SIan Molton * @codec: codec to add controls to 18973e8e1952SIan Molton * @controls: array of controls to add 18983e8e1952SIan Molton * @num_controls: number of elements in the array 18993e8e1952SIan Molton * 19003e8e1952SIan Molton * Return 0 for success, else error. 19013e8e1952SIan Molton */ 19023e8e1952SIan Molton int snd_soc_add_controls(struct snd_soc_codec *codec, 19033e8e1952SIan Molton const struct snd_kcontrol_new *controls, int num_controls) 19043e8e1952SIan Molton { 1905*f0fba2adSLiam Girdwood struct snd_card *card = codec->card->snd_card; 19063e8e1952SIan Molton int err, i; 19073e8e1952SIan Molton 19083e8e1952SIan Molton for (i = 0; i < num_controls; i++) { 19093e8e1952SIan Molton const struct snd_kcontrol_new *control = &controls[i]; 19103e8e1952SIan Molton err = snd_ctl_add(card, snd_soc_cnew(control, codec, NULL)); 19113e8e1952SIan Molton if (err < 0) { 19123e8e1952SIan Molton dev_err(codec->dev, "%s: Failed to add %s\n", 19133e8e1952SIan Molton codec->name, control->name); 19143e8e1952SIan Molton return err; 19153e8e1952SIan Molton } 19163e8e1952SIan Molton } 19173e8e1952SIan Molton 19183e8e1952SIan Molton return 0; 19193e8e1952SIan Molton } 19203e8e1952SIan Molton EXPORT_SYMBOL_GPL(snd_soc_add_controls); 19213e8e1952SIan Molton 19223e8e1952SIan Molton /** 1923db2a4165SFrank Mandarino * snd_soc_info_enum_double - enumerated double mixer info callback 1924db2a4165SFrank Mandarino * @kcontrol: mixer control 1925db2a4165SFrank Mandarino * @uinfo: control element information 1926db2a4165SFrank Mandarino * 1927db2a4165SFrank Mandarino * Callback to provide information about a double enumerated 1928db2a4165SFrank Mandarino * mixer control. 1929db2a4165SFrank Mandarino * 1930db2a4165SFrank Mandarino * Returns 0 for success. 1931db2a4165SFrank Mandarino */ 1932db2a4165SFrank Mandarino int snd_soc_info_enum_double(struct snd_kcontrol *kcontrol, 1933db2a4165SFrank Mandarino struct snd_ctl_elem_info *uinfo) 1934db2a4165SFrank Mandarino { 1935db2a4165SFrank Mandarino struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; 1936db2a4165SFrank Mandarino 1937db2a4165SFrank Mandarino uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED; 1938db2a4165SFrank Mandarino uinfo->count = e->shift_l == e->shift_r ? 1 : 2; 1939f8ba0b7bSJon Smirl uinfo->value.enumerated.items = e->max; 1940db2a4165SFrank Mandarino 1941f8ba0b7bSJon Smirl if (uinfo->value.enumerated.item > e->max - 1) 1942f8ba0b7bSJon Smirl uinfo->value.enumerated.item = e->max - 1; 1943db2a4165SFrank Mandarino strcpy(uinfo->value.enumerated.name, 1944db2a4165SFrank Mandarino e->texts[uinfo->value.enumerated.item]); 1945db2a4165SFrank Mandarino return 0; 1946db2a4165SFrank Mandarino } 1947db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_info_enum_double); 1948db2a4165SFrank Mandarino 1949db2a4165SFrank Mandarino /** 1950db2a4165SFrank Mandarino * snd_soc_get_enum_double - enumerated double mixer get callback 1951db2a4165SFrank Mandarino * @kcontrol: mixer control 1952ac11a2b3SMark Brown * @ucontrol: control element information 1953db2a4165SFrank Mandarino * 1954db2a4165SFrank Mandarino * Callback to get the value of a double enumerated mixer. 1955db2a4165SFrank Mandarino * 1956db2a4165SFrank Mandarino * Returns 0 for success. 1957db2a4165SFrank Mandarino */ 1958db2a4165SFrank Mandarino int snd_soc_get_enum_double(struct snd_kcontrol *kcontrol, 1959db2a4165SFrank Mandarino struct snd_ctl_elem_value *ucontrol) 1960db2a4165SFrank Mandarino { 1961db2a4165SFrank Mandarino struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 1962db2a4165SFrank Mandarino struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; 196346f5822fSDaniel Ribeiro unsigned int val, bitmask; 1964db2a4165SFrank Mandarino 1965f8ba0b7bSJon Smirl for (bitmask = 1; bitmask < e->max; bitmask <<= 1) 1966db2a4165SFrank Mandarino ; 1967db2a4165SFrank Mandarino val = snd_soc_read(codec, e->reg); 19683ff3f64bSMark Brown ucontrol->value.enumerated.item[0] 19693ff3f64bSMark Brown = (val >> e->shift_l) & (bitmask - 1); 1970db2a4165SFrank Mandarino if (e->shift_l != e->shift_r) 1971db2a4165SFrank Mandarino ucontrol->value.enumerated.item[1] = 1972db2a4165SFrank Mandarino (val >> e->shift_r) & (bitmask - 1); 1973db2a4165SFrank Mandarino 1974db2a4165SFrank Mandarino return 0; 1975db2a4165SFrank Mandarino } 1976db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_get_enum_double); 1977db2a4165SFrank Mandarino 1978db2a4165SFrank Mandarino /** 1979db2a4165SFrank Mandarino * snd_soc_put_enum_double - enumerated double mixer put callback 1980db2a4165SFrank Mandarino * @kcontrol: mixer control 1981ac11a2b3SMark Brown * @ucontrol: control element information 1982db2a4165SFrank Mandarino * 1983db2a4165SFrank Mandarino * Callback to set the value of a double enumerated mixer. 1984db2a4165SFrank Mandarino * 1985db2a4165SFrank Mandarino * Returns 0 for success. 1986db2a4165SFrank Mandarino */ 1987db2a4165SFrank Mandarino int snd_soc_put_enum_double(struct snd_kcontrol *kcontrol, 1988db2a4165SFrank Mandarino struct snd_ctl_elem_value *ucontrol) 1989db2a4165SFrank Mandarino { 1990db2a4165SFrank Mandarino struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 1991db2a4165SFrank Mandarino struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; 199246f5822fSDaniel Ribeiro unsigned int val; 199346f5822fSDaniel Ribeiro unsigned int mask, bitmask; 1994db2a4165SFrank Mandarino 1995f8ba0b7bSJon Smirl for (bitmask = 1; bitmask < e->max; bitmask <<= 1) 1996db2a4165SFrank Mandarino ; 1997f8ba0b7bSJon Smirl if (ucontrol->value.enumerated.item[0] > e->max - 1) 1998db2a4165SFrank Mandarino return -EINVAL; 1999db2a4165SFrank Mandarino val = ucontrol->value.enumerated.item[0] << e->shift_l; 2000db2a4165SFrank Mandarino mask = (bitmask - 1) << e->shift_l; 2001db2a4165SFrank Mandarino if (e->shift_l != e->shift_r) { 2002f8ba0b7bSJon Smirl if (ucontrol->value.enumerated.item[1] > e->max - 1) 2003db2a4165SFrank Mandarino return -EINVAL; 2004db2a4165SFrank Mandarino val |= ucontrol->value.enumerated.item[1] << e->shift_r; 2005db2a4165SFrank Mandarino mask |= (bitmask - 1) << e->shift_r; 2006db2a4165SFrank Mandarino } 2007db2a4165SFrank Mandarino 20086c508c62SEero Nurkkala return snd_soc_update_bits_locked(codec, e->reg, mask, val); 2009db2a4165SFrank Mandarino } 2010db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_put_enum_double); 2011db2a4165SFrank Mandarino 2012db2a4165SFrank Mandarino /** 20132e72f8e3SPeter Ujfalusi * snd_soc_get_value_enum_double - semi enumerated double mixer get callback 20142e72f8e3SPeter Ujfalusi * @kcontrol: mixer control 20152e72f8e3SPeter Ujfalusi * @ucontrol: control element information 20162e72f8e3SPeter Ujfalusi * 20172e72f8e3SPeter Ujfalusi * Callback to get the value of a double semi enumerated mixer. 20182e72f8e3SPeter Ujfalusi * 20192e72f8e3SPeter Ujfalusi * Semi enumerated mixer: the enumerated items are referred as values. Can be 20202e72f8e3SPeter Ujfalusi * used for handling bitfield coded enumeration for example. 20212e72f8e3SPeter Ujfalusi * 20222e72f8e3SPeter Ujfalusi * Returns 0 for success. 20232e72f8e3SPeter Ujfalusi */ 20242e72f8e3SPeter Ujfalusi int snd_soc_get_value_enum_double(struct snd_kcontrol *kcontrol, 20252e72f8e3SPeter Ujfalusi struct snd_ctl_elem_value *ucontrol) 20262e72f8e3SPeter Ujfalusi { 20272e72f8e3SPeter Ujfalusi struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 202874155556SPeter Ujfalusi struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; 202946f5822fSDaniel Ribeiro unsigned int reg_val, val, mux; 20302e72f8e3SPeter Ujfalusi 20312e72f8e3SPeter Ujfalusi reg_val = snd_soc_read(codec, e->reg); 20322e72f8e3SPeter Ujfalusi val = (reg_val >> e->shift_l) & e->mask; 20332e72f8e3SPeter Ujfalusi for (mux = 0; mux < e->max; mux++) { 20342e72f8e3SPeter Ujfalusi if (val == e->values[mux]) 20352e72f8e3SPeter Ujfalusi break; 20362e72f8e3SPeter Ujfalusi } 20372e72f8e3SPeter Ujfalusi ucontrol->value.enumerated.item[0] = mux; 20382e72f8e3SPeter Ujfalusi if (e->shift_l != e->shift_r) { 20392e72f8e3SPeter Ujfalusi val = (reg_val >> e->shift_r) & e->mask; 20402e72f8e3SPeter Ujfalusi for (mux = 0; mux < e->max; mux++) { 20412e72f8e3SPeter Ujfalusi if (val == e->values[mux]) 20422e72f8e3SPeter Ujfalusi break; 20432e72f8e3SPeter Ujfalusi } 20442e72f8e3SPeter Ujfalusi ucontrol->value.enumerated.item[1] = mux; 20452e72f8e3SPeter Ujfalusi } 20462e72f8e3SPeter Ujfalusi 20472e72f8e3SPeter Ujfalusi return 0; 20482e72f8e3SPeter Ujfalusi } 20492e72f8e3SPeter Ujfalusi EXPORT_SYMBOL_GPL(snd_soc_get_value_enum_double); 20502e72f8e3SPeter Ujfalusi 20512e72f8e3SPeter Ujfalusi /** 20522e72f8e3SPeter Ujfalusi * snd_soc_put_value_enum_double - semi enumerated double mixer put callback 20532e72f8e3SPeter Ujfalusi * @kcontrol: mixer control 20542e72f8e3SPeter Ujfalusi * @ucontrol: control element information 20552e72f8e3SPeter Ujfalusi * 20562e72f8e3SPeter Ujfalusi * Callback to set the value of a double semi enumerated mixer. 20572e72f8e3SPeter Ujfalusi * 20582e72f8e3SPeter Ujfalusi * Semi enumerated mixer: the enumerated items are referred as values. Can be 20592e72f8e3SPeter Ujfalusi * used for handling bitfield coded enumeration for example. 20602e72f8e3SPeter Ujfalusi * 20612e72f8e3SPeter Ujfalusi * Returns 0 for success. 20622e72f8e3SPeter Ujfalusi */ 20632e72f8e3SPeter Ujfalusi int snd_soc_put_value_enum_double(struct snd_kcontrol *kcontrol, 20642e72f8e3SPeter Ujfalusi struct snd_ctl_elem_value *ucontrol) 20652e72f8e3SPeter Ujfalusi { 20662e72f8e3SPeter Ujfalusi struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 206774155556SPeter Ujfalusi struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; 206846f5822fSDaniel Ribeiro unsigned int val; 206946f5822fSDaniel Ribeiro unsigned int mask; 20702e72f8e3SPeter Ujfalusi 20712e72f8e3SPeter Ujfalusi if (ucontrol->value.enumerated.item[0] > e->max - 1) 20722e72f8e3SPeter Ujfalusi return -EINVAL; 20732e72f8e3SPeter Ujfalusi val = e->values[ucontrol->value.enumerated.item[0]] << e->shift_l; 20742e72f8e3SPeter Ujfalusi mask = e->mask << e->shift_l; 20752e72f8e3SPeter Ujfalusi if (e->shift_l != e->shift_r) { 20762e72f8e3SPeter Ujfalusi if (ucontrol->value.enumerated.item[1] > e->max - 1) 20772e72f8e3SPeter Ujfalusi return -EINVAL; 20782e72f8e3SPeter Ujfalusi val |= e->values[ucontrol->value.enumerated.item[1]] << e->shift_r; 20792e72f8e3SPeter Ujfalusi mask |= e->mask << e->shift_r; 20802e72f8e3SPeter Ujfalusi } 20812e72f8e3SPeter Ujfalusi 20826c508c62SEero Nurkkala return snd_soc_update_bits_locked(codec, e->reg, mask, val); 20832e72f8e3SPeter Ujfalusi } 20842e72f8e3SPeter Ujfalusi EXPORT_SYMBOL_GPL(snd_soc_put_value_enum_double); 20852e72f8e3SPeter Ujfalusi 20862e72f8e3SPeter Ujfalusi /** 2087db2a4165SFrank Mandarino * snd_soc_info_enum_ext - external enumerated single mixer info callback 2088db2a4165SFrank Mandarino * @kcontrol: mixer control 2089db2a4165SFrank Mandarino * @uinfo: control element information 2090db2a4165SFrank Mandarino * 2091db2a4165SFrank Mandarino * Callback to provide information about an external enumerated 2092db2a4165SFrank Mandarino * single mixer. 2093db2a4165SFrank Mandarino * 2094db2a4165SFrank Mandarino * Returns 0 for success. 2095db2a4165SFrank Mandarino */ 2096db2a4165SFrank Mandarino int snd_soc_info_enum_ext(struct snd_kcontrol *kcontrol, 2097db2a4165SFrank Mandarino struct snd_ctl_elem_info *uinfo) 2098db2a4165SFrank Mandarino { 2099db2a4165SFrank Mandarino struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; 2100db2a4165SFrank Mandarino 2101db2a4165SFrank Mandarino uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED; 2102db2a4165SFrank Mandarino uinfo->count = 1; 2103f8ba0b7bSJon Smirl uinfo->value.enumerated.items = e->max; 2104db2a4165SFrank Mandarino 2105f8ba0b7bSJon Smirl if (uinfo->value.enumerated.item > e->max - 1) 2106f8ba0b7bSJon Smirl uinfo->value.enumerated.item = e->max - 1; 2107db2a4165SFrank Mandarino strcpy(uinfo->value.enumerated.name, 2108db2a4165SFrank Mandarino e->texts[uinfo->value.enumerated.item]); 2109db2a4165SFrank Mandarino return 0; 2110db2a4165SFrank Mandarino } 2111db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_info_enum_ext); 2112db2a4165SFrank Mandarino 2113db2a4165SFrank Mandarino /** 2114db2a4165SFrank Mandarino * snd_soc_info_volsw_ext - external single mixer info callback 2115db2a4165SFrank Mandarino * @kcontrol: mixer control 2116db2a4165SFrank Mandarino * @uinfo: control element information 2117db2a4165SFrank Mandarino * 2118db2a4165SFrank Mandarino * Callback to provide information about a single external mixer control. 2119db2a4165SFrank Mandarino * 2120db2a4165SFrank Mandarino * Returns 0 for success. 2121db2a4165SFrank Mandarino */ 2122db2a4165SFrank Mandarino int snd_soc_info_volsw_ext(struct snd_kcontrol *kcontrol, 2123db2a4165SFrank Mandarino struct snd_ctl_elem_info *uinfo) 2124db2a4165SFrank Mandarino { 2125a7a4ac86SPhilipp Zabel int max = kcontrol->private_value; 2126db2a4165SFrank Mandarino 2127fd5dfad9SMark Brown if (max == 1 && !strstr(kcontrol->id.name, " Volume")) 2128a7a4ac86SPhilipp Zabel uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN; 2129a7a4ac86SPhilipp Zabel else 2130a7a4ac86SPhilipp Zabel uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; 2131a7a4ac86SPhilipp Zabel 2132db2a4165SFrank Mandarino uinfo->count = 1; 2133db2a4165SFrank Mandarino uinfo->value.integer.min = 0; 2134a7a4ac86SPhilipp Zabel uinfo->value.integer.max = max; 2135db2a4165SFrank Mandarino return 0; 2136db2a4165SFrank Mandarino } 2137db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_info_volsw_ext); 2138db2a4165SFrank Mandarino 2139db2a4165SFrank Mandarino /** 2140db2a4165SFrank Mandarino * snd_soc_info_volsw - single mixer info callback 2141db2a4165SFrank Mandarino * @kcontrol: mixer control 2142db2a4165SFrank Mandarino * @uinfo: control element information 2143db2a4165SFrank Mandarino * 2144db2a4165SFrank Mandarino * Callback to provide information about a single mixer control. 2145db2a4165SFrank Mandarino * 2146db2a4165SFrank Mandarino * Returns 0 for success. 2147db2a4165SFrank Mandarino */ 2148db2a4165SFrank Mandarino int snd_soc_info_volsw(struct snd_kcontrol *kcontrol, 2149db2a4165SFrank Mandarino struct snd_ctl_elem_info *uinfo) 2150db2a4165SFrank Mandarino { 21514eaa9819SJon Smirl struct soc_mixer_control *mc = 21524eaa9819SJon Smirl (struct soc_mixer_control *)kcontrol->private_value; 2153d11bb4a9SPeter Ujfalusi int platform_max; 2154762b8df7SMark Brown unsigned int shift = mc->shift; 2155815ecf8dSJon Smirl unsigned int rshift = mc->rshift; 2156db2a4165SFrank Mandarino 2157d11bb4a9SPeter Ujfalusi if (!mc->platform_max) 2158d11bb4a9SPeter Ujfalusi mc->platform_max = mc->max; 2159d11bb4a9SPeter Ujfalusi platform_max = mc->platform_max; 2160d11bb4a9SPeter Ujfalusi 2161d11bb4a9SPeter Ujfalusi if (platform_max == 1 && !strstr(kcontrol->id.name, " Volume")) 2162a7a4ac86SPhilipp Zabel uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN; 2163a7a4ac86SPhilipp Zabel else 2164a7a4ac86SPhilipp Zabel uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; 2165a7a4ac86SPhilipp Zabel 2166db2a4165SFrank Mandarino uinfo->count = shift == rshift ? 1 : 2; 2167db2a4165SFrank Mandarino uinfo->value.integer.min = 0; 2168d11bb4a9SPeter Ujfalusi uinfo->value.integer.max = platform_max; 2169db2a4165SFrank Mandarino return 0; 2170db2a4165SFrank Mandarino } 2171db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_info_volsw); 2172db2a4165SFrank Mandarino 2173db2a4165SFrank Mandarino /** 2174db2a4165SFrank Mandarino * snd_soc_get_volsw - single mixer get callback 2175db2a4165SFrank Mandarino * @kcontrol: mixer control 2176ac11a2b3SMark Brown * @ucontrol: control element information 2177db2a4165SFrank Mandarino * 2178db2a4165SFrank Mandarino * Callback to get the value of a single mixer control. 2179db2a4165SFrank Mandarino * 2180db2a4165SFrank Mandarino * Returns 0 for success. 2181db2a4165SFrank Mandarino */ 2182db2a4165SFrank Mandarino int snd_soc_get_volsw(struct snd_kcontrol *kcontrol, 2183db2a4165SFrank Mandarino struct snd_ctl_elem_value *ucontrol) 2184db2a4165SFrank Mandarino { 21854eaa9819SJon Smirl struct soc_mixer_control *mc = 21864eaa9819SJon Smirl (struct soc_mixer_control *)kcontrol->private_value; 2187db2a4165SFrank Mandarino struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 2188815ecf8dSJon Smirl unsigned int reg = mc->reg; 2189815ecf8dSJon Smirl unsigned int shift = mc->shift; 2190815ecf8dSJon Smirl unsigned int rshift = mc->rshift; 21914eaa9819SJon Smirl int max = mc->max; 2192815ecf8dSJon Smirl unsigned int mask = (1 << fls(max)) - 1; 2193815ecf8dSJon Smirl unsigned int invert = mc->invert; 2194db2a4165SFrank Mandarino 2195db2a4165SFrank Mandarino ucontrol->value.integer.value[0] = 2196db2a4165SFrank Mandarino (snd_soc_read(codec, reg) >> shift) & mask; 2197db2a4165SFrank Mandarino if (shift != rshift) 2198db2a4165SFrank Mandarino ucontrol->value.integer.value[1] = 2199db2a4165SFrank Mandarino (snd_soc_read(codec, reg) >> rshift) & mask; 2200db2a4165SFrank Mandarino if (invert) { 2201db2a4165SFrank Mandarino ucontrol->value.integer.value[0] = 2202a7a4ac86SPhilipp Zabel max - ucontrol->value.integer.value[0]; 2203db2a4165SFrank Mandarino if (shift != rshift) 2204db2a4165SFrank Mandarino ucontrol->value.integer.value[1] = 2205a7a4ac86SPhilipp Zabel max - ucontrol->value.integer.value[1]; 2206db2a4165SFrank Mandarino } 2207db2a4165SFrank Mandarino 2208db2a4165SFrank Mandarino return 0; 2209db2a4165SFrank Mandarino } 2210db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_get_volsw); 2211db2a4165SFrank Mandarino 2212db2a4165SFrank Mandarino /** 2213db2a4165SFrank Mandarino * snd_soc_put_volsw - single mixer put callback 2214db2a4165SFrank Mandarino * @kcontrol: mixer control 2215ac11a2b3SMark Brown * @ucontrol: control element information 2216db2a4165SFrank Mandarino * 2217db2a4165SFrank Mandarino * Callback to set the value of a single mixer control. 2218db2a4165SFrank Mandarino * 2219db2a4165SFrank Mandarino * Returns 0 for success. 2220db2a4165SFrank Mandarino */ 2221db2a4165SFrank Mandarino int snd_soc_put_volsw(struct snd_kcontrol *kcontrol, 2222db2a4165SFrank Mandarino struct snd_ctl_elem_value *ucontrol) 2223db2a4165SFrank Mandarino { 22244eaa9819SJon Smirl struct soc_mixer_control *mc = 22254eaa9819SJon Smirl (struct soc_mixer_control *)kcontrol->private_value; 2226db2a4165SFrank Mandarino struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 2227815ecf8dSJon Smirl unsigned int reg = mc->reg; 2228815ecf8dSJon Smirl unsigned int shift = mc->shift; 2229815ecf8dSJon Smirl unsigned int rshift = mc->rshift; 22304eaa9819SJon Smirl int max = mc->max; 2231815ecf8dSJon Smirl unsigned int mask = (1 << fls(max)) - 1; 2232815ecf8dSJon Smirl unsigned int invert = mc->invert; 223346f5822fSDaniel Ribeiro unsigned int val, val2, val_mask; 2234db2a4165SFrank Mandarino 2235db2a4165SFrank Mandarino val = (ucontrol->value.integer.value[0] & mask); 2236db2a4165SFrank Mandarino if (invert) 2237a7a4ac86SPhilipp Zabel val = max - val; 2238db2a4165SFrank Mandarino val_mask = mask << shift; 2239db2a4165SFrank Mandarino val = val << shift; 2240db2a4165SFrank Mandarino if (shift != rshift) { 2241db2a4165SFrank Mandarino val2 = (ucontrol->value.integer.value[1] & mask); 2242db2a4165SFrank Mandarino if (invert) 2243a7a4ac86SPhilipp Zabel val2 = max - val2; 2244db2a4165SFrank Mandarino val_mask |= mask << rshift; 2245db2a4165SFrank Mandarino val |= val2 << rshift; 2246db2a4165SFrank Mandarino } 22476c508c62SEero Nurkkala return snd_soc_update_bits_locked(codec, reg, val_mask, val); 2248db2a4165SFrank Mandarino } 2249db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_put_volsw); 2250db2a4165SFrank Mandarino 2251db2a4165SFrank Mandarino /** 2252db2a4165SFrank Mandarino * snd_soc_info_volsw_2r - double mixer info callback 2253db2a4165SFrank Mandarino * @kcontrol: mixer control 2254db2a4165SFrank Mandarino * @uinfo: control element information 2255db2a4165SFrank Mandarino * 2256db2a4165SFrank Mandarino * Callback to provide information about a double mixer control that 2257db2a4165SFrank Mandarino * spans 2 codec registers. 2258db2a4165SFrank Mandarino * 2259db2a4165SFrank Mandarino * Returns 0 for success. 2260db2a4165SFrank Mandarino */ 2261db2a4165SFrank Mandarino int snd_soc_info_volsw_2r(struct snd_kcontrol *kcontrol, 2262db2a4165SFrank Mandarino struct snd_ctl_elem_info *uinfo) 2263db2a4165SFrank Mandarino { 22644eaa9819SJon Smirl struct soc_mixer_control *mc = 22654eaa9819SJon Smirl (struct soc_mixer_control *)kcontrol->private_value; 2266d11bb4a9SPeter Ujfalusi int platform_max; 2267db2a4165SFrank Mandarino 2268d11bb4a9SPeter Ujfalusi if (!mc->platform_max) 2269d11bb4a9SPeter Ujfalusi mc->platform_max = mc->max; 2270d11bb4a9SPeter Ujfalusi platform_max = mc->platform_max; 2271d11bb4a9SPeter Ujfalusi 2272d11bb4a9SPeter Ujfalusi if (platform_max == 1 && !strstr(kcontrol->id.name, " Volume")) 2273a7a4ac86SPhilipp Zabel uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN; 2274a7a4ac86SPhilipp Zabel else 2275a7a4ac86SPhilipp Zabel uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; 2276a7a4ac86SPhilipp Zabel 2277db2a4165SFrank Mandarino uinfo->count = 2; 2278db2a4165SFrank Mandarino uinfo->value.integer.min = 0; 2279d11bb4a9SPeter Ujfalusi uinfo->value.integer.max = platform_max; 2280db2a4165SFrank Mandarino return 0; 2281db2a4165SFrank Mandarino } 2282db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_info_volsw_2r); 2283db2a4165SFrank Mandarino 2284db2a4165SFrank Mandarino /** 2285db2a4165SFrank Mandarino * snd_soc_get_volsw_2r - double mixer get callback 2286db2a4165SFrank Mandarino * @kcontrol: mixer control 2287ac11a2b3SMark Brown * @ucontrol: control element information 2288db2a4165SFrank Mandarino * 2289db2a4165SFrank Mandarino * Callback to get the value of a double mixer control that spans 2 registers. 2290db2a4165SFrank Mandarino * 2291db2a4165SFrank Mandarino * Returns 0 for success. 2292db2a4165SFrank Mandarino */ 2293db2a4165SFrank Mandarino int snd_soc_get_volsw_2r(struct snd_kcontrol *kcontrol, 2294db2a4165SFrank Mandarino struct snd_ctl_elem_value *ucontrol) 2295db2a4165SFrank Mandarino { 22964eaa9819SJon Smirl struct soc_mixer_control *mc = 22974eaa9819SJon Smirl (struct soc_mixer_control *)kcontrol->private_value; 2298db2a4165SFrank Mandarino struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 2299815ecf8dSJon Smirl unsigned int reg = mc->reg; 2300815ecf8dSJon Smirl unsigned int reg2 = mc->rreg; 2301815ecf8dSJon Smirl unsigned int shift = mc->shift; 23024eaa9819SJon Smirl int max = mc->max; 2303815ecf8dSJon Smirl unsigned int mask = (1 << fls(max)) - 1; 2304815ecf8dSJon Smirl unsigned int invert = mc->invert; 2305db2a4165SFrank Mandarino 2306db2a4165SFrank Mandarino ucontrol->value.integer.value[0] = 2307db2a4165SFrank Mandarino (snd_soc_read(codec, reg) >> shift) & mask; 2308db2a4165SFrank Mandarino ucontrol->value.integer.value[1] = 2309db2a4165SFrank Mandarino (snd_soc_read(codec, reg2) >> shift) & mask; 2310db2a4165SFrank Mandarino if (invert) { 2311db2a4165SFrank Mandarino ucontrol->value.integer.value[0] = 2312a7a4ac86SPhilipp Zabel max - ucontrol->value.integer.value[0]; 2313db2a4165SFrank Mandarino ucontrol->value.integer.value[1] = 2314a7a4ac86SPhilipp Zabel max - ucontrol->value.integer.value[1]; 2315db2a4165SFrank Mandarino } 2316db2a4165SFrank Mandarino 2317db2a4165SFrank Mandarino return 0; 2318db2a4165SFrank Mandarino } 2319db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_get_volsw_2r); 2320db2a4165SFrank Mandarino 2321db2a4165SFrank Mandarino /** 2322db2a4165SFrank Mandarino * snd_soc_put_volsw_2r - double mixer set callback 2323db2a4165SFrank Mandarino * @kcontrol: mixer control 2324ac11a2b3SMark Brown * @ucontrol: control element information 2325db2a4165SFrank Mandarino * 2326db2a4165SFrank Mandarino * Callback to set the value of a double mixer control that spans 2 registers. 2327db2a4165SFrank Mandarino * 2328db2a4165SFrank Mandarino * Returns 0 for success. 2329db2a4165SFrank Mandarino */ 2330db2a4165SFrank Mandarino int snd_soc_put_volsw_2r(struct snd_kcontrol *kcontrol, 2331db2a4165SFrank Mandarino struct snd_ctl_elem_value *ucontrol) 2332db2a4165SFrank Mandarino { 23334eaa9819SJon Smirl struct soc_mixer_control *mc = 23344eaa9819SJon Smirl (struct soc_mixer_control *)kcontrol->private_value; 2335db2a4165SFrank Mandarino struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 2336815ecf8dSJon Smirl unsigned int reg = mc->reg; 2337815ecf8dSJon Smirl unsigned int reg2 = mc->rreg; 2338815ecf8dSJon Smirl unsigned int shift = mc->shift; 23394eaa9819SJon Smirl int max = mc->max; 2340815ecf8dSJon Smirl unsigned int mask = (1 << fls(max)) - 1; 2341815ecf8dSJon Smirl unsigned int invert = mc->invert; 2342db2a4165SFrank Mandarino int err; 234346f5822fSDaniel Ribeiro unsigned int val, val2, val_mask; 2344db2a4165SFrank Mandarino 2345db2a4165SFrank Mandarino val_mask = mask << shift; 2346db2a4165SFrank Mandarino val = (ucontrol->value.integer.value[0] & mask); 2347db2a4165SFrank Mandarino val2 = (ucontrol->value.integer.value[1] & mask); 2348db2a4165SFrank Mandarino 2349db2a4165SFrank Mandarino if (invert) { 2350a7a4ac86SPhilipp Zabel val = max - val; 2351a7a4ac86SPhilipp Zabel val2 = max - val2; 2352db2a4165SFrank Mandarino } 2353db2a4165SFrank Mandarino 2354db2a4165SFrank Mandarino val = val << shift; 2355db2a4165SFrank Mandarino val2 = val2 << shift; 2356db2a4165SFrank Mandarino 23576c508c62SEero Nurkkala err = snd_soc_update_bits_locked(codec, reg, val_mask, val); 23583ff3f64bSMark Brown if (err < 0) 2359db2a4165SFrank Mandarino return err; 2360db2a4165SFrank Mandarino 23616c508c62SEero Nurkkala err = snd_soc_update_bits_locked(codec, reg2, val_mask, val2); 2362db2a4165SFrank Mandarino return err; 2363db2a4165SFrank Mandarino } 2364db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_put_volsw_2r); 2365db2a4165SFrank Mandarino 2366e13ac2e9SMark Brown /** 2367e13ac2e9SMark Brown * snd_soc_info_volsw_s8 - signed mixer info callback 2368e13ac2e9SMark Brown * @kcontrol: mixer control 2369e13ac2e9SMark Brown * @uinfo: control element information 2370e13ac2e9SMark Brown * 2371e13ac2e9SMark Brown * Callback to provide information about a signed mixer control. 2372e13ac2e9SMark Brown * 2373e13ac2e9SMark Brown * Returns 0 for success. 2374e13ac2e9SMark Brown */ 2375e13ac2e9SMark Brown int snd_soc_info_volsw_s8(struct snd_kcontrol *kcontrol, 2376e13ac2e9SMark Brown struct snd_ctl_elem_info *uinfo) 2377e13ac2e9SMark Brown { 23784eaa9819SJon Smirl struct soc_mixer_control *mc = 23794eaa9819SJon Smirl (struct soc_mixer_control *)kcontrol->private_value; 2380d11bb4a9SPeter Ujfalusi int platform_max; 23814eaa9819SJon Smirl int min = mc->min; 2382e13ac2e9SMark Brown 2383d11bb4a9SPeter Ujfalusi if (!mc->platform_max) 2384d11bb4a9SPeter Ujfalusi mc->platform_max = mc->max; 2385d11bb4a9SPeter Ujfalusi platform_max = mc->platform_max; 2386d11bb4a9SPeter Ujfalusi 2387e13ac2e9SMark Brown uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; 2388e13ac2e9SMark Brown uinfo->count = 2; 2389e13ac2e9SMark Brown uinfo->value.integer.min = 0; 2390d11bb4a9SPeter Ujfalusi uinfo->value.integer.max = platform_max - min; 2391e13ac2e9SMark Brown return 0; 2392e13ac2e9SMark Brown } 2393e13ac2e9SMark Brown EXPORT_SYMBOL_GPL(snd_soc_info_volsw_s8); 2394e13ac2e9SMark Brown 2395e13ac2e9SMark Brown /** 2396e13ac2e9SMark Brown * snd_soc_get_volsw_s8 - signed mixer get callback 2397e13ac2e9SMark Brown * @kcontrol: mixer control 2398ac11a2b3SMark Brown * @ucontrol: control element information 2399e13ac2e9SMark Brown * 2400e13ac2e9SMark Brown * Callback to get the value of a signed mixer control. 2401e13ac2e9SMark Brown * 2402e13ac2e9SMark Brown * Returns 0 for success. 2403e13ac2e9SMark Brown */ 2404e13ac2e9SMark Brown int snd_soc_get_volsw_s8(struct snd_kcontrol *kcontrol, 2405e13ac2e9SMark Brown struct snd_ctl_elem_value *ucontrol) 2406e13ac2e9SMark Brown { 24074eaa9819SJon Smirl struct soc_mixer_control *mc = 24084eaa9819SJon Smirl (struct soc_mixer_control *)kcontrol->private_value; 2409e13ac2e9SMark Brown struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 2410815ecf8dSJon Smirl unsigned int reg = mc->reg; 24114eaa9819SJon Smirl int min = mc->min; 2412e13ac2e9SMark Brown int val = snd_soc_read(codec, reg); 2413e13ac2e9SMark Brown 2414e13ac2e9SMark Brown ucontrol->value.integer.value[0] = 2415e13ac2e9SMark Brown ((signed char)(val & 0xff))-min; 2416e13ac2e9SMark Brown ucontrol->value.integer.value[1] = 2417e13ac2e9SMark Brown ((signed char)((val >> 8) & 0xff))-min; 2418e13ac2e9SMark Brown return 0; 2419e13ac2e9SMark Brown } 2420e13ac2e9SMark Brown EXPORT_SYMBOL_GPL(snd_soc_get_volsw_s8); 2421e13ac2e9SMark Brown 2422e13ac2e9SMark Brown /** 2423e13ac2e9SMark Brown * snd_soc_put_volsw_sgn - signed mixer put callback 2424e13ac2e9SMark Brown * @kcontrol: mixer control 2425ac11a2b3SMark Brown * @ucontrol: control element information 2426e13ac2e9SMark Brown * 2427e13ac2e9SMark Brown * Callback to set the value of a signed mixer control. 2428e13ac2e9SMark Brown * 2429e13ac2e9SMark Brown * Returns 0 for success. 2430e13ac2e9SMark Brown */ 2431e13ac2e9SMark Brown int snd_soc_put_volsw_s8(struct snd_kcontrol *kcontrol, 2432e13ac2e9SMark Brown struct snd_ctl_elem_value *ucontrol) 2433e13ac2e9SMark Brown { 24344eaa9819SJon Smirl struct soc_mixer_control *mc = 24354eaa9819SJon Smirl (struct soc_mixer_control *)kcontrol->private_value; 2436e13ac2e9SMark Brown struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 2437815ecf8dSJon Smirl unsigned int reg = mc->reg; 24384eaa9819SJon Smirl int min = mc->min; 243946f5822fSDaniel Ribeiro unsigned int val; 2440e13ac2e9SMark Brown 2441e13ac2e9SMark Brown val = (ucontrol->value.integer.value[0]+min) & 0xff; 2442e13ac2e9SMark Brown val |= ((ucontrol->value.integer.value[1]+min) & 0xff) << 8; 2443e13ac2e9SMark Brown 24446c508c62SEero Nurkkala return snd_soc_update_bits_locked(codec, reg, 0xffff, val); 2445e13ac2e9SMark Brown } 2446e13ac2e9SMark Brown EXPORT_SYMBOL_GPL(snd_soc_put_volsw_s8); 2447e13ac2e9SMark Brown 24488c6529dbSLiam Girdwood /** 2449637d3847SPeter Ujfalusi * snd_soc_limit_volume - Set new limit to an existing volume control. 2450637d3847SPeter Ujfalusi * 2451637d3847SPeter Ujfalusi * @codec: where to look for the control 2452637d3847SPeter Ujfalusi * @name: Name of the control 2453637d3847SPeter Ujfalusi * @max: new maximum limit 2454637d3847SPeter Ujfalusi * 2455637d3847SPeter Ujfalusi * Return 0 for success, else error. 2456637d3847SPeter Ujfalusi */ 2457637d3847SPeter Ujfalusi int snd_soc_limit_volume(struct snd_soc_codec *codec, 2458637d3847SPeter Ujfalusi const char *name, int max) 2459637d3847SPeter Ujfalusi { 2460*f0fba2adSLiam Girdwood struct snd_card *card = codec->card->snd_card; 2461637d3847SPeter Ujfalusi struct snd_kcontrol *kctl; 2462637d3847SPeter Ujfalusi struct soc_mixer_control *mc; 2463637d3847SPeter Ujfalusi int found = 0; 2464637d3847SPeter Ujfalusi int ret = -EINVAL; 2465637d3847SPeter Ujfalusi 2466637d3847SPeter Ujfalusi /* Sanity check for name and max */ 2467637d3847SPeter Ujfalusi if (unlikely(!name || max <= 0)) 2468637d3847SPeter Ujfalusi return -EINVAL; 2469637d3847SPeter Ujfalusi 2470637d3847SPeter Ujfalusi list_for_each_entry(kctl, &card->controls, list) { 2471637d3847SPeter Ujfalusi if (!strncmp(kctl->id.name, name, sizeof(kctl->id.name))) { 2472637d3847SPeter Ujfalusi found = 1; 2473637d3847SPeter Ujfalusi break; 2474637d3847SPeter Ujfalusi } 2475637d3847SPeter Ujfalusi } 2476637d3847SPeter Ujfalusi if (found) { 2477637d3847SPeter Ujfalusi mc = (struct soc_mixer_control *)kctl->private_value; 2478637d3847SPeter Ujfalusi if (max <= mc->max) { 2479d11bb4a9SPeter Ujfalusi mc->platform_max = max; 2480637d3847SPeter Ujfalusi ret = 0; 2481637d3847SPeter Ujfalusi } 2482637d3847SPeter Ujfalusi } 2483637d3847SPeter Ujfalusi return ret; 2484637d3847SPeter Ujfalusi } 2485637d3847SPeter Ujfalusi EXPORT_SYMBOL_GPL(snd_soc_limit_volume); 2486637d3847SPeter Ujfalusi 2487637d3847SPeter Ujfalusi /** 2488b6f4bb38Sapatard@mandriva.com * snd_soc_info_volsw_2r_sx - double with tlv and variable data size 2489b6f4bb38Sapatard@mandriva.com * mixer info callback 2490b6f4bb38Sapatard@mandriva.com * @kcontrol: mixer control 2491b6f4bb38Sapatard@mandriva.com * @uinfo: control element information 2492b6f4bb38Sapatard@mandriva.com * 2493b6f4bb38Sapatard@mandriva.com * Returns 0 for success. 2494b6f4bb38Sapatard@mandriva.com */ 2495b6f4bb38Sapatard@mandriva.com int snd_soc_info_volsw_2r_sx(struct snd_kcontrol *kcontrol, 2496b6f4bb38Sapatard@mandriva.com struct snd_ctl_elem_info *uinfo) 2497b6f4bb38Sapatard@mandriva.com { 2498b6f4bb38Sapatard@mandriva.com struct soc_mixer_control *mc = 2499b6f4bb38Sapatard@mandriva.com (struct soc_mixer_control *)kcontrol->private_value; 2500b6f4bb38Sapatard@mandriva.com int max = mc->max; 2501b6f4bb38Sapatard@mandriva.com int min = mc->min; 2502b6f4bb38Sapatard@mandriva.com 2503b6f4bb38Sapatard@mandriva.com uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; 2504b6f4bb38Sapatard@mandriva.com uinfo->count = 2; 2505b6f4bb38Sapatard@mandriva.com uinfo->value.integer.min = 0; 2506b6f4bb38Sapatard@mandriva.com uinfo->value.integer.max = max-min; 2507b6f4bb38Sapatard@mandriva.com 2508b6f4bb38Sapatard@mandriva.com return 0; 2509b6f4bb38Sapatard@mandriva.com } 2510b6f4bb38Sapatard@mandriva.com EXPORT_SYMBOL_GPL(snd_soc_info_volsw_2r_sx); 2511b6f4bb38Sapatard@mandriva.com 2512b6f4bb38Sapatard@mandriva.com /** 2513b6f4bb38Sapatard@mandriva.com * snd_soc_get_volsw_2r_sx - double with tlv and variable data size 2514b6f4bb38Sapatard@mandriva.com * mixer get callback 2515b6f4bb38Sapatard@mandriva.com * @kcontrol: mixer control 2516b6f4bb38Sapatard@mandriva.com * @uinfo: control element information 2517b6f4bb38Sapatard@mandriva.com * 2518b6f4bb38Sapatard@mandriva.com * Returns 0 for success. 2519b6f4bb38Sapatard@mandriva.com */ 2520b6f4bb38Sapatard@mandriva.com int snd_soc_get_volsw_2r_sx(struct snd_kcontrol *kcontrol, 2521b6f4bb38Sapatard@mandriva.com struct snd_ctl_elem_value *ucontrol) 2522b6f4bb38Sapatard@mandriva.com { 2523b6f4bb38Sapatard@mandriva.com struct soc_mixer_control *mc = 2524b6f4bb38Sapatard@mandriva.com (struct soc_mixer_control *)kcontrol->private_value; 2525b6f4bb38Sapatard@mandriva.com struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 2526b6f4bb38Sapatard@mandriva.com unsigned int mask = (1<<mc->shift)-1; 2527b6f4bb38Sapatard@mandriva.com int min = mc->min; 2528b6f4bb38Sapatard@mandriva.com int val = snd_soc_read(codec, mc->reg) & mask; 2529b6f4bb38Sapatard@mandriva.com int valr = snd_soc_read(codec, mc->rreg) & mask; 2530b6f4bb38Sapatard@mandriva.com 253120630c7fSStuart Longland ucontrol->value.integer.value[0] = ((val & 0xff)-min) & mask; 253220630c7fSStuart Longland ucontrol->value.integer.value[1] = ((valr & 0xff)-min) & mask; 2533b6f4bb38Sapatard@mandriva.com return 0; 2534b6f4bb38Sapatard@mandriva.com } 2535b6f4bb38Sapatard@mandriva.com EXPORT_SYMBOL_GPL(snd_soc_get_volsw_2r_sx); 2536b6f4bb38Sapatard@mandriva.com 2537b6f4bb38Sapatard@mandriva.com /** 2538b6f4bb38Sapatard@mandriva.com * snd_soc_put_volsw_2r_sx - double with tlv and variable data size 2539b6f4bb38Sapatard@mandriva.com * mixer put callback 2540b6f4bb38Sapatard@mandriva.com * @kcontrol: mixer control 2541b6f4bb38Sapatard@mandriva.com * @uinfo: control element information 2542b6f4bb38Sapatard@mandriva.com * 2543b6f4bb38Sapatard@mandriva.com * Returns 0 for success. 2544b6f4bb38Sapatard@mandriva.com */ 2545b6f4bb38Sapatard@mandriva.com int snd_soc_put_volsw_2r_sx(struct snd_kcontrol *kcontrol, 2546b6f4bb38Sapatard@mandriva.com struct snd_ctl_elem_value *ucontrol) 2547b6f4bb38Sapatard@mandriva.com { 2548b6f4bb38Sapatard@mandriva.com struct soc_mixer_control *mc = 2549b6f4bb38Sapatard@mandriva.com (struct soc_mixer_control *)kcontrol->private_value; 2550b6f4bb38Sapatard@mandriva.com struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 2551b6f4bb38Sapatard@mandriva.com unsigned int mask = (1<<mc->shift)-1; 2552b6f4bb38Sapatard@mandriva.com int min = mc->min; 2553b6f4bb38Sapatard@mandriva.com int ret; 2554b6f4bb38Sapatard@mandriva.com unsigned int val, valr, oval, ovalr; 2555b6f4bb38Sapatard@mandriva.com 2556b6f4bb38Sapatard@mandriva.com val = ((ucontrol->value.integer.value[0]+min) & 0xff); 2557b6f4bb38Sapatard@mandriva.com val &= mask; 2558b6f4bb38Sapatard@mandriva.com valr = ((ucontrol->value.integer.value[1]+min) & 0xff); 2559b6f4bb38Sapatard@mandriva.com valr &= mask; 2560b6f4bb38Sapatard@mandriva.com 2561b6f4bb38Sapatard@mandriva.com oval = snd_soc_read(codec, mc->reg) & mask; 2562b6f4bb38Sapatard@mandriva.com ovalr = snd_soc_read(codec, mc->rreg) & mask; 2563b6f4bb38Sapatard@mandriva.com 2564b6f4bb38Sapatard@mandriva.com ret = 0; 2565b6f4bb38Sapatard@mandriva.com if (oval != val) { 2566b6f4bb38Sapatard@mandriva.com ret = snd_soc_write(codec, mc->reg, val); 2567b6f4bb38Sapatard@mandriva.com if (ret < 0) 2568f1df5aecSMark Brown return ret; 2569b6f4bb38Sapatard@mandriva.com } 2570b6f4bb38Sapatard@mandriva.com if (ovalr != valr) { 2571b6f4bb38Sapatard@mandriva.com ret = snd_soc_write(codec, mc->rreg, valr); 2572b6f4bb38Sapatard@mandriva.com if (ret < 0) 2573f1df5aecSMark Brown return ret; 2574b6f4bb38Sapatard@mandriva.com } 2575b6f4bb38Sapatard@mandriva.com 2576b6f4bb38Sapatard@mandriva.com return 0; 2577b6f4bb38Sapatard@mandriva.com } 2578b6f4bb38Sapatard@mandriva.com EXPORT_SYMBOL_GPL(snd_soc_put_volsw_2r_sx); 2579b6f4bb38Sapatard@mandriva.com 2580b6f4bb38Sapatard@mandriva.com /** 25818c6529dbSLiam Girdwood * snd_soc_dai_set_sysclk - configure DAI system or master clock. 25828c6529dbSLiam Girdwood * @dai: DAI 25838c6529dbSLiam Girdwood * @clk_id: DAI specific clock ID 25848c6529dbSLiam Girdwood * @freq: new clock frequency in Hz 25858c6529dbSLiam Girdwood * @dir: new clock direction - input/output. 25868c6529dbSLiam Girdwood * 25878c6529dbSLiam Girdwood * Configures the DAI master (MCLK) or system (SYSCLK) clocking. 25888c6529dbSLiam Girdwood */ 25898c6529dbSLiam Girdwood int snd_soc_dai_set_sysclk(struct snd_soc_dai *dai, int clk_id, 25908c6529dbSLiam Girdwood unsigned int freq, int dir) 25918c6529dbSLiam Girdwood { 2592*f0fba2adSLiam Girdwood if (dai->driver && dai->driver->ops->set_sysclk) 2593*f0fba2adSLiam Girdwood return dai->driver->ops->set_sysclk(dai, clk_id, freq, dir); 25948c6529dbSLiam Girdwood else 25958c6529dbSLiam Girdwood return -EINVAL; 25968c6529dbSLiam Girdwood } 25978c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_sysclk); 25988c6529dbSLiam Girdwood 25998c6529dbSLiam Girdwood /** 26008c6529dbSLiam Girdwood * snd_soc_dai_set_clkdiv - configure DAI clock dividers. 26018c6529dbSLiam Girdwood * @dai: DAI 2602ac11a2b3SMark Brown * @div_id: DAI specific clock divider ID 26038c6529dbSLiam Girdwood * @div: new clock divisor. 26048c6529dbSLiam Girdwood * 26058c6529dbSLiam Girdwood * Configures the clock dividers. This is used to derive the best DAI bit and 26068c6529dbSLiam Girdwood * frame clocks from the system or master clock. It's best to set the DAI bit 26078c6529dbSLiam Girdwood * and frame clocks as low as possible to save system power. 26088c6529dbSLiam Girdwood */ 26098c6529dbSLiam Girdwood int snd_soc_dai_set_clkdiv(struct snd_soc_dai *dai, 26108c6529dbSLiam Girdwood int div_id, int div) 26118c6529dbSLiam Girdwood { 2612*f0fba2adSLiam Girdwood if (dai->driver && dai->driver->ops->set_clkdiv) 2613*f0fba2adSLiam Girdwood return dai->driver->ops->set_clkdiv(dai, div_id, div); 26148c6529dbSLiam Girdwood else 26158c6529dbSLiam Girdwood return -EINVAL; 26168c6529dbSLiam Girdwood } 26178c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_clkdiv); 26188c6529dbSLiam Girdwood 26198c6529dbSLiam Girdwood /** 26208c6529dbSLiam Girdwood * snd_soc_dai_set_pll - configure DAI PLL. 26218c6529dbSLiam Girdwood * @dai: DAI 26228c6529dbSLiam Girdwood * @pll_id: DAI specific PLL ID 262385488037SMark Brown * @source: DAI specific source for the PLL 26248c6529dbSLiam Girdwood * @freq_in: PLL input clock frequency in Hz 26258c6529dbSLiam Girdwood * @freq_out: requested PLL output clock frequency in Hz 26268c6529dbSLiam Girdwood * 26278c6529dbSLiam Girdwood * Configures and enables PLL to generate output clock based on input clock. 26288c6529dbSLiam Girdwood */ 262985488037SMark Brown int snd_soc_dai_set_pll(struct snd_soc_dai *dai, int pll_id, int source, 263085488037SMark Brown unsigned int freq_in, unsigned int freq_out) 26318c6529dbSLiam Girdwood { 2632*f0fba2adSLiam Girdwood if (dai->driver && dai->driver->ops->set_pll) 2633*f0fba2adSLiam Girdwood return dai->driver->ops->set_pll(dai, pll_id, source, 263485488037SMark Brown freq_in, freq_out); 26358c6529dbSLiam Girdwood else 26368c6529dbSLiam Girdwood return -EINVAL; 26378c6529dbSLiam Girdwood } 26388c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_pll); 26398c6529dbSLiam Girdwood 26408c6529dbSLiam Girdwood /** 26418c6529dbSLiam Girdwood * snd_soc_dai_set_fmt - configure DAI hardware audio format. 26428c6529dbSLiam Girdwood * @dai: DAI 26438c6529dbSLiam Girdwood * @fmt: SND_SOC_DAIFMT_ format value. 26448c6529dbSLiam Girdwood * 26458c6529dbSLiam Girdwood * Configures the DAI hardware format and clocking. 26468c6529dbSLiam Girdwood */ 26478c6529dbSLiam Girdwood int snd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt) 26488c6529dbSLiam Girdwood { 2649*f0fba2adSLiam Girdwood if (dai->driver && dai->driver->ops->set_fmt) 2650*f0fba2adSLiam Girdwood return dai->driver->ops->set_fmt(dai, fmt); 26518c6529dbSLiam Girdwood else 26528c6529dbSLiam Girdwood return -EINVAL; 26538c6529dbSLiam Girdwood } 26548c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_fmt); 26558c6529dbSLiam Girdwood 26568c6529dbSLiam Girdwood /** 26578c6529dbSLiam Girdwood * snd_soc_dai_set_tdm_slot - configure DAI TDM. 26588c6529dbSLiam Girdwood * @dai: DAI 2659a5479e38SDaniel Ribeiro * @tx_mask: bitmask representing active TX slots. 2660a5479e38SDaniel Ribeiro * @rx_mask: bitmask representing active RX slots. 26618c6529dbSLiam Girdwood * @slots: Number of slots in use. 2662a5479e38SDaniel Ribeiro * @slot_width: Width in bits for each slot. 26638c6529dbSLiam Girdwood * 26648c6529dbSLiam Girdwood * Configures a DAI for TDM operation. Both mask and slots are codec and DAI 26658c6529dbSLiam Girdwood * specific. 26668c6529dbSLiam Girdwood */ 26678c6529dbSLiam Girdwood int snd_soc_dai_set_tdm_slot(struct snd_soc_dai *dai, 2668a5479e38SDaniel Ribeiro unsigned int tx_mask, unsigned int rx_mask, int slots, int slot_width) 26698c6529dbSLiam Girdwood { 2670*f0fba2adSLiam Girdwood if (dai->driver && dai->driver->ops->set_tdm_slot) 2671*f0fba2adSLiam Girdwood return dai->driver->ops->set_tdm_slot(dai, tx_mask, rx_mask, 2672a5479e38SDaniel Ribeiro slots, slot_width); 26738c6529dbSLiam Girdwood else 26748c6529dbSLiam Girdwood return -EINVAL; 26758c6529dbSLiam Girdwood } 26768c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_tdm_slot); 26778c6529dbSLiam Girdwood 26788c6529dbSLiam Girdwood /** 2679472df3cbSBarry Song * snd_soc_dai_set_channel_map - configure DAI audio channel map 2680472df3cbSBarry Song * @dai: DAI 2681472df3cbSBarry Song * @tx_num: how many TX channels 2682472df3cbSBarry Song * @tx_slot: pointer to an array which imply the TX slot number channel 2683472df3cbSBarry Song * 0~num-1 uses 2684472df3cbSBarry Song * @rx_num: how many RX channels 2685472df3cbSBarry Song * @rx_slot: pointer to an array which imply the RX slot number channel 2686472df3cbSBarry Song * 0~num-1 uses 2687472df3cbSBarry Song * 2688472df3cbSBarry Song * configure the relationship between channel number and TDM slot number. 2689472df3cbSBarry Song */ 2690472df3cbSBarry Song int snd_soc_dai_set_channel_map(struct snd_soc_dai *dai, 2691472df3cbSBarry Song unsigned int tx_num, unsigned int *tx_slot, 2692472df3cbSBarry Song unsigned int rx_num, unsigned int *rx_slot) 2693472df3cbSBarry Song { 2694*f0fba2adSLiam Girdwood if (dai->driver && dai->driver->ops->set_channel_map) 2695*f0fba2adSLiam Girdwood return dai->driver->ops->set_channel_map(dai, tx_num, tx_slot, 2696472df3cbSBarry Song rx_num, rx_slot); 2697472df3cbSBarry Song else 2698472df3cbSBarry Song return -EINVAL; 2699472df3cbSBarry Song } 2700472df3cbSBarry Song EXPORT_SYMBOL_GPL(snd_soc_dai_set_channel_map); 2701472df3cbSBarry Song 2702472df3cbSBarry Song /** 27038c6529dbSLiam Girdwood * snd_soc_dai_set_tristate - configure DAI system or master clock. 27048c6529dbSLiam Girdwood * @dai: DAI 27058c6529dbSLiam Girdwood * @tristate: tristate enable 27068c6529dbSLiam Girdwood * 27078c6529dbSLiam Girdwood * Tristates the DAI so that others can use it. 27088c6529dbSLiam Girdwood */ 27098c6529dbSLiam Girdwood int snd_soc_dai_set_tristate(struct snd_soc_dai *dai, int tristate) 27108c6529dbSLiam Girdwood { 2711*f0fba2adSLiam Girdwood if (dai->driver && dai->driver->ops->set_tristate) 2712*f0fba2adSLiam Girdwood return dai->driver->ops->set_tristate(dai, tristate); 27138c6529dbSLiam Girdwood else 27148c6529dbSLiam Girdwood return -EINVAL; 27158c6529dbSLiam Girdwood } 27168c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_tristate); 27178c6529dbSLiam Girdwood 27188c6529dbSLiam Girdwood /** 27198c6529dbSLiam Girdwood * snd_soc_dai_digital_mute - configure DAI system or master clock. 27208c6529dbSLiam Girdwood * @dai: DAI 27218c6529dbSLiam Girdwood * @mute: mute enable 27228c6529dbSLiam Girdwood * 27238c6529dbSLiam Girdwood * Mutes the DAI DAC. 27248c6529dbSLiam Girdwood */ 27258c6529dbSLiam Girdwood int snd_soc_dai_digital_mute(struct snd_soc_dai *dai, int mute) 27268c6529dbSLiam Girdwood { 2727*f0fba2adSLiam Girdwood if (dai->driver && dai->driver->ops->digital_mute) 2728*f0fba2adSLiam Girdwood return dai->driver->ops->digital_mute(dai, mute); 27298c6529dbSLiam Girdwood else 27308c6529dbSLiam Girdwood return -EINVAL; 27318c6529dbSLiam Girdwood } 27328c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_digital_mute); 27338c6529dbSLiam Girdwood 2734c5af3a2eSMark Brown /** 2735c5af3a2eSMark Brown * snd_soc_register_card - Register a card with the ASoC core 2736c5af3a2eSMark Brown * 2737ac11a2b3SMark Brown * @card: Card to register 2738c5af3a2eSMark Brown * 2739c5af3a2eSMark Brown * Note that currently this is an internal only function: it will be 2740c5af3a2eSMark Brown * exposed to machine drivers after further backporting of ASoC v2 2741c5af3a2eSMark Brown * registration APIs. 2742c5af3a2eSMark Brown */ 2743c5af3a2eSMark Brown static int snd_soc_register_card(struct snd_soc_card *card) 2744c5af3a2eSMark Brown { 2745*f0fba2adSLiam Girdwood int i; 2746*f0fba2adSLiam Girdwood 2747c5af3a2eSMark Brown if (!card->name || !card->dev) 2748c5af3a2eSMark Brown return -EINVAL; 2749c5af3a2eSMark Brown 2750*f0fba2adSLiam Girdwood card->rtd = kzalloc(sizeof(struct snd_soc_pcm_runtime) * card->num_links, 2751*f0fba2adSLiam Girdwood GFP_KERNEL); 2752*f0fba2adSLiam Girdwood if (card->rtd == NULL) 2753*f0fba2adSLiam Girdwood return -ENOMEM; 2754*f0fba2adSLiam Girdwood 2755*f0fba2adSLiam Girdwood for (i = 0; i < card->num_links; i++) 2756*f0fba2adSLiam Girdwood card->rtd[i].dai_link = &card->dai_link[i]; 2757*f0fba2adSLiam Girdwood 2758c5af3a2eSMark Brown INIT_LIST_HEAD(&card->list); 2759c5af3a2eSMark Brown card->instantiated = 0; 2760*f0fba2adSLiam Girdwood mutex_init(&card->mutex); 2761c5af3a2eSMark Brown 2762c5af3a2eSMark Brown mutex_lock(&client_mutex); 2763c5af3a2eSMark Brown list_add(&card->list, &card_list); 2764435c5e25SMark Brown snd_soc_instantiate_cards(); 2765c5af3a2eSMark Brown mutex_unlock(&client_mutex); 2766c5af3a2eSMark Brown 2767c5af3a2eSMark Brown dev_dbg(card->dev, "Registered card '%s'\n", card->name); 2768c5af3a2eSMark Brown 2769c5af3a2eSMark Brown return 0; 2770c5af3a2eSMark Brown } 2771c5af3a2eSMark Brown 2772c5af3a2eSMark Brown /** 2773c5af3a2eSMark Brown * snd_soc_unregister_card - Unregister a card with the ASoC core 2774c5af3a2eSMark Brown * 2775ac11a2b3SMark Brown * @card: Card to unregister 2776c5af3a2eSMark Brown * 2777c5af3a2eSMark Brown * Note that currently this is an internal only function: it will be 2778c5af3a2eSMark Brown * exposed to machine drivers after further backporting of ASoC v2 2779c5af3a2eSMark Brown * registration APIs. 2780c5af3a2eSMark Brown */ 2781c5af3a2eSMark Brown static int snd_soc_unregister_card(struct snd_soc_card *card) 2782c5af3a2eSMark Brown { 2783c5af3a2eSMark Brown mutex_lock(&client_mutex); 2784c5af3a2eSMark Brown list_del(&card->list); 2785c5af3a2eSMark Brown mutex_unlock(&client_mutex); 2786c5af3a2eSMark Brown dev_dbg(card->dev, "Unregistered card '%s'\n", card->name); 2787c5af3a2eSMark Brown 2788c5af3a2eSMark Brown return 0; 2789c5af3a2eSMark Brown } 2790c5af3a2eSMark Brown 2791*f0fba2adSLiam Girdwood /* 2792*f0fba2adSLiam Girdwood * Simplify DAI link configuration by removing ".-1" from device names 2793*f0fba2adSLiam Girdwood * and sanitizing names. 2794*f0fba2adSLiam Girdwood */ 2795*f0fba2adSLiam Girdwood static inline char *fmt_single_name(struct device *dev, int *id) 2796*f0fba2adSLiam Girdwood { 2797*f0fba2adSLiam Girdwood char *found, name[NAME_SIZE]; 2798*f0fba2adSLiam Girdwood int id1, id2; 2799*f0fba2adSLiam Girdwood 2800*f0fba2adSLiam Girdwood if (dev_name(dev) == NULL) 2801*f0fba2adSLiam Girdwood return NULL; 2802*f0fba2adSLiam Girdwood 2803*f0fba2adSLiam Girdwood strncpy(name, dev_name(dev), NAME_SIZE); 2804*f0fba2adSLiam Girdwood 2805*f0fba2adSLiam Girdwood /* are we a "%s.%d" name (platform and SPI components) */ 2806*f0fba2adSLiam Girdwood found = strstr(name, dev->driver->name); 2807*f0fba2adSLiam Girdwood if (found) { 2808*f0fba2adSLiam Girdwood /* get ID */ 2809*f0fba2adSLiam Girdwood if (sscanf(&found[strlen(dev->driver->name)], ".%d", id) == 1) { 2810*f0fba2adSLiam Girdwood 2811*f0fba2adSLiam Girdwood /* discard ID from name if ID == -1 */ 2812*f0fba2adSLiam Girdwood if (*id == -1) 2813*f0fba2adSLiam Girdwood found[strlen(dev->driver->name)] = '\0'; 2814*f0fba2adSLiam Girdwood } 2815*f0fba2adSLiam Girdwood 2816*f0fba2adSLiam Girdwood } else { 2817*f0fba2adSLiam Girdwood /* I2C component devices are named "bus-addr" */ 2818*f0fba2adSLiam Girdwood if (sscanf(name, "%x-%x", &id1, &id2) == 2) { 2819*f0fba2adSLiam Girdwood char tmp[NAME_SIZE]; 2820*f0fba2adSLiam Girdwood 2821*f0fba2adSLiam Girdwood /* create unique ID number from I2C addr and bus */ 2822*f0fba2adSLiam Girdwood *id = ((id1 && 0xffff) << 16) + id2; 2823*f0fba2adSLiam Girdwood 2824*f0fba2adSLiam Girdwood /* sanitize component name for DAI link creation */ 2825*f0fba2adSLiam Girdwood snprintf(tmp, NAME_SIZE, "%s.%s", dev->driver->name, name); 2826*f0fba2adSLiam Girdwood strncpy(name, tmp, NAME_SIZE); 2827*f0fba2adSLiam Girdwood } else 2828*f0fba2adSLiam Girdwood *id = 0; 2829*f0fba2adSLiam Girdwood } 2830*f0fba2adSLiam Girdwood 2831*f0fba2adSLiam Girdwood return kstrdup(name, GFP_KERNEL); 2832*f0fba2adSLiam Girdwood } 2833*f0fba2adSLiam Girdwood 2834*f0fba2adSLiam Girdwood /* 2835*f0fba2adSLiam Girdwood * Simplify DAI link naming for single devices with multiple DAIs by removing 2836*f0fba2adSLiam Girdwood * any ".-1" and using the DAI name (instead of device name). 2837*f0fba2adSLiam Girdwood */ 2838*f0fba2adSLiam Girdwood static inline char *fmt_multiple_name(struct device *dev, 2839*f0fba2adSLiam Girdwood struct snd_soc_dai_driver *dai_drv) 2840*f0fba2adSLiam Girdwood { 2841*f0fba2adSLiam Girdwood if (dai_drv->name == NULL) { 2842*f0fba2adSLiam Girdwood printk(KERN_ERR "asoc: error - multiple DAI %s registered with no name\n", 2843*f0fba2adSLiam Girdwood dev_name(dev)); 2844*f0fba2adSLiam Girdwood return NULL; 2845*f0fba2adSLiam Girdwood } 2846*f0fba2adSLiam Girdwood 2847*f0fba2adSLiam Girdwood return kstrdup(dai_drv->name, GFP_KERNEL); 2848*f0fba2adSLiam Girdwood } 2849*f0fba2adSLiam Girdwood 28509115171aSMark Brown /** 28519115171aSMark Brown * snd_soc_register_dai - Register a DAI with the ASoC core 28529115171aSMark Brown * 2853ac11a2b3SMark Brown * @dai: DAI to register 28549115171aSMark Brown */ 2855*f0fba2adSLiam Girdwood int snd_soc_register_dai(struct device *dev, 2856*f0fba2adSLiam Girdwood struct snd_soc_dai_driver *dai_drv) 28579115171aSMark Brown { 2858*f0fba2adSLiam Girdwood struct snd_soc_dai *dai; 28599115171aSMark Brown 2860*f0fba2adSLiam Girdwood dev_dbg(dev, "dai register %s\n", dev_name(dev)); 28619115171aSMark Brown 2862*f0fba2adSLiam Girdwood dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL); 2863*f0fba2adSLiam Girdwood if (dai == NULL) 2864*f0fba2adSLiam Girdwood return -ENOMEM; 28656335d055SEric Miao 2866*f0fba2adSLiam Girdwood /* create DAI component name */ 2867*f0fba2adSLiam Girdwood dai->name = fmt_single_name(dev, &dai->id); 2868*f0fba2adSLiam Girdwood if (dai->name == NULL) { 2869*f0fba2adSLiam Girdwood kfree(dai); 2870*f0fba2adSLiam Girdwood return -ENOMEM; 2871*f0fba2adSLiam Girdwood } 2872*f0fba2adSLiam Girdwood 2873*f0fba2adSLiam Girdwood dai->dev = dev; 2874*f0fba2adSLiam Girdwood dai->driver = dai_drv; 2875*f0fba2adSLiam Girdwood if (!dai->driver->ops) 2876*f0fba2adSLiam Girdwood dai->driver->ops = &null_dai_ops; 28779115171aSMark Brown 28789115171aSMark Brown mutex_lock(&client_mutex); 28799115171aSMark Brown list_add(&dai->list, &dai_list); 2880435c5e25SMark Brown snd_soc_instantiate_cards(); 28819115171aSMark Brown mutex_unlock(&client_mutex); 28829115171aSMark Brown 28839115171aSMark Brown pr_debug("Registered DAI '%s'\n", dai->name); 28849115171aSMark Brown 28859115171aSMark Brown return 0; 28869115171aSMark Brown } 28879115171aSMark Brown EXPORT_SYMBOL_GPL(snd_soc_register_dai); 28889115171aSMark Brown 28899115171aSMark Brown /** 28909115171aSMark Brown * snd_soc_unregister_dai - Unregister a DAI from the ASoC core 28919115171aSMark Brown * 2892ac11a2b3SMark Brown * @dai: DAI to unregister 28939115171aSMark Brown */ 2894*f0fba2adSLiam Girdwood void snd_soc_unregister_dai(struct device *dev) 28959115171aSMark Brown { 2896*f0fba2adSLiam Girdwood struct snd_soc_dai *dai; 2897*f0fba2adSLiam Girdwood 2898*f0fba2adSLiam Girdwood list_for_each_entry(dai, &dai_list, list) { 2899*f0fba2adSLiam Girdwood if (dev == dai->dev) 2900*f0fba2adSLiam Girdwood goto found; 2901*f0fba2adSLiam Girdwood } 2902*f0fba2adSLiam Girdwood return; 2903*f0fba2adSLiam Girdwood 2904*f0fba2adSLiam Girdwood found: 29059115171aSMark Brown mutex_lock(&client_mutex); 29069115171aSMark Brown list_del(&dai->list); 29079115171aSMark Brown mutex_unlock(&client_mutex); 29089115171aSMark Brown 29099115171aSMark Brown pr_debug("Unregistered DAI '%s'\n", dai->name); 2910*f0fba2adSLiam Girdwood kfree(dai->name); 2911*f0fba2adSLiam Girdwood kfree(dai); 29129115171aSMark Brown } 29139115171aSMark Brown EXPORT_SYMBOL_GPL(snd_soc_unregister_dai); 29149115171aSMark Brown 29159115171aSMark Brown /** 29169115171aSMark Brown * snd_soc_register_dais - Register multiple DAIs with the ASoC core 29179115171aSMark Brown * 2918ac11a2b3SMark Brown * @dai: Array of DAIs to register 2919ac11a2b3SMark Brown * @count: Number of DAIs 29209115171aSMark Brown */ 2921*f0fba2adSLiam Girdwood int snd_soc_register_dais(struct device *dev, 2922*f0fba2adSLiam Girdwood struct snd_soc_dai_driver *dai_drv, size_t count) 29239115171aSMark Brown { 2924*f0fba2adSLiam Girdwood struct snd_soc_dai *dai; 2925*f0fba2adSLiam Girdwood int i, ret = 0; 2926*f0fba2adSLiam Girdwood 2927*f0fba2adSLiam Girdwood dev_dbg(dev, "dai register %s #%d\n", dev_name(dev), count); 29289115171aSMark Brown 29299115171aSMark Brown for (i = 0; i < count; i++) { 2930*f0fba2adSLiam Girdwood 2931*f0fba2adSLiam Girdwood dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL); 2932*f0fba2adSLiam Girdwood if (dai == NULL) 2933*f0fba2adSLiam Girdwood return -ENOMEM; 2934*f0fba2adSLiam Girdwood 2935*f0fba2adSLiam Girdwood /* create DAI component name */ 2936*f0fba2adSLiam Girdwood dai->name = fmt_multiple_name(dev, &dai_drv[i]); 2937*f0fba2adSLiam Girdwood if (dai->name == NULL) { 2938*f0fba2adSLiam Girdwood kfree(dai); 2939*f0fba2adSLiam Girdwood ret = -EINVAL; 29409115171aSMark Brown goto err; 29419115171aSMark Brown } 29429115171aSMark Brown 2943*f0fba2adSLiam Girdwood dai->dev = dev; 2944*f0fba2adSLiam Girdwood dai->id = i; 2945*f0fba2adSLiam Girdwood dai->driver = &dai_drv[i]; 2946*f0fba2adSLiam Girdwood if (!dai->driver->ops) 2947*f0fba2adSLiam Girdwood dai->driver->ops = &null_dai_ops; 2948*f0fba2adSLiam Girdwood 2949*f0fba2adSLiam Girdwood mutex_lock(&client_mutex); 2950*f0fba2adSLiam Girdwood list_add(&dai->list, &dai_list); 2951*f0fba2adSLiam Girdwood mutex_unlock(&client_mutex); 2952*f0fba2adSLiam Girdwood 2953*f0fba2adSLiam Girdwood pr_debug("Registered DAI '%s'\n", dai->name); 2954*f0fba2adSLiam Girdwood } 2955*f0fba2adSLiam Girdwood 2956*f0fba2adSLiam Girdwood snd_soc_instantiate_cards(); 29579115171aSMark Brown return 0; 29589115171aSMark Brown 29599115171aSMark Brown err: 29609115171aSMark Brown for (i--; i >= 0; i--) 2961*f0fba2adSLiam Girdwood snd_soc_unregister_dai(dev); 29629115171aSMark Brown 29639115171aSMark Brown return ret; 29649115171aSMark Brown } 29659115171aSMark Brown EXPORT_SYMBOL_GPL(snd_soc_register_dais); 29669115171aSMark Brown 29679115171aSMark Brown /** 29689115171aSMark Brown * snd_soc_unregister_dais - Unregister multiple DAIs from the ASoC core 29699115171aSMark Brown * 2970ac11a2b3SMark Brown * @dai: Array of DAIs to unregister 2971ac11a2b3SMark Brown * @count: Number of DAIs 29729115171aSMark Brown */ 2973*f0fba2adSLiam Girdwood void snd_soc_unregister_dais(struct device *dev, size_t count) 29749115171aSMark Brown { 29759115171aSMark Brown int i; 29769115171aSMark Brown 29779115171aSMark Brown for (i = 0; i < count; i++) 2978*f0fba2adSLiam Girdwood snd_soc_unregister_dai(dev); 29799115171aSMark Brown } 29809115171aSMark Brown EXPORT_SYMBOL_GPL(snd_soc_unregister_dais); 29819115171aSMark Brown 298212a48a8cSMark Brown /** 298312a48a8cSMark Brown * snd_soc_register_platform - Register a platform with the ASoC core 298412a48a8cSMark Brown * 2985ac11a2b3SMark Brown * @platform: platform to register 298612a48a8cSMark Brown */ 2987*f0fba2adSLiam Girdwood int snd_soc_register_platform(struct device *dev, 2988*f0fba2adSLiam Girdwood struct snd_soc_platform_driver *platform_drv) 298912a48a8cSMark Brown { 2990*f0fba2adSLiam Girdwood struct snd_soc_platform *platform; 299112a48a8cSMark Brown 2992*f0fba2adSLiam Girdwood dev_dbg(dev, "platform register %s\n", dev_name(dev)); 2993*f0fba2adSLiam Girdwood 2994*f0fba2adSLiam Girdwood platform = kzalloc(sizeof(struct snd_soc_platform), GFP_KERNEL); 2995*f0fba2adSLiam Girdwood if (platform == NULL) 2996*f0fba2adSLiam Girdwood return -ENOMEM; 2997*f0fba2adSLiam Girdwood 2998*f0fba2adSLiam Girdwood /* create platform component name */ 2999*f0fba2adSLiam Girdwood platform->name = fmt_single_name(dev, &platform->id); 3000*f0fba2adSLiam Girdwood if (platform->name == NULL) { 3001*f0fba2adSLiam Girdwood kfree(platform); 3002*f0fba2adSLiam Girdwood return -ENOMEM; 3003*f0fba2adSLiam Girdwood } 3004*f0fba2adSLiam Girdwood 3005*f0fba2adSLiam Girdwood platform->dev = dev; 3006*f0fba2adSLiam Girdwood platform->driver = platform_drv; 300712a48a8cSMark Brown 300812a48a8cSMark Brown mutex_lock(&client_mutex); 300912a48a8cSMark Brown list_add(&platform->list, &platform_list); 3010435c5e25SMark Brown snd_soc_instantiate_cards(); 301112a48a8cSMark Brown mutex_unlock(&client_mutex); 301212a48a8cSMark Brown 301312a48a8cSMark Brown pr_debug("Registered platform '%s'\n", platform->name); 301412a48a8cSMark Brown 301512a48a8cSMark Brown return 0; 301612a48a8cSMark Brown } 301712a48a8cSMark Brown EXPORT_SYMBOL_GPL(snd_soc_register_platform); 301812a48a8cSMark Brown 301912a48a8cSMark Brown /** 302012a48a8cSMark Brown * snd_soc_unregister_platform - Unregister a platform from the ASoC core 302112a48a8cSMark Brown * 3022ac11a2b3SMark Brown * @platform: platform to unregister 302312a48a8cSMark Brown */ 3024*f0fba2adSLiam Girdwood void snd_soc_unregister_platform(struct device *dev) 302512a48a8cSMark Brown { 3026*f0fba2adSLiam Girdwood struct snd_soc_platform *platform; 3027*f0fba2adSLiam Girdwood 3028*f0fba2adSLiam Girdwood list_for_each_entry(platform, &platform_list, list) { 3029*f0fba2adSLiam Girdwood if (dev == platform->dev) 3030*f0fba2adSLiam Girdwood goto found; 3031*f0fba2adSLiam Girdwood } 3032*f0fba2adSLiam Girdwood return; 3033*f0fba2adSLiam Girdwood 3034*f0fba2adSLiam Girdwood found: 303512a48a8cSMark Brown mutex_lock(&client_mutex); 303612a48a8cSMark Brown list_del(&platform->list); 303712a48a8cSMark Brown mutex_unlock(&client_mutex); 303812a48a8cSMark Brown 303912a48a8cSMark Brown pr_debug("Unregistered platform '%s'\n", platform->name); 3040*f0fba2adSLiam Girdwood kfree(platform->name); 3041*f0fba2adSLiam Girdwood kfree(platform); 304212a48a8cSMark Brown } 304312a48a8cSMark Brown EXPORT_SYMBOL_GPL(snd_soc_unregister_platform); 304412a48a8cSMark Brown 3045151ab22cSMark Brown static u64 codec_format_map[] = { 3046151ab22cSMark Brown SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S16_BE, 3047151ab22cSMark Brown SNDRV_PCM_FMTBIT_U16_LE | SNDRV_PCM_FMTBIT_U16_BE, 3048151ab22cSMark Brown SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S24_BE, 3049151ab22cSMark Brown SNDRV_PCM_FMTBIT_U24_LE | SNDRV_PCM_FMTBIT_U24_BE, 3050151ab22cSMark Brown SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_S32_BE, 3051151ab22cSMark Brown SNDRV_PCM_FMTBIT_U32_LE | SNDRV_PCM_FMTBIT_U32_BE, 3052151ab22cSMark Brown SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_U24_3BE, 3053151ab22cSMark Brown SNDRV_PCM_FMTBIT_U24_3LE | SNDRV_PCM_FMTBIT_U24_3BE, 3054151ab22cSMark Brown SNDRV_PCM_FMTBIT_S20_3LE | SNDRV_PCM_FMTBIT_S20_3BE, 3055151ab22cSMark Brown SNDRV_PCM_FMTBIT_U20_3LE | SNDRV_PCM_FMTBIT_U20_3BE, 3056151ab22cSMark Brown SNDRV_PCM_FMTBIT_S18_3LE | SNDRV_PCM_FMTBIT_S18_3BE, 3057151ab22cSMark Brown SNDRV_PCM_FMTBIT_U18_3LE | SNDRV_PCM_FMTBIT_U18_3BE, 3058151ab22cSMark Brown SNDRV_PCM_FMTBIT_FLOAT_LE | SNDRV_PCM_FMTBIT_FLOAT_BE, 3059151ab22cSMark Brown SNDRV_PCM_FMTBIT_FLOAT64_LE | SNDRV_PCM_FMTBIT_FLOAT64_BE, 3060151ab22cSMark Brown SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE 3061151ab22cSMark Brown | SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_BE, 3062151ab22cSMark Brown }; 3063151ab22cSMark Brown 3064151ab22cSMark Brown /* Fix up the DAI formats for endianness: codecs don't actually see 3065151ab22cSMark Brown * the endianness of the data but we're using the CPU format 3066151ab22cSMark Brown * definitions which do need to include endianness so we ensure that 3067151ab22cSMark Brown * codec DAIs always have both big and little endian variants set. 3068151ab22cSMark Brown */ 3069151ab22cSMark Brown static void fixup_codec_formats(struct snd_soc_pcm_stream *stream) 3070151ab22cSMark Brown { 3071151ab22cSMark Brown int i; 3072151ab22cSMark Brown 3073151ab22cSMark Brown for (i = 0; i < ARRAY_SIZE(codec_format_map); i++) 3074151ab22cSMark Brown if (stream->formats & codec_format_map[i]) 3075151ab22cSMark Brown stream->formats |= codec_format_map[i]; 3076151ab22cSMark Brown } 3077151ab22cSMark Brown 30780d0cf00aSMark Brown /** 30790d0cf00aSMark Brown * snd_soc_register_codec - Register a codec with the ASoC core 30800d0cf00aSMark Brown * 3081ac11a2b3SMark Brown * @codec: codec to register 30820d0cf00aSMark Brown */ 3083*f0fba2adSLiam Girdwood int snd_soc_register_codec(struct device *dev, 3084*f0fba2adSLiam Girdwood struct snd_soc_codec_driver *codec_drv, 3085*f0fba2adSLiam Girdwood struct snd_soc_dai_driver *dai_drv, int num_dai) 30860d0cf00aSMark Brown { 3087*f0fba2adSLiam Girdwood struct snd_soc_codec *codec; 3088*f0fba2adSLiam Girdwood int ret, i; 3089151ab22cSMark Brown 3090*f0fba2adSLiam Girdwood dev_dbg(dev, "codec register %s\n", dev_name(dev)); 30910d0cf00aSMark Brown 3092*f0fba2adSLiam Girdwood codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL); 3093*f0fba2adSLiam Girdwood if (codec == NULL) 3094*f0fba2adSLiam Girdwood return -ENOMEM; 30950d0cf00aSMark Brown 3096*f0fba2adSLiam Girdwood /* create CODEC component name */ 3097*f0fba2adSLiam Girdwood codec->name = fmt_single_name(dev, &codec->id); 3098*f0fba2adSLiam Girdwood if (codec->name == NULL) { 3099*f0fba2adSLiam Girdwood kfree(codec); 3100*f0fba2adSLiam Girdwood return -ENOMEM; 3101151ab22cSMark Brown } 3102151ab22cSMark Brown 3103*f0fba2adSLiam Girdwood /* allocate CODEC register cache */ 3104*f0fba2adSLiam Girdwood if (codec_drv->reg_cache_size && codec_drv->reg_word_size) { 3105*f0fba2adSLiam Girdwood 3106*f0fba2adSLiam Girdwood if (codec_drv->reg_cache_default) 3107*f0fba2adSLiam Girdwood codec->reg_cache = kmemdup(codec_drv->reg_cache_default, 3108*f0fba2adSLiam Girdwood codec_drv->reg_cache_size * codec_drv->reg_word_size, GFP_KERNEL); 3109*f0fba2adSLiam Girdwood else 3110*f0fba2adSLiam Girdwood codec->reg_cache = kzalloc(codec_drv->reg_cache_size * 3111*f0fba2adSLiam Girdwood codec_drv->reg_word_size, GFP_KERNEL); 3112*f0fba2adSLiam Girdwood 3113*f0fba2adSLiam Girdwood if (codec->reg_cache == NULL) { 3114*f0fba2adSLiam Girdwood kfree(codec->name); 3115*f0fba2adSLiam Girdwood kfree(codec); 3116*f0fba2adSLiam Girdwood return -ENOMEM; 3117*f0fba2adSLiam Girdwood } 3118*f0fba2adSLiam Girdwood } 3119*f0fba2adSLiam Girdwood 3120*f0fba2adSLiam Girdwood codec->dev = dev; 3121*f0fba2adSLiam Girdwood codec->driver = codec_drv; 3122*f0fba2adSLiam Girdwood codec->bias_level = SND_SOC_BIAS_OFF; 3123*f0fba2adSLiam Girdwood codec->num_dai = num_dai; 3124*f0fba2adSLiam Girdwood mutex_init(&codec->mutex); 3125*f0fba2adSLiam Girdwood INIT_LIST_HEAD(&codec->dapm_widgets); 3126*f0fba2adSLiam Girdwood INIT_LIST_HEAD(&codec->dapm_paths); 3127*f0fba2adSLiam Girdwood 3128*f0fba2adSLiam Girdwood for (i = 0; i < num_dai; i++) { 3129*f0fba2adSLiam Girdwood fixup_codec_formats(&dai_drv[i].playback); 3130*f0fba2adSLiam Girdwood fixup_codec_formats(&dai_drv[i].capture); 3131*f0fba2adSLiam Girdwood } 3132*f0fba2adSLiam Girdwood 3133*f0fba2adSLiam Girdwood /* register DAIs */ 3134*f0fba2adSLiam Girdwood ret = snd_soc_register_dais(dev, dai_drv, num_dai); 3135*f0fba2adSLiam Girdwood if (ret < 0) 3136*f0fba2adSLiam Girdwood goto error; 3137*f0fba2adSLiam Girdwood 31380d0cf00aSMark Brown mutex_lock(&client_mutex); 31390d0cf00aSMark Brown list_add(&codec->list, &codec_list); 31400d0cf00aSMark Brown snd_soc_instantiate_cards(); 31410d0cf00aSMark Brown mutex_unlock(&client_mutex); 31420d0cf00aSMark Brown 31430d0cf00aSMark Brown pr_debug("Registered codec '%s'\n", codec->name); 31440d0cf00aSMark Brown return 0; 3145*f0fba2adSLiam Girdwood 3146*f0fba2adSLiam Girdwood error: 3147*f0fba2adSLiam Girdwood for (i--; i >= 0; i--) 3148*f0fba2adSLiam Girdwood snd_soc_unregister_dai(dev); 3149*f0fba2adSLiam Girdwood 3150*f0fba2adSLiam Girdwood if (codec->reg_cache) 3151*f0fba2adSLiam Girdwood kfree(codec->reg_cache); 3152*f0fba2adSLiam Girdwood kfree(codec->name); 3153*f0fba2adSLiam Girdwood kfree(codec); 3154*f0fba2adSLiam Girdwood return ret; 31550d0cf00aSMark Brown } 31560d0cf00aSMark Brown EXPORT_SYMBOL_GPL(snd_soc_register_codec); 31570d0cf00aSMark Brown 31580d0cf00aSMark Brown /** 31590d0cf00aSMark Brown * snd_soc_unregister_codec - Unregister a codec from the ASoC core 31600d0cf00aSMark Brown * 3161ac11a2b3SMark Brown * @codec: codec to unregister 31620d0cf00aSMark Brown */ 3163*f0fba2adSLiam Girdwood void snd_soc_unregister_codec(struct device *dev) 31640d0cf00aSMark Brown { 3165*f0fba2adSLiam Girdwood struct snd_soc_codec *codec; 3166*f0fba2adSLiam Girdwood int i; 3167*f0fba2adSLiam Girdwood 3168*f0fba2adSLiam Girdwood list_for_each_entry(codec, &codec_list, list) { 3169*f0fba2adSLiam Girdwood if (dev == codec->dev) 3170*f0fba2adSLiam Girdwood goto found; 3171*f0fba2adSLiam Girdwood } 3172*f0fba2adSLiam Girdwood return; 3173*f0fba2adSLiam Girdwood 3174*f0fba2adSLiam Girdwood found: 3175*f0fba2adSLiam Girdwood for (i = 0; i < codec->num_dai; i++) 3176*f0fba2adSLiam Girdwood snd_soc_unregister_dai(dev); 3177*f0fba2adSLiam Girdwood 31780d0cf00aSMark Brown mutex_lock(&client_mutex); 31790d0cf00aSMark Brown list_del(&codec->list); 31800d0cf00aSMark Brown mutex_unlock(&client_mutex); 31810d0cf00aSMark Brown 31820d0cf00aSMark Brown pr_debug("Unregistered codec '%s'\n", codec->name); 3183*f0fba2adSLiam Girdwood 3184*f0fba2adSLiam Girdwood if (codec->reg_cache) 3185*f0fba2adSLiam Girdwood kfree(codec->reg_cache); 3186*f0fba2adSLiam Girdwood kfree(codec); 31870d0cf00aSMark Brown } 31880d0cf00aSMark Brown EXPORT_SYMBOL_GPL(snd_soc_unregister_codec); 31890d0cf00aSMark Brown 3190c9b3a40fSTakashi Iwai static int __init snd_soc_init(void) 3191db2a4165SFrank Mandarino { 3192384c89e2SMark Brown #ifdef CONFIG_DEBUG_FS 3193384c89e2SMark Brown debugfs_root = debugfs_create_dir("asoc", NULL); 3194384c89e2SMark Brown if (IS_ERR(debugfs_root) || !debugfs_root) { 3195384c89e2SMark Brown printk(KERN_WARNING 3196384c89e2SMark Brown "ASoC: Failed to create debugfs directory\n"); 3197384c89e2SMark Brown debugfs_root = NULL; 3198384c89e2SMark Brown } 3199384c89e2SMark Brown #endif 3200384c89e2SMark Brown 3201db2a4165SFrank Mandarino return platform_driver_register(&soc_driver); 3202db2a4165SFrank Mandarino } 3203db2a4165SFrank Mandarino 32047d8c16a6SMark Brown static void __exit snd_soc_exit(void) 3205db2a4165SFrank Mandarino { 3206384c89e2SMark Brown #ifdef CONFIG_DEBUG_FS 3207384c89e2SMark Brown debugfs_remove_recursive(debugfs_root); 3208384c89e2SMark Brown #endif 3209db2a4165SFrank Mandarino platform_driver_unregister(&soc_driver); 3210db2a4165SFrank Mandarino } 3211db2a4165SFrank Mandarino 3212db2a4165SFrank Mandarino module_init(snd_soc_init); 3213db2a4165SFrank Mandarino module_exit(snd_soc_exit); 3214db2a4165SFrank Mandarino 3215db2a4165SFrank Mandarino /* Module information */ 3216d331124dSLiam Girdwood MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk"); 3217db2a4165SFrank Mandarino MODULE_DESCRIPTION("ALSA SoC Core"); 3218db2a4165SFrank Mandarino MODULE_LICENSE("GPL"); 32198b45a209SKay Sievers MODULE_ALIAS("platform:soc-audio"); 3220