1 // SPDX-License-Identifier: GPL-2.0-only
2 // Copyright (C) 2014-2015 Broadcom Corporation
3 #include <linux/clk.h>
4 #include <linux/delay.h>
5 #include <linux/init.h>
6 #include <linux/io.h>
7 #include <linux/module.h>
8 #include <linux/of_device.h>
9 #include <linux/slab.h>
10 #include <sound/core.h>
11 #include <sound/pcm.h>
12 #include <sound/pcm_params.h>
13 #include <sound/soc.h>
14 #include <sound/soc-dai.h>
15
16 #include "cygnus-ssp.h"
17
18 #define DEFAULT_VCO 1354750204
19
20 #define CAPTURE_FCI_ID_BASE 0x180
21 #define CYGNUS_SSP_TRISTATE_MASK 0x001fff
22 #define CYGNUS_PLLCLKSEL_MASK 0xf
23
24 /* Used with stream_on field to indicate which streams are active */
25 #define PLAYBACK_STREAM_MASK BIT(0)
26 #define CAPTURE_STREAM_MASK BIT(1)
27
28 #define I2S_STREAM_CFG_MASK 0xff003ff
29 #define I2S_CAP_STREAM_CFG_MASK 0xf0
30 #define SPDIF_STREAM_CFG_MASK 0x3ff
31 #define CH_GRP_STEREO 0x1
32
33 /* Begin register offset defines */
34 #define AUD_MISC_SEROUT_OE_REG_BASE 0x01c
35 #define AUD_MISC_SEROUT_SPDIF_OE 12
36 #define AUD_MISC_SEROUT_MCLK_OE 3
37 #define AUD_MISC_SEROUT_LRCK_OE 2
38 #define AUD_MISC_SEROUT_SCLK_OE 1
39 #define AUD_MISC_SEROUT_SDAT_OE 0
40
41 /* AUD_FMM_BF_CTRL_xxx regs */
42 #define BF_DST_CFG0_OFFSET 0x100
43 #define BF_DST_CFG1_OFFSET 0x104
44 #define BF_DST_CFG2_OFFSET 0x108
45
46 #define BF_DST_CTRL0_OFFSET 0x130
47 #define BF_DST_CTRL1_OFFSET 0x134
48 #define BF_DST_CTRL2_OFFSET 0x138
49
50 #define BF_SRC_CFG0_OFFSET 0x148
51 #define BF_SRC_CFG1_OFFSET 0x14c
52 #define BF_SRC_CFG2_OFFSET 0x150
53 #define BF_SRC_CFG3_OFFSET 0x154
54
55 #define BF_SRC_CTRL0_OFFSET 0x1c0
56 #define BF_SRC_CTRL1_OFFSET 0x1c4
57 #define BF_SRC_CTRL2_OFFSET 0x1c8
58 #define BF_SRC_CTRL3_OFFSET 0x1cc
59
60 #define BF_SRC_GRP0_OFFSET 0x1fc
61 #define BF_SRC_GRP1_OFFSET 0x200
62 #define BF_SRC_GRP2_OFFSET 0x204
63 #define BF_SRC_GRP3_OFFSET 0x208
64
65 #define BF_SRC_GRP_EN_OFFSET 0x320
66 #define BF_SRC_GRP_FLOWON_OFFSET 0x324
67 #define BF_SRC_GRP_SYNC_DIS_OFFSET 0x328
68
69 /* AUD_FMM_IOP_OUT_I2S_xxx regs */
70 #define OUT_I2S_0_STREAM_CFG_OFFSET 0xa00
71 #define OUT_I2S_0_CFG_OFFSET 0xa04
72 #define OUT_I2S_0_MCLK_CFG_OFFSET 0xa0c
73
74 #define OUT_I2S_1_STREAM_CFG_OFFSET 0xa40
75 #define OUT_I2S_1_CFG_OFFSET 0xa44
76 #define OUT_I2S_1_MCLK_CFG_OFFSET 0xa4c
77
78 #define OUT_I2S_2_STREAM_CFG_OFFSET 0xa80
79 #define OUT_I2S_2_CFG_OFFSET 0xa84
80 #define OUT_I2S_2_MCLK_CFG_OFFSET 0xa8c
81
82 /* AUD_FMM_IOP_OUT_SPDIF_xxx regs */
83 #define SPDIF_STREAM_CFG_OFFSET 0xac0
84 #define SPDIF_CTRL_OFFSET 0xac4
85 #define SPDIF_FORMAT_CFG_OFFSET 0xad8
86 #define SPDIF_MCLK_CFG_OFFSET 0xadc
87
88 /* AUD_FMM_IOP_PLL_0_xxx regs */
89 #define IOP_PLL_0_MACRO_OFFSET 0xb00
90 #define IOP_PLL_0_MDIV_Ch0_OFFSET 0xb14
91 #define IOP_PLL_0_MDIV_Ch1_OFFSET 0xb18
92 #define IOP_PLL_0_MDIV_Ch2_OFFSET 0xb1c
93
94 #define IOP_PLL_0_ACTIVE_MDIV_Ch0_OFFSET 0xb30
95 #define IOP_PLL_0_ACTIVE_MDIV_Ch1_OFFSET 0xb34
96 #define IOP_PLL_0_ACTIVE_MDIV_Ch2_OFFSET 0xb38
97
98 /* AUD_FMM_IOP_xxx regs */
99 #define IOP_PLL_0_CONTROL_OFFSET 0xb04
100 #define IOP_PLL_0_USER_NDIV_OFFSET 0xb08
101 #define IOP_PLL_0_ACTIVE_NDIV_OFFSET 0xb20
102 #define IOP_PLL_0_RESET_OFFSET 0xb5c
103
104 /* AUD_FMM_IOP_IN_I2S_xxx regs */
105 #define IN_I2S_0_STREAM_CFG_OFFSET 0x00
106 #define IN_I2S_0_CFG_OFFSET 0x04
107 #define IN_I2S_1_STREAM_CFG_OFFSET 0x40
108 #define IN_I2S_1_CFG_OFFSET 0x44
109 #define IN_I2S_2_STREAM_CFG_OFFSET 0x80
110 #define IN_I2S_2_CFG_OFFSET 0x84
111
112 /* AUD_FMM_IOP_MISC_xxx regs */
113 #define IOP_SW_INIT_LOGIC 0x1c0
114
115 /* End register offset defines */
116
117
118 /* AUD_FMM_IOP_OUT_I2S_x_MCLK_CFG_0_REG */
119 #define I2S_OUT_MCLKRATE_SHIFT 16
120
121 /* AUD_FMM_IOP_OUT_I2S_x_MCLK_CFG_REG */
122 #define I2S_OUT_PLLCLKSEL_SHIFT 0
123
124 /* AUD_FMM_IOP_OUT_I2S_x_STREAM_CFG */
125 #define I2S_OUT_STREAM_ENA 31
126 #define I2S_OUT_STREAM_CFG_GROUP_ID 20
127 #define I2S_OUT_STREAM_CFG_CHANNEL_GROUPING 24
128
129 /* AUD_FMM_IOP_IN_I2S_x_CAP */
130 #define I2S_IN_STREAM_CFG_CAP_ENA 31
131 #define I2S_IN_STREAM_CFG_0_GROUP_ID 4
132
133 /* AUD_FMM_IOP_OUT_I2S_x_I2S_CFG_REG */
134 #define I2S_OUT_CFGX_CLK_ENA 0
135 #define I2S_OUT_CFGX_DATA_ENABLE 1
136 #define I2S_OUT_CFGX_DATA_ALIGNMENT 6
137 #define I2S_OUT_CFGX_BITS_PER_SLOT 13
138 #define I2S_OUT_CFGX_VALID_SLOT 14
139 #define I2S_OUT_CFGX_FSYNC_WIDTH 18
140 #define I2S_OUT_CFGX_SCLKS_PER_1FS_DIV32 26
141 #define I2S_OUT_CFGX_SLAVE_MODE 30
142 #define I2S_OUT_CFGX_TDM_MODE 31
143
144 /* AUD_FMM_BF_CTRL_SOURCECH_CFGx_REG */
145 #define BF_SRC_CFGX_SFIFO_ENA 0
146 #define BF_SRC_CFGX_BUFFER_PAIR_ENABLE 1
147 #define BF_SRC_CFGX_SAMPLE_CH_MODE 2
148 #define BF_SRC_CFGX_SFIFO_SZ_DOUBLE 5
149 #define BF_SRC_CFGX_NOT_PAUSE_WHEN_EMPTY 10
150 #define BF_SRC_CFGX_BIT_RES 20
151 #define BF_SRC_CFGX_PROCESS_SEQ_ID_VALID 31
152
153 /* AUD_FMM_BF_CTRL_DESTCH_CFGx_REG */
154 #define BF_DST_CFGX_CAP_ENA 0
155 #define BF_DST_CFGX_BUFFER_PAIR_ENABLE 1
156 #define BF_DST_CFGX_DFIFO_SZ_DOUBLE 2
157 #define BF_DST_CFGX_NOT_PAUSE_WHEN_FULL 11
158 #define BF_DST_CFGX_FCI_ID 12
159 #define BF_DST_CFGX_CAP_MODE 24
160 #define BF_DST_CFGX_PROC_SEQ_ID_VALID 31
161
162 /* AUD_FMM_IOP_OUT_SPDIF_xxx */
163 #define SPDIF_0_OUT_DITHER_ENA 3
164 #define SPDIF_0_OUT_STREAM_ENA 31
165
166 /* AUD_FMM_IOP_PLL_0_USER */
167 #define IOP_PLL_0_USER_NDIV_FRAC 10
168
169 /* AUD_FMM_IOP_PLL_0_ACTIVE */
170 #define IOP_PLL_0_ACTIVE_NDIV_FRAC 10
171
172
173 #define INIT_SSP_REGS(num) (struct cygnus_ssp_regs){ \
174 .i2s_stream_cfg = OUT_I2S_ ##num## _STREAM_CFG_OFFSET, \
175 .i2s_cap_stream_cfg = IN_I2S_ ##num## _STREAM_CFG_OFFSET, \
176 .i2s_cfg = OUT_I2S_ ##num## _CFG_OFFSET, \
177 .i2s_cap_cfg = IN_I2S_ ##num## _CFG_OFFSET, \
178 .i2s_mclk_cfg = OUT_I2S_ ##num## _MCLK_CFG_OFFSET, \
179 .bf_destch_ctrl = BF_DST_CTRL ##num## _OFFSET, \
180 .bf_destch_cfg = BF_DST_CFG ##num## _OFFSET, \
181 .bf_sourcech_ctrl = BF_SRC_CTRL ##num## _OFFSET, \
182 .bf_sourcech_cfg = BF_SRC_CFG ##num## _OFFSET, \
183 .bf_sourcech_grp = BF_SRC_GRP ##num## _OFFSET \
184 }
185
186 struct pll_macro_entry {
187 u32 mclk;
188 u32 pll_ch_num;
189 };
190
191 /*
192 * PLL has 3 output channels (1x, 2x, and 4x). Below are
193 * the common MCLK frequencies used by audio driver
194 */
195 static const struct pll_macro_entry pll_predef_mclk[] = {
196 { 4096000, 0},
197 { 8192000, 1},
198 {16384000, 2},
199
200 { 5644800, 0},
201 {11289600, 1},
202 {22579200, 2},
203
204 { 6144000, 0},
205 {12288000, 1},
206 {24576000, 2},
207
208 {12288000, 0},
209 {24576000, 1},
210 {49152000, 2},
211
212 {22579200, 0},
213 {45158400, 1},
214 {90316800, 2},
215
216 {24576000, 0},
217 {49152000, 1},
218 {98304000, 2},
219 };
220
221 #define CYGNUS_RATE_MIN 8000
222 #define CYGNUS_RATE_MAX 384000
223
224 /* List of valid frame sizes for tdm mode */
225 static const int ssp_valid_tdm_framesize[] = {32, 64, 128, 256, 512};
226
227 static const unsigned int cygnus_rates[] = {
228 8000, 11025, 16000, 22050, 32000, 44100, 48000,
229 88200, 96000, 176400, 192000, 352800, 384000
230 };
231
232 static const struct snd_pcm_hw_constraint_list cygnus_rate_constraint = {
233 .count = ARRAY_SIZE(cygnus_rates),
234 .list = cygnus_rates,
235 };
236
cygnus_dai_get_portinfo(struct snd_soc_dai * dai)237 static struct cygnus_aio_port *cygnus_dai_get_portinfo(struct snd_soc_dai *dai)
238 {
239 struct cygnus_audio *cygaud = snd_soc_dai_get_drvdata(dai);
240
241 return &cygaud->portinfo[dai->id];
242 }
243
audio_ssp_init_portregs(struct cygnus_aio_port * aio)244 static int audio_ssp_init_portregs(struct cygnus_aio_port *aio)
245 {
246 u32 value, fci_id;
247 int status = 0;
248
249 switch (aio->port_type) {
250 case PORT_TDM:
251 value = readl(aio->cygaud->audio + aio->regs.i2s_stream_cfg);
252 value &= ~I2S_STREAM_CFG_MASK;
253
254 /* Set Group ID */
255 writel(aio->portnum,
256 aio->cygaud->audio + aio->regs.bf_sourcech_grp);
257
258 /* Configure the AUD_FMM_IOP_OUT_I2S_x_STREAM_CFG reg */
259 value |= aio->portnum << I2S_OUT_STREAM_CFG_GROUP_ID;
260 value |= aio->portnum; /* FCI ID is the port num */
261 value |= CH_GRP_STEREO << I2S_OUT_STREAM_CFG_CHANNEL_GROUPING;
262 writel(value, aio->cygaud->audio + aio->regs.i2s_stream_cfg);
263
264 /* Configure the AUD_FMM_BF_CTRL_SOURCECH_CFGX reg */
265 value = readl(aio->cygaud->audio + aio->regs.bf_sourcech_cfg);
266 value &= ~BIT(BF_SRC_CFGX_NOT_PAUSE_WHEN_EMPTY);
267 value |= BIT(BF_SRC_CFGX_SFIFO_SZ_DOUBLE);
268 value |= BIT(BF_SRC_CFGX_PROCESS_SEQ_ID_VALID);
269 writel(value, aio->cygaud->audio + aio->regs.bf_sourcech_cfg);
270
271 /* Configure the AUD_FMM_IOP_IN_I2S_x_CAP_STREAM_CFG_0 reg */
272 value = readl(aio->cygaud->i2s_in +
273 aio->regs.i2s_cap_stream_cfg);
274 value &= ~I2S_CAP_STREAM_CFG_MASK;
275 value |= aio->portnum << I2S_IN_STREAM_CFG_0_GROUP_ID;
276 writel(value, aio->cygaud->i2s_in +
277 aio->regs.i2s_cap_stream_cfg);
278
279 /* Configure the AUD_FMM_BF_CTRL_DESTCH_CFGX_REG_BASE reg */
280 fci_id = CAPTURE_FCI_ID_BASE + aio->portnum;
281
282 value = readl(aio->cygaud->audio + aio->regs.bf_destch_cfg);
283 value |= BIT(BF_DST_CFGX_DFIFO_SZ_DOUBLE);
284 value &= ~BIT(BF_DST_CFGX_NOT_PAUSE_WHEN_FULL);
285 value |= (fci_id << BF_DST_CFGX_FCI_ID);
286 value |= BIT(BF_DST_CFGX_PROC_SEQ_ID_VALID);
287 writel(value, aio->cygaud->audio + aio->regs.bf_destch_cfg);
288
289 /* Enable the transmit pin for this port */
290 value = readl(aio->cygaud->audio + AUD_MISC_SEROUT_OE_REG_BASE);
291 value &= ~BIT((aio->portnum * 4) + AUD_MISC_SEROUT_SDAT_OE);
292 writel(value, aio->cygaud->audio + AUD_MISC_SEROUT_OE_REG_BASE);
293 break;
294 case PORT_SPDIF:
295 writel(aio->portnum, aio->cygaud->audio + BF_SRC_GRP3_OFFSET);
296
297 value = readl(aio->cygaud->audio + SPDIF_CTRL_OFFSET);
298 value |= BIT(SPDIF_0_OUT_DITHER_ENA);
299 writel(value, aio->cygaud->audio + SPDIF_CTRL_OFFSET);
300
301 /* Enable and set the FCI ID for the SPDIF channel */
302 value = readl(aio->cygaud->audio + SPDIF_STREAM_CFG_OFFSET);
303 value &= ~SPDIF_STREAM_CFG_MASK;
304 value |= aio->portnum; /* FCI ID is the port num */
305 value |= BIT(SPDIF_0_OUT_STREAM_ENA);
306 writel(value, aio->cygaud->audio + SPDIF_STREAM_CFG_OFFSET);
307
308 value = readl(aio->cygaud->audio + aio->regs.bf_sourcech_cfg);
309 value &= ~BIT(BF_SRC_CFGX_NOT_PAUSE_WHEN_EMPTY);
310 value |= BIT(BF_SRC_CFGX_SFIFO_SZ_DOUBLE);
311 value |= BIT(BF_SRC_CFGX_PROCESS_SEQ_ID_VALID);
312 writel(value, aio->cygaud->audio + aio->regs.bf_sourcech_cfg);
313
314 /* Enable the spdif output pin */
315 value = readl(aio->cygaud->audio + AUD_MISC_SEROUT_OE_REG_BASE);
316 value &= ~BIT(AUD_MISC_SEROUT_SPDIF_OE);
317 writel(value, aio->cygaud->audio + AUD_MISC_SEROUT_OE_REG_BASE);
318 break;
319 default:
320 dev_err(aio->cygaud->dev, "Port not supported\n");
321 status = -EINVAL;
322 }
323
324 return status;
325 }
326
audio_ssp_in_enable(struct cygnus_aio_port * aio)327 static void audio_ssp_in_enable(struct cygnus_aio_port *aio)
328 {
329 u32 value;
330
331 value = readl(aio->cygaud->audio + aio->regs.bf_destch_cfg);
332 value |= BIT(BF_DST_CFGX_CAP_ENA);
333 writel(value, aio->cygaud->audio + aio->regs.bf_destch_cfg);
334
335 writel(0x1, aio->cygaud->audio + aio->regs.bf_destch_ctrl);
336
337 value = readl(aio->cygaud->audio + aio->regs.i2s_cfg);
338 value |= BIT(I2S_OUT_CFGX_CLK_ENA);
339 value |= BIT(I2S_OUT_CFGX_DATA_ENABLE);
340 writel(value, aio->cygaud->audio + aio->regs.i2s_cfg);
341
342 value = readl(aio->cygaud->i2s_in + aio->regs.i2s_cap_stream_cfg);
343 value |= BIT(I2S_IN_STREAM_CFG_CAP_ENA);
344 writel(value, aio->cygaud->i2s_in + aio->regs.i2s_cap_stream_cfg);
345
346 aio->streams_on |= CAPTURE_STREAM_MASK;
347 }
348
audio_ssp_in_disable(struct cygnus_aio_port * aio)349 static void audio_ssp_in_disable(struct cygnus_aio_port *aio)
350 {
351 u32 value;
352
353 value = readl(aio->cygaud->i2s_in + aio->regs.i2s_cap_stream_cfg);
354 value &= ~BIT(I2S_IN_STREAM_CFG_CAP_ENA);
355 writel(value, aio->cygaud->i2s_in + aio->regs.i2s_cap_stream_cfg);
356
357 aio->streams_on &= ~CAPTURE_STREAM_MASK;
358
359 /* If both playback and capture are off */
360 if (!aio->streams_on) {
361 value = readl(aio->cygaud->audio + aio->regs.i2s_cfg);
362 value &= ~BIT(I2S_OUT_CFGX_CLK_ENA);
363 value &= ~BIT(I2S_OUT_CFGX_DATA_ENABLE);
364 writel(value, aio->cygaud->audio + aio->regs.i2s_cfg);
365 }
366
367 writel(0x0, aio->cygaud->audio + aio->regs.bf_destch_ctrl);
368
369 value = readl(aio->cygaud->audio + aio->regs.bf_destch_cfg);
370 value &= ~BIT(BF_DST_CFGX_CAP_ENA);
371 writel(value, aio->cygaud->audio + aio->regs.bf_destch_cfg);
372 }
373
audio_ssp_out_enable(struct cygnus_aio_port * aio)374 static int audio_ssp_out_enable(struct cygnus_aio_port *aio)
375 {
376 u32 value;
377 int status = 0;
378
379 switch (aio->port_type) {
380 case PORT_TDM:
381 value = readl(aio->cygaud->audio + aio->regs.i2s_stream_cfg);
382 value |= BIT(I2S_OUT_STREAM_ENA);
383 writel(value, aio->cygaud->audio + aio->regs.i2s_stream_cfg);
384
385 writel(1, aio->cygaud->audio + aio->regs.bf_sourcech_ctrl);
386
387 value = readl(aio->cygaud->audio + aio->regs.i2s_cfg);
388 value |= BIT(I2S_OUT_CFGX_CLK_ENA);
389 value |= BIT(I2S_OUT_CFGX_DATA_ENABLE);
390 writel(value, aio->cygaud->audio + aio->regs.i2s_cfg);
391
392 value = readl(aio->cygaud->audio + aio->regs.bf_sourcech_cfg);
393 value |= BIT(BF_SRC_CFGX_SFIFO_ENA);
394 writel(value, aio->cygaud->audio + aio->regs.bf_sourcech_cfg);
395
396 aio->streams_on |= PLAYBACK_STREAM_MASK;
397 break;
398 case PORT_SPDIF:
399 value = readl(aio->cygaud->audio + SPDIF_FORMAT_CFG_OFFSET);
400 value |= 0x3;
401 writel(value, aio->cygaud->audio + SPDIF_FORMAT_CFG_OFFSET);
402
403 writel(1, aio->cygaud->audio + aio->regs.bf_sourcech_ctrl);
404
405 value = readl(aio->cygaud->audio + aio->regs.bf_sourcech_cfg);
406 value |= BIT(BF_SRC_CFGX_SFIFO_ENA);
407 writel(value, aio->cygaud->audio + aio->regs.bf_sourcech_cfg);
408 break;
409 default:
410 dev_err(aio->cygaud->dev,
411 "Port not supported %d\n", aio->portnum);
412 status = -EINVAL;
413 }
414
415 return status;
416 }
417
audio_ssp_out_disable(struct cygnus_aio_port * aio)418 static int audio_ssp_out_disable(struct cygnus_aio_port *aio)
419 {
420 u32 value;
421 int status = 0;
422
423 switch (aio->port_type) {
424 case PORT_TDM:
425 aio->streams_on &= ~PLAYBACK_STREAM_MASK;
426
427 /* If both playback and capture are off */
428 if (!aio->streams_on) {
429 value = readl(aio->cygaud->audio + aio->regs.i2s_cfg);
430 value &= ~BIT(I2S_OUT_CFGX_CLK_ENA);
431 value &= ~BIT(I2S_OUT_CFGX_DATA_ENABLE);
432 writel(value, aio->cygaud->audio + aio->regs.i2s_cfg);
433 }
434
435 /* set group_sync_dis = 1 */
436 value = readl(aio->cygaud->audio + BF_SRC_GRP_SYNC_DIS_OFFSET);
437 value |= BIT(aio->portnum);
438 writel(value, aio->cygaud->audio + BF_SRC_GRP_SYNC_DIS_OFFSET);
439
440 writel(0, aio->cygaud->audio + aio->regs.bf_sourcech_ctrl);
441
442 value = readl(aio->cygaud->audio + aio->regs.bf_sourcech_cfg);
443 value &= ~BIT(BF_SRC_CFGX_SFIFO_ENA);
444 writel(value, aio->cygaud->audio + aio->regs.bf_sourcech_cfg);
445
446 /* set group_sync_dis = 0 */
447 value = readl(aio->cygaud->audio + BF_SRC_GRP_SYNC_DIS_OFFSET);
448 value &= ~BIT(aio->portnum);
449 writel(value, aio->cygaud->audio + BF_SRC_GRP_SYNC_DIS_OFFSET);
450
451 value = readl(aio->cygaud->audio + aio->regs.i2s_stream_cfg);
452 value &= ~BIT(I2S_OUT_STREAM_ENA);
453 writel(value, aio->cygaud->audio + aio->regs.i2s_stream_cfg);
454
455 /* IOP SW INIT on OUT_I2S_x */
456 value = readl(aio->cygaud->i2s_in + IOP_SW_INIT_LOGIC);
457 value |= BIT(aio->portnum);
458 writel(value, aio->cygaud->i2s_in + IOP_SW_INIT_LOGIC);
459 value &= ~BIT(aio->portnum);
460 writel(value, aio->cygaud->i2s_in + IOP_SW_INIT_LOGIC);
461 break;
462 case PORT_SPDIF:
463 value = readl(aio->cygaud->audio + SPDIF_FORMAT_CFG_OFFSET);
464 value &= ~0x3;
465 writel(value, aio->cygaud->audio + SPDIF_FORMAT_CFG_OFFSET);
466 writel(0, aio->cygaud->audio + aio->regs.bf_sourcech_ctrl);
467
468 value = readl(aio->cygaud->audio + aio->regs.bf_sourcech_cfg);
469 value &= ~BIT(BF_SRC_CFGX_SFIFO_ENA);
470 writel(value, aio->cygaud->audio + aio->regs.bf_sourcech_cfg);
471 break;
472 default:
473 dev_err(aio->cygaud->dev,
474 "Port not supported %d\n", aio->portnum);
475 status = -EINVAL;
476 }
477
478 return status;
479 }
480
pll_configure_mclk(struct cygnus_audio * cygaud,u32 mclk,struct cygnus_aio_port * aio)481 static int pll_configure_mclk(struct cygnus_audio *cygaud, u32 mclk,
482 struct cygnus_aio_port *aio)
483 {
484 int i = 0, error;
485 bool found = false;
486 const struct pll_macro_entry *p_entry;
487 struct clk *ch_clk;
488
489 for (i = 0; i < ARRAY_SIZE(pll_predef_mclk); i++) {
490 p_entry = &pll_predef_mclk[i];
491 if (p_entry->mclk == mclk) {
492 found = true;
493 break;
494 }
495 }
496 if (!found) {
497 dev_err(cygaud->dev,
498 "%s No valid mclk freq (%u) found!\n", __func__, mclk);
499 return -EINVAL;
500 }
501
502 ch_clk = cygaud->audio_clk[p_entry->pll_ch_num];
503
504 if ((aio->clk_trace.cap_en) && (!aio->clk_trace.cap_clk_en)) {
505 error = clk_prepare_enable(ch_clk);
506 if (error) {
507 dev_err(cygaud->dev, "%s clk_prepare_enable failed %d\n",
508 __func__, error);
509 return error;
510 }
511 aio->clk_trace.cap_clk_en = true;
512 }
513
514 if ((aio->clk_trace.play_en) && (!aio->clk_trace.play_clk_en)) {
515 error = clk_prepare_enable(ch_clk);
516 if (error) {
517 dev_err(cygaud->dev, "%s clk_prepare_enable failed %d\n",
518 __func__, error);
519 return error;
520 }
521 aio->clk_trace.play_clk_en = true;
522 }
523
524 error = clk_set_rate(ch_clk, mclk);
525 if (error) {
526 dev_err(cygaud->dev, "%s Set MCLK rate failed: %d\n",
527 __func__, error);
528 return error;
529 }
530
531 return p_entry->pll_ch_num;
532 }
533
cygnus_ssp_set_clocks(struct cygnus_aio_port * aio)534 static int cygnus_ssp_set_clocks(struct cygnus_aio_port *aio)
535 {
536 u32 value;
537 u32 mask = 0xf;
538 u32 sclk;
539 u32 mclk_rate;
540 unsigned int bit_rate;
541 unsigned int ratio;
542
543 bit_rate = aio->bit_per_frame * aio->lrclk;
544
545 /*
546 * Check if the bit clock can be generated from the given MCLK.
547 * MCLK must be a perfect multiple of bit clock and must be one of the
548 * following values... (2,4,6,8,10,12,14)
549 */
550 if ((aio->mclk % bit_rate) != 0)
551 return -EINVAL;
552
553 ratio = aio->mclk / bit_rate;
554 switch (ratio) {
555 case 2:
556 case 4:
557 case 6:
558 case 8:
559 case 10:
560 case 12:
561 case 14:
562 mclk_rate = ratio / 2;
563 break;
564
565 default:
566 dev_err(aio->cygaud->dev,
567 "Invalid combination of MCLK and BCLK\n");
568 dev_err(aio->cygaud->dev, "lrclk = %u, bits/frame = %u, mclk = %u\n",
569 aio->lrclk, aio->bit_per_frame, aio->mclk);
570 return -EINVAL;
571 }
572
573 /* Set sclk rate */
574 switch (aio->port_type) {
575 case PORT_TDM:
576 sclk = aio->bit_per_frame;
577 if (sclk == 512)
578 sclk = 0;
579
580 /* sclks_per_1fs_div = sclk cycles/32 */
581 sclk /= 32;
582
583 /* Set number of bitclks per frame */
584 value = readl(aio->cygaud->audio + aio->regs.i2s_cfg);
585 value &= ~(mask << I2S_OUT_CFGX_SCLKS_PER_1FS_DIV32);
586 value |= sclk << I2S_OUT_CFGX_SCLKS_PER_1FS_DIV32;
587 writel(value, aio->cygaud->audio + aio->regs.i2s_cfg);
588 dev_dbg(aio->cygaud->dev,
589 "SCLKS_PER_1FS_DIV32 = 0x%x\n", value);
590 break;
591 case PORT_SPDIF:
592 break;
593 default:
594 dev_err(aio->cygaud->dev, "Unknown port type\n");
595 return -EINVAL;
596 }
597
598 /* Set MCLK_RATE ssp port (spdif and ssp are the same) */
599 value = readl(aio->cygaud->audio + aio->regs.i2s_mclk_cfg);
600 value &= ~(0xf << I2S_OUT_MCLKRATE_SHIFT);
601 value |= (mclk_rate << I2S_OUT_MCLKRATE_SHIFT);
602 writel(value, aio->cygaud->audio + aio->regs.i2s_mclk_cfg);
603
604 dev_dbg(aio->cygaud->dev, "mclk cfg reg = 0x%x\n", value);
605 dev_dbg(aio->cygaud->dev, "bits per frame = %u, mclk = %u Hz, lrclk = %u Hz\n",
606 aio->bit_per_frame, aio->mclk, aio->lrclk);
607 return 0;
608 }
609
cygnus_ssp_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * params,struct snd_soc_dai * dai)610 static int cygnus_ssp_hw_params(struct snd_pcm_substream *substream,
611 struct snd_pcm_hw_params *params,
612 struct snd_soc_dai *dai)
613 {
614 struct cygnus_aio_port *aio = cygnus_dai_get_portinfo(dai);
615 int rate, bitres;
616 u32 value;
617 u32 mask = 0x1f;
618 int ret = 0;
619
620 dev_dbg(aio->cygaud->dev, "%s port = %d\n", __func__, aio->portnum);
621 dev_dbg(aio->cygaud->dev, "params_channels %d\n",
622 params_channels(params));
623 dev_dbg(aio->cygaud->dev, "rate %d\n", params_rate(params));
624 dev_dbg(aio->cygaud->dev, "format %d\n", params_format(params));
625
626 rate = params_rate(params);
627
628 switch (aio->mode) {
629 case CYGNUS_SSPMODE_TDM:
630 if ((rate == 192000) && (params_channels(params) > 4)) {
631 dev_err(aio->cygaud->dev, "Cannot run %d channels at %dHz\n",
632 params_channels(params), rate);
633 return -EINVAL;
634 }
635 break;
636 case CYGNUS_SSPMODE_I2S:
637 aio->bit_per_frame = 64; /* I2S must be 64 bit per frame */
638 break;
639 default:
640 dev_err(aio->cygaud->dev,
641 "%s port running in unknown mode\n", __func__);
642 return -EINVAL;
643 }
644
645 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
646 value = readl(aio->cygaud->audio + aio->regs.bf_sourcech_cfg);
647 value &= ~BIT(BF_SRC_CFGX_BUFFER_PAIR_ENABLE);
648 value &= ~BIT(BF_SRC_CFGX_SAMPLE_CH_MODE);
649 writel(value, aio->cygaud->audio + aio->regs.bf_sourcech_cfg);
650
651 switch (params_format(params)) {
652 case SNDRV_PCM_FORMAT_S16_LE:
653 bitres = 16;
654 break;
655
656 case SNDRV_PCM_FORMAT_S32_LE:
657 /* 32 bit mode is coded as 0 */
658 bitres = 0;
659 break;
660
661 default:
662 return -EINVAL;
663 }
664
665 value = readl(aio->cygaud->audio + aio->regs.bf_sourcech_cfg);
666 value &= ~(mask << BF_SRC_CFGX_BIT_RES);
667 value |= (bitres << BF_SRC_CFGX_BIT_RES);
668 writel(value, aio->cygaud->audio + aio->regs.bf_sourcech_cfg);
669
670 } else {
671
672 switch (params_format(params)) {
673 case SNDRV_PCM_FORMAT_S16_LE:
674 value = readl(aio->cygaud->audio +
675 aio->regs.bf_destch_cfg);
676 value |= BIT(BF_DST_CFGX_CAP_MODE);
677 writel(value, aio->cygaud->audio +
678 aio->regs.bf_destch_cfg);
679 break;
680
681 case SNDRV_PCM_FORMAT_S32_LE:
682 value = readl(aio->cygaud->audio +
683 aio->regs.bf_destch_cfg);
684 value &= ~BIT(BF_DST_CFGX_CAP_MODE);
685 writel(value, aio->cygaud->audio +
686 aio->regs.bf_destch_cfg);
687 break;
688
689 default:
690 return -EINVAL;
691 }
692 }
693
694 aio->lrclk = rate;
695
696 if (!aio->is_slave)
697 ret = cygnus_ssp_set_clocks(aio);
698
699 return ret;
700 }
701
702 /*
703 * This function sets the mclk frequency for pll clock
704 */
cygnus_ssp_set_sysclk(struct snd_soc_dai * dai,int clk_id,unsigned int freq,int dir)705 static int cygnus_ssp_set_sysclk(struct snd_soc_dai *dai,
706 int clk_id, unsigned int freq, int dir)
707 {
708 int sel;
709 u32 value;
710 struct cygnus_aio_port *aio = cygnus_dai_get_portinfo(dai);
711 struct cygnus_audio *cygaud = snd_soc_dai_get_drvdata(dai);
712
713 dev_dbg(aio->cygaud->dev,
714 "%s Enter port = %d\n", __func__, aio->portnum);
715 sel = pll_configure_mclk(cygaud, freq, aio);
716 if (sel < 0) {
717 dev_err(aio->cygaud->dev,
718 "%s Setting mclk failed.\n", __func__);
719 return -EINVAL;
720 }
721
722 aio->mclk = freq;
723
724 dev_dbg(aio->cygaud->dev, "%s Setting MCLKSEL to %d\n", __func__, sel);
725 value = readl(aio->cygaud->audio + aio->regs.i2s_mclk_cfg);
726 value &= ~(0xf << I2S_OUT_PLLCLKSEL_SHIFT);
727 value |= (sel << I2S_OUT_PLLCLKSEL_SHIFT);
728 writel(value, aio->cygaud->audio + aio->regs.i2s_mclk_cfg);
729
730 return 0;
731 }
732
cygnus_ssp_startup(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)733 static int cygnus_ssp_startup(struct snd_pcm_substream *substream,
734 struct snd_soc_dai *dai)
735 {
736 struct cygnus_aio_port *aio = cygnus_dai_get_portinfo(dai);
737
738 snd_soc_dai_set_dma_data(dai, substream, aio);
739 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
740 aio->clk_trace.play_en = true;
741 else
742 aio->clk_trace.cap_en = true;
743
744 substream->runtime->hw.rate_min = CYGNUS_RATE_MIN;
745 substream->runtime->hw.rate_max = CYGNUS_RATE_MAX;
746
747 snd_pcm_hw_constraint_list(substream->runtime, 0,
748 SNDRV_PCM_HW_PARAM_RATE, &cygnus_rate_constraint);
749 return 0;
750 }
751
cygnus_ssp_shutdown(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)752 static void cygnus_ssp_shutdown(struct snd_pcm_substream *substream,
753 struct snd_soc_dai *dai)
754 {
755 struct cygnus_aio_port *aio = cygnus_dai_get_portinfo(dai);
756
757 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
758 aio->clk_trace.play_en = false;
759 else
760 aio->clk_trace.cap_en = false;
761
762 if (!aio->is_slave) {
763 u32 val;
764
765 val = readl(aio->cygaud->audio + aio->regs.i2s_mclk_cfg);
766 val &= CYGNUS_PLLCLKSEL_MASK;
767 if (val >= ARRAY_SIZE(aio->cygaud->audio_clk)) {
768 dev_err(aio->cygaud->dev, "Clk index %u is out of bounds\n",
769 val);
770 return;
771 }
772
773 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
774 if (aio->clk_trace.play_clk_en) {
775 clk_disable_unprepare(aio->cygaud->
776 audio_clk[val]);
777 aio->clk_trace.play_clk_en = false;
778 }
779 } else {
780 if (aio->clk_trace.cap_clk_en) {
781 clk_disable_unprepare(aio->cygaud->
782 audio_clk[val]);
783 aio->clk_trace.cap_clk_en = false;
784 }
785 }
786 }
787 }
788
789 /*
790 * Bit Update Notes
791 * 31 Yes TDM Mode (1 = TDM, 0 = i2s)
792 * 30 Yes Slave Mode (1 = Slave, 0 = Master)
793 * 29:26 No Sclks per frame
794 * 25:18 Yes FS Width
795 * 17:14 No Valid Slots
796 * 13 No Bits (1 = 16 bits, 0 = 32 bits)
797 * 12:08 No Bits per samp
798 * 07 Yes Justifcation (1 = LSB, 0 = MSB)
799 * 06 Yes Alignment (1 = Delay 1 clk, 0 = no delay
800 * 05 Yes SCLK polarity (1 = Rising, 0 = Falling)
801 * 04 Yes LRCLK Polarity (1 = High for left, 0 = Low for left)
802 * 03:02 Yes Reserved - write as zero
803 * 01 No Data Enable
804 * 00 No CLK Enable
805 */
806 #define I2S_OUT_CFG_REG_UPDATE_MASK 0x3C03FF03
807
808 /* Input cfg is same as output, but the FS width is not a valid field */
809 #define I2S_IN_CFG_REG_UPDATE_MASK (I2S_OUT_CFG_REG_UPDATE_MASK | 0x03FC0000)
810
cygnus_ssp_set_custom_fsync_width(struct snd_soc_dai * cpu_dai,int len)811 int cygnus_ssp_set_custom_fsync_width(struct snd_soc_dai *cpu_dai, int len)
812 {
813 struct cygnus_aio_port *aio = cygnus_dai_get_portinfo(cpu_dai);
814
815 if ((len > 0) && (len < 256)) {
816 aio->fsync_width = len;
817 return 0;
818 } else {
819 return -EINVAL;
820 }
821 }
822 EXPORT_SYMBOL_GPL(cygnus_ssp_set_custom_fsync_width);
823
cygnus_ssp_set_fmt(struct snd_soc_dai * cpu_dai,unsigned int fmt)824 static int cygnus_ssp_set_fmt(struct snd_soc_dai *cpu_dai, unsigned int fmt)
825 {
826 struct cygnus_aio_port *aio = cygnus_dai_get_portinfo(cpu_dai);
827 u32 ssp_curcfg;
828 u32 ssp_newcfg;
829 u32 ssp_outcfg;
830 u32 ssp_incfg;
831 u32 val;
832 u32 mask;
833
834 dev_dbg(aio->cygaud->dev, "%s Enter fmt: %x\n", __func__, fmt);
835
836 if (aio->port_type == PORT_SPDIF)
837 return -EINVAL;
838
839 ssp_newcfg = 0;
840
841 switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) {
842 case SND_SOC_DAIFMT_BC_FC:
843 ssp_newcfg |= BIT(I2S_OUT_CFGX_SLAVE_MODE);
844 aio->is_slave = 1;
845 break;
846 case SND_SOC_DAIFMT_BP_FP:
847 ssp_newcfg &= ~BIT(I2S_OUT_CFGX_SLAVE_MODE);
848 aio->is_slave = 0;
849 break;
850 default:
851 return -EINVAL;
852 }
853
854 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
855 case SND_SOC_DAIFMT_I2S:
856 ssp_newcfg |= BIT(I2S_OUT_CFGX_DATA_ALIGNMENT);
857 ssp_newcfg |= BIT(I2S_OUT_CFGX_FSYNC_WIDTH);
858 aio->mode = CYGNUS_SSPMODE_I2S;
859 break;
860
861 case SND_SOC_DAIFMT_DSP_A:
862 case SND_SOC_DAIFMT_DSP_B:
863 ssp_newcfg |= BIT(I2S_OUT_CFGX_TDM_MODE);
864
865 /* DSP_A = data after FS, DSP_B = data during FS */
866 if ((fmt & SND_SOC_DAIFMT_FORMAT_MASK) == SND_SOC_DAIFMT_DSP_A)
867 ssp_newcfg |= BIT(I2S_OUT_CFGX_DATA_ALIGNMENT);
868
869 if ((aio->fsync_width > 0) && (aio->fsync_width < 256))
870 ssp_newcfg |=
871 (aio->fsync_width << I2S_OUT_CFGX_FSYNC_WIDTH);
872 else
873 ssp_newcfg |= BIT(I2S_OUT_CFGX_FSYNC_WIDTH);
874
875 aio->mode = CYGNUS_SSPMODE_TDM;
876 break;
877
878 default:
879 return -EINVAL;
880 }
881
882 /*
883 * SSP out cfg.
884 * Retain bits we do not want to update, then OR in new bits
885 */
886 ssp_curcfg = readl(aio->cygaud->audio + aio->regs.i2s_cfg);
887 ssp_outcfg = (ssp_curcfg & I2S_OUT_CFG_REG_UPDATE_MASK) | ssp_newcfg;
888 writel(ssp_outcfg, aio->cygaud->audio + aio->regs.i2s_cfg);
889
890 /*
891 * SSP in cfg.
892 * Retain bits we do not want to update, then OR in new bits
893 */
894 ssp_curcfg = readl(aio->cygaud->i2s_in + aio->regs.i2s_cap_cfg);
895 ssp_incfg = (ssp_curcfg & I2S_IN_CFG_REG_UPDATE_MASK) | ssp_newcfg;
896 writel(ssp_incfg, aio->cygaud->i2s_in + aio->regs.i2s_cap_cfg);
897
898 val = readl(aio->cygaud->audio + AUD_MISC_SEROUT_OE_REG_BASE);
899
900 /*
901 * Configure the word clk and bit clk as output or tristate
902 * Each port has 4 bits for controlling its pins.
903 * Shift the mask based upon port number.
904 */
905 mask = BIT(AUD_MISC_SEROUT_LRCK_OE)
906 | BIT(AUD_MISC_SEROUT_SCLK_OE)
907 | BIT(AUD_MISC_SEROUT_MCLK_OE);
908 mask = mask << (aio->portnum * 4);
909 if (aio->is_slave)
910 /* Set bit for tri-state */
911 val |= mask;
912 else
913 /* Clear bit for drive */
914 val &= ~mask;
915
916 dev_dbg(aio->cygaud->dev, "%s Set OE bits 0x%x\n", __func__, val);
917 writel(val, aio->cygaud->audio + AUD_MISC_SEROUT_OE_REG_BASE);
918
919 return 0;
920 }
921
cygnus_ssp_trigger(struct snd_pcm_substream * substream,int cmd,struct snd_soc_dai * dai)922 static int cygnus_ssp_trigger(struct snd_pcm_substream *substream, int cmd,
923 struct snd_soc_dai *dai)
924 {
925 struct cygnus_aio_port *aio = cygnus_dai_get_portinfo(dai);
926 struct cygnus_audio *cygaud = snd_soc_dai_get_drvdata(dai);
927
928 dev_dbg(aio->cygaud->dev,
929 "%s cmd %d at port = %d\n", __func__, cmd, aio->portnum);
930
931 switch (cmd) {
932 case SNDRV_PCM_TRIGGER_START:
933 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
934 case SNDRV_PCM_TRIGGER_RESUME:
935 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
936 audio_ssp_out_enable(aio);
937 else
938 audio_ssp_in_enable(aio);
939 cygaud->active_ports++;
940
941 break;
942
943 case SNDRV_PCM_TRIGGER_STOP:
944 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
945 case SNDRV_PCM_TRIGGER_SUSPEND:
946 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
947 audio_ssp_out_disable(aio);
948 else
949 audio_ssp_in_disable(aio);
950 cygaud->active_ports--;
951 break;
952
953 default:
954 return -EINVAL;
955 }
956
957 return 0;
958 }
959
cygnus_set_dai_tdm_slot(struct snd_soc_dai * cpu_dai,unsigned int tx_mask,unsigned int rx_mask,int slots,int slot_width)960 static int cygnus_set_dai_tdm_slot(struct snd_soc_dai *cpu_dai,
961 unsigned int tx_mask, unsigned int rx_mask, int slots, int slot_width)
962 {
963 struct cygnus_aio_port *aio = cygnus_dai_get_portinfo(cpu_dai);
964 u32 value;
965 int bits_per_slot = 0; /* default to 32-bits per slot */
966 int frame_bits;
967 unsigned int active_slots;
968 bool found = false;
969 int i;
970
971 if (tx_mask != rx_mask) {
972 dev_err(aio->cygaud->dev,
973 "%s tx_mask must equal rx_mask\n", __func__);
974 return -EINVAL;
975 }
976
977 active_slots = hweight32(tx_mask);
978
979 if (active_slots > 16)
980 return -EINVAL;
981
982 /* Slot value must be even */
983 if (active_slots % 2)
984 return -EINVAL;
985
986 /* We encode 16 slots as 0 in the reg */
987 if (active_slots == 16)
988 active_slots = 0;
989
990 /* Slot Width is either 16 or 32 */
991 switch (slot_width) {
992 case 16:
993 bits_per_slot = 1;
994 break;
995 case 32:
996 bits_per_slot = 0;
997 break;
998 default:
999 bits_per_slot = 0;
1000 dev_warn(aio->cygaud->dev,
1001 "%s Defaulting Slot Width to 32\n", __func__);
1002 }
1003
1004 frame_bits = slots * slot_width;
1005
1006 for (i = 0; i < ARRAY_SIZE(ssp_valid_tdm_framesize); i++) {
1007 if (ssp_valid_tdm_framesize[i] == frame_bits) {
1008 found = true;
1009 break;
1010 }
1011 }
1012
1013 if (!found) {
1014 dev_err(aio->cygaud->dev,
1015 "%s In TDM mode, frame bits INVALID (%d)\n",
1016 __func__, frame_bits);
1017 return -EINVAL;
1018 }
1019
1020 aio->bit_per_frame = frame_bits;
1021
1022 dev_dbg(aio->cygaud->dev, "%s active_slots %u, bits per frame %d\n",
1023 __func__, active_slots, frame_bits);
1024
1025 /* Set capture side of ssp port */
1026 value = readl(aio->cygaud->i2s_in + aio->regs.i2s_cap_cfg);
1027 value &= ~(0xf << I2S_OUT_CFGX_VALID_SLOT);
1028 value |= (active_slots << I2S_OUT_CFGX_VALID_SLOT);
1029 value &= ~BIT(I2S_OUT_CFGX_BITS_PER_SLOT);
1030 value |= (bits_per_slot << I2S_OUT_CFGX_BITS_PER_SLOT);
1031 writel(value, aio->cygaud->i2s_in + aio->regs.i2s_cap_cfg);
1032
1033 /* Set playback side of ssp port */
1034 value = readl(aio->cygaud->audio + aio->regs.i2s_cfg);
1035 value &= ~(0xf << I2S_OUT_CFGX_VALID_SLOT);
1036 value |= (active_slots << I2S_OUT_CFGX_VALID_SLOT);
1037 value &= ~BIT(I2S_OUT_CFGX_BITS_PER_SLOT);
1038 value |= (bits_per_slot << I2S_OUT_CFGX_BITS_PER_SLOT);
1039 writel(value, aio->cygaud->audio + aio->regs.i2s_cfg);
1040
1041 return 0;
1042 }
1043
1044 #ifdef CONFIG_PM_SLEEP
__cygnus_ssp_suspend(struct snd_soc_dai * cpu_dai)1045 static int __cygnus_ssp_suspend(struct snd_soc_dai *cpu_dai)
1046 {
1047 struct cygnus_aio_port *aio = cygnus_dai_get_portinfo(cpu_dai);
1048
1049 if (!snd_soc_dai_active(cpu_dai))
1050 return 0;
1051
1052 if (!aio->is_slave) {
1053 u32 val;
1054
1055 val = readl(aio->cygaud->audio + aio->regs.i2s_mclk_cfg);
1056 val &= CYGNUS_PLLCLKSEL_MASK;
1057 if (val >= ARRAY_SIZE(aio->cygaud->audio_clk)) {
1058 dev_err(aio->cygaud->dev, "Clk index %u is out of bounds\n",
1059 val);
1060 return -EINVAL;
1061 }
1062
1063 if (aio->clk_trace.cap_clk_en)
1064 clk_disable_unprepare(aio->cygaud->audio_clk[val]);
1065 if (aio->clk_trace.play_clk_en)
1066 clk_disable_unprepare(aio->cygaud->audio_clk[val]);
1067
1068 aio->pll_clk_num = val;
1069 }
1070
1071 return 0;
1072 }
1073
cygnus_ssp_suspend(struct snd_soc_component * component)1074 static int cygnus_ssp_suspend(struct snd_soc_component *component)
1075 {
1076 struct snd_soc_dai *dai;
1077 int ret = 0;
1078
1079 for_each_component_dais(component, dai)
1080 ret |= __cygnus_ssp_suspend(dai);
1081
1082 return ret;
1083 }
1084
__cygnus_ssp_resume(struct snd_soc_dai * cpu_dai)1085 static int __cygnus_ssp_resume(struct snd_soc_dai *cpu_dai)
1086 {
1087 struct cygnus_aio_port *aio = cygnus_dai_get_portinfo(cpu_dai);
1088 int error;
1089
1090 if (!snd_soc_dai_active(cpu_dai))
1091 return 0;
1092
1093 if (!aio->is_slave) {
1094 if (aio->clk_trace.cap_clk_en) {
1095 error = clk_prepare_enable(aio->cygaud->
1096 audio_clk[aio->pll_clk_num]);
1097 if (error) {
1098 dev_err(aio->cygaud->dev, "%s clk_prepare_enable failed\n",
1099 __func__);
1100 return -EINVAL;
1101 }
1102 }
1103 if (aio->clk_trace.play_clk_en) {
1104 error = clk_prepare_enable(aio->cygaud->
1105 audio_clk[aio->pll_clk_num]);
1106 if (error) {
1107 if (aio->clk_trace.cap_clk_en)
1108 clk_disable_unprepare(aio->cygaud->
1109 audio_clk[aio->pll_clk_num]);
1110 dev_err(aio->cygaud->dev, "%s clk_prepare_enable failed\n",
1111 __func__);
1112 return -EINVAL;
1113 }
1114 }
1115 }
1116
1117 return 0;
1118 }
1119
cygnus_ssp_resume(struct snd_soc_component * component)1120 static int cygnus_ssp_resume(struct snd_soc_component *component)
1121 {
1122 struct snd_soc_dai *dai;
1123 int ret = 0;
1124
1125 for_each_component_dais(component, dai)
1126 ret |= __cygnus_ssp_resume(dai);
1127
1128 return ret;
1129 }
1130
1131 #else
1132 #define cygnus_ssp_suspend NULL
1133 #define cygnus_ssp_resume NULL
1134 #endif
1135
1136 static const struct snd_soc_dai_ops cygnus_ssp_dai_ops = {
1137 .startup = cygnus_ssp_startup,
1138 .shutdown = cygnus_ssp_shutdown,
1139 .trigger = cygnus_ssp_trigger,
1140 .hw_params = cygnus_ssp_hw_params,
1141 .set_fmt = cygnus_ssp_set_fmt,
1142 .set_sysclk = cygnus_ssp_set_sysclk,
1143 .set_tdm_slot = cygnus_set_dai_tdm_slot,
1144 };
1145
1146 static const struct snd_soc_dai_ops cygnus_spdif_dai_ops = {
1147 .startup = cygnus_ssp_startup,
1148 .shutdown = cygnus_ssp_shutdown,
1149 .trigger = cygnus_ssp_trigger,
1150 .hw_params = cygnus_ssp_hw_params,
1151 .set_sysclk = cygnus_ssp_set_sysclk,
1152 };
1153
1154 #define INIT_CPU_DAI(num) { \
1155 .name = "cygnus-ssp" #num, \
1156 .playback = { \
1157 .channels_min = 2, \
1158 .channels_max = 16, \
1159 .rates = SNDRV_PCM_RATE_KNOT, \
1160 .formats = SNDRV_PCM_FMTBIT_S16_LE | \
1161 SNDRV_PCM_FMTBIT_S32_LE, \
1162 }, \
1163 .capture = { \
1164 .channels_min = 2, \
1165 .channels_max = 16, \
1166 .rates = SNDRV_PCM_RATE_KNOT, \
1167 .formats = SNDRV_PCM_FMTBIT_S16_LE | \
1168 SNDRV_PCM_FMTBIT_S32_LE, \
1169 }, \
1170 .ops = &cygnus_ssp_dai_ops, \
1171 }
1172
1173 static const struct snd_soc_dai_driver cygnus_ssp_dai_info[] = {
1174 INIT_CPU_DAI(0),
1175 INIT_CPU_DAI(1),
1176 INIT_CPU_DAI(2),
1177 };
1178
1179 static const struct snd_soc_dai_driver cygnus_spdif_dai_info = {
1180 .name = "cygnus-spdif",
1181 .playback = {
1182 .channels_min = 2,
1183 .channels_max = 2,
1184 .rates = SNDRV_PCM_RATE_KNOT,
1185 .formats = SNDRV_PCM_FMTBIT_S16_LE |
1186 SNDRV_PCM_FMTBIT_S32_LE,
1187 },
1188 .ops = &cygnus_spdif_dai_ops,
1189 };
1190
1191 static struct snd_soc_dai_driver cygnus_ssp_dai[CYGNUS_MAX_PORTS];
1192
1193 static const struct snd_soc_component_driver cygnus_ssp_component = {
1194 .name = "cygnus-audio",
1195 .suspend = cygnus_ssp_suspend,
1196 .resume = cygnus_ssp_resume,
1197 .legacy_dai_naming = 1,
1198 };
1199
1200 /*
1201 * Return < 0 if error
1202 * Return 0 if disabled
1203 * Return 1 if enabled and node is parsed successfully
1204 */
parse_ssp_child_node(struct platform_device * pdev,struct device_node * dn,struct cygnus_audio * cygaud,struct snd_soc_dai_driver * p_dai)1205 static int parse_ssp_child_node(struct platform_device *pdev,
1206 struct device_node *dn,
1207 struct cygnus_audio *cygaud,
1208 struct snd_soc_dai_driver *p_dai)
1209 {
1210 struct cygnus_aio_port *aio;
1211 struct cygnus_ssp_regs ssp_regs[3];
1212 u32 rawval;
1213 int portnum = -1;
1214 enum cygnus_audio_port_type port_type;
1215
1216 if (of_property_read_u32(dn, "reg", &rawval)) {
1217 dev_err(&pdev->dev, "Missing reg property\n");
1218 return -EINVAL;
1219 }
1220
1221 portnum = rawval;
1222 switch (rawval) {
1223 case 0:
1224 ssp_regs[0] = INIT_SSP_REGS(0);
1225 port_type = PORT_TDM;
1226 break;
1227 case 1:
1228 ssp_regs[1] = INIT_SSP_REGS(1);
1229 port_type = PORT_TDM;
1230 break;
1231 case 2:
1232 ssp_regs[2] = INIT_SSP_REGS(2);
1233 port_type = PORT_TDM;
1234 break;
1235 case 3:
1236 port_type = PORT_SPDIF;
1237 break;
1238 default:
1239 dev_err(&pdev->dev, "Bad value for reg %u\n", rawval);
1240 return -EINVAL;
1241 }
1242
1243 aio = &cygaud->portinfo[portnum];
1244 aio->cygaud = cygaud;
1245 aio->portnum = portnum;
1246 aio->port_type = port_type;
1247 aio->fsync_width = -1;
1248
1249 switch (port_type) {
1250 case PORT_TDM:
1251 aio->regs = ssp_regs[portnum];
1252 *p_dai = cygnus_ssp_dai_info[portnum];
1253 aio->mode = CYGNUS_SSPMODE_UNKNOWN;
1254 break;
1255
1256 case PORT_SPDIF:
1257 aio->regs.bf_sourcech_cfg = BF_SRC_CFG3_OFFSET;
1258 aio->regs.bf_sourcech_ctrl = BF_SRC_CTRL3_OFFSET;
1259 aio->regs.i2s_mclk_cfg = SPDIF_MCLK_CFG_OFFSET;
1260 aio->regs.i2s_stream_cfg = SPDIF_STREAM_CFG_OFFSET;
1261 *p_dai = cygnus_spdif_dai_info;
1262
1263 /* For the purposes of this code SPDIF can be I2S mode */
1264 aio->mode = CYGNUS_SSPMODE_I2S;
1265 break;
1266 default:
1267 dev_err(&pdev->dev, "Bad value for port_type %d\n", port_type);
1268 return -EINVAL;
1269 }
1270
1271 dev_dbg(&pdev->dev, "%s portnum = %d\n", __func__, aio->portnum);
1272 aio->streams_on = 0;
1273 aio->cygaud->dev = &pdev->dev;
1274 aio->clk_trace.play_en = false;
1275 aio->clk_trace.cap_en = false;
1276
1277 audio_ssp_init_portregs(aio);
1278 return 0;
1279 }
1280
audio_clk_init(struct platform_device * pdev,struct cygnus_audio * cygaud)1281 static int audio_clk_init(struct platform_device *pdev,
1282 struct cygnus_audio *cygaud)
1283 {
1284 int i;
1285 char clk_name[PROP_LEN_MAX];
1286
1287 for (i = 0; i < ARRAY_SIZE(cygaud->audio_clk); i++) {
1288 snprintf(clk_name, PROP_LEN_MAX, "ch%d_audio", i);
1289
1290 cygaud->audio_clk[i] = devm_clk_get(&pdev->dev, clk_name);
1291 if (IS_ERR(cygaud->audio_clk[i]))
1292 return PTR_ERR(cygaud->audio_clk[i]);
1293 }
1294
1295 return 0;
1296 }
1297
cygnus_ssp_probe(struct platform_device * pdev)1298 static int cygnus_ssp_probe(struct platform_device *pdev)
1299 {
1300 struct device *dev = &pdev->dev;
1301 struct device_node *child_node;
1302 struct cygnus_audio *cygaud;
1303 int err;
1304 int node_count;
1305 int active_port_count;
1306
1307 cygaud = devm_kzalloc(dev, sizeof(struct cygnus_audio), GFP_KERNEL);
1308 if (!cygaud)
1309 return -ENOMEM;
1310
1311 dev_set_drvdata(dev, cygaud);
1312
1313 cygaud->audio = devm_platform_ioremap_resource_byname(pdev, "aud");
1314 if (IS_ERR(cygaud->audio))
1315 return PTR_ERR(cygaud->audio);
1316
1317 cygaud->i2s_in = devm_platform_ioremap_resource_byname(pdev, "i2s_in");
1318 if (IS_ERR(cygaud->i2s_in))
1319 return PTR_ERR(cygaud->i2s_in);
1320
1321 /* Tri-state all controlable pins until we know that we need them */
1322 writel(CYGNUS_SSP_TRISTATE_MASK,
1323 cygaud->audio + AUD_MISC_SEROUT_OE_REG_BASE);
1324
1325 node_count = of_get_child_count(pdev->dev.of_node);
1326 if ((node_count < 1) || (node_count > CYGNUS_MAX_PORTS)) {
1327 dev_err(dev, "child nodes is %d. Must be between 1 and %d\n",
1328 node_count, CYGNUS_MAX_PORTS);
1329 return -EINVAL;
1330 }
1331
1332 active_port_count = 0;
1333
1334 for_each_available_child_of_node(pdev->dev.of_node, child_node) {
1335 err = parse_ssp_child_node(pdev, child_node, cygaud,
1336 &cygnus_ssp_dai[active_port_count]);
1337
1338 /* negative is err, 0 is active and good, 1 is disabled */
1339 if (err < 0) {
1340 of_node_put(child_node);
1341 return err;
1342 }
1343 else if (!err) {
1344 dev_dbg(dev, "Activating DAI: %s\n",
1345 cygnus_ssp_dai[active_port_count].name);
1346 active_port_count++;
1347 }
1348 }
1349
1350 cygaud->dev = dev;
1351 cygaud->active_ports = 0;
1352
1353 dev_dbg(dev, "Registering %d DAIs\n", active_port_count);
1354 err = devm_snd_soc_register_component(dev, &cygnus_ssp_component,
1355 cygnus_ssp_dai, active_port_count);
1356 if (err) {
1357 dev_err(dev, "snd_soc_register_dai failed\n");
1358 return err;
1359 }
1360
1361 cygaud->irq_num = platform_get_irq(pdev, 0);
1362 if (cygaud->irq_num <= 0)
1363 return cygaud->irq_num;
1364
1365 err = audio_clk_init(pdev, cygaud);
1366 if (err) {
1367 dev_err(dev, "audio clock initialization failed\n");
1368 return err;
1369 }
1370
1371 err = cygnus_soc_platform_register(dev, cygaud);
1372 if (err) {
1373 dev_err(dev, "platform reg error %d\n", err);
1374 return err;
1375 }
1376
1377 return 0;
1378 }
1379
cygnus_ssp_remove(struct platform_device * pdev)1380 static int cygnus_ssp_remove(struct platform_device *pdev)
1381 {
1382 cygnus_soc_platform_unregister(&pdev->dev);
1383
1384 return 0;
1385 }
1386
1387 static const struct of_device_id cygnus_ssp_of_match[] = {
1388 { .compatible = "brcm,cygnus-audio" },
1389 {},
1390 };
1391 MODULE_DEVICE_TABLE(of, cygnus_ssp_of_match);
1392
1393 static struct platform_driver cygnus_ssp_driver = {
1394 .probe = cygnus_ssp_probe,
1395 .remove = cygnus_ssp_remove,
1396 .driver = {
1397 .name = "cygnus-ssp",
1398 .of_match_table = cygnus_ssp_of_match,
1399 },
1400 };
1401
1402 module_platform_driver(cygnus_ssp_driver);
1403
1404 MODULE_ALIAS("platform:cygnus-ssp");
1405 MODULE_LICENSE("GPL v2");
1406 MODULE_AUTHOR("Broadcom");
1407 MODULE_DESCRIPTION("Cygnus ASoC SSP Interface");
1408