]>
Commit | Line | Data |
---|---|---|
9f5b64b7 GL |
1 | /* |
2 | * ALSA SoC driver for Migo-R | |
3 | * | |
4 | * Copyright (C) 2009-2010 Guennadi Liakhovetski <g.liakhovetski@gmx.de> | |
5 | * | |
6 | * This program is free software; you can redistribute it and/or modify | |
7 | * it under the terms of the GNU General Public License version 2 as | |
8 | * published by the Free Software Foundation. | |
9 | */ | |
10 | ||
11 | #include <linux/device.h> | |
12 | #include <linux/firmware.h> | |
13 | #include <linux/module.h> | |
14 | ||
cbfa5184 | 15 | #include <asm/clkdev.h> |
9f5b64b7 GL |
16 | #include <asm/clock.h> |
17 | ||
18 | #include <cpu/sh7722.h> | |
19 | ||
20 | #include <sound/core.h> | |
21 | #include <sound/pcm.h> | |
22 | #include <sound/soc.h> | |
23 | #include <sound/soc-dapm.h> | |
24 | ||
25 | #include "../codecs/wm8978.h" | |
26 | #include "siu.h" | |
27 | ||
28 | /* Default 8000Hz sampling frequency */ | |
29 | static unsigned long codec_freq = 8000 * 512; | |
30 | ||
31 | static unsigned int use_count; | |
32 | ||
33 | /* External clock, sourced from the codec at the SIUMCKB pin */ | |
34 | static unsigned long siumckb_recalc(struct clk *clk) | |
35 | { | |
36 | return codec_freq; | |
37 | } | |
38 | ||
39 | static struct clk_ops siumckb_clk_ops = { | |
40 | .recalc = siumckb_recalc, | |
41 | }; | |
42 | ||
43 | static struct clk siumckb_clk = { | |
9f5b64b7 GL |
44 | .ops = &siumckb_clk_ops, |
45 | .rate = 0, /* initialised at run-time */ | |
46 | }; | |
47 | ||
cbfa5184 GL |
48 | static struct clk_lookup *siumckb_lookup; |
49 | ||
9f5b64b7 GL |
50 | static int migor_hw_params(struct snd_pcm_substream *substream, |
51 | struct snd_pcm_hw_params *params) | |
52 | { | |
53 | struct snd_soc_pcm_runtime *rtd = substream->private_data; | |
54 | struct snd_soc_dai *codec_dai = rtd->dai->codec_dai; | |
55 | int ret; | |
56 | unsigned int rate = params_rate(params); | |
57 | ||
58 | ret = snd_soc_dai_set_sysclk(codec_dai, WM8978_PLL, 13000000, | |
59 | SND_SOC_CLOCK_IN); | |
60 | if (ret < 0) | |
61 | return ret; | |
62 | ||
9f5b64b7 GL |
63 | ret = snd_soc_dai_set_clkdiv(codec_dai, WM8978_OPCLKRATE, rate * 512); |
64 | if (ret < 0) | |
65 | return ret; | |
66 | ||
67 | ret = snd_soc_dai_set_fmt(codec_dai, SND_SOC_DAIFMT_NB_IF | | |
68 | SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_CBS_CFS); | |
69 | if (ret < 0) | |
70 | return ret; | |
71 | ||
72 | ret = snd_soc_dai_set_fmt(rtd->dai->cpu_dai, SND_SOC_DAIFMT_NB_IF | | |
73 | SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_CBS_CFS); | |
74 | if (ret < 0) | |
75 | return ret; | |
76 | ||
77 | codec_freq = rate * 512; | |
78 | /* | |
79 | * This propagates the parent frequency change to children and | |
80 | * recalculates the frequency table | |
81 | */ | |
82 | clk_set_rate(&siumckb_clk, codec_freq); | |
83 | dev_dbg(codec_dai->dev, "%s: configure %luHz\n", __func__, codec_freq); | |
84 | ||
85 | ret = snd_soc_dai_set_sysclk(rtd->dai->cpu_dai, SIU_CLKB_EXT, | |
86 | codec_freq / 2, SND_SOC_CLOCK_IN); | |
87 | ||
88 | if (!ret) | |
89 | use_count++; | |
90 | ||
91 | return ret; | |
92 | } | |
93 | ||
94 | static int migor_hw_free(struct snd_pcm_substream *substream) | |
95 | { | |
96 | struct snd_soc_pcm_runtime *rtd = substream->private_data; | |
97 | struct snd_soc_dai *codec_dai = rtd->dai->codec_dai; | |
98 | ||
99 | if (use_count) { | |
100 | use_count--; | |
101 | ||
102 | if (!use_count) | |
103 | snd_soc_dai_set_sysclk(codec_dai, WM8978_PLL, 0, | |
104 | SND_SOC_CLOCK_IN); | |
105 | } else { | |
106 | dev_dbg(codec_dai->dev, "Unbalanced hw_free!\n"); | |
107 | } | |
108 | ||
109 | return 0; | |
110 | } | |
111 | ||
112 | static struct snd_soc_ops migor_dai_ops = { | |
113 | .hw_params = migor_hw_params, | |
114 | .hw_free = migor_hw_free, | |
115 | }; | |
116 | ||
117 | static const struct snd_soc_dapm_widget migor_dapm_widgets[] = { | |
118 | SND_SOC_DAPM_HP("Headphone", NULL), | |
119 | SND_SOC_DAPM_MIC("Onboard Microphone", NULL), | |
120 | SND_SOC_DAPM_MIC("External Microphone", NULL), | |
121 | }; | |
122 | ||
123 | static const struct snd_soc_dapm_route audio_map[] = { | |
124 | /* Headphone output connected to LHP/RHP, enable OUT4 for VMID */ | |
125 | { "Headphone", NULL, "OUT4 VMID" }, | |
126 | { "OUT4 VMID", NULL, "LHP" }, | |
127 | { "OUT4 VMID", NULL, "RHP" }, | |
128 | ||
129 | /* On-board microphone */ | |
130 | { "RMICN", NULL, "Mic Bias" }, | |
131 | { "RMICP", NULL, "Mic Bias" }, | |
132 | { "Mic Bias", NULL, "Onboard Microphone" }, | |
133 | ||
134 | /* External microphone */ | |
135 | { "LMICN", NULL, "Mic Bias" }, | |
136 | { "LMICP", NULL, "Mic Bias" }, | |
137 | { "Mic Bias", NULL, "External Microphone" }, | |
138 | }; | |
139 | ||
140 | static int migor_dai_init(struct snd_soc_codec *codec) | |
141 | { | |
142 | snd_soc_dapm_new_controls(codec, migor_dapm_widgets, | |
143 | ARRAY_SIZE(migor_dapm_widgets)); | |
144 | ||
145 | snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map)); | |
146 | ||
147 | return 0; | |
148 | } | |
149 | ||
150 | /* migor digital audio interface glue - connects codec <--> CPU */ | |
151 | static struct snd_soc_dai_link migor_dai = { | |
152 | .name = "wm8978", | |
153 | .stream_name = "WM8978", | |
154 | .cpu_dai = &siu_i2s_dai, | |
155 | .codec_dai = &wm8978_dai, | |
156 | .ops = &migor_dai_ops, | |
157 | .init = migor_dai_init, | |
158 | }; | |
159 | ||
160 | /* migor audio machine driver */ | |
161 | static struct snd_soc_card snd_soc_migor = { | |
162 | .name = "Migo-R", | |
163 | .platform = &siu_platform, | |
164 | .dai_link = &migor_dai, | |
165 | .num_links = 1, | |
166 | }; | |
167 | ||
168 | /* migor audio subsystem */ | |
169 | static struct snd_soc_device migor_snd_devdata = { | |
170 | .card = &snd_soc_migor, | |
171 | .codec_dev = &soc_codec_dev_wm8978, | |
172 | }; | |
173 | ||
174 | static struct platform_device *migor_snd_device; | |
175 | ||
176 | static int __init migor_init(void) | |
177 | { | |
178 | int ret; | |
179 | ||
180 | ret = clk_register(&siumckb_clk); | |
181 | if (ret < 0) | |
182 | return ret; | |
183 | ||
cbfa5184 GL |
184 | siumckb_lookup = clkdev_alloc(&siumckb_clk, "siumckb_clk", NULL); |
185 | if (!siumckb_lookup) { | |
186 | ret = -ENOMEM; | |
187 | goto eclkdevalloc; | |
188 | } | |
189 | clkdev_add(siumckb_lookup); | |
190 | ||
9f5b64b7 GL |
191 | /* Port number used on this machine: port B */ |
192 | migor_snd_device = platform_device_alloc("soc-audio", 1); | |
193 | if (!migor_snd_device) { | |
194 | ret = -ENOMEM; | |
195 | goto epdevalloc; | |
196 | } | |
197 | ||
198 | platform_set_drvdata(migor_snd_device, &migor_snd_devdata); | |
199 | ||
200 | migor_snd_devdata.dev = &migor_snd_device->dev; | |
201 | ||
202 | ret = platform_device_add(migor_snd_device); | |
203 | if (ret) | |
204 | goto epdevadd; | |
205 | ||
206 | return 0; | |
207 | ||
208 | epdevadd: | |
209 | platform_device_put(migor_snd_device); | |
210 | epdevalloc: | |
cbfa5184 GL |
211 | clkdev_drop(siumckb_lookup); |
212 | eclkdevalloc: | |
9f5b64b7 GL |
213 | clk_unregister(&siumckb_clk); |
214 | return ret; | |
215 | } | |
216 | ||
217 | static void __exit migor_exit(void) | |
218 | { | |
cbfa5184 | 219 | clkdev_drop(siumckb_lookup); |
9f5b64b7 GL |
220 | clk_unregister(&siumckb_clk); |
221 | platform_device_unregister(migor_snd_device); | |
222 | } | |
223 | ||
224 | module_init(migor_init); | |
225 | module_exit(migor_exit); | |
226 | ||
227 | MODULE_AUTHOR("Guennadi Liakhovetski <g.liakhovetski@gmx.de>"); | |
228 | MODULE_DESCRIPTION("ALSA SoC Migor"); | |
229 | MODULE_LICENSE("GPL v2"); |