2 * omap-mcbsp.c -- OMAP ALSA SoC DAI driver using McBSP port
4 * Copyright (C) 2008 Nokia Corporation
6 * Contact: Jarkko Nikula <jarkko.nikula@bitmer.com>
7 * Peter Ujfalusi <peter.ujfalusi@ti.com>
9 * This program is free software; you can redistribute it and/or
10 * modify it under the terms of the GNU General Public License
11 * version 2 as published by the Free Software Foundation.
13 * This program is distributed in the hope that it will be useful, but
14 * WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
16 * General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
25 #include <linux/init.h>
26 #include <linux/module.h>
27 #include <linux/device.h>
28 #include <linux/pm_runtime.h>
29 #include <sound/core.h>
30 #include <sound/pcm.h>
31 #include <sound/pcm_params.h>
32 #include <sound/initval.h>
33 #include <sound/soc.h>
37 #include <linux/platform_data/asoc-ti-mcbsp.h>
39 #include "omap-mcbsp.h"
42 #define OMAP_MCBSP_RATES (SNDRV_PCM_RATE_8000_96000)
44 #define OMAP_MCBSP_SOC_SINGLE_S16_EXT(xname, xmin, xmax, \
45 xhandler_get, xhandler_put) \
46 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \
47 .info = omap_mcbsp_st_info_volsw, \
48 .get = xhandler_get, .put = xhandler_put, \
49 .private_value = (unsigned long) &(struct soc_mixer_control) \
50 {.min = xmin, .max = xmax} }
53 OMAP_MCBSP_WORD_8
= 0,
62 * Stream DMA parameters. DMA request line and port address are set runtime
63 * since they are different between OMAP1 and later OMAPs
65 static void omap_mcbsp_set_threshold(struct snd_pcm_substream
*substream
)
67 struct snd_soc_pcm_runtime
*rtd
= substream
->private_data
;
68 struct snd_soc_dai
*cpu_dai
= rtd
->cpu_dai
;
69 struct omap_mcbsp
*mcbsp
= snd_soc_dai_get_drvdata(cpu_dai
);
70 struct omap_pcm_dma_data
*dma_data
;
73 dma_data
= snd_soc_dai_get_dma_data(rtd
->cpu_dai
, substream
);
76 * Configure McBSP threshold based on either:
77 * packet_size, when the sDMA is in packet mode, or based on the
78 * period size in THRESHOLD mode, otherwise use McBSP threshold = 1
81 if (dma_data
->packet_size
)
82 words
= dma_data
->packet_size
;
83 else if (mcbsp
->dma_op_mode
== MCBSP_DMA_MODE_THRESHOLD
)
84 words
= snd_pcm_lib_period_bytes(substream
) /
89 /* Configure McBSP internal buffer usage */
90 if (substream
->stream
== SNDRV_PCM_STREAM_PLAYBACK
)
91 omap_mcbsp_set_tx_threshold(mcbsp
, words
);
93 omap_mcbsp_set_rx_threshold(mcbsp
, words
);
96 static int omap_mcbsp_hwrule_min_buffersize(struct snd_pcm_hw_params
*params
,
97 struct snd_pcm_hw_rule
*rule
)
99 struct snd_interval
*buffer_size
= hw_param_interval(params
,
100 SNDRV_PCM_HW_PARAM_BUFFER_SIZE
);
101 struct snd_interval
*channels
= hw_param_interval(params
,
102 SNDRV_PCM_HW_PARAM_CHANNELS
);
103 struct omap_mcbsp
*mcbsp
= rule
->private;
104 struct snd_interval frames
;
107 snd_interval_any(&frames
);
108 size
= mcbsp
->pdata
->buffer_size
;
110 frames
.min
= size
/ channels
->min
;
112 return snd_interval_refine(buffer_size
, &frames
);
115 static int omap_mcbsp_dai_startup(struct snd_pcm_substream
*substream
,
116 struct snd_soc_dai
*cpu_dai
)
118 struct omap_mcbsp
*mcbsp
= snd_soc_dai_get_drvdata(cpu_dai
);
121 if (!cpu_dai
->active
)
122 err
= omap_mcbsp_request(mcbsp
);
125 * OMAP3 McBSP FIFO is word structured.
126 * McBSP2 has 1024 + 256 = 1280 word long buffer,
127 * McBSP1,3,4,5 has 128 word long buffer
128 * This means that the size of the FIFO depends on the sample format.
129 * For example on McBSP3:
130 * 16bit samples: size is 128 * 2 = 256 bytes
131 * 32bit samples: size is 128 * 4 = 512 bytes
132 * It is simpler to place constraint for buffer and period based on
134 * McBSP3 as example again (16 or 32 bit samples):
135 * 1 channel (mono): size is 128 frames (128 words)
136 * 2 channels (stereo): size is 128 / 2 = 64 frames (2 * 64 words)
137 * 4 channels: size is 128 / 4 = 32 frames (4 * 32 words)
139 if (mcbsp
->pdata
->buffer_size
) {
141 * Rule for the buffer size. We should not allow
142 * smaller buffer than the FIFO size to avoid underruns.
143 * This applies only for the playback stream.
145 if (substream
->stream
== SNDRV_PCM_STREAM_PLAYBACK
)
146 snd_pcm_hw_rule_add(substream
->runtime
, 0,
147 SNDRV_PCM_HW_PARAM_BUFFER_SIZE
,
148 omap_mcbsp_hwrule_min_buffersize
,
150 SNDRV_PCM_HW_PARAM_CHANNELS
, -1);
152 /* Make sure, that the period size is always even */
153 snd_pcm_hw_constraint_step(substream
->runtime
, 0,
154 SNDRV_PCM_HW_PARAM_PERIOD_SIZE
, 2);
160 static void omap_mcbsp_dai_shutdown(struct snd_pcm_substream
*substream
,
161 struct snd_soc_dai
*cpu_dai
)
163 struct omap_mcbsp
*mcbsp
= snd_soc_dai_get_drvdata(cpu_dai
);
165 if (!cpu_dai
->active
) {
166 omap_mcbsp_free(mcbsp
);
167 mcbsp
->configured
= 0;
171 static int omap_mcbsp_dai_trigger(struct snd_pcm_substream
*substream
, int cmd
,
172 struct snd_soc_dai
*cpu_dai
)
174 struct omap_mcbsp
*mcbsp
= snd_soc_dai_get_drvdata(cpu_dai
);
175 int err
= 0, play
= (substream
->stream
== SNDRV_PCM_STREAM_PLAYBACK
);
178 case SNDRV_PCM_TRIGGER_START
:
179 case SNDRV_PCM_TRIGGER_RESUME
:
180 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE
:
182 omap_mcbsp_start(mcbsp
, play
, !play
);
185 case SNDRV_PCM_TRIGGER_STOP
:
186 case SNDRV_PCM_TRIGGER_SUSPEND
:
187 case SNDRV_PCM_TRIGGER_PAUSE_PUSH
:
188 omap_mcbsp_stop(mcbsp
, play
, !play
);
198 static snd_pcm_sframes_t
omap_mcbsp_dai_delay(
199 struct snd_pcm_substream
*substream
,
200 struct snd_soc_dai
*dai
)
202 struct snd_soc_pcm_runtime
*rtd
= substream
->private_data
;
203 struct snd_soc_dai
*cpu_dai
= rtd
->cpu_dai
;
204 struct omap_mcbsp
*mcbsp
= snd_soc_dai_get_drvdata(cpu_dai
);
206 snd_pcm_sframes_t delay
;
208 if (substream
->stream
== SNDRV_PCM_STREAM_PLAYBACK
)
209 fifo_use
= omap_mcbsp_get_tx_delay(mcbsp
);
211 fifo_use
= omap_mcbsp_get_rx_delay(mcbsp
);
214 * Divide the used locations with the channel count to get the
215 * FIFO usage in samples (don't care about partial samples in the
218 delay
= fifo_use
/ substream
->runtime
->channels
;
223 static int omap_mcbsp_dai_hw_params(struct snd_pcm_substream
*substream
,
224 struct snd_pcm_hw_params
*params
,
225 struct snd_soc_dai
*cpu_dai
)
227 struct omap_mcbsp
*mcbsp
= snd_soc_dai_get_drvdata(cpu_dai
);
228 struct omap_mcbsp_reg_cfg
*regs
= &mcbsp
->cfg_regs
;
229 struct omap_pcm_dma_data
*dma_data
;
230 int wlen
, channels
, wpf
, sync_mode
= OMAP_DMA_SYNC_ELEMENT
;
232 unsigned int format
, div
, framesize
, master
;
234 dma_data
= &mcbsp
->dma_data
[substream
->stream
];
235 channels
= params_channels(params
);
237 switch (params_format(params
)) {
238 case SNDRV_PCM_FORMAT_S16_LE
:
239 dma_data
->data_type
= OMAP_DMA_DATA_TYPE_S16
;
242 case SNDRV_PCM_FORMAT_S32_LE
:
243 dma_data
->data_type
= OMAP_DMA_DATA_TYPE_S32
;
249 if (mcbsp
->pdata
->buffer_size
) {
250 dma_data
->set_threshold
= omap_mcbsp_set_threshold
;
251 if (mcbsp
->dma_op_mode
== MCBSP_DMA_MODE_THRESHOLD
) {
252 int period_words
, max_thrsh
;
254 period_words
= params_period_bytes(params
) / (wlen
/ 8);
255 if (substream
->stream
== SNDRV_PCM_STREAM_PLAYBACK
)
256 max_thrsh
= mcbsp
->max_tx_thres
;
258 max_thrsh
= mcbsp
->max_rx_thres
;
260 * If the period contains less or equal number of words,
261 * we are using the original threshold mode setup:
262 * McBSP threshold = sDMA frame size = period_size
263 * Otherwise we switch to sDMA packet mode:
264 * McBSP threshold = sDMA packet size
265 * sDMA frame size = period size
267 if (period_words
> max_thrsh
) {
271 * Look for the biggest threshold value, which
272 * divides the period size evenly.
274 divider
= period_words
/ max_thrsh
;
275 if (period_words
% max_thrsh
)
277 while (period_words
% divider
&&
278 divider
< period_words
)
280 if (divider
== period_words
)
283 pkt_size
= period_words
/ divider
;
284 sync_mode
= OMAP_DMA_SYNC_PACKET
;
286 sync_mode
= OMAP_DMA_SYNC_FRAME
;
288 } else if (channels
> 1) {
289 /* Use packet mode for non mono streams */
291 sync_mode
= OMAP_DMA_SYNC_PACKET
;
295 dma_data
->sync_mode
= sync_mode
;
296 dma_data
->packet_size
= pkt_size
;
298 snd_soc_dai_set_dma_data(cpu_dai
, substream
, dma_data
);
300 if (mcbsp
->configured
) {
301 /* McBSP already configured by another stream */
305 regs
->rcr2
&= ~(RPHASE
| RFRLEN2(0x7f) | RWDLEN2(7));
306 regs
->xcr2
&= ~(RPHASE
| XFRLEN2(0x7f) | XWDLEN2(7));
307 regs
->rcr1
&= ~(RFRLEN1(0x7f) | RWDLEN1(7));
308 regs
->xcr1
&= ~(XFRLEN1(0x7f) | XWDLEN1(7));
309 format
= mcbsp
->fmt
& SND_SOC_DAIFMT_FORMAT_MASK
;
311 if (channels
== 2 && (format
== SND_SOC_DAIFMT_I2S
||
312 format
== SND_SOC_DAIFMT_LEFT_J
)) {
313 /* Use dual-phase frames */
314 regs
->rcr2
|= RPHASE
;
315 regs
->xcr2
|= XPHASE
;
316 /* Set 1 word per (McBSP) frame for phase1 and phase2 */
318 regs
->rcr2
|= RFRLEN2(wpf
- 1);
319 regs
->xcr2
|= XFRLEN2(wpf
- 1);
322 regs
->rcr1
|= RFRLEN1(wpf
- 1);
323 regs
->xcr1
|= XFRLEN1(wpf
- 1);
325 switch (params_format(params
)) {
326 case SNDRV_PCM_FORMAT_S16_LE
:
327 /* Set word lengths */
328 regs
->rcr2
|= RWDLEN2(OMAP_MCBSP_WORD_16
);
329 regs
->rcr1
|= RWDLEN1(OMAP_MCBSP_WORD_16
);
330 regs
->xcr2
|= XWDLEN2(OMAP_MCBSP_WORD_16
);
331 regs
->xcr1
|= XWDLEN1(OMAP_MCBSP_WORD_16
);
333 case SNDRV_PCM_FORMAT_S32_LE
:
334 /* Set word lengths */
335 regs
->rcr2
|= RWDLEN2(OMAP_MCBSP_WORD_32
);
336 regs
->rcr1
|= RWDLEN1(OMAP_MCBSP_WORD_32
);
337 regs
->xcr2
|= XWDLEN2(OMAP_MCBSP_WORD_32
);
338 regs
->xcr1
|= XWDLEN1(OMAP_MCBSP_WORD_32
);
341 /* Unsupported PCM format */
345 /* In McBSP master modes, FRAME (i.e. sample rate) is generated
346 * by _counting_ BCLKs. Calculate frame size in BCLKs */
347 master
= mcbsp
->fmt
& SND_SOC_DAIFMT_MASTER_MASK
;
348 if (master
== SND_SOC_DAIFMT_CBS_CFS
) {
349 div
= mcbsp
->clk_div
? mcbsp
->clk_div
: 1;
350 framesize
= (mcbsp
->in_freq
/ div
) / params_rate(params
);
352 if (framesize
< wlen
* channels
) {
353 printk(KERN_ERR
"%s: not enough bandwidth for desired rate and "
354 "channels\n", __func__
);
358 framesize
= wlen
* channels
;
360 /* Set FS period and length in terms of bit clock periods */
361 regs
->srgr2
&= ~FPER(0xfff);
362 regs
->srgr1
&= ~FWID(0xff);
364 case SND_SOC_DAIFMT_I2S
:
365 case SND_SOC_DAIFMT_LEFT_J
:
366 regs
->srgr2
|= FPER(framesize
- 1);
367 regs
->srgr1
|= FWID((framesize
>> 1) - 1);
369 case SND_SOC_DAIFMT_DSP_A
:
370 case SND_SOC_DAIFMT_DSP_B
:
371 regs
->srgr2
|= FPER(framesize
- 1);
372 regs
->srgr1
|= FWID(0);
376 omap_mcbsp_config(mcbsp
, &mcbsp
->cfg_regs
);
378 mcbsp
->configured
= 1;
384 * This must be called before _set_clkdiv and _set_sysclk since McBSP register
385 * cache is initialized here
387 static int omap_mcbsp_dai_set_dai_fmt(struct snd_soc_dai
*cpu_dai
,
390 struct omap_mcbsp
*mcbsp
= snd_soc_dai_get_drvdata(cpu_dai
);
391 struct omap_mcbsp_reg_cfg
*regs
= &mcbsp
->cfg_regs
;
394 if (mcbsp
->configured
)
398 memset(regs
, 0, sizeof(*regs
));
399 /* Generic McBSP register settings */
400 regs
->spcr2
|= XINTM(3) | FREE
;
401 regs
->spcr1
|= RINTM(3);
402 /* RFIG and XFIG are not defined in 34xx */
403 if (!cpu_is_omap34xx() && !cpu_is_omap44xx()) {
407 if (cpu_is_omap2430() || cpu_is_omap34xx() || cpu_is_omap44xx()) {
408 regs
->xccr
= DXENDLY(1) | XDMAEN
| XDISABLE
;
409 regs
->rccr
= RFULL_CYCLE
| RDMAEN
| RDISABLE
;
412 switch (fmt
& SND_SOC_DAIFMT_FORMAT_MASK
) {
413 case SND_SOC_DAIFMT_I2S
:
414 /* 1-bit data delay */
415 regs
->rcr2
|= RDATDLY(1);
416 regs
->xcr2
|= XDATDLY(1);
418 case SND_SOC_DAIFMT_LEFT_J
:
419 /* 0-bit data delay */
420 regs
->rcr2
|= RDATDLY(0);
421 regs
->xcr2
|= XDATDLY(0);
422 regs
->spcr1
|= RJUST(2);
423 /* Invert FS polarity configuration */
426 case SND_SOC_DAIFMT_DSP_A
:
427 /* 1-bit data delay */
428 regs
->rcr2
|= RDATDLY(1);
429 regs
->xcr2
|= XDATDLY(1);
430 /* Invert FS polarity configuration */
433 case SND_SOC_DAIFMT_DSP_B
:
434 /* 0-bit data delay */
435 regs
->rcr2
|= RDATDLY(0);
436 regs
->xcr2
|= XDATDLY(0);
437 /* Invert FS polarity configuration */
441 /* Unsupported data format */
445 switch (fmt
& SND_SOC_DAIFMT_MASTER_MASK
) {
446 case SND_SOC_DAIFMT_CBS_CFS
:
447 /* McBSP master. Set FS and bit clocks as outputs */
448 regs
->pcr0
|= FSXM
| FSRM
|
450 /* Sample rate generator drives the FS */
453 case SND_SOC_DAIFMT_CBM_CFM
:
457 /* Unsupported master/slave configuration */
461 /* Set bit clock (CLKX/CLKR) and FS polarities */
462 switch (fmt
& SND_SOC_DAIFMT_INV_MASK
) {
463 case SND_SOC_DAIFMT_NB_NF
:
466 * FS active low. TX data driven on falling edge of bit clock
467 * and RX data sampled on rising edge of bit clock.
469 regs
->pcr0
|= FSXP
| FSRP
|
472 case SND_SOC_DAIFMT_NB_IF
:
473 regs
->pcr0
|= CLKXP
| CLKRP
;
475 case SND_SOC_DAIFMT_IB_NF
:
476 regs
->pcr0
|= FSXP
| FSRP
;
478 case SND_SOC_DAIFMT_IB_IF
:
484 regs
->pcr0
^= FSXP
| FSRP
;
489 static int omap_mcbsp_dai_set_clkdiv(struct snd_soc_dai
*cpu_dai
,
492 struct omap_mcbsp
*mcbsp
= snd_soc_dai_get_drvdata(cpu_dai
);
493 struct omap_mcbsp_reg_cfg
*regs
= &mcbsp
->cfg_regs
;
495 if (div_id
!= OMAP_MCBSP_CLKGDV
)
498 mcbsp
->clk_div
= div
;
499 regs
->srgr1
&= ~CLKGDV(0xff);
500 regs
->srgr1
|= CLKGDV(div
- 1);
505 static int omap_mcbsp_dai_set_dai_sysclk(struct snd_soc_dai
*cpu_dai
,
506 int clk_id
, unsigned int freq
,
509 struct omap_mcbsp
*mcbsp
= snd_soc_dai_get_drvdata(cpu_dai
);
510 struct omap_mcbsp_reg_cfg
*regs
= &mcbsp
->cfg_regs
;
514 if (freq
== mcbsp
->in_freq
)
520 if (clk_id
== OMAP_MCBSP_SYSCLK_CLK
||
521 clk_id
== OMAP_MCBSP_SYSCLK_CLKS_FCLK
||
522 clk_id
== OMAP_MCBSP_SYSCLK_CLKS_EXT
||
523 clk_id
== OMAP_MCBSP_SYSCLK_CLKX_EXT
||
524 clk_id
== OMAP_MCBSP_SYSCLK_CLKR_EXT
) {
525 mcbsp
->in_freq
= freq
;
526 regs
->srgr2
&= ~CLKSM
;
527 regs
->pcr0
&= ~SCLKME
;
528 } else if (cpu_class_is_omap1()) {
530 * McBSP CLKR/FSR signal muxing functions are only available on
531 * OMAP2 or newer versions
537 case OMAP_MCBSP_SYSCLK_CLK
:
538 regs
->srgr2
|= CLKSM
;
540 case OMAP_MCBSP_SYSCLK_CLKS_FCLK
:
541 if (cpu_class_is_omap1()) {
545 err
= omap2_mcbsp_set_clks_src(mcbsp
,
546 MCBSP_CLKS_PRCM_SRC
);
548 case OMAP_MCBSP_SYSCLK_CLKS_EXT
:
549 if (cpu_class_is_omap1()) {
553 err
= omap2_mcbsp_set_clks_src(mcbsp
,
557 case OMAP_MCBSP_SYSCLK_CLKX_EXT
:
558 regs
->srgr2
|= CLKSM
;
559 case OMAP_MCBSP_SYSCLK_CLKR_EXT
:
560 regs
->pcr0
|= SCLKME
;
564 case OMAP_MCBSP_CLKR_SRC_CLKR
:
565 err
= omap_mcbsp_6pin_src_mux(mcbsp
, CLKR_SRC_CLKR
);
567 case OMAP_MCBSP_CLKR_SRC_CLKX
:
568 err
= omap_mcbsp_6pin_src_mux(mcbsp
, CLKR_SRC_CLKX
);
570 case OMAP_MCBSP_FSR_SRC_FSR
:
571 err
= omap_mcbsp_6pin_src_mux(mcbsp
, FSR_SRC_FSR
);
573 case OMAP_MCBSP_FSR_SRC_FSX
:
574 err
= omap_mcbsp_6pin_src_mux(mcbsp
, FSR_SRC_FSX
);
583 static const struct snd_soc_dai_ops mcbsp_dai_ops
= {
584 .startup
= omap_mcbsp_dai_startup
,
585 .shutdown
= omap_mcbsp_dai_shutdown
,
586 .trigger
= omap_mcbsp_dai_trigger
,
587 .delay
= omap_mcbsp_dai_delay
,
588 .hw_params
= omap_mcbsp_dai_hw_params
,
589 .set_fmt
= omap_mcbsp_dai_set_dai_fmt
,
590 .set_clkdiv
= omap_mcbsp_dai_set_clkdiv
,
591 .set_sysclk
= omap_mcbsp_dai_set_dai_sysclk
,
594 static int omap_mcbsp_probe(struct snd_soc_dai
*dai
)
596 struct omap_mcbsp
*mcbsp
= snd_soc_dai_get_drvdata(dai
);
598 pm_runtime_enable(mcbsp
->dev
);
603 static int omap_mcbsp_remove(struct snd_soc_dai
*dai
)
605 struct omap_mcbsp
*mcbsp
= snd_soc_dai_get_drvdata(dai
);
607 pm_runtime_disable(mcbsp
->dev
);
612 static struct snd_soc_dai_driver omap_mcbsp_dai
= {
613 .probe
= omap_mcbsp_probe
,
614 .remove
= omap_mcbsp_remove
,
618 .rates
= OMAP_MCBSP_RATES
,
619 .formats
= SNDRV_PCM_FMTBIT_S16_LE
| SNDRV_PCM_FMTBIT_S32_LE
,
624 .rates
= OMAP_MCBSP_RATES
,
625 .formats
= SNDRV_PCM_FMTBIT_S16_LE
| SNDRV_PCM_FMTBIT_S32_LE
,
627 .ops
= &mcbsp_dai_ops
,
630 static int omap_mcbsp_st_info_volsw(struct snd_kcontrol
*kcontrol
,
631 struct snd_ctl_elem_info
*uinfo
)
633 struct soc_mixer_control
*mc
=
634 (struct soc_mixer_control
*)kcontrol
->private_value
;
638 uinfo
->type
= SNDRV_CTL_ELEM_TYPE_INTEGER
;
640 uinfo
->value
.integer
.min
= min
;
641 uinfo
->value
.integer
.max
= max
;
645 #define OMAP_MCBSP_ST_SET_CHANNEL_VOLUME(channel) \
647 omap_mcbsp_set_st_ch##channel##_volume(struct snd_kcontrol *kc, \
648 struct snd_ctl_elem_value *uc) \
650 struct snd_soc_dai *cpu_dai = snd_kcontrol_chip(kc); \
651 struct omap_mcbsp *mcbsp = snd_soc_dai_get_drvdata(cpu_dai); \
652 struct soc_mixer_control *mc = \
653 (struct soc_mixer_control *)kc->private_value; \
656 int val = uc->value.integer.value[0]; \
658 if (val < min || val > max) \
661 /* OMAP McBSP implementation uses index values 0..4 */ \
662 return omap_st_set_chgain(mcbsp, channel, val); \
665 #define OMAP_MCBSP_ST_GET_CHANNEL_VOLUME(channel) \
667 omap_mcbsp_get_st_ch##channel##_volume(struct snd_kcontrol *kc, \
668 struct snd_ctl_elem_value *uc) \
670 struct snd_soc_dai *cpu_dai = snd_kcontrol_chip(kc); \
671 struct omap_mcbsp *mcbsp = snd_soc_dai_get_drvdata(cpu_dai); \
674 if (omap_st_get_chgain(mcbsp, channel, &chgain)) \
677 uc->value.integer.value[0] = chgain; \
681 OMAP_MCBSP_ST_SET_CHANNEL_VOLUME(0)
682 OMAP_MCBSP_ST_SET_CHANNEL_VOLUME(1)
683 OMAP_MCBSP_ST_GET_CHANNEL_VOLUME(0)
684 OMAP_MCBSP_ST_GET_CHANNEL_VOLUME(1)
686 static int omap_mcbsp_st_put_mode(struct snd_kcontrol
*kcontrol
,
687 struct snd_ctl_elem_value
*ucontrol
)
689 struct snd_soc_dai
*cpu_dai
= snd_kcontrol_chip(kcontrol
);
690 struct omap_mcbsp
*mcbsp
= snd_soc_dai_get_drvdata(cpu_dai
);
691 u8 value
= ucontrol
->value
.integer
.value
[0];
693 if (value
== omap_st_is_enabled(mcbsp
))
697 omap_st_enable(mcbsp
);
699 omap_st_disable(mcbsp
);
704 static int omap_mcbsp_st_get_mode(struct snd_kcontrol
*kcontrol
,
705 struct snd_ctl_elem_value
*ucontrol
)
707 struct snd_soc_dai
*cpu_dai
= snd_kcontrol_chip(kcontrol
);
708 struct omap_mcbsp
*mcbsp
= snd_soc_dai_get_drvdata(cpu_dai
);
710 ucontrol
->value
.integer
.value
[0] = omap_st_is_enabled(mcbsp
);
714 static const struct snd_kcontrol_new omap_mcbsp2_st_controls
[] = {
715 SOC_SINGLE_EXT("McBSP2 Sidetone Switch", 1, 0, 1, 0,
716 omap_mcbsp_st_get_mode
, omap_mcbsp_st_put_mode
),
717 OMAP_MCBSP_SOC_SINGLE_S16_EXT("McBSP2 Sidetone Channel 0 Volume",
719 omap_mcbsp_get_st_ch0_volume
,
720 omap_mcbsp_set_st_ch0_volume
),
721 OMAP_MCBSP_SOC_SINGLE_S16_EXT("McBSP2 Sidetone Channel 1 Volume",
723 omap_mcbsp_get_st_ch1_volume
,
724 omap_mcbsp_set_st_ch1_volume
),
727 static const struct snd_kcontrol_new omap_mcbsp3_st_controls
[] = {
728 SOC_SINGLE_EXT("McBSP3 Sidetone Switch", 2, 0, 1, 0,
729 omap_mcbsp_st_get_mode
, omap_mcbsp_st_put_mode
),
730 OMAP_MCBSP_SOC_SINGLE_S16_EXT("McBSP3 Sidetone Channel 0 Volume",
732 omap_mcbsp_get_st_ch0_volume
,
733 omap_mcbsp_set_st_ch0_volume
),
734 OMAP_MCBSP_SOC_SINGLE_S16_EXT("McBSP3 Sidetone Channel 1 Volume",
736 omap_mcbsp_get_st_ch1_volume
,
737 omap_mcbsp_set_st_ch1_volume
),
740 int omap_mcbsp_st_add_controls(struct snd_soc_pcm_runtime
*rtd
)
742 struct snd_soc_dai
*cpu_dai
= rtd
->cpu_dai
;
743 struct omap_mcbsp
*mcbsp
= snd_soc_dai_get_drvdata(cpu_dai
);
748 switch (cpu_dai
->id
) {
749 case 2: /* McBSP 2 */
750 return snd_soc_add_dai_controls(cpu_dai
,
751 omap_mcbsp2_st_controls
,
752 ARRAY_SIZE(omap_mcbsp2_st_controls
));
753 case 3: /* McBSP 3 */
754 return snd_soc_add_dai_controls(cpu_dai
,
755 omap_mcbsp3_st_controls
,
756 ARRAY_SIZE(omap_mcbsp3_st_controls
));
763 EXPORT_SYMBOL_GPL(omap_mcbsp_st_add_controls
);
765 static __devinit
int asoc_mcbsp_probe(struct platform_device
*pdev
)
767 struct omap_mcbsp_platform_data
*pdata
= dev_get_platdata(&pdev
->dev
);
768 struct omap_mcbsp
*mcbsp
;
772 dev_err(&pdev
->dev
, "missing platform data.\n");
775 mcbsp
= devm_kzalloc(&pdev
->dev
, sizeof(struct omap_mcbsp
), GFP_KERNEL
);
779 mcbsp
->id
= pdev
->id
;
780 mcbsp
->pdata
= pdata
;
781 mcbsp
->dev
= &pdev
->dev
;
782 platform_set_drvdata(pdev
, mcbsp
);
784 ret
= omap_mcbsp_init(pdev
);
786 return snd_soc_register_dai(&pdev
->dev
, &omap_mcbsp_dai
);
791 static int __devexit
asoc_mcbsp_remove(struct platform_device
*pdev
)
793 struct omap_mcbsp
*mcbsp
= platform_get_drvdata(pdev
);
795 snd_soc_unregister_dai(&pdev
->dev
);
797 if (mcbsp
->pdata
->ops
&& mcbsp
->pdata
->ops
->free
)
798 mcbsp
->pdata
->ops
->free(mcbsp
->id
);
800 omap_mcbsp_sysfs_remove(mcbsp
);
802 clk_put(mcbsp
->fclk
);
804 platform_set_drvdata(pdev
, NULL
);
809 static struct platform_driver asoc_mcbsp_driver
= {
811 .name
= "omap-mcbsp",
812 .owner
= THIS_MODULE
,
815 .probe
= asoc_mcbsp_probe
,
816 .remove
= __devexit_p(asoc_mcbsp_remove
),
819 module_platform_driver(asoc_mcbsp_driver
);
821 MODULE_AUTHOR("Jarkko Nikula <jarkko.nikula@bitmer.com>");
822 MODULE_DESCRIPTION("OMAP I2S SoC Interface");
823 MODULE_LICENSE("GPL");
824 MODULE_ALIAS("platform:omap-mcbsp");