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