1
2
3
4
5
6
7
8
9
10
11
12
13
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/core.h>
23#include <sound/pcm.h>
24#include <sound/soc.h>
25#include <sound/soc-dapm.h>
26
27#include <asm/mach-types.h>
28#include <asm/hardware/locomo.h>
29#include <mach/pxa-regs.h>
30#include <mach/hardware.h>
31#include <mach/poodle.h>
32#include <mach/audio.h>
33
34#include "../codecs/wm8731.h"
35#include "pxa2xx-pcm.h"
36#include "pxa2xx-i2s.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
44#define POODLE_AUDIO_CLOCK 12288000
45
46static int poodle_jack_func;
47static int poodle_spk_func;
48
49static void poodle_ext_control(struct snd_soc_codec *codec)
50{
51
52 if (poodle_jack_func == POODLE_HP) {
53
54 locomo_gpio_write(&poodle_locomo_device.dev,
55 POODLE_LOCOMO_GPIO_MUTE_L, 1);
56 locomo_gpio_write(&poodle_locomo_device.dev,
57 POODLE_LOCOMO_GPIO_MUTE_R, 1);
58 snd_soc_dapm_enable_pin(codec, "Headphone Jack");
59 } else {
60 locomo_gpio_write(&poodle_locomo_device.dev,
61 POODLE_LOCOMO_GPIO_MUTE_L, 0);
62 locomo_gpio_write(&poodle_locomo_device.dev,
63 POODLE_LOCOMO_GPIO_MUTE_R, 0);
64 snd_soc_dapm_disable_pin(codec, "Headphone Jack");
65 }
66
67
68 if (poodle_spk_func == POODLE_SPK_ON)
69 snd_soc_dapm_enable_pin(codec, "Ext Spk");
70 else
71 snd_soc_dapm_disable_pin(codec, "Ext Spk");
72
73
74 snd_soc_dapm_sync(codec);
75}
76
77static int poodle_startup(struct snd_pcm_substream *substream)
78{
79 struct snd_soc_pcm_runtime *rtd = substream->private_data;
80 struct snd_soc_codec *codec = rtd->socdev->codec;
81
82
83 poodle_ext_control(codec);
84 return 0;
85}
86
87
88static void poodle_shutdown(struct snd_pcm_substream *substream)
89{
90
91 locomo_gpio_write(&poodle_locomo_device.dev,
92 POODLE_LOCOMO_GPIO_MUTE_L, 1);
93 locomo_gpio_write(&poodle_locomo_device.dev,
94 POODLE_LOCOMO_GPIO_MUTE_R, 1);
95}
96
97static int poodle_hw_params(struct snd_pcm_substream *substream,
98 struct snd_pcm_hw_params *params)
99{
100 struct snd_soc_pcm_runtime *rtd = substream->private_data;
101 struct snd_soc_dai *codec_dai = rtd->dai->codec_dai;
102 struct snd_soc_dai *cpu_dai = rtd->dai->cpu_dai;
103 unsigned int clk = 0;
104 int ret = 0;
105
106 switch (params_rate(params)) {
107 case 8000:
108 case 16000:
109 case 48000:
110 case 96000:
111 clk = 12288000;
112 break;
113 case 11025:
114 case 22050:
115 case 44100:
116 clk = 11289600;
117 break;
118 }
119
120
121 ret = snd_soc_dai_set_fmt(codec_dai, SND_SOC_DAIFMT_I2S |
122 SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBS_CFS);
123 if (ret < 0)
124 return ret;
125
126
127 ret = snd_soc_dai_set_fmt(cpu_dai, SND_SOC_DAIFMT_I2S |
128 SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBS_CFS);
129 if (ret < 0)
130 return ret;
131
132
133 ret = snd_soc_dai_set_sysclk(codec_dai, WM8731_SYSCLK, clk,
134 SND_SOC_CLOCK_IN);
135 if (ret < 0)
136 return ret;
137
138
139 ret = snd_soc_dai_set_sysclk(cpu_dai, PXA2XX_I2S_SYSCLK, 0,
140 SND_SOC_CLOCK_IN);
141 if (ret < 0)
142 return ret;
143
144 return 0;
145}
146
147static struct snd_soc_ops poodle_ops = {
148 .startup = poodle_startup,
149 .hw_params = poodle_hw_params,
150 .shutdown = poodle_shutdown,
151};
152
153static int poodle_get_jack(struct snd_kcontrol *kcontrol,
154 struct snd_ctl_elem_value *ucontrol)
155{
156 ucontrol->value.integer.value[0] = poodle_jack_func;
157 return 0;
158}
159
160static int poodle_set_jack(struct snd_kcontrol *kcontrol,
161 struct snd_ctl_elem_value *ucontrol)
162{
163 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
164
165 if (poodle_jack_func == ucontrol->value.integer.value[0])
166 return 0;
167
168 poodle_jack_func = ucontrol->value.integer.value[0];
169 poodle_ext_control(codec);
170 return 1;
171}
172
173static int poodle_get_spk(struct snd_kcontrol *kcontrol,
174 struct snd_ctl_elem_value *ucontrol)
175{
176 ucontrol->value.integer.value[0] = poodle_spk_func;
177 return 0;
178}
179
180static int poodle_set_spk(struct snd_kcontrol *kcontrol,
181 struct snd_ctl_elem_value *ucontrol)
182{
183 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
184
185 if (poodle_spk_func == ucontrol->value.integer.value[0])
186 return 0;
187
188 poodle_spk_func = ucontrol->value.integer.value[0];
189 poodle_ext_control(codec);
190 return 1;
191}
192
193static int poodle_amp_event(struct snd_soc_dapm_widget *w,
194 struct snd_kcontrol *k, int event)
195{
196 if (SND_SOC_DAPM_EVENT_ON(event))
197 locomo_gpio_write(&poodle_locomo_device.dev,
198 POODLE_LOCOMO_GPIO_AMP_ON, 0);
199 else
200 locomo_gpio_write(&poodle_locomo_device.dev,
201 POODLE_LOCOMO_GPIO_AMP_ON, 1);
202
203 return 0;
204}
205
206
207static const struct snd_soc_dapm_widget wm8731_dapm_widgets[] = {
208SND_SOC_DAPM_HP("Headphone Jack", NULL),
209SND_SOC_DAPM_SPK("Ext Spk", poodle_amp_event),
210};
211
212
213static const struct snd_soc_dapm_route audio_map[] = {
214
215
216 {"Headphone Jack", NULL, "LHPOUT"},
217 {"Headphone Jack", NULL, "RHPOUT"},
218
219
220 {"Ext Spk", NULL, "ROUT"},
221 {"Ext Spk", NULL, "LOUT"},
222};
223
224static const char *jack_function[] = {"Off", "Headphone"};
225static const char *spk_function[] = {"Off", "On"};
226static const struct soc_enum poodle_enum[] = {
227 SOC_ENUM_SINGLE_EXT(2, jack_function),
228 SOC_ENUM_SINGLE_EXT(2, spk_function),
229};
230
231static const struct snd_kcontrol_new wm8731_poodle_controls[] = {
232 SOC_ENUM_EXT("Jack Function", poodle_enum[0], poodle_get_jack,
233 poodle_set_jack),
234 SOC_ENUM_EXT("Speaker Function", poodle_enum[1], poodle_get_spk,
235 poodle_set_spk),
236};
237
238
239
240
241static int poodle_wm8731_init(struct snd_soc_codec *codec)
242{
243 int i, err;
244
245 snd_soc_dapm_disable_pin(codec, "LLINEIN");
246 snd_soc_dapm_disable_pin(codec, "RLINEIN");
247 snd_soc_dapm_enable_pin(codec, "MICIN");
248
249
250 for (i = 0; i < ARRAY_SIZE(wm8731_poodle_controls); i++) {
251 err = snd_ctl_add(codec->card,
252 snd_soc_cnew(&wm8731_poodle_controls[i], codec, NULL));
253 if (err < 0)
254 return err;
255 }
256
257
258 snd_soc_dapm_new_controls(codec, wm8731_dapm_widgets,
259 ARRAY_SIZE(wm8731_dapm_widgets));
260
261
262 snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map));
263
264 snd_soc_dapm_sync(codec);
265 return 0;
266}
267
268
269static struct snd_soc_dai_link poodle_dai = {
270 .name = "WM8731",
271 .stream_name = "WM8731",
272 .cpu_dai = &pxa_i2s_dai,
273 .codec_dai = &wm8731_dai,
274 .init = poodle_wm8731_init,
275 .ops = &poodle_ops,
276};
277
278
279static struct snd_soc_machine snd_soc_machine_poodle = {
280 .name = "Poodle",
281 .dai_link = &poodle_dai,
282 .num_links = 1,
283};
284
285
286static struct wm8731_setup_data poodle_wm8731_setup = {
287 .i2c_address = 0x1b,
288};
289
290
291static struct snd_soc_device poodle_snd_devdata = {
292 .machine = &snd_soc_machine_poodle,
293 .platform = &pxa2xx_soc_platform,
294 .codec_dev = &soc_codec_dev_wm8731,
295 .codec_data = &poodle_wm8731_setup,
296};
297
298static struct platform_device *poodle_snd_device;
299
300static int __init poodle_init(void)
301{
302 int ret;
303
304 if (!machine_is_poodle())
305 return -ENODEV;
306
307 locomo_gpio_set_dir(&poodle_locomo_device.dev,
308 POODLE_LOCOMO_GPIO_AMP_ON, 0);
309
310 locomo_gpio_set_dir(&poodle_locomo_device.dev,
311 POODLE_LOCOMO_GPIO_MUTE_L, 0);
312 locomo_gpio_set_dir(&poodle_locomo_device.dev,
313 POODLE_LOCOMO_GPIO_MUTE_R, 0);
314
315 poodle_snd_device = platform_device_alloc("soc-audio", -1);
316 if (!poodle_snd_device)
317 return -ENOMEM;
318
319 platform_set_drvdata(poodle_snd_device, &poodle_snd_devdata);
320 poodle_snd_devdata.dev = &poodle_snd_device->dev;
321 ret = platform_device_add(poodle_snd_device);
322
323 if (ret)
324 platform_device_put(poodle_snd_device);
325
326 return ret;
327}
328
329static void __exit poodle_exit(void)
330{
331 platform_device_unregister(poodle_snd_device);
332}
333
334module_init(poodle_init);
335module_exit(poodle_exit);
336
337
338MODULE_AUTHOR("Richard Purdie");
339MODULE_DESCRIPTION("ALSA SoC Poodle");
340MODULE_LICENSE("GPL");
341