blob: 988ff504dd599355d89bf5d5215df94f7edc29be [file] [log] [blame]
Stephen Warrena8bf1ba2011-01-07 22:36:16 -07001/*
Stephen Warrendc0a50af2011-04-12 11:40:36 -06002 * tegra_wm8903.c - Tegra machine ASoC driver for boards using WM8903 codec.
Stephen Warrena8bf1ba2011-01-07 22:36:16 -07003 *
4 * Author: Stephen Warren <swarren@nvidia.com>
Stephen Warren72de2b12011-01-28 14:26:36 -07005 * Copyright (C) 2010-2011 - NVIDIA, Inc.
Stephen Warrena8bf1ba2011-01-07 22:36:16 -07006 *
7 * Based on code copyright/by:
8 *
9 * (c) 2009, 2010 Nvidia Graphics Pvt. Ltd.
10 *
11 * Copyright 2007 Wolfson Microelectronics PLC.
12 * Author: Graeme Gregory
13 * graeme.gregory@wolfsonmicro.com or linux@wolfsonmicro.com
14 *
15 * This program is free software; you can redistribute it and/or
16 * modify it under the terms of the GNU General Public License
17 * version 2 as published by the Free Software Foundation.
18 *
19 * This program is distributed in the hope that it will be useful, but
20 * WITHOUT ANY WARRANTY; without even the implied warranty of
21 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
22 * General Public License for more details.
23 *
24 * You should have received a copy of the GNU General Public License
25 * along with this program; if not, write to the Free Software
26 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
27 * 02110-1301 USA
28 *
29 */
30
31#include <asm/mach-types.h>
Stephen Warren72de2b12011-01-28 14:26:36 -070032
Stephen Warrena8bf1ba2011-01-07 22:36:16 -070033#include <linux/module.h>
Stephen Warren72de2b12011-01-28 14:26:36 -070034#include <linux/platform_device.h>
35#include <linux/slab.h>
Stephen Warren6e267642011-01-28 14:26:37 -070036#include <linux/gpio.h>
37
Stephen Warren4651d552011-04-12 11:28:59 -060038#include <mach/tegra_wm8903_pdata.h>
Stephen Warren72de2b12011-01-28 14:26:36 -070039
Stephen Warrena8bf1ba2011-01-07 22:36:16 -070040#include <sound/core.h>
Stephen Warrenf7d3e402011-02-03 13:56:13 -070041#include <sound/jack.h>
Stephen Warrena8bf1ba2011-01-07 22:36:16 -070042#include <sound/pcm.h>
43#include <sound/pcm_params.h>
44#include <sound/soc.h>
45
Stephen Warren41b5f9b2011-02-10 15:37:16 -070046#include "../codecs/wm8903.h"
47
Stephen Warrena8bf1ba2011-01-07 22:36:16 -070048#include "tegra_das.h"
49#include "tegra_i2s.h"
50#include "tegra_pcm.h"
51#include "tegra_asoc_utils.h"
52
Stephen Warren7b33af22011-04-12 11:29:00 -060053#define DRV_NAME "tegra-snd-wm8903"
Stephen Warrena8bf1ba2011-01-07 22:36:16 -070054
Stephen Warrenbf1b1322011-02-10 15:37:18 -070055#define GPIO_SPKR_EN BIT(0)
Stephen Warren773b1d32011-04-12 11:40:39 -060056#define GPIO_HP_MUTE BIT(1)
57#define GPIO_INT_MIC_EN BIT(2)
58#define GPIO_EXT_MIC_EN BIT(3)
Stephen Warrenbf1b1322011-02-10 15:37:18 -070059
Stephen Warrendc0a50af2011-04-12 11:40:36 -060060struct tegra_wm8903 {
Stephen Warrend64e57c2011-01-28 14:26:40 -070061 struct tegra_asoc_utils_data util_data;
Stephen Warren4651d552011-04-12 11:28:59 -060062 struct tegra_wm8903_platform_data *pdata;
Stephen Warrenbf1b1322011-02-10 15:37:18 -070063 int gpio_requested;
Stephen Warren72de2b12011-01-28 14:26:36 -070064};
Stephen Warrena8bf1ba2011-01-07 22:36:16 -070065
Stephen Warrendc0a50af2011-04-12 11:40:36 -060066static int tegra_wm8903_hw_params(struct snd_pcm_substream *substream,
Stephen Warrena8bf1ba2011-01-07 22:36:16 -070067 struct snd_pcm_hw_params *params)
68{
69 struct snd_soc_pcm_runtime *rtd = substream->private_data;
70 struct snd_soc_dai *codec_dai = rtd->codec_dai;
71 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
Stephen Warrenc244d472011-01-28 14:26:39 -070072 struct snd_soc_codec *codec = rtd->codec;
73 struct snd_soc_card *card = codec->card;
Stephen Warrendc0a50af2011-04-12 11:40:36 -060074 struct tegra_wm8903 *machine = snd_soc_card_get_drvdata(card);
Stephen Warren07541392011-04-19 15:25:09 -060075 int srate, mclk;
Stephen Warrena8bf1ba2011-01-07 22:36:16 -070076 int err;
77
78 srate = params_rate(params);
79 switch (srate) {
80 case 64000:
81 case 88200:
82 case 96000:
83 mclk = 128 * srate;
84 break;
85 default:
86 mclk = 256 * srate;
87 break;
88 }
89 /* FIXME: Codec only requires >= 3MHz if OSR==0 */
90 while (mclk < 6000000)
91 mclk *= 2;
92
Stephen Warren07541392011-04-19 15:25:09 -060093 err = tegra_asoc_utils_set_rate(&machine->util_data, srate, mclk);
Stephen Warrena8bf1ba2011-01-07 22:36:16 -070094 if (err < 0) {
Stephen Warrenc244d472011-01-28 14:26:39 -070095 dev_err(card->dev, "Can't configure clocks\n");
Stephen Warrena8bf1ba2011-01-07 22:36:16 -070096 return err;
97 }
98
99 err = snd_soc_dai_set_fmt(codec_dai,
100 SND_SOC_DAIFMT_I2S |
101 SND_SOC_DAIFMT_NB_NF |
102 SND_SOC_DAIFMT_CBS_CFS);
103 if (err < 0) {
Stephen Warrenc244d472011-01-28 14:26:39 -0700104 dev_err(card->dev, "codec_dai fmt not set\n");
Stephen Warrena8bf1ba2011-01-07 22:36:16 -0700105 return err;
106 }
107
108 err = snd_soc_dai_set_fmt(cpu_dai,
109 SND_SOC_DAIFMT_I2S |
110 SND_SOC_DAIFMT_NB_NF |
111 SND_SOC_DAIFMT_CBS_CFS);
112 if (err < 0) {
Stephen Warrenc244d472011-01-28 14:26:39 -0700113 dev_err(card->dev, "cpu_dai fmt not set\n");
Stephen Warrena8bf1ba2011-01-07 22:36:16 -0700114 return err;
115 }
116
Stephen Warren07541392011-04-19 15:25:09 -0600117 err = snd_soc_dai_set_sysclk(codec_dai, 0, mclk,
118 SND_SOC_CLOCK_IN);
119 if (err < 0) {
120 dev_err(card->dev, "codec_dai clock not set\n");
121 return err;
Stephen Warrena8bf1ba2011-01-07 22:36:16 -0700122 }
123
124 return 0;
125}
126
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600127static struct snd_soc_ops tegra_wm8903_ops = {
128 .hw_params = tegra_wm8903_hw_params,
Stephen Warrena8bf1ba2011-01-07 22:36:16 -0700129};
130
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600131static struct snd_soc_jack tegra_wm8903_hp_jack;
Stephen Warrenf7d3e402011-02-03 13:56:13 -0700132
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600133static struct snd_soc_jack_pin tegra_wm8903_hp_jack_pins[] = {
Stephen Warrenf7d3e402011-02-03 13:56:13 -0700134 {
135 .pin = "Headphone Jack",
136 .mask = SND_JACK_HEADPHONE,
137 },
138};
139
Stephen Warren3eb25f92011-04-12 11:40:38 -0600140static struct snd_soc_jack_gpio tegra_wm8903_hp_jack_gpio = {
141 .name = "headphone detect",
142 .report = SND_JACK_HEADPHONE,
143 .debounce_time = 150,
144 .invert = 1,
Stephen Warrenf7d3e402011-02-03 13:56:13 -0700145};
146
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600147static struct snd_soc_jack tegra_wm8903_mic_jack;
Stephen Warren41b5f9b2011-02-10 15:37:16 -0700148
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600149static struct snd_soc_jack_pin tegra_wm8903_mic_jack_pins[] = {
Stephen Warren41b5f9b2011-02-10 15:37:16 -0700150 {
151 .pin = "Mic Jack",
152 .mask = SND_JACK_MICROPHONE,
153 },
154};
155
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600156static int tegra_wm8903_event_int_spk(struct snd_soc_dapm_widget *w,
Stephen Warren6e267642011-01-28 14:26:37 -0700157 struct snd_kcontrol *k, int event)
158{
159 struct snd_soc_codec *codec = w->codec;
160 struct snd_soc_card *card = codec->card;
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600161 struct tegra_wm8903 *machine = snd_soc_card_get_drvdata(card);
162 struct tegra_wm8903_platform_data *pdata = machine->pdata;
Stephen Warren6e267642011-01-28 14:26:37 -0700163
Stephen Warren773b1d32011-04-12 11:40:39 -0600164 if (!(machine->gpio_requested & GPIO_SPKR_EN))
165 return 0;
166
Stephen Warren6e267642011-01-28 14:26:37 -0700167 gpio_set_value_cansleep(pdata->gpio_spkr_en,
Stephen Warrenf9eabc32011-01-31 11:00:17 -0700168 SND_SOC_DAPM_EVENT_ON(event));
Stephen Warren6e267642011-01-28 14:26:37 -0700169
170 return 0;
171}
172
Stephen Warren773b1d32011-04-12 11:40:39 -0600173static int tegra_wm8903_event_hp(struct snd_soc_dapm_widget *w,
174 struct snd_kcontrol *k, int event)
175{
176 struct snd_soc_codec *codec = w->codec;
177 struct snd_soc_card *card = codec->card;
178 struct tegra_wm8903 *machine = snd_soc_card_get_drvdata(card);
179 struct tegra_wm8903_platform_data *pdata = machine->pdata;
180
181 if (!(machine->gpio_requested & GPIO_HP_MUTE))
182 return 0;
183
184 gpio_set_value_cansleep(pdata->gpio_hp_mute,
185 !SND_SOC_DAPM_EVENT_ON(event));
186
187 return 0;
188}
189
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600190static const struct snd_soc_dapm_widget tegra_wm8903_dapm_widgets[] = {
191 SND_SOC_DAPM_SPK("Int Spk", tegra_wm8903_event_int_spk),
Stephen Warren773b1d32011-04-12 11:40:39 -0600192 SND_SOC_DAPM_HP("Headphone Jack", tegra_wm8903_event_hp),
Stephen Warren62ffac42011-01-13 15:22:08 -0700193 SND_SOC_DAPM_MIC("Mic Jack", NULL),
194};
195
196static const struct snd_soc_dapm_route harmony_audio_map[] = {
197 {"Headphone Jack", NULL, "HPOUTR"},
198 {"Headphone Jack", NULL, "HPOUTL"},
Stephen Warren6e267642011-01-28 14:26:37 -0700199 {"Int Spk", NULL, "ROP"},
200 {"Int Spk", NULL, "RON"},
201 {"Int Spk", NULL, "LOP"},
202 {"Int Spk", NULL, "LON"},
Stephen Warren62ffac42011-01-13 15:22:08 -0700203 {"Mic Bias", NULL, "Mic Jack"},
204 {"IN1L", NULL, "Mic Bias"},
205};
206
Stephen Warren773b1d32011-04-12 11:40:39 -0600207static const struct snd_soc_dapm_route seaboard_audio_map[] = {
208 {"Headphone Jack", NULL, "HPOUTR"},
209 {"Headphone Jack", NULL, "HPOUTL"},
210 {"Int Spk", NULL, "ROP"},
211 {"Int Spk", NULL, "RON"},
212 {"Int Spk", NULL, "LOP"},
213 {"Int Spk", NULL, "LON"},
214 {"Mic Bias", NULL, "Mic Jack"},
215 {"IN1R", NULL, "Mic Bias"},
216};
217
218static const struct snd_soc_dapm_route kaen_audio_map[] = {
219 {"Headphone Jack", NULL, "HPOUTR"},
220 {"Headphone Jack", NULL, "HPOUTL"},
221 {"Int Spk", NULL, "ROP"},
222 {"Int Spk", NULL, "RON"},
223 {"Int Spk", NULL, "LOP"},
224 {"Int Spk", NULL, "LON"},
225 {"Mic Bias", NULL, "Mic Jack"},
226 {"IN2R", NULL, "Mic Bias"},
227};
228
229static const struct snd_soc_dapm_route aebl_audio_map[] = {
230 {"Headphone Jack", NULL, "HPOUTR"},
231 {"Headphone Jack", NULL, "HPOUTL"},
232 {"Int Spk", NULL, "LINEOUTR"},
233 {"Int Spk", NULL, "LINEOUTL"},
234 {"Mic Bias", NULL, "Mic Jack"},
235 {"IN1R", NULL, "Mic Bias"},
236};
237
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600238static const struct snd_kcontrol_new tegra_wm8903_controls[] = {
Stephen Warren3d8bc392011-02-03 13:56:14 -0700239 SOC_DAPM_PIN_SWITCH("Int Spk"),
240};
241
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600242static int tegra_wm8903_init(struct snd_soc_pcm_runtime *rtd)
Stephen Warren62ffac42011-01-13 15:22:08 -0700243{
244 struct snd_soc_codec *codec = rtd->codec;
245 struct snd_soc_dapm_context *dapm = &codec->dapm;
Stephen Warren6e267642011-01-28 14:26:37 -0700246 struct snd_soc_card *card = codec->card;
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600247 struct tegra_wm8903 *machine = snd_soc_card_get_drvdata(card);
248 struct tegra_wm8903_platform_data *pdata = machine->pdata;
Stephen Warren6e267642011-01-28 14:26:37 -0700249 int ret;
250
Stephen Warren773b1d32011-04-12 11:40:39 -0600251 if (gpio_is_valid(pdata->gpio_spkr_en)) {
252 ret = gpio_request(pdata->gpio_spkr_en, "spkr_en");
253 if (ret) {
254 dev_err(card->dev, "cannot get spkr_en gpio\n");
255 return ret;
256 }
257 machine->gpio_requested |= GPIO_SPKR_EN;
258
259 gpio_direction_output(pdata->gpio_spkr_en, 0);
Stephen Warren6e267642011-01-28 14:26:37 -0700260 }
Stephen Warren6e267642011-01-28 14:26:37 -0700261
Stephen Warren773b1d32011-04-12 11:40:39 -0600262 if (gpio_is_valid(pdata->gpio_hp_mute)) {
263 ret = gpio_request(pdata->gpio_hp_mute, "hp_mute");
264 if (ret) {
265 dev_err(card->dev, "cannot get hp_mute gpio\n");
266 return ret;
267 }
268 machine->gpio_requested |= GPIO_HP_MUTE;
Stephen Warren62ffac42011-01-13 15:22:08 -0700269
Stephen Warren773b1d32011-04-12 11:40:39 -0600270 gpio_direction_output(pdata->gpio_hp_mute, 0);
Stephen Warrenbf1b1322011-02-10 15:37:18 -0700271 }
Stephen Warrenbf1b1322011-02-10 15:37:18 -0700272
Stephen Warren773b1d32011-04-12 11:40:39 -0600273 if (gpio_is_valid(pdata->gpio_int_mic_en)) {
274 ret = gpio_request(pdata->gpio_int_mic_en, "int_mic_en");
275 if (ret) {
276 dev_err(card->dev, "cannot get int_mic_en gpio\n");
277 return ret;
278 }
279 machine->gpio_requested |= GPIO_INT_MIC_EN;
Stephen Warrenbf1b1322011-02-10 15:37:18 -0700280
Stephen Warren773b1d32011-04-12 11:40:39 -0600281 /* Disable int mic; enable signal is active-high */
282 gpio_direction_output(pdata->gpio_int_mic_en, 0);
Stephen Warrenbf1b1322011-02-10 15:37:18 -0700283 }
Stephen Warrenbf1b1322011-02-10 15:37:18 -0700284
Stephen Warren773b1d32011-04-12 11:40:39 -0600285 if (gpio_is_valid(pdata->gpio_ext_mic_en)) {
286 ret = gpio_request(pdata->gpio_ext_mic_en, "ext_mic_en");
287 if (ret) {
288 dev_err(card->dev, "cannot get ext_mic_en gpio\n");
289 return ret;
290 }
291 machine->gpio_requested |= GPIO_EXT_MIC_EN;
292
293 /* Enable ext mic; enable signal is active-low */
294 gpio_direction_output(pdata->gpio_ext_mic_en, 0);
295 }
Stephen Warrenbf1b1322011-02-10 15:37:18 -0700296
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600297 ret = snd_soc_add_controls(codec, tegra_wm8903_controls,
298 ARRAY_SIZE(tegra_wm8903_controls));
Stephen Warren3d8bc392011-02-03 13:56:14 -0700299 if (ret < 0)
300 return ret;
301
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600302 snd_soc_dapm_new_controls(dapm, tegra_wm8903_dapm_widgets,
303 ARRAY_SIZE(tegra_wm8903_dapm_widgets));
Stephen Warren62ffac42011-01-13 15:22:08 -0700304
Stephen Warren773b1d32011-04-12 11:40:39 -0600305 if (machine_is_harmony() || machine_is_ventana()) {
306 snd_soc_dapm_add_routes(dapm, harmony_audio_map,
307 ARRAY_SIZE(harmony_audio_map));
308 } else if (machine_is_seaboard()) {
309 snd_soc_dapm_add_routes(dapm, seaboard_audio_map,
310 ARRAY_SIZE(seaboard_audio_map));
311 } else if (machine_is_kaen()) {
312 snd_soc_dapm_add_routes(dapm, kaen_audio_map,
313 ARRAY_SIZE(kaen_audio_map));
314 } else {
315 snd_soc_dapm_add_routes(dapm, aebl_audio_map,
316 ARRAY_SIZE(aebl_audio_map));
317 }
Stephen Warren62ffac42011-01-13 15:22:08 -0700318
Stephen Warren773b1d32011-04-12 11:40:39 -0600319 if (gpio_is_valid(pdata->gpio_hp_det)) {
320 tegra_wm8903_hp_jack_gpio.gpio = pdata->gpio_hp_det;
321 snd_soc_jack_new(codec, "Headphone Jack", SND_JACK_HEADPHONE,
322 &tegra_wm8903_hp_jack);
323 snd_soc_jack_add_pins(&tegra_wm8903_hp_jack,
324 ARRAY_SIZE(tegra_wm8903_hp_jack_pins),
325 tegra_wm8903_hp_jack_pins);
326 snd_soc_jack_add_gpios(&tegra_wm8903_hp_jack,
327 1,
328 &tegra_wm8903_hp_jack_gpio);
329 }
Stephen Warrenf7d3e402011-02-03 13:56:13 -0700330
Stephen Warren41b5f9b2011-02-10 15:37:16 -0700331 snd_soc_jack_new(codec, "Mic Jack", SND_JACK_MICROPHONE,
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600332 &tegra_wm8903_mic_jack);
333 snd_soc_jack_add_pins(&tegra_wm8903_mic_jack,
334 ARRAY_SIZE(tegra_wm8903_mic_jack_pins),
335 tegra_wm8903_mic_jack_pins);
336 wm8903_mic_detect(codec, &tegra_wm8903_mic_jack, SND_JACK_MICROPHONE,
337 0);
Stephen Warren41b5f9b2011-02-10 15:37:16 -0700338
339 snd_soc_dapm_force_enable_pin(dapm, "Mic Bias");
340
Stephen Warren773b1d32011-04-12 11:40:39 -0600341 /* FIXME: Calculate automatically based on DAPM routes? */
342 if (!machine_is_harmony() && !machine_is_ventana())
343 snd_soc_dapm_nc_pin(dapm, "IN1L");
344 if (!machine_is_seaboard() && !machine_is_aebl())
345 snd_soc_dapm_nc_pin(dapm, "IN1R");
346 snd_soc_dapm_nc_pin(dapm, "IN2L");
347 if (!machine_is_kaen())
348 snd_soc_dapm_nc_pin(dapm, "IN2R");
Stephen Warren0d6cdca2011-02-10 15:37:17 -0700349 snd_soc_dapm_nc_pin(dapm, "IN3L");
350 snd_soc_dapm_nc_pin(dapm, "IN3R");
Stephen Warren773b1d32011-04-12 11:40:39 -0600351
352 if (machine_is_aebl()) {
353 snd_soc_dapm_nc_pin(dapm, "LON");
354 snd_soc_dapm_nc_pin(dapm, "RON");
355 snd_soc_dapm_nc_pin(dapm, "ROP");
356 snd_soc_dapm_nc_pin(dapm, "LOP");
357 } else {
358 snd_soc_dapm_nc_pin(dapm, "LINEOUTR");
359 snd_soc_dapm_nc_pin(dapm, "LINEOUTL");
360 }
Stephen Warren0d6cdca2011-02-10 15:37:17 -0700361
Stephen Warren41b5f9b2011-02-10 15:37:16 -0700362 snd_soc_dapm_sync(dapm);
363
Stephen Warren62ffac42011-01-13 15:22:08 -0700364 return 0;
365}
366
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600367static struct snd_soc_dai_link tegra_wm8903_dai = {
Stephen Warrena8bf1ba2011-01-07 22:36:16 -0700368 .name = "WM8903",
369 .stream_name = "WM8903 PCM",
Mark Brown4b592c92011-02-09 13:47:06 +0000370 .codec_name = "wm8903.0-001a",
Stephen Warrena8bf1ba2011-01-07 22:36:16 -0700371 .platform_name = "tegra-pcm-audio",
372 .cpu_dai_name = "tegra-i2s.0",
373 .codec_dai_name = "wm8903-hifi",
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600374 .init = tegra_wm8903_init,
375 .ops = &tegra_wm8903_ops,
Stephen Warrena8bf1ba2011-01-07 22:36:16 -0700376};
377
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600378static struct snd_soc_card snd_soc_tegra_wm8903 = {
379 .name = "tegra-wm8903",
380 .dai_link = &tegra_wm8903_dai,
Stephen Warrena8bf1ba2011-01-07 22:36:16 -0700381 .num_links = 1,
382};
383
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600384static __devinit int tegra_wm8903_driver_probe(struct platform_device *pdev)
Stephen Warrena8bf1ba2011-01-07 22:36:16 -0700385{
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600386 struct snd_soc_card *card = &snd_soc_tegra_wm8903;
387 struct tegra_wm8903 *machine;
Stephen Warren4651d552011-04-12 11:28:59 -0600388 struct tegra_wm8903_platform_data *pdata;
Stephen Warrena8bf1ba2011-01-07 22:36:16 -0700389 int ret;
390
Stephen Warren6e267642011-01-28 14:26:37 -0700391 pdata = pdev->dev.platform_data;
392 if (!pdata) {
Stephen Warren773b1d32011-04-12 11:40:39 -0600393 dev_err(&pdev->dev, "No platform data supplied\n");
Stephen Warren6e267642011-01-28 14:26:37 -0700394 return -EINVAL;
395 }
396
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600397 machine = kzalloc(sizeof(struct tegra_wm8903), GFP_KERNEL);
398 if (!machine) {
399 dev_err(&pdev->dev, "Can't allocate tegra_wm8903 struct\n");
Stephen Warren72de2b12011-01-28 14:26:36 -0700400 return -ENOMEM;
401 }
402
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600403 machine->pdata = pdata;
Stephen Warren6e267642011-01-28 14:26:37 -0700404
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600405 ret = tegra_asoc_utils_init(&machine->util_data, &pdev->dev);
Stephen Warren72de2b12011-01-28 14:26:36 -0700406 if (ret)
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600407 goto err_free_machine;
Stephen Warren72de2b12011-01-28 14:26:36 -0700408
409 card->dev = &pdev->dev;
410 platform_set_drvdata(pdev, card);
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600411 snd_soc_card_set_drvdata(card, machine);
Stephen Warren72de2b12011-01-28 14:26:36 -0700412
413 ret = snd_soc_register_card(card);
Stephen Warrena8bf1ba2011-01-07 22:36:16 -0700414 if (ret) {
Stephen Warren72de2b12011-01-28 14:26:36 -0700415 dev_err(&pdev->dev, "snd_soc_register_card failed (%d)\n",
Stephen Warrena8bf1ba2011-01-07 22:36:16 -0700416 ret);
Stephen Warrenacb83032011-04-19 15:25:08 -0600417 goto err_fini_utils;
Stephen Warrena8bf1ba2011-01-07 22:36:16 -0700418 }
419
420 return 0;
421
Stephen Warrenacb83032011-04-19 15:25:08 -0600422err_fini_utils:
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600423 tegra_asoc_utils_fini(&machine->util_data);
424err_free_machine:
425 kfree(machine);
Stephen Warrena8bf1ba2011-01-07 22:36:16 -0700426 return ret;
427}
Stephen Warrena8bf1ba2011-01-07 22:36:16 -0700428
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600429static int __devexit tegra_wm8903_driver_remove(struct platform_device *pdev)
Stephen Warrena8bf1ba2011-01-07 22:36:16 -0700430{
Stephen Warren72de2b12011-01-28 14:26:36 -0700431 struct snd_soc_card *card = platform_get_drvdata(pdev);
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600432 struct tegra_wm8903 *machine = snd_soc_card_get_drvdata(card);
433 struct tegra_wm8903_platform_data *pdata = machine->pdata;
Stephen Warren72de2b12011-01-28 14:26:36 -0700434
435 snd_soc_unregister_card(card);
436
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600437 tegra_asoc_utils_fini(&machine->util_data);
Stephen Warren72de2b12011-01-28 14:26:36 -0700438
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600439 if (machine->gpio_requested & GPIO_EXT_MIC_EN)
Stephen Warrenbf1b1322011-02-10 15:37:18 -0700440 gpio_free(pdata->gpio_ext_mic_en);
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600441 if (machine->gpio_requested & GPIO_INT_MIC_EN)
Stephen Warrenbf1b1322011-02-10 15:37:18 -0700442 gpio_free(pdata->gpio_int_mic_en);
Stephen Warren773b1d32011-04-12 11:40:39 -0600443 if (machine->gpio_requested & GPIO_HP_MUTE)
444 gpio_free(pdata->gpio_hp_mute);
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600445 if (machine->gpio_requested & GPIO_SPKR_EN)
Stephen Warren6e267642011-01-28 14:26:37 -0700446 gpio_free(pdata->gpio_spkr_en);
447
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600448 kfree(machine);
Stephen Warren72de2b12011-01-28 14:26:36 -0700449
450 return 0;
Stephen Warrena8bf1ba2011-01-07 22:36:16 -0700451}
Stephen Warren72de2b12011-01-28 14:26:36 -0700452
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600453static struct platform_driver tegra_wm8903_driver = {
Stephen Warren72de2b12011-01-28 14:26:36 -0700454 .driver = {
455 .name = DRV_NAME,
456 .owner = THIS_MODULE,
Stephen Warrendeb26072011-04-05 19:35:30 -0600457 .pm = &snd_soc_pm_ops,
Stephen Warren72de2b12011-01-28 14:26:36 -0700458 },
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600459 .probe = tegra_wm8903_driver_probe,
460 .remove = __devexit_p(tegra_wm8903_driver_remove),
Stephen Warren72de2b12011-01-28 14:26:36 -0700461};
462
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600463static int __init tegra_wm8903_modinit(void)
Stephen Warren72de2b12011-01-28 14:26:36 -0700464{
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600465 return platform_driver_register(&tegra_wm8903_driver);
Stephen Warren72de2b12011-01-28 14:26:36 -0700466}
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600467module_init(tegra_wm8903_modinit);
Stephen Warren72de2b12011-01-28 14:26:36 -0700468
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600469static void __exit tegra_wm8903_modexit(void)
Stephen Warren72de2b12011-01-28 14:26:36 -0700470{
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600471 platform_driver_unregister(&tegra_wm8903_driver);
Stephen Warren72de2b12011-01-28 14:26:36 -0700472}
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600473module_exit(tegra_wm8903_modexit);
Stephen Warrena8bf1ba2011-01-07 22:36:16 -0700474
475MODULE_AUTHOR("Stephen Warren <swarren@nvidia.com>");
Stephen Warrendc0a50af2011-04-12 11:40:36 -0600476MODULE_DESCRIPTION("Tegra+WM8903 machine ASoC driver");
Stephen Warrena8bf1ba2011-01-07 22:36:16 -0700477MODULE_LICENSE("GPL");
Stephen Warren8eb34202011-02-10 15:37:19 -0700478MODULE_ALIAS("platform:" DRV_NAME);