Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 1 | /* |
Peter Ujfalusi | 13f81d6 | 2011-12-07 15:54:50 +0200 | [diff] [blame] | 2 | * omap-abe-twl6040.c -- SoC audio for TI OMAP based boards with ABE and |
| 3 | * twl6040 codec |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 4 | * |
Peter Ujfalusi | 8747a6b | 2011-12-07 15:31:26 +0200 | [diff] [blame] | 5 | * Author: Misael Lopez Cruz <misael.lopez@ti.com> |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 6 | * |
| 7 | * This program is free software; you can redistribute it and/or |
| 8 | * modify it under the terms of the GNU General Public License |
| 9 | * version 2 as published by the Free Software Foundation. |
| 10 | * |
| 11 | * This program is distributed in the hope that it will be useful, but |
| 12 | * WITHOUT ANY WARRANTY; without even the implied warranty of |
| 13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| 14 | * General Public License for more details. |
| 15 | * |
| 16 | * You should have received a copy of the GNU General Public License |
| 17 | * along with this program; if not, write to the Free Software |
| 18 | * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA |
| 19 | * 02110-1301 USA |
| 20 | * |
| 21 | */ |
| 22 | |
| 23 | #include <linux/clk.h> |
| 24 | #include <linux/platform_device.h> |
Misael Lopez Cruz | fb34d3d | 2011-05-01 21:27:00 -0500 | [diff] [blame] | 25 | #include <linux/mfd/twl6040.h> |
Peter Ujfalusi | d1be1d2 | 2011-12-08 11:07:42 +0200 | [diff] [blame] | 26 | #include <linux/platform_data/omap-abe-twl6040.h> |
Paul Gortmaker | da155d5 | 2011-07-15 12:38:28 -0400 | [diff] [blame] | 27 | #include <linux/module.h> |
Misael Lopez Cruz | fb34d3d | 2011-05-01 21:27:00 -0500 | [diff] [blame] | 28 | |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 29 | #include <sound/core.h> |
| 30 | #include <sound/pcm.h> |
| 31 | #include <sound/soc.h> |
Jorge Eduardo Candelaria | 96dc227 | 2010-12-10 20:45:19 -0600 | [diff] [blame] | 32 | #include <sound/jack.h> |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 33 | |
| 34 | #include <asm/mach-types.h> |
| 35 | #include <plat/hardware.h> |
| 36 | #include <plat/mux.h> |
| 37 | |
Peter Ujfalusi | 6524c8e | 2011-11-28 15:45:43 +0200 | [diff] [blame] | 38 | #include "omap-dmic.h" |
Misael Lopez Cruz | f5f9d7b | 2011-07-05 19:50:45 +0300 | [diff] [blame] | 39 | #include "omap-mcpdm.h" |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 40 | #include "omap-pcm.h" |
| 41 | #include "../codecs/twl6040.h" |
| 42 | |
Peter Ujfalusi | 356bccb | 2012-04-24 12:52:53 +0300 | [diff] [blame] | 43 | struct abe_twl6040 { |
| 44 | int jack_detection; /* board can detect jack events */ |
| 45 | int mclk_freq; /* MCLK frequency speed for twl6040 */ |
| 46 | }; |
| 47 | |
Peter Ujfalusi | 13f81d6 | 2011-12-07 15:54:50 +0200 | [diff] [blame] | 48 | static int omap_abe_hw_params(struct snd_pcm_substream *substream, |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 49 | struct snd_pcm_hw_params *params) |
| 50 | { |
| 51 | struct snd_soc_pcm_runtime *rtd = substream->private_data; |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 52 | struct snd_soc_dai *codec_dai = rtd->codec_dai; |
Peter Ujfalusi | 62ba98c | 2012-01-24 12:36:10 +0200 | [diff] [blame] | 53 | struct snd_soc_codec *codec = rtd->codec; |
| 54 | struct snd_soc_card *card = codec->card; |
Peter Ujfalusi | 356bccb | 2012-04-24 12:52:53 +0300 | [diff] [blame] | 55 | struct abe_twl6040 *priv = snd_soc_card_get_drvdata(card); |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 56 | int clk_id, freq; |
| 57 | int ret; |
| 58 | |
Peter Ujfalusi | af958c7 | 2011-06-27 17:03:14 +0300 | [diff] [blame] | 59 | clk_id = twl6040_get_clk_id(rtd->codec); |
| 60 | if (clk_id == TWL6040_SYSCLK_SEL_HPPLL) |
Peter Ujfalusi | 356bccb | 2012-04-24 12:52:53 +0300 | [diff] [blame] | 61 | freq = priv->mclk_freq; |
Peter Ujfalusi | af958c7 | 2011-06-27 17:03:14 +0300 | [diff] [blame] | 62 | else if (clk_id == TWL6040_SYSCLK_SEL_LPPLL) |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 63 | freq = 32768; |
Peter Ujfalusi | af958c7 | 2011-06-27 17:03:14 +0300 | [diff] [blame] | 64 | else |
| 65 | return -EINVAL; |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 66 | |
| 67 | /* set the codec mclk */ |
| 68 | ret = snd_soc_dai_set_sysclk(codec_dai, clk_id, freq, |
| 69 | SND_SOC_CLOCK_IN); |
| 70 | if (ret) { |
| 71 | printk(KERN_ERR "can't set codec system clock\n"); |
| 72 | return ret; |
| 73 | } |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 74 | return ret; |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 75 | } |
| 76 | |
Peter Ujfalusi | 13f81d6 | 2011-12-07 15:54:50 +0200 | [diff] [blame] | 77 | static struct snd_soc_ops omap_abe_ops = { |
| 78 | .hw_params = omap_abe_hw_params, |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 79 | }; |
| 80 | |
Peter Ujfalusi | 13f81d6 | 2011-12-07 15:54:50 +0200 | [diff] [blame] | 81 | static int omap_abe_dmic_hw_params(struct snd_pcm_substream *substream, |
Peter Ujfalusi | 6524c8e | 2011-11-28 15:45:43 +0200 | [diff] [blame] | 82 | struct snd_pcm_hw_params *params) |
| 83 | { |
| 84 | struct snd_soc_pcm_runtime *rtd = substream->private_data; |
| 85 | struct snd_soc_dai *cpu_dai = rtd->cpu_dai; |
| 86 | int ret = 0; |
| 87 | |
| 88 | ret = snd_soc_dai_set_sysclk(cpu_dai, OMAP_DMIC_SYSCLK_PAD_CLKS, |
| 89 | 19200000, SND_SOC_CLOCK_IN); |
| 90 | if (ret < 0) { |
| 91 | printk(KERN_ERR "can't set DMIC cpu system clock\n"); |
| 92 | return ret; |
| 93 | } |
| 94 | ret = snd_soc_dai_set_sysclk(cpu_dai, OMAP_DMIC_ABE_DMIC_CLK, 2400000, |
| 95 | SND_SOC_CLOCK_OUT); |
| 96 | if (ret < 0) { |
| 97 | printk(KERN_ERR "can't set DMIC output clock\n"); |
| 98 | return ret; |
| 99 | } |
| 100 | return 0; |
| 101 | } |
| 102 | |
Peter Ujfalusi | 13f81d6 | 2011-12-07 15:54:50 +0200 | [diff] [blame] | 103 | static struct snd_soc_ops omap_abe_dmic_ops = { |
| 104 | .hw_params = omap_abe_dmic_hw_params, |
Peter Ujfalusi | 6524c8e | 2011-11-28 15:45:43 +0200 | [diff] [blame] | 105 | }; |
| 106 | |
Jorge Eduardo Candelaria | 96dc227 | 2010-12-10 20:45:19 -0600 | [diff] [blame] | 107 | /* Headset jack */ |
| 108 | static struct snd_soc_jack hs_jack; |
| 109 | |
| 110 | /*Headset jack detection DAPM pins */ |
| 111 | static struct snd_soc_jack_pin hs_jack_pins[] = { |
| 112 | { |
| 113 | .pin = "Headset Mic", |
| 114 | .mask = SND_JACK_MICROPHONE, |
| 115 | }, |
| 116 | { |
| 117 | .pin = "Headset Stereophone", |
| 118 | .mask = SND_JACK_HEADPHONE, |
| 119 | }, |
| 120 | }; |
| 121 | |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 122 | /* SDP4430 machine DAPM */ |
Peter Ujfalusi | 13f81d6 | 2011-12-07 15:54:50 +0200 | [diff] [blame] | 123 | static const struct snd_soc_dapm_widget twl6040_dapm_widgets[] = { |
Peter Ujfalusi | b320883 | 2011-12-22 12:55:49 +0200 | [diff] [blame] | 124 | /* Outputs */ |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 125 | SND_SOC_DAPM_HP("Headset Stereophone", NULL), |
Jorge Eduardo Candelaria | 7254e2b | 2010-05-18 12:44:17 -0500 | [diff] [blame] | 126 | SND_SOC_DAPM_SPK("Earphone Spk", NULL), |
Peter Ujfalusi | b320883 | 2011-12-22 12:55:49 +0200 | [diff] [blame] | 127 | SND_SOC_DAPM_SPK("Ext Spk", NULL), |
| 128 | SND_SOC_DAPM_LINE("Line Out", NULL), |
| 129 | SND_SOC_DAPM_SPK("Vibrator", NULL), |
| 130 | |
| 131 | /* Inputs */ |
| 132 | SND_SOC_DAPM_MIC("Headset Mic", NULL), |
| 133 | SND_SOC_DAPM_MIC("Main Handset Mic", NULL), |
| 134 | SND_SOC_DAPM_MIC("Sub Handset Mic", NULL), |
| 135 | SND_SOC_DAPM_LINE("Line In", NULL), |
Peter Ujfalusi | 7d09f9e | 2012-04-24 12:41:32 +0300 | [diff] [blame] | 136 | |
| 137 | /* Digital microphones */ |
| 138 | SND_SOC_DAPM_MIC("Digital Mic", NULL), |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 139 | }; |
| 140 | |
| 141 | static const struct snd_soc_dapm_route audio_map[] = { |
Peter Ujfalusi | b320883 | 2011-12-22 12:55:49 +0200 | [diff] [blame] | 142 | /* Routings for outputs */ |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 143 | {"Headset Stereophone", NULL, "HSOL"}, |
| 144 | {"Headset Stereophone", NULL, "HSOR"}, |
Jorge Eduardo Candelaria | 7254e2b | 2010-05-18 12:44:17 -0500 | [diff] [blame] | 145 | |
Jorge Eduardo Candelaria | 7254e2b | 2010-05-18 12:44:17 -0500 | [diff] [blame] | 146 | {"Earphone Spk", NULL, "EP"}, |
Jorge Eduardo Candelaria | 23ac3b6 | 2010-12-08 10:55:05 -0600 | [diff] [blame] | 147 | |
Peter Ujfalusi | b320883 | 2011-12-22 12:55:49 +0200 | [diff] [blame] | 148 | {"Ext Spk", NULL, "HFL"}, |
| 149 | {"Ext Spk", NULL, "HFR"}, |
| 150 | |
| 151 | {"Line Out", NULL, "AUXL"}, |
| 152 | {"Line Out", NULL, "AUXR"}, |
| 153 | |
| 154 | {"Vibrator", NULL, "VIBRAL"}, |
| 155 | {"Vibrator", NULL, "VIBRAR"}, |
| 156 | |
| 157 | /* Routings for inputs */ |
| 158 | {"HSMIC", NULL, "Headset Mic"}, |
| 159 | {"Headset Mic", NULL, "Headset Mic Bias"}, |
| 160 | |
| 161 | {"MAINMIC", NULL, "Main Handset Mic"}, |
| 162 | {"Main Handset Mic", NULL, "Main Mic Bias"}, |
| 163 | |
| 164 | {"SUBMIC", NULL, "Sub Handset Mic"}, |
| 165 | {"Sub Handset Mic", NULL, "Main Mic Bias"}, |
| 166 | |
| 167 | {"AFML", NULL, "Line In"}, |
| 168 | {"AFMR", NULL, "Line In"}, |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 169 | }; |
| 170 | |
Peter Ujfalusi | 4ca07cb | 2011-12-22 13:58:01 +0200 | [diff] [blame] | 171 | static inline void twl6040_disconnect_pin(struct snd_soc_dapm_context *dapm, |
| 172 | int connected, char *pin) |
| 173 | { |
| 174 | if (!connected) |
| 175 | snd_soc_dapm_disable_pin(dapm, pin); |
| 176 | } |
| 177 | |
Peter Ujfalusi | 13f81d6 | 2011-12-07 15:54:50 +0200 | [diff] [blame] | 178 | static int omap_abe_twl6040_init(struct snd_soc_pcm_runtime *rtd) |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 179 | { |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 180 | struct snd_soc_codec *codec = rtd->codec; |
Peter Ujfalusi | 4ca07cb | 2011-12-22 13:58:01 +0200 | [diff] [blame] | 181 | struct snd_soc_card *card = codec->card; |
| 182 | struct snd_soc_dapm_context *dapm = &codec->dapm; |
| 183 | struct omap_abe_twl6040_data *pdata = dev_get_platdata(card->dev); |
Peter Ujfalusi | 356bccb | 2012-04-24 12:52:53 +0300 | [diff] [blame] | 184 | struct abe_twl6040 *priv = snd_soc_card_get_drvdata(card); |
Peter Ujfalusi | 4ca07cb | 2011-12-22 13:58:01 +0200 | [diff] [blame] | 185 | int hs_trim; |
| 186 | int ret = 0; |
| 187 | |
| 188 | /* Disable not connected paths if not used */ |
| 189 | twl6040_disconnect_pin(dapm, pdata->has_hs, "Headset Stereophone"); |
| 190 | twl6040_disconnect_pin(dapm, pdata->has_hf, "Ext Spk"); |
| 191 | twl6040_disconnect_pin(dapm, pdata->has_ep, "Earphone Spk"); |
| 192 | twl6040_disconnect_pin(dapm, pdata->has_aux, "Line Out"); |
| 193 | twl6040_disconnect_pin(dapm, pdata->has_vibra, "Vinrator"); |
| 194 | twl6040_disconnect_pin(dapm, pdata->has_hsmic, "Headset Mic"); |
| 195 | twl6040_disconnect_pin(dapm, pdata->has_mainmic, "Main Handset Mic"); |
| 196 | twl6040_disconnect_pin(dapm, pdata->has_submic, "Sub Handset Mic"); |
| 197 | twl6040_disconnect_pin(dapm, pdata->has_afm, "Line In"); |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 198 | |
Peter Ujfalusi | 7bf3d92 | 2011-09-26 16:05:59 +0300 | [diff] [blame] | 199 | /* |
| 200 | * Configure McPDM offset cancellation based on the HSOTRIM value from |
| 201 | * twl6040. |
| 202 | */ |
| 203 | hs_trim = twl6040_get_trim_value(codec, TWL6040_TRIM_HSOTRIM); |
| 204 | omap_mcpdm_configure_dn_offsets(rtd, TWL6040_HSF_TRIM_LEFT(hs_trim), |
| 205 | TWL6040_HSF_TRIM_RIGHT(hs_trim)); |
| 206 | |
Peter Ujfalusi | 4ca07cb | 2011-12-22 13:58:01 +0200 | [diff] [blame] | 207 | /* Headset jack detection only if it is supported */ |
Peter Ujfalusi | 356bccb | 2012-04-24 12:52:53 +0300 | [diff] [blame] | 208 | if (priv->jack_detection) { |
Peter Ujfalusi | 4ca07cb | 2011-12-22 13:58:01 +0200 | [diff] [blame] | 209 | ret = snd_soc_jack_new(codec, "Headset Jack", |
| 210 | SND_JACK_HEADSET, &hs_jack); |
| 211 | if (ret) |
| 212 | return ret; |
Jorge Eduardo Candelaria | 96dc227 | 2010-12-10 20:45:19 -0600 | [diff] [blame] | 213 | |
Peter Ujfalusi | 4ca07cb | 2011-12-22 13:58:01 +0200 | [diff] [blame] | 214 | ret = snd_soc_jack_add_pins(&hs_jack, ARRAY_SIZE(hs_jack_pins), |
| 215 | hs_jack_pins); |
Jorge Eduardo Candelaria | 96dc227 | 2010-12-10 20:45:19 -0600 | [diff] [blame] | 216 | twl6040_hs_jack_detect(codec, &hs_jack, SND_JACK_HEADSET); |
Peter Ujfalusi | 4ca07cb | 2011-12-22 13:58:01 +0200 | [diff] [blame] | 217 | } |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 218 | |
| 219 | return ret; |
| 220 | } |
| 221 | |
Peter Ujfalusi | 6524c8e | 2011-11-28 15:45:43 +0200 | [diff] [blame] | 222 | static const struct snd_soc_dapm_route dmic_audio_map[] = { |
Peter Ujfalusi | 778cee7 | 2011-12-22 12:47:21 +0200 | [diff] [blame] | 223 | {"DMic", NULL, "Digital Mic"}, |
| 224 | {"Digital Mic", NULL, "Digital Mic1 Bias"}, |
Peter Ujfalusi | 6524c8e | 2011-11-28 15:45:43 +0200 | [diff] [blame] | 225 | }; |
| 226 | |
Peter Ujfalusi | 13f81d6 | 2011-12-07 15:54:50 +0200 | [diff] [blame] | 227 | static int omap_abe_dmic_init(struct snd_soc_pcm_runtime *rtd) |
Peter Ujfalusi | 6524c8e | 2011-11-28 15:45:43 +0200 | [diff] [blame] | 228 | { |
| 229 | struct snd_soc_codec *codec = rtd->codec; |
| 230 | struct snd_soc_dapm_context *dapm = &codec->dapm; |
Peter Ujfalusi | 6524c8e | 2011-11-28 15:45:43 +0200 | [diff] [blame] | 231 | |
| 232 | return snd_soc_dapm_add_routes(dapm, dmic_audio_map, |
| 233 | ARRAY_SIZE(dmic_audio_map)); |
| 234 | } |
| 235 | |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 236 | /* Digital audio interface glue - connects codec <--> CPU */ |
Peter Ujfalusi | c2f9895 | 2012-04-24 12:36:25 +0300 | [diff] [blame] | 237 | static struct snd_soc_dai_link abe_twl6040_dai_links[] = { |
Peter Ujfalusi | 6524c8e | 2011-11-28 15:45:43 +0200 | [diff] [blame] | 238 | { |
| 239 | .name = "TWL6040", |
| 240 | .stream_name = "TWL6040", |
| 241 | .cpu_dai_name = "omap-mcpdm", |
| 242 | .codec_dai_name = "twl6040-legacy", |
| 243 | .platform_name = "omap-pcm-audio", |
| 244 | .codec_name = "twl6040-codec", |
Peter Ujfalusi | 13f81d6 | 2011-12-07 15:54:50 +0200 | [diff] [blame] | 245 | .init = omap_abe_twl6040_init, |
| 246 | .ops = &omap_abe_ops, |
Peter Ujfalusi | 6524c8e | 2011-11-28 15:45:43 +0200 | [diff] [blame] | 247 | }, |
| 248 | { |
| 249 | .name = "DMIC", |
| 250 | .stream_name = "DMIC Capture", |
| 251 | .cpu_dai_name = "omap-dmic", |
| 252 | .codec_dai_name = "dmic-hifi", |
| 253 | .platform_name = "omap-pcm-audio", |
| 254 | .codec_name = "dmic-codec", |
Peter Ujfalusi | 13f81d6 | 2011-12-07 15:54:50 +0200 | [diff] [blame] | 255 | .init = omap_abe_dmic_init, |
| 256 | .ops = &omap_abe_dmic_ops, |
Peter Ujfalusi | 6524c8e | 2011-11-28 15:45:43 +0200 | [diff] [blame] | 257 | }, |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 258 | }; |
| 259 | |
| 260 | /* Audio machine driver */ |
Peter Ujfalusi | 13f81d6 | 2011-12-07 15:54:50 +0200 | [diff] [blame] | 261 | static struct snd_soc_card omap_abe_card = { |
Axel Lin | b425b88 | 2011-12-22 11:08:59 +0800 | [diff] [blame] | 262 | .owner = THIS_MODULE, |
Peter Ujfalusi | fc8e5b4 | 2011-10-10 15:34:15 +0300 | [diff] [blame] | 263 | |
Peter Ujfalusi | 13f81d6 | 2011-12-07 15:54:50 +0200 | [diff] [blame] | 264 | .dapm_widgets = twl6040_dapm_widgets, |
| 265 | .num_dapm_widgets = ARRAY_SIZE(twl6040_dapm_widgets), |
Peter Ujfalusi | fc8e5b4 | 2011-10-10 15:34:15 +0300 | [diff] [blame] | 266 | .dapm_routes = audio_map, |
| 267 | .num_dapm_routes = ARRAY_SIZE(audio_map), |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 268 | }; |
| 269 | |
Peter Ujfalusi | d1be1d2 | 2011-12-08 11:07:42 +0200 | [diff] [blame] | 270 | static __devinit int omap_abe_probe(struct platform_device *pdev) |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 271 | { |
Peter Ujfalusi | d1be1d2 | 2011-12-08 11:07:42 +0200 | [diff] [blame] | 272 | struct omap_abe_twl6040_data *pdata = dev_get_platdata(&pdev->dev); |
| 273 | struct snd_soc_card *card = &omap_abe_card; |
Peter Ujfalusi | 356bccb | 2012-04-24 12:52:53 +0300 | [diff] [blame] | 274 | struct abe_twl6040 *priv; |
Peter Ujfalusi | c2f9895 | 2012-04-24 12:36:25 +0300 | [diff] [blame] | 275 | int num_links = 0; |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 276 | int ret; |
| 277 | |
Peter Ujfalusi | d1be1d2 | 2011-12-08 11:07:42 +0200 | [diff] [blame] | 278 | card->dev = &pdev->dev; |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 279 | |
Peter Ujfalusi | d1be1d2 | 2011-12-08 11:07:42 +0200 | [diff] [blame] | 280 | if (!pdata) { |
| 281 | dev_err(&pdev->dev, "Missing pdata\n"); |
| 282 | return -ENODEV; |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 283 | } |
| 284 | |
Peter Ujfalusi | 356bccb | 2012-04-24 12:52:53 +0300 | [diff] [blame] | 285 | priv = devm_kzalloc(&pdev->dev, sizeof(struct abe_twl6040), GFP_KERNEL); |
| 286 | if (priv == NULL) |
| 287 | return -ENOMEM; |
| 288 | |
Peter Ujfalusi | d1be1d2 | 2011-12-08 11:07:42 +0200 | [diff] [blame] | 289 | if (pdata->card_name) { |
| 290 | card->name = pdata->card_name; |
| 291 | } else { |
| 292 | dev_err(&pdev->dev, "Card name is not provided\n"); |
| 293 | return -ENODEV; |
| 294 | } |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 295 | |
Peter Ujfalusi | 356bccb | 2012-04-24 12:52:53 +0300 | [diff] [blame] | 296 | priv->jack_detection = pdata->jack_detection; |
| 297 | priv->mclk_freq = pdata->mclk_freq; |
| 298 | |
| 299 | |
| 300 | if (!priv->mclk_freq) { |
Peter Ujfalusi | 62ba98c | 2012-01-24 12:36:10 +0200 | [diff] [blame] | 301 | dev_err(&pdev->dev, "MCLK frequency missing\n"); |
| 302 | return -ENODEV; |
| 303 | } |
| 304 | |
Peter Ujfalusi | c2f9895 | 2012-04-24 12:36:25 +0300 | [diff] [blame] | 305 | if (pdata->has_dmic) |
| 306 | num_links = 2; |
| 307 | else |
| 308 | num_links = 1; |
| 309 | |
| 310 | card->dai_link = abe_twl6040_dai_links; |
| 311 | card->num_links = num_links; |
Peter Ujfalusi | 8d946dd | 2011-12-22 13:10:02 +0200 | [diff] [blame] | 312 | |
Peter Ujfalusi | 356bccb | 2012-04-24 12:52:53 +0300 | [diff] [blame] | 313 | snd_soc_card_set_drvdata(card, priv); |
| 314 | |
Peter Ujfalusi | d1be1d2 | 2011-12-08 11:07:42 +0200 | [diff] [blame] | 315 | ret = snd_soc_register_card(card); |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 316 | if (ret) |
Peter Ujfalusi | d1be1d2 | 2011-12-08 11:07:42 +0200 | [diff] [blame] | 317 | dev_err(&pdev->dev, "snd_soc_register_card() failed: %d\n", |
| 318 | ret); |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 319 | |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 320 | return ret; |
| 321 | } |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 322 | |
Peter Ujfalusi | d1be1d2 | 2011-12-08 11:07:42 +0200 | [diff] [blame] | 323 | static int __devexit omap_abe_remove(struct platform_device *pdev) |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 324 | { |
Peter Ujfalusi | d1be1d2 | 2011-12-08 11:07:42 +0200 | [diff] [blame] | 325 | struct snd_soc_card *card = platform_get_drvdata(pdev); |
| 326 | |
| 327 | snd_soc_unregister_card(card); |
| 328 | |
| 329 | return 0; |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 330 | } |
Peter Ujfalusi | d1be1d2 | 2011-12-08 11:07:42 +0200 | [diff] [blame] | 331 | |
| 332 | static struct platform_driver omap_abe_driver = { |
| 333 | .driver = { |
| 334 | .name = "omap-abe-twl6040", |
| 335 | .owner = THIS_MODULE, |
| 336 | .pm = &snd_soc_pm_ops, |
| 337 | }, |
| 338 | .probe = omap_abe_probe, |
| 339 | .remove = __devexit_p(omap_abe_remove), |
| 340 | }; |
| 341 | |
| 342 | module_platform_driver(omap_abe_driver); |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 343 | |
Peter Ujfalusi | 8747a6b | 2011-12-07 15:31:26 +0200 | [diff] [blame] | 344 | MODULE_AUTHOR("Misael Lopez Cruz <misael.lopez@ti.com>"); |
Peter Ujfalusi | 13f81d6 | 2011-12-07 15:54:50 +0200 | [diff] [blame] | 345 | MODULE_DESCRIPTION("ALSA SoC for OMAP boards with ABE and twl6040 codec"); |
Misael Lopez Cruz | 5e64d6a | 2010-05-17 19:53:10 -0500 | [diff] [blame] | 346 | MODULE_LICENSE("GPL"); |
Peter Ujfalusi | d1be1d2 | 2011-12-08 11:07:42 +0200 | [diff] [blame] | 347 | MODULE_ALIAS("platform:omap-abe-twl6040"); |