[ALSA] cleanup and error reporting for sound/core/init.c
[linux-2.6] / sound / soc / pxa / poodle.c
1 /*
2  * poodle.c  --  SoC audio for Poodle
3  *
4  * Copyright 2005 Wolfson Microelectronics PLC.
5  * Copyright 2005 Openedhand Ltd.
6  *
7  * Authors: Liam Girdwood <liam.girdwood@wolfsonmicro.com>
8  *          Richard Purdie <richard@openedhand.com>
9  *
10  *  This program is free software; you can redistribute  it and/or modify it
11  *  under  the terms of  the GNU General  Public License as published by the
12  *  Free Software Foundation;  either version 2 of the  License, or (at your
13  *  option) any later version.
14  *
15  */
16
17 #include <linux/module.h>
18 #include <linux/moduleparam.h>
19 #include <linux/timer.h>
20 #include <linux/interrupt.h>
21 #include <linux/platform_device.h>
22 #include <sound/driver.h>
23 #include <sound/core.h>
24 #include <sound/pcm.h>
25 #include <sound/soc.h>
26 #include <sound/soc-dapm.h>
27
28 #include <asm/mach-types.h>
29 #include <asm/hardware/locomo.h>
30 #include <asm/arch/pxa-regs.h>
31 #include <asm/arch/hardware.h>
32 #include <asm/arch/poodle.h>
33 #include <asm/arch/audio.h>
34
35 #include "../codecs/wm8731.h"
36 #include "pxa2xx-pcm.h"
37
38 #define POODLE_HP        1
39 #define POODLE_HP_OFF    0
40 #define POODLE_SPK_ON    1
41 #define POODLE_SPK_OFF   0
42
43  /* audio clock in Hz - rounded from 12.235MHz */
44 #define POODLE_AUDIO_CLOCK 12288000
45
46 static int poodle_jack_func;
47 static int poodle_spk_func;
48
49 static void poodle_ext_control(struct snd_soc_codec *codec)
50 {
51         int spk = 0;
52
53         /* set up jack connection */
54         if (poodle_jack_func == POODLE_HP) {
55                 /* set = unmute headphone */
56                 locomo_gpio_write(&poodle_locomo_device.dev,
57                         POODLE_LOCOMO_GPIO_MUTE_L, 1);
58                 locomo_gpio_write(&poodle_locomo_device.dev,
59                         POODLE_LOCOMO_GPIO_MUTE_R, 1);
60                 snd_soc_dapm_set_endpoint(codec, "Headphone Jack", 1);
61         } else {
62                 locomo_gpio_write(&poodle_locomo_device.dev,
63                         POODLE_LOCOMO_GPIO_MUTE_L, 0);
64                 locomo_gpio_write(&poodle_locomo_device.dev,
65                         POODLE_LOCOMO_GPIO_MUTE_R, 0);
66                 snd_soc_dapm_set_endpoint(codec, "Headphone Jack", 0);
67         }
68
69         if (poodle_spk_func == POODLE_SPK_ON)
70                 spk = 1;
71
72         /* set the enpoints to their new connetion states */
73         snd_soc_dapm_set_endpoint(codec, "Ext Spk", spk);
74
75         /* signal a DAPM event */
76         snd_soc_dapm_sync_endpoints(codec);
77 }
78
79 static int poodle_startup(struct snd_pcm_substream *substream)
80 {
81         struct snd_soc_pcm_runtime *rtd = substream->private_data;
82         struct snd_soc_codec *codec = rtd->socdev->codec;
83
84         /* check the jack status at stream startup */
85         poodle_ext_control(codec);
86         return 0;
87 }
88
89 /* we need to unmute the HP at shutdown as the mute burns power on poodle */
90 static int poodle_shutdown(struct snd_pcm_substream *substream)
91 {
92         struct snd_soc_pcm_runtime *rtd = substream->private_data;
93         struct snd_soc_codec *codec = rtd->socdev->codec;
94
95         /* set = unmute headphone */
96         locomo_gpio_write(&poodle_locomo_device.dev,
97                 POODLE_LOCOMO_GPIO_MUTE_L, 1);
98         locomo_gpio_write(&poodle_locomo_device.dev,
99                 POODLE_LOCOMO_GPIO_MUTE_R, 1);
100         return 0;
101 }
102
103 static struct snd_soc_ops poodle_ops = {
104         .startup = poodle_startup,
105         .shutdown = poodle_shutdown,
106 };
107
108 static int poodle_get_jack(struct snd_kcontrol *kcontrol,
109         struct snd_ctl_elem_value *ucontrol)
110 {
111         ucontrol->value.integer.value[0] = poodle_jack_func;
112         return 0;
113 }
114
115 static int poodle_set_jack(struct snd_kcontrol *kcontrol,
116         struct snd_ctl_elem_value *ucontrol)
117 {
118         struct snd_soc_codec *codec =  snd_kcontrol_chip(kcontrol);
119
120         if (poodle_jack_func == ucontrol->value.integer.value[0])
121                 return 0;
122
123         poodle_jack_func = ucontrol->value.integer.value[0];
124         poodle_ext_control(codec);
125         return 1;
126 }
127
128 static int poodle_get_spk(struct snd_kcontrol *kcontrol,
129         struct snd_ctl_elem_value *ucontrol)
130 {
131         ucontrol->value.integer.value[0] = poodle_spk_func;
132         return 0;
133 }
134
135 static int poodle_set_spk(struct snd_kcontrol *kcontrol,
136         struct snd_ctl_elem_value *ucontrol)
137 {
138         struct snd_soc_codec *codec =  snd_kcontrol_chip(kcontrol);
139
140         if (poodle_spk_func == ucontrol->value.integer.value[0])
141                 return 0;
142
143         poodle_spk_func = ucontrol->value.integer.value[0];
144         poodle_ext_control(codec);
145         return 1;
146 }
147
148 static int poodle_amp_event(struct snd_soc_dapm_widget *w, int event)
149 {
150         if (SND_SOC_DAPM_EVENT_ON(event))
151                 locomo_gpio_write(&poodle_locomo_device.dev,
152                         POODLE_LOCOMO_GPIO_AMP_ON, 0);
153         else
154                 locomo_gpio_write(&poodle_locomo_device.dev,
155                         POODLE_LOCOMO_GPIO_AMP_ON, 1);
156
157         return 0;
158 }
159
160 /* poodle machine dapm widgets */
161 static const struct snd_soc_dapm_widget wm8731_dapm_widgets[] = {
162 SND_SOC_DAPM_HP("Headphone Jack", NULL),
163 SND_SOC_DAPM_SPK("Ext Spk", poodle_amp_event),
164 };
165
166 /* Corgi machine audio_mapnections to the codec pins */
167 static const char *audio_map[][3] = {
168
169         /* headphone connected to LHPOUT1, RHPOUT1 */
170         {"Headphone Jack", NULL, "LHPOUT"},
171         {"Headphone Jack", NULL, "RHPOUT"},
172
173         /* speaker connected to LOUT, ROUT */
174         {"Ext Spk", NULL, "ROUT"},
175         {"Ext Spk", NULL, "LOUT"},
176
177         {NULL, NULL, NULL},
178 };
179
180 static const char *jack_function[] = {"Off", "Headphone"};
181 static const char *spk_function[] = {"Off", "On"};
182 static const struct soc_enum poodle_enum[] = {
183         SOC_ENUM_SINGLE_EXT(2, jack_function),
184         SOC_ENUM_SINGLE_EXT(2, spk_function),
185 };
186
187 static const snd_kcontrol_new_t wm8731_poodle_controls[] = {
188         SOC_ENUM_EXT("Jack Function", poodle_enum[0], poodle_get_jack,
189                 poodle_set_jack),
190         SOC_ENUM_EXT("Speaker Function", poodle_enum[1], poodle_get_spk,
191                 poodle_set_spk),
192 };
193
194 /*
195  * Logic for a wm8731 as connected on a Sharp SL-C7x0 Device
196  */
197 static int poodle_wm8731_init(struct snd_soc_codec *codec)
198 {
199         int i, err;
200
201         snd_soc_dapm_set_endpoint(codec, "LLINEIN", 0);
202         snd_soc_dapm_set_endpoint(codec, "RLINEIN", 0);
203         snd_soc_dapm_set_endpoint(codec, "MICIN", 1);
204
205         /* Add poodle specific controls */
206         for (i = 0; i < ARRAY_SIZE(wm8731_poodle_controls); i++) {
207                 err = snd_ctl_add(codec->card,
208                         snd_soc_cnew(&wm8731_poodle_controls[i],codec, NULL));
209                 if (err < 0)
210                         return err;
211         }
212
213         /* Add poodle specific widgets */
214         for (i = 0; i < ARRAY_SIZE(wm8731_dapm_widgets); i++) {
215                 snd_soc_dapm_new_control(codec, &wm8731_dapm_widgets[i]);
216         }
217
218         /* Set up poodle specific audio path audio_map */
219         for (i = 0; audio_map[i][0] != NULL; i++) {
220                 snd_soc_dapm_connect_input(codec, audio_map[i][0],
221                         audio_map[i][1], audio_map[i][2]);
222         }
223
224         snd_soc_dapm_sync_endpoints(codec);
225         return 0;
226 }
227
228 static unsigned int poodle_config_sysclk(struct snd_soc_pcm_runtime *rtd,
229         struct snd_soc_clock_info *info)
230 {
231         if (info->bclk_master & SND_SOC_DAIFMT_CBS_CFS) {
232                 /* pxa2xx is i2s master  */
233                 switch (info->rate) {
234                 case 44100:
235                 case 88200:
236                         /* configure codec digital filters for 44.1, 88.2 */
237                         rtd->codec_dai->config_sysclk(rtd->codec_dai, info,
238                                 11289600);
239                 break;
240                 default:
241                         /* configure codec digital filters for all other rates */
242                         rtd->codec_dai->config_sysclk(rtd->codec_dai, info,
243                                 POODLE_AUDIO_CLOCK);
244                 break;
245                 }
246                 return rtd->cpu_dai->config_sysclk(rtd->cpu_dai, info,
247                         POODLE_AUDIO_CLOCK);
248         } else {
249                 /* codec is i2s master -
250                  * only configure codec DAI clock and filters */
251                 return rtd->codec_dai->config_sysclk(rtd->codec_dai, info,
252                         POODLE_AUDIO_CLOCK);
253         }
254 }
255
256 /* poodle digital audio interface glue - connects codec <--> CPU */
257 static struct snd_soc_dai_link poodle_dai = {
258         .name = "WM8731",
259         .stream_name = "WM8731",
260         .cpu_dai = &pxa_i2s_dai,
261         .codec_dai = &wm8731_dai,
262         .init = poodle_wm8731_init,
263         .config_sysclk = poodle_config_sysclk,
264 };
265
266 /* poodle audio machine driver */
267 static struct snd_soc_machine snd_soc_machine_poodle = {
268         .name = "Poodle",
269         .dai_link = &poodle_dai,
270         .num_links = 1,
271         .ops = &poodle_ops,
272 };
273
274 /* poodle audio private data */
275 static struct wm8731_setup_data poodle_wm8731_setup = {
276         .i2c_address = 0x1b,
277 };
278
279 /* poodle audio subsystem */
280 static struct snd_soc_device poodle_snd_devdata = {
281         .machine = &snd_soc_machine_poodle,
282         .platform = &pxa2xx_soc_platform,
283         .codec_dev = &soc_codec_dev_wm8731,
284         .codec_data = &poodle_wm8731_setup,
285 };
286
287 static struct platform_device *poodle_snd_device;
288
289 static int __init poodle_init(void)
290 {
291         int ret;
292
293         if (!machine_is_poodle())
294                 return -ENODEV;
295
296         locomo_gpio_set_dir(&poodle_locomo_device.dev,
297                 POODLE_LOCOMO_GPIO_AMP_ON, 0);
298         /* should we mute HP at startup - burning power ?*/
299         locomo_gpio_set_dir(&poodle_locomo_device.dev,
300                 POODLE_LOCOMO_GPIO_MUTE_L, 0);
301         locomo_gpio_set_dir(&poodle_locomo_device.dev,
302                 POODLE_LOCOMO_GPIO_MUTE_R, 0);
303
304         poodle_snd_device = platform_device_alloc("soc-audio", -1);
305         if (!poodle_snd_device)
306                 return -ENOMEM;
307
308         platform_set_drvdata(poodle_snd_device, &poodle_snd_devdata);
309         poodle_snd_devdata.dev = &poodle_snd_device->dev;
310         ret = platform_device_add(poodle_snd_device);
311
312         if (ret)
313                 platform_device_put(poodle_snd_device);
314
315         return ret;
316 }
317
318 static void __exit poodle_exit(void)
319 {
320         platform_device_unregister(poodle_snd_device);
321 }
322
323 module_init(poodle_init);
324 module_exit(poodle_exit);
325
326 /* Module information */
327 MODULE_AUTHOR("Richard Purdie");
328 MODULE_DESCRIPTION("ALSA SoC Poodle");
329 MODULE_LICENSE("GPL");