1
2
3
4
5
6
7
8
9
10#include <linux/module.h>
11#include <linux/device.h>
12#include <linux/io.h>
13#include <linux/clk.h>
14#include <linux/mutex.h>
15
16#include <sound/soc.h>
17#include <sound/soc-dapm.h>
18#include <sound/pcm.h>
19#include <sound/pcm_params.h>
20
21#include "ux500_pcm.h"
22#include "ux500_msp_dai.h"
23#include "mop500_ab8500.h"
24#include "../codecs/ab8500-codec.h"
25
26#define TX_SLOT_MONO 0x0008
27#define TX_SLOT_STEREO 0x000a
28#define RX_SLOT_MONO 0x0001
29#define RX_SLOT_STEREO 0x0003
30#define TX_SLOT_8CH 0x00FF
31#define RX_SLOT_8CH 0x00FF
32
33#define DEF_TX_SLOTS TX_SLOT_STEREO
34#define DEF_RX_SLOTS RX_SLOT_MONO
35
36#define DRIVERMODE_NORMAL 0
37#define DRIVERMODE_CODEC_ONLY 1
38
39
40static unsigned int tx_slots = DEF_TX_SLOTS;
41static unsigned int rx_slots = DEF_RX_SLOTS;
42
43
44static DEFINE_MUTEX(mop500_ab8500_params_lock);
45static unsigned long mop500_ab8500_usage;
46static int mop500_ab8500_rate;
47static int mop500_ab8500_channels;
48
49
50static const char * const enum_mclk[] = {
51 "SYSCLK",
52 "ULPCLK"
53};
54enum mclk {
55 MCLK_SYSCLK,
56 MCLK_ULPCLK,
57};
58
59static SOC_ENUM_SINGLE_EXT_DECL(soc_enum_mclk, enum_mclk);
60
61
62struct mop500_ab8500_drvdata {
63
64 enum mclk mclk_sel;
65 struct clk *clk_ptr_intclk;
66 struct clk *clk_ptr_sysclk;
67 struct clk *clk_ptr_ulpclk;
68};
69
70static inline const char *get_mclk_str(enum mclk mclk_sel)
71{
72 switch (mclk_sel) {
73 case MCLK_SYSCLK:
74 return "SYSCLK";
75 case MCLK_ULPCLK:
76 return "ULPCLK";
77 default:
78 return "Unknown";
79 }
80}
81
82static int mop500_ab8500_set_mclk(struct device *dev,
83 struct mop500_ab8500_drvdata *drvdata)
84{
85 int status;
86 struct clk *clk_ptr;
87
88 if (IS_ERR(drvdata->clk_ptr_intclk)) {
89 dev_err(dev,
90 "%s: ERROR: intclk not initialized!\n", __func__);
91 return -EIO;
92 }
93
94 switch (drvdata->mclk_sel) {
95 case MCLK_SYSCLK:
96 clk_ptr = drvdata->clk_ptr_sysclk;
97 break;
98 case MCLK_ULPCLK:
99 clk_ptr = drvdata->clk_ptr_ulpclk;
100 break;
101 default:
102 return -EINVAL;
103 }
104
105 if (IS_ERR(clk_ptr)) {
106 dev_err(dev, "%s: ERROR: %s not initialized!\n", __func__,
107 get_mclk_str(drvdata->mclk_sel));
108 return -EIO;
109 }
110
111 status = clk_set_parent(drvdata->clk_ptr_intclk, clk_ptr);
112 if (status)
113 dev_err(dev,
114 "%s: ERROR: Setting intclk parent to %s failed (ret = %d)!",
115 __func__, get_mclk_str(drvdata->mclk_sel), status);
116 else
117 dev_dbg(dev,
118 "%s: intclk parent changed to %s.\n",
119 __func__, get_mclk_str(drvdata->mclk_sel));
120
121 return status;
122}
123
124
125
126
127
128static int mclk_input_control_get(struct snd_kcontrol *kcontrol,
129 struct snd_ctl_elem_value *ucontrol)
130{
131 struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
132 struct mop500_ab8500_drvdata *drvdata =
133 snd_soc_card_get_drvdata(card);
134
135 ucontrol->value.enumerated.item[0] = drvdata->mclk_sel;
136
137 return 0;
138}
139
140static int mclk_input_control_put(struct snd_kcontrol *kcontrol,
141 struct snd_ctl_elem_value *ucontrol)
142{
143 struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
144 struct mop500_ab8500_drvdata *drvdata =
145 snd_soc_card_get_drvdata(card);
146 unsigned int val = ucontrol->value.enumerated.item[0];
147
148 if (val > (unsigned int)MCLK_ULPCLK)
149 return -EINVAL;
150 if (drvdata->mclk_sel == val)
151 return 0;
152
153 drvdata->mclk_sel = val;
154
155 return 1;
156}
157
158
159
160
161
162static struct snd_kcontrol_new mop500_ab8500_ctrls[] = {
163 SOC_ENUM_EXT("Master Clock Select",
164 soc_enum_mclk,
165 mclk_input_control_get, mclk_input_control_put),
166 SOC_DAPM_PIN_SWITCH("Headset Left"),
167 SOC_DAPM_PIN_SWITCH("Headset Right"),
168 SOC_DAPM_PIN_SWITCH("Earpiece"),
169 SOC_DAPM_PIN_SWITCH("Speaker Left"),
170 SOC_DAPM_PIN_SWITCH("Speaker Right"),
171 SOC_DAPM_PIN_SWITCH("LineOut Left"),
172 SOC_DAPM_PIN_SWITCH("LineOut Right"),
173 SOC_DAPM_PIN_SWITCH("Vibra 1"),
174 SOC_DAPM_PIN_SWITCH("Vibra 2"),
175 SOC_DAPM_PIN_SWITCH("Mic 1"),
176 SOC_DAPM_PIN_SWITCH("Mic 2"),
177 SOC_DAPM_PIN_SWITCH("LineIn Left"),
178 SOC_DAPM_PIN_SWITCH("LineIn Right"),
179 SOC_DAPM_PIN_SWITCH("DMic 1"),
180 SOC_DAPM_PIN_SWITCH("DMic 2"),
181 SOC_DAPM_PIN_SWITCH("DMic 3"),
182 SOC_DAPM_PIN_SWITCH("DMic 4"),
183 SOC_DAPM_PIN_SWITCH("DMic 5"),
184 SOC_DAPM_PIN_SWITCH("DMic 6"),
185};
186
187
188
189static int mop500_ab8500_startup(struct snd_pcm_substream *substream)
190{
191 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
192
193
194 return mop500_ab8500_set_mclk(rtd->card->dev,
195 snd_soc_card_get_drvdata(rtd->card));
196}
197
198static void mop500_ab8500_shutdown(struct snd_pcm_substream *substream)
199{
200 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
201 struct device *dev = rtd->card->dev;
202
203 dev_dbg(dev, "%s: Enter\n", __func__);
204
205
206 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
207 tx_slots = DEF_TX_SLOTS;
208 else
209 rx_slots = DEF_RX_SLOTS;
210}
211
212static int mop500_ab8500_hw_params(struct snd_pcm_substream *substream,
213 struct snd_pcm_hw_params *params)
214{
215 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
216 struct snd_soc_dai *codec_dai = snd_soc_rtd_to_codec(rtd, 0);
217 struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0);
218 struct device *dev = rtd->card->dev;
219 unsigned int fmt;
220 int channels, ret = 0, driver_mode, slots;
221 unsigned int sw_codec, sw_cpu;
222 bool is_playback;
223
224 dev_dbg(dev, "%s: Enter\n", __func__);
225
226 dev_dbg(dev, "%s: substream->pcm->name = %s\n"
227 "substream->pcm->id = %s.\n"
228 "substream->name = %s.\n"
229 "substream->number = %d.\n",
230 __func__,
231 substream->pcm->name,
232 substream->pcm->id,
233 substream->name,
234 substream->number);
235
236
237 mutex_lock(&mop500_ab8500_params_lock);
238 if (mop500_ab8500_usage) {
239 if (mop500_ab8500_rate != params_rate(params) ||
240 mop500_ab8500_channels != params_channels(params)) {
241 mutex_unlock(&mop500_ab8500_params_lock);
242 return -EBUSY;
243 }
244 } else {
245 mop500_ab8500_rate = params_rate(params);
246 mop500_ab8500_channels = params_channels(params);
247 }
248 __set_bit(cpu_dai->id, &mop500_ab8500_usage);
249 mutex_unlock(&mop500_ab8500_params_lock);
250
251 channels = params_channels(params);
252
253 switch (params_format(params)) {
254 case SNDRV_PCM_FORMAT_S32_LE:
255 sw_cpu = 32;
256 break;
257
258 case SNDRV_PCM_FORMAT_S16_LE:
259 sw_cpu = 16;
260 break;
261
262 default:
263 return -EINVAL;
264 }
265
266
267 if (channels == 8)
268 driver_mode = DRIVERMODE_CODEC_ONLY;
269 else
270 driver_mode = DRIVERMODE_NORMAL;
271 dev_dbg(dev, "%s: Driver-mode: %s.\n", __func__,
272 (driver_mode == DRIVERMODE_NORMAL) ? "NORMAL" : "CODEC_ONLY");
273
274
275
276 if (driver_mode == DRIVERMODE_NORMAL) {
277 fmt = SND_SOC_DAIFMT_DSP_A |
278 SND_SOC_DAIFMT_CBP_CFP |
279 SND_SOC_DAIFMT_NB_NF |
280 SND_SOC_DAIFMT_CONT;
281 } else {
282 fmt = SND_SOC_DAIFMT_DSP_A |
283 SND_SOC_DAIFMT_CBP_CFP |
284 SND_SOC_DAIFMT_NB_NF |
285 SND_SOC_DAIFMT_GATED;
286 }
287
288 ret = snd_soc_runtime_set_dai_fmt(rtd, fmt);
289 if (ret)
290 return ret;
291
292
293
294 is_playback = (substream->stream == SNDRV_PCM_STREAM_PLAYBACK);
295 switch (channels) {
296 case 1:
297 slots = 16;
298 tx_slots = (is_playback) ? TX_SLOT_MONO : 0;
299 rx_slots = (is_playback) ? 0 : RX_SLOT_MONO;
300 break;
301 case 2:
302 slots = 16;
303 tx_slots = (is_playback) ? TX_SLOT_STEREO : 0;
304 rx_slots = (is_playback) ? 0 : RX_SLOT_STEREO;
305 break;
306 case 8:
307 slots = 16;
308 tx_slots = (is_playback) ? TX_SLOT_8CH : 0;
309 rx_slots = (is_playback) ? 0 : RX_SLOT_8CH;
310 break;
311 default:
312 return -EINVAL;
313 }
314
315 if (driver_mode == DRIVERMODE_NORMAL)
316 sw_codec = sw_cpu;
317 else
318 sw_codec = 20;
319
320 dev_dbg(dev, "%s: CPU-DAI TDM: TX=0x%04X RX=0x%04x\n", __func__,
321 tx_slots, rx_slots);
322 ret = snd_soc_dai_set_tdm_slot(cpu_dai, tx_slots, rx_slots, slots,
323 sw_cpu);
324 if (ret)
325 return ret;
326
327 dev_dbg(dev, "%s: CODEC-DAI TDM: TX=0x%04X RX=0x%04x\n", __func__,
328 tx_slots, rx_slots);
329 ret = snd_soc_dai_set_tdm_slot(codec_dai, tx_slots, rx_slots, slots,
330 sw_codec);
331 if (ret)
332 return ret;
333
334 return 0;
335}
336
337static int mop500_ab8500_hw_free(struct snd_pcm_substream *substream)
338{
339 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
340 struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0);
341
342 mutex_lock(&mop500_ab8500_params_lock);
343 __clear_bit(cpu_dai->id, &mop500_ab8500_usage);
344 mutex_unlock(&mop500_ab8500_params_lock);
345
346 return 0;
347}
348
349const struct snd_soc_ops mop500_ab8500_ops[] = {
350 {
351 .hw_params = mop500_ab8500_hw_params,
352 .hw_free = mop500_ab8500_hw_free,
353 .startup = mop500_ab8500_startup,
354 .shutdown = mop500_ab8500_shutdown,
355 }
356};
357
358int mop500_ab8500_machine_init(struct snd_soc_pcm_runtime *rtd)
359{
360 struct snd_soc_dapm_context *dapm = &rtd->card->dapm;
361 struct device *dev = rtd->card->dev;
362 struct mop500_ab8500_drvdata *drvdata;
363 int ret;
364
365 dev_dbg(dev, "%s Enter.\n", __func__);
366
367
368 drvdata = devm_kzalloc(dev, sizeof(struct mop500_ab8500_drvdata),
369 GFP_KERNEL);
370
371 if (!drvdata)
372 return -ENOMEM;
373
374 snd_soc_card_set_drvdata(rtd->card, drvdata);
375
376
377
378 drvdata->clk_ptr_sysclk = clk_get(dev, "sysclk");
379 if (IS_ERR(drvdata->clk_ptr_sysclk))
380 dev_warn(dev, "%s: WARNING: clk_get failed for 'sysclk'!\n",
381 __func__);
382 drvdata->clk_ptr_ulpclk = clk_get(dev, "ulpclk");
383 if (IS_ERR(drvdata->clk_ptr_ulpclk))
384 dev_warn(dev, "%s: WARNING: clk_get failed for 'ulpclk'!\n",
385 __func__);
386 drvdata->clk_ptr_intclk = clk_get(dev, "intclk");
387 if (IS_ERR(drvdata->clk_ptr_intclk))
388 dev_warn(dev, "%s: WARNING: clk_get failed for 'intclk'!\n",
389 __func__);
390
391
392 drvdata->mclk_sel = MCLK_ULPCLK;
393 ret = mop500_ab8500_set_mclk(dev, drvdata);
394 if (ret < 0)
395 dev_warn(dev, "%s: WARNING: mop500_ab8500_set_mclk!\n",
396 __func__);
397
398 drvdata->mclk_sel = MCLK_ULPCLK;
399
400
401 ret = snd_soc_add_card_controls(rtd->card, mop500_ab8500_ctrls,
402 ARRAY_SIZE(mop500_ab8500_ctrls));
403 if (ret < 0) {
404 pr_err("%s: Failed to add machine-controls (%d)!\n",
405 __func__, ret);
406 return ret;
407 }
408
409 ret = snd_soc_dapm_disable_pin(dapm, "Earpiece");
410 ret |= snd_soc_dapm_disable_pin(dapm, "Speaker Left");
411 ret |= snd_soc_dapm_disable_pin(dapm, "Speaker Right");
412 ret |= snd_soc_dapm_disable_pin(dapm, "LineOut Left");
413 ret |= snd_soc_dapm_disable_pin(dapm, "LineOut Right");
414 ret |= snd_soc_dapm_disable_pin(dapm, "Vibra 1");
415 ret |= snd_soc_dapm_disable_pin(dapm, "Vibra 2");
416 ret |= snd_soc_dapm_disable_pin(dapm, "Mic 1");
417 ret |= snd_soc_dapm_disable_pin(dapm, "Mic 2");
418 ret |= snd_soc_dapm_disable_pin(dapm, "LineIn Left");
419 ret |= snd_soc_dapm_disable_pin(dapm, "LineIn Right");
420 ret |= snd_soc_dapm_disable_pin(dapm, "DMic 1");
421 ret |= snd_soc_dapm_disable_pin(dapm, "DMic 2");
422 ret |= snd_soc_dapm_disable_pin(dapm, "DMic 3");
423 ret |= snd_soc_dapm_disable_pin(dapm, "DMic 4");
424 ret |= snd_soc_dapm_disable_pin(dapm, "DMic 5");
425 ret |= snd_soc_dapm_disable_pin(dapm, "DMic 6");
426
427 return ret;
428}
429
430void mop500_ab8500_remove(struct snd_soc_card *card)
431{
432 struct mop500_ab8500_drvdata *drvdata = snd_soc_card_get_drvdata(card);
433
434 clk_put(drvdata->clk_ptr_sysclk);
435 clk_put(drvdata->clk_ptr_ulpclk);
436 clk_put(drvdata->clk_ptr_intclk);
437
438 snd_soc_card_set_drvdata(card, drvdata);
439}
440
