xref: /OK3568_Linux_fs/kernel/sound/soc/intel/keembay/kmb_platform.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun //
3*4882a593Smuzhiyun // Copyright (C) 2020 Intel Corporation.
4*4882a593Smuzhiyun //
5*4882a593Smuzhiyun // Intel KeemBay Platform driver.
6*4882a593Smuzhiyun //
7*4882a593Smuzhiyun 
8*4882a593Smuzhiyun #include <linux/clk.h>
9*4882a593Smuzhiyun #include <linux/io.h>
10*4882a593Smuzhiyun #include <linux/module.h>
11*4882a593Smuzhiyun #include <linux/of.h>
12*4882a593Smuzhiyun #include <linux/of_device.h>
13*4882a593Smuzhiyun #include <sound/pcm.h>
14*4882a593Smuzhiyun #include <sound/pcm_params.h>
15*4882a593Smuzhiyun #include <sound/soc.h>
16*4882a593Smuzhiyun #include "kmb_platform.h"
17*4882a593Smuzhiyun 
18*4882a593Smuzhiyun #define PERIODS_MIN		2
19*4882a593Smuzhiyun #define PERIODS_MAX		48
20*4882a593Smuzhiyun #define PERIOD_BYTES_MIN	4096
21*4882a593Smuzhiyun #define BUFFER_BYTES_MAX	(PERIODS_MAX * PERIOD_BYTES_MIN)
22*4882a593Smuzhiyun #define TDM_OPERATION		5
23*4882a593Smuzhiyun #define I2S_OPERATION		0
24*4882a593Smuzhiyun #define DATA_WIDTH_CONFIG_BIT	6
25*4882a593Smuzhiyun #define TDM_CHANNEL_CONFIG_BIT	3
26*4882a593Smuzhiyun 
27*4882a593Smuzhiyun static const struct snd_pcm_hardware kmb_pcm_hardware = {
28*4882a593Smuzhiyun 	.info = SNDRV_PCM_INFO_INTERLEAVED |
29*4882a593Smuzhiyun 		SNDRV_PCM_INFO_MMAP |
30*4882a593Smuzhiyun 		SNDRV_PCM_INFO_MMAP_VALID |
31*4882a593Smuzhiyun 		SNDRV_PCM_INFO_BATCH |
32*4882a593Smuzhiyun 		SNDRV_PCM_INFO_BLOCK_TRANSFER,
33*4882a593Smuzhiyun 	.rates = SNDRV_PCM_RATE_8000 |
34*4882a593Smuzhiyun 		 SNDRV_PCM_RATE_16000 |
35*4882a593Smuzhiyun 		 SNDRV_PCM_RATE_48000,
36*4882a593Smuzhiyun 	.rate_min = 8000,
37*4882a593Smuzhiyun 	.rate_max = 48000,
38*4882a593Smuzhiyun 	.formats = SNDRV_PCM_FMTBIT_S16_LE |
39*4882a593Smuzhiyun 		   SNDRV_PCM_FMTBIT_S24_LE |
40*4882a593Smuzhiyun 		   SNDRV_PCM_FMTBIT_S32_LE,
41*4882a593Smuzhiyun 	.channels_min = 2,
42*4882a593Smuzhiyun 	.channels_max = 2,
43*4882a593Smuzhiyun 	.buffer_bytes_max = BUFFER_BYTES_MAX,
44*4882a593Smuzhiyun 	.period_bytes_min = PERIOD_BYTES_MIN,
45*4882a593Smuzhiyun 	.period_bytes_max = BUFFER_BYTES_MAX / PERIODS_MIN,
46*4882a593Smuzhiyun 	.periods_min = PERIODS_MIN,
47*4882a593Smuzhiyun 	.periods_max = PERIODS_MAX,
48*4882a593Smuzhiyun 	.fifo_size = 16,
49*4882a593Smuzhiyun };
50*4882a593Smuzhiyun 
kmb_pcm_tx_fn(struct kmb_i2s_info * kmb_i2s,struct snd_pcm_runtime * runtime,unsigned int tx_ptr,bool * period_elapsed)51*4882a593Smuzhiyun static unsigned int kmb_pcm_tx_fn(struct kmb_i2s_info *kmb_i2s,
52*4882a593Smuzhiyun 				  struct snd_pcm_runtime *runtime,
53*4882a593Smuzhiyun 				  unsigned int tx_ptr, bool *period_elapsed)
54*4882a593Smuzhiyun {
55*4882a593Smuzhiyun 	unsigned int period_pos = tx_ptr % runtime->period_size;
56*4882a593Smuzhiyun 	void __iomem *i2s_base = kmb_i2s->i2s_base;
57*4882a593Smuzhiyun 	void *buf = runtime->dma_area;
58*4882a593Smuzhiyun 	int i;
59*4882a593Smuzhiyun 
60*4882a593Smuzhiyun 	/* KMB i2s uses two separate L/R FIFO */
61*4882a593Smuzhiyun 	for (i = 0; i < kmb_i2s->fifo_th; i++) {
62*4882a593Smuzhiyun 		if (kmb_i2s->config.data_width == 16) {
63*4882a593Smuzhiyun 			writel(((u16(*)[2])buf)[tx_ptr][0], i2s_base + LRBR_LTHR(0));
64*4882a593Smuzhiyun 			writel(((u16(*)[2])buf)[tx_ptr][1], i2s_base + RRBR_RTHR(0));
65*4882a593Smuzhiyun 		} else {
66*4882a593Smuzhiyun 			writel(((u32(*)[2])buf)[tx_ptr][0], i2s_base + LRBR_LTHR(0));
67*4882a593Smuzhiyun 			writel(((u32(*)[2])buf)[tx_ptr][1], i2s_base + RRBR_RTHR(0));
68*4882a593Smuzhiyun 		}
69*4882a593Smuzhiyun 
70*4882a593Smuzhiyun 		period_pos++;
71*4882a593Smuzhiyun 
72*4882a593Smuzhiyun 		if (++tx_ptr >= runtime->buffer_size)
73*4882a593Smuzhiyun 			tx_ptr = 0;
74*4882a593Smuzhiyun 	}
75*4882a593Smuzhiyun 
76*4882a593Smuzhiyun 	*period_elapsed = period_pos >= runtime->period_size;
77*4882a593Smuzhiyun 
78*4882a593Smuzhiyun 	return tx_ptr;
79*4882a593Smuzhiyun }
80*4882a593Smuzhiyun 
kmb_pcm_rx_fn(struct kmb_i2s_info * kmb_i2s,struct snd_pcm_runtime * runtime,unsigned int rx_ptr,bool * period_elapsed)81*4882a593Smuzhiyun static unsigned int kmb_pcm_rx_fn(struct kmb_i2s_info *kmb_i2s,
82*4882a593Smuzhiyun 				  struct snd_pcm_runtime *runtime,
83*4882a593Smuzhiyun 				  unsigned int rx_ptr, bool *period_elapsed)
84*4882a593Smuzhiyun {
85*4882a593Smuzhiyun 	unsigned int period_pos = rx_ptr % runtime->period_size;
86*4882a593Smuzhiyun 	void __iomem *i2s_base = kmb_i2s->i2s_base;
87*4882a593Smuzhiyun 	int chan = kmb_i2s->config.chan_nr;
88*4882a593Smuzhiyun 	void *buf = runtime->dma_area;
89*4882a593Smuzhiyun 	int i, j;
90*4882a593Smuzhiyun 
91*4882a593Smuzhiyun 	/* KMB i2s uses two separate L/R FIFO */
92*4882a593Smuzhiyun 	for (i = 0; i < kmb_i2s->fifo_th; i++) {
93*4882a593Smuzhiyun 		for (j = 0; j < chan / 2; j++) {
94*4882a593Smuzhiyun 			if (kmb_i2s->config.data_width == 16) {
95*4882a593Smuzhiyun 				((u16 *)buf)[rx_ptr * chan + (j * 2)] =
96*4882a593Smuzhiyun 						readl(i2s_base + LRBR_LTHR(j));
97*4882a593Smuzhiyun 				((u16 *)buf)[rx_ptr * chan + ((j * 2) + 1)] =
98*4882a593Smuzhiyun 						readl(i2s_base + RRBR_RTHR(j));
99*4882a593Smuzhiyun 			} else {
100*4882a593Smuzhiyun 				((u32 *)buf)[rx_ptr * chan + (j * 2)] =
101*4882a593Smuzhiyun 						readl(i2s_base + LRBR_LTHR(j));
102*4882a593Smuzhiyun 				((u32 *)buf)[rx_ptr * chan + ((j * 2) + 1)] =
103*4882a593Smuzhiyun 						readl(i2s_base + RRBR_RTHR(j));
104*4882a593Smuzhiyun 			}
105*4882a593Smuzhiyun 		}
106*4882a593Smuzhiyun 		period_pos++;
107*4882a593Smuzhiyun 
108*4882a593Smuzhiyun 		if (++rx_ptr >= runtime->buffer_size)
109*4882a593Smuzhiyun 			rx_ptr = 0;
110*4882a593Smuzhiyun 	}
111*4882a593Smuzhiyun 
112*4882a593Smuzhiyun 	*period_elapsed = period_pos >= runtime->period_size;
113*4882a593Smuzhiyun 
114*4882a593Smuzhiyun 	return rx_ptr;
115*4882a593Smuzhiyun }
116*4882a593Smuzhiyun 
kmb_i2s_disable_channels(struct kmb_i2s_info * kmb_i2s,u32 stream)117*4882a593Smuzhiyun static inline void kmb_i2s_disable_channels(struct kmb_i2s_info *kmb_i2s,
118*4882a593Smuzhiyun 					    u32 stream)
119*4882a593Smuzhiyun {
120*4882a593Smuzhiyun 	u32 i;
121*4882a593Smuzhiyun 
122*4882a593Smuzhiyun 	/* Disable all channels regardless of configuration*/
123*4882a593Smuzhiyun 	if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
124*4882a593Smuzhiyun 		for (i = 0; i < MAX_ISR; i++)
125*4882a593Smuzhiyun 			writel(0, kmb_i2s->i2s_base + TER(i));
126*4882a593Smuzhiyun 	} else {
127*4882a593Smuzhiyun 		for (i = 0; i < MAX_ISR; i++)
128*4882a593Smuzhiyun 			writel(0, kmb_i2s->i2s_base + RER(i));
129*4882a593Smuzhiyun 	}
130*4882a593Smuzhiyun }
131*4882a593Smuzhiyun 
kmb_i2s_clear_irqs(struct kmb_i2s_info * kmb_i2s,u32 stream)132*4882a593Smuzhiyun static inline void kmb_i2s_clear_irqs(struct kmb_i2s_info *kmb_i2s, u32 stream)
133*4882a593Smuzhiyun {
134*4882a593Smuzhiyun 	struct i2s_clk_config_data *config = &kmb_i2s->config;
135*4882a593Smuzhiyun 	u32 i;
136*4882a593Smuzhiyun 
137*4882a593Smuzhiyun 	if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
138*4882a593Smuzhiyun 		for (i = 0; i < config->chan_nr / 2; i++)
139*4882a593Smuzhiyun 			readl(kmb_i2s->i2s_base + TOR(i));
140*4882a593Smuzhiyun 	} else {
141*4882a593Smuzhiyun 		for (i = 0; i < config->chan_nr / 2; i++)
142*4882a593Smuzhiyun 			readl(kmb_i2s->i2s_base + ROR(i));
143*4882a593Smuzhiyun 	}
144*4882a593Smuzhiyun }
145*4882a593Smuzhiyun 
kmb_i2s_irq_trigger(struct kmb_i2s_info * kmb_i2s,u32 stream,int chan_nr,bool trigger)146*4882a593Smuzhiyun static inline void kmb_i2s_irq_trigger(struct kmb_i2s_info *kmb_i2s,
147*4882a593Smuzhiyun 				       u32 stream, int chan_nr, bool trigger)
148*4882a593Smuzhiyun {
149*4882a593Smuzhiyun 	u32 i, irq;
150*4882a593Smuzhiyun 	u32 flag;
151*4882a593Smuzhiyun 
152*4882a593Smuzhiyun 	if (stream == SNDRV_PCM_STREAM_PLAYBACK)
153*4882a593Smuzhiyun 		flag = TX_INT_FLAG;
154*4882a593Smuzhiyun 	else
155*4882a593Smuzhiyun 		flag = RX_INT_FLAG;
156*4882a593Smuzhiyun 
157*4882a593Smuzhiyun 	for (i = 0; i < chan_nr / 2; i++) {
158*4882a593Smuzhiyun 		irq = readl(kmb_i2s->i2s_base + IMR(i));
159*4882a593Smuzhiyun 
160*4882a593Smuzhiyun 		if (trigger)
161*4882a593Smuzhiyun 			irq = irq & ~flag;
162*4882a593Smuzhiyun 		else
163*4882a593Smuzhiyun 			irq = irq | flag;
164*4882a593Smuzhiyun 
165*4882a593Smuzhiyun 		writel(irq, kmb_i2s->i2s_base + IMR(i));
166*4882a593Smuzhiyun 	}
167*4882a593Smuzhiyun }
168*4882a593Smuzhiyun 
kmb_pcm_operation(struct kmb_i2s_info * kmb_i2s,bool playback)169*4882a593Smuzhiyun static void kmb_pcm_operation(struct kmb_i2s_info *kmb_i2s, bool playback)
170*4882a593Smuzhiyun {
171*4882a593Smuzhiyun 	struct snd_pcm_substream *substream;
172*4882a593Smuzhiyun 	bool period_elapsed;
173*4882a593Smuzhiyun 	unsigned int new_ptr;
174*4882a593Smuzhiyun 	unsigned int ptr;
175*4882a593Smuzhiyun 
176*4882a593Smuzhiyun 	if (playback)
177*4882a593Smuzhiyun 		substream = kmb_i2s->tx_substream;
178*4882a593Smuzhiyun 	else
179*4882a593Smuzhiyun 		substream = kmb_i2s->rx_substream;
180*4882a593Smuzhiyun 
181*4882a593Smuzhiyun 	if (!substream || !snd_pcm_running(substream))
182*4882a593Smuzhiyun 		return;
183*4882a593Smuzhiyun 
184*4882a593Smuzhiyun 	if (playback) {
185*4882a593Smuzhiyun 		ptr = kmb_i2s->tx_ptr;
186*4882a593Smuzhiyun 		new_ptr = kmb_pcm_tx_fn(kmb_i2s, substream->runtime,
187*4882a593Smuzhiyun 					ptr, &period_elapsed);
188*4882a593Smuzhiyun 		cmpxchg(&kmb_i2s->tx_ptr, ptr, new_ptr);
189*4882a593Smuzhiyun 	} else {
190*4882a593Smuzhiyun 		ptr = kmb_i2s->rx_ptr;
191*4882a593Smuzhiyun 		new_ptr = kmb_pcm_rx_fn(kmb_i2s, substream->runtime,
192*4882a593Smuzhiyun 					ptr, &period_elapsed);
193*4882a593Smuzhiyun 		cmpxchg(&kmb_i2s->rx_ptr, ptr, new_ptr);
194*4882a593Smuzhiyun 	}
195*4882a593Smuzhiyun 
196*4882a593Smuzhiyun 	if (period_elapsed)
197*4882a593Smuzhiyun 		snd_pcm_period_elapsed(substream);
198*4882a593Smuzhiyun }
199*4882a593Smuzhiyun 
kmb_pcm_open(struct snd_soc_component * component,struct snd_pcm_substream * substream)200*4882a593Smuzhiyun static int kmb_pcm_open(struct snd_soc_component *component,
201*4882a593Smuzhiyun 			struct snd_pcm_substream *substream)
202*4882a593Smuzhiyun {
203*4882a593Smuzhiyun 	struct snd_pcm_runtime *runtime = substream->runtime;
204*4882a593Smuzhiyun 	struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
205*4882a593Smuzhiyun 	struct kmb_i2s_info *kmb_i2s;
206*4882a593Smuzhiyun 
207*4882a593Smuzhiyun 	kmb_i2s = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0));
208*4882a593Smuzhiyun 	snd_soc_set_runtime_hwparams(substream, &kmb_pcm_hardware);
209*4882a593Smuzhiyun 	snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS);
210*4882a593Smuzhiyun 	runtime->private_data = kmb_i2s;
211*4882a593Smuzhiyun 
212*4882a593Smuzhiyun 	return 0;
213*4882a593Smuzhiyun }
214*4882a593Smuzhiyun 
kmb_pcm_trigger(struct snd_soc_component * component,struct snd_pcm_substream * substream,int cmd)215*4882a593Smuzhiyun static int kmb_pcm_trigger(struct snd_soc_component *component,
216*4882a593Smuzhiyun 			   struct snd_pcm_substream *substream, int cmd)
217*4882a593Smuzhiyun {
218*4882a593Smuzhiyun 	struct snd_pcm_runtime *runtime = substream->runtime;
219*4882a593Smuzhiyun 	struct kmb_i2s_info *kmb_i2s = runtime->private_data;
220*4882a593Smuzhiyun 
221*4882a593Smuzhiyun 	switch (cmd) {
222*4882a593Smuzhiyun 	case SNDRV_PCM_TRIGGER_START:
223*4882a593Smuzhiyun 		if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
224*4882a593Smuzhiyun 			kmb_i2s->tx_ptr = 0;
225*4882a593Smuzhiyun 			kmb_i2s->tx_substream = substream;
226*4882a593Smuzhiyun 		} else {
227*4882a593Smuzhiyun 			kmb_i2s->rx_ptr = 0;
228*4882a593Smuzhiyun 			kmb_i2s->rx_substream = substream;
229*4882a593Smuzhiyun 		}
230*4882a593Smuzhiyun 		break;
231*4882a593Smuzhiyun 	case SNDRV_PCM_TRIGGER_STOP:
232*4882a593Smuzhiyun 		if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
233*4882a593Smuzhiyun 			kmb_i2s->tx_substream = NULL;
234*4882a593Smuzhiyun 		else
235*4882a593Smuzhiyun 			kmb_i2s->rx_substream = NULL;
236*4882a593Smuzhiyun 		break;
237*4882a593Smuzhiyun 	default:
238*4882a593Smuzhiyun 		return -EINVAL;
239*4882a593Smuzhiyun 	}
240*4882a593Smuzhiyun 
241*4882a593Smuzhiyun 	return 0;
242*4882a593Smuzhiyun }
243*4882a593Smuzhiyun 
kmb_i2s_irq_handler(int irq,void * dev_id)244*4882a593Smuzhiyun static irqreturn_t kmb_i2s_irq_handler(int irq, void *dev_id)
245*4882a593Smuzhiyun {
246*4882a593Smuzhiyun 	struct kmb_i2s_info *kmb_i2s = dev_id;
247*4882a593Smuzhiyun 	struct i2s_clk_config_data *config = &kmb_i2s->config;
248*4882a593Smuzhiyun 	irqreturn_t ret = IRQ_NONE;
249*4882a593Smuzhiyun 	u32 tx_enabled = 0;
250*4882a593Smuzhiyun 	u32 isr[4];
251*4882a593Smuzhiyun 	int i;
252*4882a593Smuzhiyun 
253*4882a593Smuzhiyun 	for (i = 0; i < config->chan_nr / 2; i++)
254*4882a593Smuzhiyun 		isr[i] = readl(kmb_i2s->i2s_base + ISR(i));
255*4882a593Smuzhiyun 
256*4882a593Smuzhiyun 	kmb_i2s_clear_irqs(kmb_i2s, SNDRV_PCM_STREAM_PLAYBACK);
257*4882a593Smuzhiyun 	kmb_i2s_clear_irqs(kmb_i2s, SNDRV_PCM_STREAM_CAPTURE);
258*4882a593Smuzhiyun 	/* Only check TX interrupt if TX is active */
259*4882a593Smuzhiyun 	tx_enabled = readl(kmb_i2s->i2s_base + ITER);
260*4882a593Smuzhiyun 
261*4882a593Smuzhiyun 	/*
262*4882a593Smuzhiyun 	 * Data available. Retrieve samples from FIFO
263*4882a593Smuzhiyun 	 */
264*4882a593Smuzhiyun 
265*4882a593Smuzhiyun 	/*
266*4882a593Smuzhiyun 	 * 8 channel audio will have isr[0..2] triggered,
267*4882a593Smuzhiyun 	 * reading the specific isr based on the audio configuration,
268*4882a593Smuzhiyun 	 * to avoid reading the buffers too early.
269*4882a593Smuzhiyun 	 */
270*4882a593Smuzhiyun 	switch (config->chan_nr) {
271*4882a593Smuzhiyun 	case 2:
272*4882a593Smuzhiyun 		if (isr[0] & ISR_RXDA)
273*4882a593Smuzhiyun 			kmb_pcm_operation(kmb_i2s, false);
274*4882a593Smuzhiyun 		ret = IRQ_HANDLED;
275*4882a593Smuzhiyun 		break;
276*4882a593Smuzhiyun 	case 4:
277*4882a593Smuzhiyun 		if (isr[1] & ISR_RXDA)
278*4882a593Smuzhiyun 			kmb_pcm_operation(kmb_i2s, false);
279*4882a593Smuzhiyun 		ret = IRQ_HANDLED;
280*4882a593Smuzhiyun 		break;
281*4882a593Smuzhiyun 	case 8:
282*4882a593Smuzhiyun 		if (isr[3] & ISR_RXDA)
283*4882a593Smuzhiyun 			kmb_pcm_operation(kmb_i2s, false);
284*4882a593Smuzhiyun 		ret = IRQ_HANDLED;
285*4882a593Smuzhiyun 		break;
286*4882a593Smuzhiyun 	}
287*4882a593Smuzhiyun 
288*4882a593Smuzhiyun 	for (i = 0; i < config->chan_nr / 2; i++) {
289*4882a593Smuzhiyun 		/*
290*4882a593Smuzhiyun 		 * Check if TX fifo is empty. If empty fill FIFO with samples
291*4882a593Smuzhiyun 		 */
292*4882a593Smuzhiyun 		if ((isr[i] & ISR_TXFE) && tx_enabled) {
293*4882a593Smuzhiyun 			kmb_pcm_operation(kmb_i2s, true);
294*4882a593Smuzhiyun 			ret = IRQ_HANDLED;
295*4882a593Smuzhiyun 		}
296*4882a593Smuzhiyun 
297*4882a593Smuzhiyun 		/* Error Handling: TX */
298*4882a593Smuzhiyun 		if (isr[i] & ISR_TXFO) {
299*4882a593Smuzhiyun 			dev_dbg(kmb_i2s->dev, "TX overrun (ch_id=%d)\n", i);
300*4882a593Smuzhiyun 			ret = IRQ_HANDLED;
301*4882a593Smuzhiyun 		}
302*4882a593Smuzhiyun 		/* Error Handling: RX */
303*4882a593Smuzhiyun 		if (isr[i] & ISR_RXFO) {
304*4882a593Smuzhiyun 			dev_dbg(kmb_i2s->dev, "RX overrun (ch_id=%d)\n", i);
305*4882a593Smuzhiyun 			ret = IRQ_HANDLED;
306*4882a593Smuzhiyun 		}
307*4882a593Smuzhiyun 	}
308*4882a593Smuzhiyun 
309*4882a593Smuzhiyun 	return ret;
310*4882a593Smuzhiyun }
311*4882a593Smuzhiyun 
kmb_platform_pcm_new(struct snd_soc_component * component,struct snd_soc_pcm_runtime * soc_runtime)312*4882a593Smuzhiyun static int kmb_platform_pcm_new(struct snd_soc_component *component,
313*4882a593Smuzhiyun 				struct snd_soc_pcm_runtime *soc_runtime)
314*4882a593Smuzhiyun {
315*4882a593Smuzhiyun 	size_t size = kmb_pcm_hardware.buffer_bytes_max;
316*4882a593Smuzhiyun 	/* Use SNDRV_DMA_TYPE_CONTINUOUS as KMB doesn't use PCI sg buffer */
317*4882a593Smuzhiyun 	snd_pcm_set_managed_buffer_all(soc_runtime->pcm,
318*4882a593Smuzhiyun 				       SNDRV_DMA_TYPE_CONTINUOUS,
319*4882a593Smuzhiyun 				       NULL, size, size);
320*4882a593Smuzhiyun 	return 0;
321*4882a593Smuzhiyun }
322*4882a593Smuzhiyun 
kmb_pcm_pointer(struct snd_soc_component * component,struct snd_pcm_substream * substream)323*4882a593Smuzhiyun static snd_pcm_uframes_t kmb_pcm_pointer(struct snd_soc_component *component,
324*4882a593Smuzhiyun 					 struct snd_pcm_substream *substream)
325*4882a593Smuzhiyun {
326*4882a593Smuzhiyun 	struct snd_pcm_runtime *runtime = substream->runtime;
327*4882a593Smuzhiyun 	struct kmb_i2s_info *kmb_i2s = runtime->private_data;
328*4882a593Smuzhiyun 	snd_pcm_uframes_t pos;
329*4882a593Smuzhiyun 
330*4882a593Smuzhiyun 	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
331*4882a593Smuzhiyun 		pos = kmb_i2s->tx_ptr;
332*4882a593Smuzhiyun 	else
333*4882a593Smuzhiyun 		pos = kmb_i2s->rx_ptr;
334*4882a593Smuzhiyun 
335*4882a593Smuzhiyun 	return pos < runtime->buffer_size ? pos : 0;
336*4882a593Smuzhiyun }
337*4882a593Smuzhiyun 
338*4882a593Smuzhiyun static const struct snd_soc_component_driver kmb_component = {
339*4882a593Smuzhiyun 	.name		= "kmb",
340*4882a593Smuzhiyun 	.pcm_construct	= kmb_platform_pcm_new,
341*4882a593Smuzhiyun 	.open		= kmb_pcm_open,
342*4882a593Smuzhiyun 	.trigger	= kmb_pcm_trigger,
343*4882a593Smuzhiyun 	.pointer	= kmb_pcm_pointer,
344*4882a593Smuzhiyun };
345*4882a593Smuzhiyun 
kmb_i2s_start(struct kmb_i2s_info * kmb_i2s,struct snd_pcm_substream * substream)346*4882a593Smuzhiyun static void kmb_i2s_start(struct kmb_i2s_info *kmb_i2s,
347*4882a593Smuzhiyun 			  struct snd_pcm_substream *substream)
348*4882a593Smuzhiyun {
349*4882a593Smuzhiyun 	struct i2s_clk_config_data *config = &kmb_i2s->config;
350*4882a593Smuzhiyun 
351*4882a593Smuzhiyun 	/* I2S Programming sequence in Keem_Bay_VPU_DB_v1.1 */
352*4882a593Smuzhiyun 	writel(1, kmb_i2s->i2s_base + IER);
353*4882a593Smuzhiyun 
354*4882a593Smuzhiyun 	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
355*4882a593Smuzhiyun 		writel(1, kmb_i2s->i2s_base + ITER);
356*4882a593Smuzhiyun 	else
357*4882a593Smuzhiyun 		writel(1, kmb_i2s->i2s_base + IRER);
358*4882a593Smuzhiyun 
359*4882a593Smuzhiyun 	kmb_i2s_irq_trigger(kmb_i2s, substream->stream, config->chan_nr, true);
360*4882a593Smuzhiyun 
361*4882a593Smuzhiyun 	if (kmb_i2s->master)
362*4882a593Smuzhiyun 		writel(1, kmb_i2s->i2s_base + CER);
363*4882a593Smuzhiyun 	else
364*4882a593Smuzhiyun 		writel(0, kmb_i2s->i2s_base + CER);
365*4882a593Smuzhiyun }
366*4882a593Smuzhiyun 
kmb_i2s_stop(struct kmb_i2s_info * kmb_i2s,struct snd_pcm_substream * substream)367*4882a593Smuzhiyun static void kmb_i2s_stop(struct kmb_i2s_info *kmb_i2s,
368*4882a593Smuzhiyun 			 struct snd_pcm_substream *substream)
369*4882a593Smuzhiyun {
370*4882a593Smuzhiyun 	/* I2S Programming sequence in Keem_Bay_VPU_DB_v1.1 */
371*4882a593Smuzhiyun 	kmb_i2s_clear_irqs(kmb_i2s, substream->stream);
372*4882a593Smuzhiyun 
373*4882a593Smuzhiyun 	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
374*4882a593Smuzhiyun 		writel(0, kmb_i2s->i2s_base + ITER);
375*4882a593Smuzhiyun 	else
376*4882a593Smuzhiyun 		writel(0, kmb_i2s->i2s_base + IRER);
377*4882a593Smuzhiyun 
378*4882a593Smuzhiyun 	kmb_i2s_irq_trigger(kmb_i2s, substream->stream, 8, false);
379*4882a593Smuzhiyun 
380*4882a593Smuzhiyun 	if (!kmb_i2s->active) {
381*4882a593Smuzhiyun 		writel(0, kmb_i2s->i2s_base + CER);
382*4882a593Smuzhiyun 		writel(0, kmb_i2s->i2s_base + IER);
383*4882a593Smuzhiyun 	}
384*4882a593Smuzhiyun }
385*4882a593Smuzhiyun 
kmb_disable_clk(void * clk)386*4882a593Smuzhiyun static void kmb_disable_clk(void *clk)
387*4882a593Smuzhiyun {
388*4882a593Smuzhiyun 	clk_disable_unprepare(clk);
389*4882a593Smuzhiyun }
390*4882a593Smuzhiyun 
kmb_set_dai_fmt(struct snd_soc_dai * cpu_dai,unsigned int fmt)391*4882a593Smuzhiyun static int kmb_set_dai_fmt(struct snd_soc_dai *cpu_dai, unsigned int fmt)
392*4882a593Smuzhiyun {
393*4882a593Smuzhiyun 	struct kmb_i2s_info *kmb_i2s = snd_soc_dai_get_drvdata(cpu_dai);
394*4882a593Smuzhiyun 	int ret;
395*4882a593Smuzhiyun 
396*4882a593Smuzhiyun 	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
397*4882a593Smuzhiyun 	case SND_SOC_DAIFMT_CBM_CFM:
398*4882a593Smuzhiyun 		kmb_i2s->master = false;
399*4882a593Smuzhiyun 		ret = 0;
400*4882a593Smuzhiyun 		break;
401*4882a593Smuzhiyun 	case SND_SOC_DAIFMT_CBS_CFS:
402*4882a593Smuzhiyun 		writel(MASTER_MODE, kmb_i2s->pss_base + I2S_GEN_CFG_0);
403*4882a593Smuzhiyun 
404*4882a593Smuzhiyun 		ret = clk_prepare_enable(kmb_i2s->clk_i2s);
405*4882a593Smuzhiyun 		if (ret < 0)
406*4882a593Smuzhiyun 			return ret;
407*4882a593Smuzhiyun 
408*4882a593Smuzhiyun 		ret = devm_add_action_or_reset(kmb_i2s->dev, kmb_disable_clk,
409*4882a593Smuzhiyun 					       kmb_i2s->clk_i2s);
410*4882a593Smuzhiyun 		if (ret)
411*4882a593Smuzhiyun 			return ret;
412*4882a593Smuzhiyun 
413*4882a593Smuzhiyun 		kmb_i2s->master = true;
414*4882a593Smuzhiyun 		break;
415*4882a593Smuzhiyun 	default:
416*4882a593Smuzhiyun 		return -EINVAL;
417*4882a593Smuzhiyun 	}
418*4882a593Smuzhiyun 
419*4882a593Smuzhiyun 	return ret;
420*4882a593Smuzhiyun }
421*4882a593Smuzhiyun 
kmb_dai_trigger(struct snd_pcm_substream * substream,int cmd,struct snd_soc_dai * cpu_dai)422*4882a593Smuzhiyun static int kmb_dai_trigger(struct snd_pcm_substream *substream,
423*4882a593Smuzhiyun 			   int cmd, struct snd_soc_dai *cpu_dai)
424*4882a593Smuzhiyun {
425*4882a593Smuzhiyun 	struct kmb_i2s_info *kmb_i2s  = snd_soc_dai_get_drvdata(cpu_dai);
426*4882a593Smuzhiyun 
427*4882a593Smuzhiyun 	switch (cmd) {
428*4882a593Smuzhiyun 	case SNDRV_PCM_TRIGGER_START:
429*4882a593Smuzhiyun 		/* Keep track of i2s activity before turn off
430*4882a593Smuzhiyun 		 * the i2s interface
431*4882a593Smuzhiyun 		 */
432*4882a593Smuzhiyun 		kmb_i2s->active++;
433*4882a593Smuzhiyun 		kmb_i2s_start(kmb_i2s, substream);
434*4882a593Smuzhiyun 		break;
435*4882a593Smuzhiyun 	case SNDRV_PCM_TRIGGER_STOP:
436*4882a593Smuzhiyun 		kmb_i2s->active--;
437*4882a593Smuzhiyun 		kmb_i2s_stop(kmb_i2s, substream);
438*4882a593Smuzhiyun 		break;
439*4882a593Smuzhiyun 	default:
440*4882a593Smuzhiyun 		return  -EINVAL;
441*4882a593Smuzhiyun 	}
442*4882a593Smuzhiyun 
443*4882a593Smuzhiyun 	return 0;
444*4882a593Smuzhiyun }
445*4882a593Smuzhiyun 
kmb_i2s_config(struct kmb_i2s_info * kmb_i2s,int stream)446*4882a593Smuzhiyun static void kmb_i2s_config(struct kmb_i2s_info *kmb_i2s, int stream)
447*4882a593Smuzhiyun {
448*4882a593Smuzhiyun 	struct i2s_clk_config_data *config = &kmb_i2s->config;
449*4882a593Smuzhiyun 	u32 ch_reg;
450*4882a593Smuzhiyun 
451*4882a593Smuzhiyun 	kmb_i2s_disable_channels(kmb_i2s, stream);
452*4882a593Smuzhiyun 
453*4882a593Smuzhiyun 	for (ch_reg = 0; ch_reg < config->chan_nr / 2; ch_reg++) {
454*4882a593Smuzhiyun 		if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
455*4882a593Smuzhiyun 			writel(kmb_i2s->xfer_resolution,
456*4882a593Smuzhiyun 			       kmb_i2s->i2s_base + TCR(ch_reg));
457*4882a593Smuzhiyun 
458*4882a593Smuzhiyun 			writel(kmb_i2s->fifo_th - 1,
459*4882a593Smuzhiyun 			       kmb_i2s->i2s_base + TFCR(ch_reg));
460*4882a593Smuzhiyun 
461*4882a593Smuzhiyun 			writel(1, kmb_i2s->i2s_base + TER(ch_reg));
462*4882a593Smuzhiyun 		} else {
463*4882a593Smuzhiyun 			writel(kmb_i2s->xfer_resolution,
464*4882a593Smuzhiyun 			       kmb_i2s->i2s_base + RCR(ch_reg));
465*4882a593Smuzhiyun 
466*4882a593Smuzhiyun 			writel(kmb_i2s->fifo_th - 1,
467*4882a593Smuzhiyun 			       kmb_i2s->i2s_base + RFCR(ch_reg));
468*4882a593Smuzhiyun 
469*4882a593Smuzhiyun 			writel(1, kmb_i2s->i2s_base + RER(ch_reg));
470*4882a593Smuzhiyun 		}
471*4882a593Smuzhiyun 	}
472*4882a593Smuzhiyun }
473*4882a593Smuzhiyun 
kmb_dai_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * hw_params,struct snd_soc_dai * cpu_dai)474*4882a593Smuzhiyun static int kmb_dai_hw_params(struct snd_pcm_substream *substream,
475*4882a593Smuzhiyun 			     struct snd_pcm_hw_params *hw_params,
476*4882a593Smuzhiyun 			     struct snd_soc_dai *cpu_dai)
477*4882a593Smuzhiyun {
478*4882a593Smuzhiyun 	struct kmb_i2s_info *kmb_i2s = snd_soc_dai_get_drvdata(cpu_dai);
479*4882a593Smuzhiyun 	struct i2s_clk_config_data *config = &kmb_i2s->config;
480*4882a593Smuzhiyun 	u32 write_val;
481*4882a593Smuzhiyun 	int ret;
482*4882a593Smuzhiyun 
483*4882a593Smuzhiyun 	switch (params_format(hw_params)) {
484*4882a593Smuzhiyun 	case SNDRV_PCM_FORMAT_S16_LE:
485*4882a593Smuzhiyun 		config->data_width = 16;
486*4882a593Smuzhiyun 		kmb_i2s->ccr = 0x00;
487*4882a593Smuzhiyun 		kmb_i2s->xfer_resolution = 0x02;
488*4882a593Smuzhiyun 		break;
489*4882a593Smuzhiyun 	case SNDRV_PCM_FORMAT_S24_LE:
490*4882a593Smuzhiyun 		config->data_width = 32;
491*4882a593Smuzhiyun 		kmb_i2s->ccr = 0x14;
492*4882a593Smuzhiyun 		kmb_i2s->xfer_resolution = 0x05;
493*4882a593Smuzhiyun 		break;
494*4882a593Smuzhiyun 	case SNDRV_PCM_FORMAT_S32_LE:
495*4882a593Smuzhiyun 		config->data_width = 32;
496*4882a593Smuzhiyun 		kmb_i2s->ccr = 0x10;
497*4882a593Smuzhiyun 		kmb_i2s->xfer_resolution = 0x05;
498*4882a593Smuzhiyun 		break;
499*4882a593Smuzhiyun 	default:
500*4882a593Smuzhiyun 		dev_err(kmb_i2s->dev, "kmb: unsupported PCM fmt");
501*4882a593Smuzhiyun 		return -EINVAL;
502*4882a593Smuzhiyun 	}
503*4882a593Smuzhiyun 
504*4882a593Smuzhiyun 	config->chan_nr = params_channels(hw_params);
505*4882a593Smuzhiyun 
506*4882a593Smuzhiyun 	switch (config->chan_nr) {
507*4882a593Smuzhiyun 	case 8:
508*4882a593Smuzhiyun 	case 4:
509*4882a593Smuzhiyun 		/*
510*4882a593Smuzhiyun 		 * Platform is not capable of providing clocks for
511*4882a593Smuzhiyun 		 * multi channel audio
512*4882a593Smuzhiyun 		 */
513*4882a593Smuzhiyun 		if (kmb_i2s->master)
514*4882a593Smuzhiyun 			return -EINVAL;
515*4882a593Smuzhiyun 
516*4882a593Smuzhiyun 		write_val = ((config->chan_nr / 2) << TDM_CHANNEL_CONFIG_BIT) |
517*4882a593Smuzhiyun 				(config->data_width << DATA_WIDTH_CONFIG_BIT) |
518*4882a593Smuzhiyun 				TDM_OPERATION;
519*4882a593Smuzhiyun 
520*4882a593Smuzhiyun 		writel(write_val, kmb_i2s->pss_base + I2S_GEN_CFG_0);
521*4882a593Smuzhiyun 		break;
522*4882a593Smuzhiyun 	case 2:
523*4882a593Smuzhiyun 		/*
524*4882a593Smuzhiyun 		 * Platform is only capable of providing clocks need for
525*4882a593Smuzhiyun 		 * 2 channel master mode
526*4882a593Smuzhiyun 		 */
527*4882a593Smuzhiyun 		if (!(kmb_i2s->master))
528*4882a593Smuzhiyun 			return -EINVAL;
529*4882a593Smuzhiyun 
530*4882a593Smuzhiyun 		write_val = ((config->chan_nr / 2) << TDM_CHANNEL_CONFIG_BIT) |
531*4882a593Smuzhiyun 				(config->data_width << DATA_WIDTH_CONFIG_BIT) |
532*4882a593Smuzhiyun 				MASTER_MODE | I2S_OPERATION;
533*4882a593Smuzhiyun 
534*4882a593Smuzhiyun 		writel(write_val, kmb_i2s->pss_base + I2S_GEN_CFG_0);
535*4882a593Smuzhiyun 		break;
536*4882a593Smuzhiyun 	default:
537*4882a593Smuzhiyun 		dev_dbg(kmb_i2s->dev, "channel not supported\n");
538*4882a593Smuzhiyun 		return -EINVAL;
539*4882a593Smuzhiyun 	}
540*4882a593Smuzhiyun 
541*4882a593Smuzhiyun 	kmb_i2s_config(kmb_i2s, substream->stream);
542*4882a593Smuzhiyun 
543*4882a593Smuzhiyun 	writel(kmb_i2s->ccr, kmb_i2s->i2s_base + CCR);
544*4882a593Smuzhiyun 
545*4882a593Smuzhiyun 	config->sample_rate = params_rate(hw_params);
546*4882a593Smuzhiyun 
547*4882a593Smuzhiyun 	if (kmb_i2s->master) {
548*4882a593Smuzhiyun 		/* Only 2 ch supported in Master mode */
549*4882a593Smuzhiyun 		u32 bitclk = config->sample_rate * config->data_width * 2;
550*4882a593Smuzhiyun 
551*4882a593Smuzhiyun 		ret = clk_set_rate(kmb_i2s->clk_i2s, bitclk);
552*4882a593Smuzhiyun 		if (ret) {
553*4882a593Smuzhiyun 			dev_err(kmb_i2s->dev,
554*4882a593Smuzhiyun 				"Can't set I2S clock rate: %d\n", ret);
555*4882a593Smuzhiyun 			return ret;
556*4882a593Smuzhiyun 		}
557*4882a593Smuzhiyun 	}
558*4882a593Smuzhiyun 
559*4882a593Smuzhiyun 	return 0;
560*4882a593Smuzhiyun }
561*4882a593Smuzhiyun 
kmb_dai_prepare(struct snd_pcm_substream * substream,struct snd_soc_dai * cpu_dai)562*4882a593Smuzhiyun static int kmb_dai_prepare(struct snd_pcm_substream *substream,
563*4882a593Smuzhiyun 			   struct snd_soc_dai *cpu_dai)
564*4882a593Smuzhiyun {
565*4882a593Smuzhiyun 	struct kmb_i2s_info *kmb_i2s = snd_soc_dai_get_drvdata(cpu_dai);
566*4882a593Smuzhiyun 
567*4882a593Smuzhiyun 	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
568*4882a593Smuzhiyun 		writel(1, kmb_i2s->i2s_base + TXFFR);
569*4882a593Smuzhiyun 	else
570*4882a593Smuzhiyun 		writel(1, kmb_i2s->i2s_base + RXFFR);
571*4882a593Smuzhiyun 
572*4882a593Smuzhiyun 	return 0;
573*4882a593Smuzhiyun }
574*4882a593Smuzhiyun 
575*4882a593Smuzhiyun static struct snd_soc_dai_ops kmb_dai_ops = {
576*4882a593Smuzhiyun 	.trigger	= kmb_dai_trigger,
577*4882a593Smuzhiyun 	.hw_params	= kmb_dai_hw_params,
578*4882a593Smuzhiyun 	.prepare	= kmb_dai_prepare,
579*4882a593Smuzhiyun 	.set_fmt	= kmb_set_dai_fmt,
580*4882a593Smuzhiyun };
581*4882a593Smuzhiyun 
582*4882a593Smuzhiyun static struct snd_soc_dai_driver intel_kmb_i2s_dai[] = {
583*4882a593Smuzhiyun 	{
584*4882a593Smuzhiyun 		.name = "intel_kmb_i2s",
585*4882a593Smuzhiyun 		.playback = {
586*4882a593Smuzhiyun 			.channels_min = 2,
587*4882a593Smuzhiyun 			.channels_max = 2,
588*4882a593Smuzhiyun 			.rates = SNDRV_PCM_RATE_8000 |
589*4882a593Smuzhiyun 				 SNDRV_PCM_RATE_16000 |
590*4882a593Smuzhiyun 				 SNDRV_PCM_RATE_48000,
591*4882a593Smuzhiyun 			.rate_min = 8000,
592*4882a593Smuzhiyun 			.rate_max = 48000,
593*4882a593Smuzhiyun 			.formats = (SNDRV_PCM_FMTBIT_S32_LE |
594*4882a593Smuzhiyun 				    SNDRV_PCM_FMTBIT_S24_LE |
595*4882a593Smuzhiyun 				    SNDRV_PCM_FMTBIT_S16_LE),
596*4882a593Smuzhiyun 		},
597*4882a593Smuzhiyun 		.capture = {
598*4882a593Smuzhiyun 			.channels_min = 2,
599*4882a593Smuzhiyun 			.channels_max = 2,
600*4882a593Smuzhiyun 			.rates = SNDRV_PCM_RATE_8000 |
601*4882a593Smuzhiyun 				 SNDRV_PCM_RATE_16000 |
602*4882a593Smuzhiyun 				 SNDRV_PCM_RATE_48000,
603*4882a593Smuzhiyun 			.rate_min = 8000,
604*4882a593Smuzhiyun 			.rate_max = 48000,
605*4882a593Smuzhiyun 			.formats = (SNDRV_PCM_FMTBIT_S32_LE |
606*4882a593Smuzhiyun 				    SNDRV_PCM_FMTBIT_S24_LE |
607*4882a593Smuzhiyun 				    SNDRV_PCM_FMTBIT_S16_LE),
608*4882a593Smuzhiyun 		},
609*4882a593Smuzhiyun 		.ops = &kmb_dai_ops,
610*4882a593Smuzhiyun 	},
611*4882a593Smuzhiyun };
612*4882a593Smuzhiyun 
613*4882a593Smuzhiyun static struct snd_soc_dai_driver intel_kmb_tdm_dai[] = {
614*4882a593Smuzhiyun 	{
615*4882a593Smuzhiyun 		.name = "intel_kmb_tdm",
616*4882a593Smuzhiyun 		.capture = {
617*4882a593Smuzhiyun 			.channels_min = 4,
618*4882a593Smuzhiyun 			.channels_max = 8,
619*4882a593Smuzhiyun 			.rates = SNDRV_PCM_RATE_8000 |
620*4882a593Smuzhiyun 				 SNDRV_PCM_RATE_16000 |
621*4882a593Smuzhiyun 				 SNDRV_PCM_RATE_48000,
622*4882a593Smuzhiyun 			.rate_min = 8000,
623*4882a593Smuzhiyun 			.rate_max = 48000,
624*4882a593Smuzhiyun 			.formats = (SNDRV_PCM_FMTBIT_S32_LE |
625*4882a593Smuzhiyun 				    SNDRV_PCM_FMTBIT_S24_LE |
626*4882a593Smuzhiyun 				    SNDRV_PCM_FMTBIT_S16_LE),
627*4882a593Smuzhiyun 		},
628*4882a593Smuzhiyun 		.ops = &kmb_dai_ops,
629*4882a593Smuzhiyun 	},
630*4882a593Smuzhiyun };
631*4882a593Smuzhiyun 
632*4882a593Smuzhiyun static const struct of_device_id kmb_plat_of_match[] = {
633*4882a593Smuzhiyun 	{ .compatible = "intel,keembay-i2s", .data = &intel_kmb_i2s_dai},
634*4882a593Smuzhiyun 	{ .compatible = "intel,keembay-tdm", .data = &intel_kmb_tdm_dai},
635*4882a593Smuzhiyun 	{}
636*4882a593Smuzhiyun };
637*4882a593Smuzhiyun 
kmb_plat_dai_probe(struct platform_device * pdev)638*4882a593Smuzhiyun static int kmb_plat_dai_probe(struct platform_device *pdev)
639*4882a593Smuzhiyun {
640*4882a593Smuzhiyun 	struct snd_soc_dai_driver *kmb_i2s_dai;
641*4882a593Smuzhiyun 	const struct of_device_id *match;
642*4882a593Smuzhiyun 	struct device *dev = &pdev->dev;
643*4882a593Smuzhiyun 	struct kmb_i2s_info *kmb_i2s;
644*4882a593Smuzhiyun 	int ret, irq;
645*4882a593Smuzhiyun 	u32 comp1_reg;
646*4882a593Smuzhiyun 
647*4882a593Smuzhiyun 	kmb_i2s = devm_kzalloc(dev, sizeof(*kmb_i2s), GFP_KERNEL);
648*4882a593Smuzhiyun 	if (!kmb_i2s)
649*4882a593Smuzhiyun 		return -ENOMEM;
650*4882a593Smuzhiyun 
651*4882a593Smuzhiyun 	kmb_i2s_dai = devm_kzalloc(dev, sizeof(*kmb_i2s_dai), GFP_KERNEL);
652*4882a593Smuzhiyun 	if (!kmb_i2s_dai)
653*4882a593Smuzhiyun 		return -ENOMEM;
654*4882a593Smuzhiyun 
655*4882a593Smuzhiyun 	match = of_match_device(kmb_plat_of_match, &pdev->dev);
656*4882a593Smuzhiyun 	if (!match) {
657*4882a593Smuzhiyun 		dev_err(&pdev->dev, "Error: No device match found\n");
658*4882a593Smuzhiyun 		return -ENODEV;
659*4882a593Smuzhiyun 	}
660*4882a593Smuzhiyun 	kmb_i2s_dai = (struct snd_soc_dai_driver *) match->data;
661*4882a593Smuzhiyun 
662*4882a593Smuzhiyun 	/* Prepare the related clocks */
663*4882a593Smuzhiyun 	kmb_i2s->clk_apb = devm_clk_get(dev, "apb_clk");
664*4882a593Smuzhiyun 	if (IS_ERR(kmb_i2s->clk_apb)) {
665*4882a593Smuzhiyun 		dev_err(dev, "Failed to get apb clock\n");
666*4882a593Smuzhiyun 		return PTR_ERR(kmb_i2s->clk_apb);
667*4882a593Smuzhiyun 	}
668*4882a593Smuzhiyun 
669*4882a593Smuzhiyun 	ret = clk_prepare_enable(kmb_i2s->clk_apb);
670*4882a593Smuzhiyun 	if (ret < 0)
671*4882a593Smuzhiyun 		return ret;
672*4882a593Smuzhiyun 
673*4882a593Smuzhiyun 	ret = devm_add_action_or_reset(dev, kmb_disable_clk, kmb_i2s->clk_apb);
674*4882a593Smuzhiyun 	if (ret) {
675*4882a593Smuzhiyun 		dev_err(dev, "Failed to add clk_apb reset action\n");
676*4882a593Smuzhiyun 		return ret;
677*4882a593Smuzhiyun 	}
678*4882a593Smuzhiyun 
679*4882a593Smuzhiyun 	kmb_i2s->clk_i2s = devm_clk_get(dev, "osc");
680*4882a593Smuzhiyun 	if (IS_ERR(kmb_i2s->clk_i2s)) {
681*4882a593Smuzhiyun 		dev_err(dev, "Failed to get osc clock\n");
682*4882a593Smuzhiyun 		return PTR_ERR(kmb_i2s->clk_i2s);
683*4882a593Smuzhiyun 	}
684*4882a593Smuzhiyun 
685*4882a593Smuzhiyun 	kmb_i2s->i2s_base = devm_platform_ioremap_resource(pdev, 0);
686*4882a593Smuzhiyun 	if (IS_ERR(kmb_i2s->i2s_base))
687*4882a593Smuzhiyun 		return PTR_ERR(kmb_i2s->i2s_base);
688*4882a593Smuzhiyun 
689*4882a593Smuzhiyun 	kmb_i2s->pss_base = devm_platform_ioremap_resource(pdev, 1);
690*4882a593Smuzhiyun 	if (IS_ERR(kmb_i2s->pss_base))
691*4882a593Smuzhiyun 		return PTR_ERR(kmb_i2s->pss_base);
692*4882a593Smuzhiyun 
693*4882a593Smuzhiyun 	kmb_i2s->dev = &pdev->dev;
694*4882a593Smuzhiyun 
695*4882a593Smuzhiyun 	irq = platform_get_irq_optional(pdev, 0);
696*4882a593Smuzhiyun 	if (irq > 0) {
697*4882a593Smuzhiyun 		ret = devm_request_irq(dev, irq, kmb_i2s_irq_handler, 0,
698*4882a593Smuzhiyun 				       pdev->name, kmb_i2s);
699*4882a593Smuzhiyun 		if (ret < 0) {
700*4882a593Smuzhiyun 			dev_err(dev, "failed to request irq\n");
701*4882a593Smuzhiyun 			return ret;
702*4882a593Smuzhiyun 		}
703*4882a593Smuzhiyun 	}
704*4882a593Smuzhiyun 
705*4882a593Smuzhiyun 	comp1_reg = readl(kmb_i2s->i2s_base + I2S_COMP_PARAM_1);
706*4882a593Smuzhiyun 
707*4882a593Smuzhiyun 	kmb_i2s->fifo_th = (1 << COMP1_FIFO_DEPTH(comp1_reg)) / 2;
708*4882a593Smuzhiyun 
709*4882a593Smuzhiyun 	ret = devm_snd_soc_register_component(dev, &kmb_component,
710*4882a593Smuzhiyun 					      kmb_i2s_dai, 1);
711*4882a593Smuzhiyun 	if (ret) {
712*4882a593Smuzhiyun 		dev_err(dev, "not able to register dai\n");
713*4882a593Smuzhiyun 		return ret;
714*4882a593Smuzhiyun 	}
715*4882a593Smuzhiyun 
716*4882a593Smuzhiyun 	/* To ensure none of the channels are enabled at boot up */
717*4882a593Smuzhiyun 	kmb_i2s_disable_channels(kmb_i2s, SNDRV_PCM_STREAM_PLAYBACK);
718*4882a593Smuzhiyun 	kmb_i2s_disable_channels(kmb_i2s, SNDRV_PCM_STREAM_CAPTURE);
719*4882a593Smuzhiyun 
720*4882a593Smuzhiyun 	dev_set_drvdata(dev, kmb_i2s);
721*4882a593Smuzhiyun 
722*4882a593Smuzhiyun 	return ret;
723*4882a593Smuzhiyun }
724*4882a593Smuzhiyun 
725*4882a593Smuzhiyun static struct platform_driver kmb_plat_dai_driver = {
726*4882a593Smuzhiyun 	.driver		= {
727*4882a593Smuzhiyun 		.name		= "kmb-plat-dai",
728*4882a593Smuzhiyun 		.of_match_table = kmb_plat_of_match,
729*4882a593Smuzhiyun 	},
730*4882a593Smuzhiyun 	.probe		= kmb_plat_dai_probe,
731*4882a593Smuzhiyun };
732*4882a593Smuzhiyun 
733*4882a593Smuzhiyun module_platform_driver(kmb_plat_dai_driver);
734*4882a593Smuzhiyun 
735*4882a593Smuzhiyun MODULE_DESCRIPTION("ASoC Intel KeemBay Platform driver");
736*4882a593Smuzhiyun MODULE_AUTHOR("Sia Jee Heng <jee.heng.sia@intel.com>");
737*4882a593Smuzhiyun MODULE_AUTHOR("Sit, Michael Wei Hong <michael.wei.hong.sit@intel.com>");
738*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
739*4882a593Smuzhiyun MODULE_ALIAS("platform:kmb_platform");
740