ssi.c 18.3 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21
/*
 * Renesas R-Car SSIU/SSI support
 *
 * Copyright (C) 2013 Renesas Solutions Corp.
 * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
 *
 * Based on fsi.c
 * Kuninori Morimoto <morimoto.kuninori@renesas.com>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */
#include <linux/delay.h>
#include "rsnd.h"
#define RSND_SSI_NAME_SIZE 16

/*
 * SSICR
 */
#define	FORCE		(1 << 31)	/* Fixed */
22
#define	DMEN		(1 << 28)	/* DMA Enable */
23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54
#define	UIEN		(1 << 27)	/* Underflow Interrupt Enable */
#define	OIEN		(1 << 26)	/* Overflow Interrupt Enable */
#define	IIEN		(1 << 25)	/* Idle Mode Interrupt Enable */
#define	DIEN		(1 << 24)	/* Data Interrupt Enable */

#define	DWL_8		(0 << 19)	/* Data Word Length */
#define	DWL_16		(1 << 19)	/* Data Word Length */
#define	DWL_18		(2 << 19)	/* Data Word Length */
#define	DWL_20		(3 << 19)	/* Data Word Length */
#define	DWL_22		(4 << 19)	/* Data Word Length */
#define	DWL_24		(5 << 19)	/* Data Word Length */
#define	DWL_32		(6 << 19)	/* Data Word Length */

#define	SWL_32		(3 << 16)	/* R/W System Word Length */
#define	SCKD		(1 << 15)	/* Serial Bit Clock Direction */
#define	SWSD		(1 << 14)	/* Serial WS Direction */
#define	SCKP		(1 << 13)	/* Serial Bit Clock Polarity */
#define	SWSP		(1 << 12)	/* Serial WS Polarity */
#define	SDTA		(1 << 10)	/* Serial Data Alignment */
#define	DEL		(1 <<  8)	/* Serial Data Delay */
#define	CKDV(v)		(v <<  4)	/* Serial Clock Division Ratio */
#define	TRMD		(1 <<  1)	/* Transmit/Receive Mode Select */
#define	EN		(1 <<  0)	/* SSI Module Enable */

/*
 * SSISR
 */
#define	UIRQ		(1 << 27)	/* Underflow Error Interrupt Status */
#define	OIRQ		(1 << 26)	/* Overflow Error Interrupt Status */
#define	IIRQ		(1 << 25)	/* Idle Mode Interrupt Status */
#define	DIRQ		(1 << 24)	/* Data Interrupt Status Flag */

55 56 57 58 59
/*
 * SSIWSR
 */
#define CONT		(1 << 8)	/* WS Continue Function */

60 61
#define SSI_NAME "ssi"

62 63 64 65
struct rsnd_ssi {
	struct rsnd_ssi_platform_info *info; /* rcar_snd.h */
	struct rsnd_ssi *parent;
	struct rsnd_mod mod;
66
	struct rsnd_dma *dma;
67 68 69

	u32 cr_own;
	u32 cr_clk;
70
	int chan;
71 72 73 74 75 76 77
	int err;
	unsigned int usrcnt;
};

#define for_each_rsnd_ssi(pos, priv, i)					\
	for (i = 0;							\
	     (i < rsnd_ssi_nr(priv)) &&					\
78
		((pos) = ((struct rsnd_ssi *)(priv)->ssi + i));		\
79 80
	     i++)

81
#define rsnd_ssi_to_dma(mod) ((ssi)->dma)
82
#define rsnd_ssi_nr(priv) ((priv)->ssi_nr)
83
#define rsnd_mod_to_ssi(_mod) container_of((_mod), struct rsnd_ssi, mod)
84
#define rsnd_ssi_pio_available(ssi) ((ssi)->info->irq > 0)
85
#define rsnd_ssi_parent(ssi) ((ssi)->parent)
86
#define rsnd_ssi_mode_flags(p) ((p)->info->flags)
87
#define rsnd_ssi_dai_id(ssi) ((ssi)->info->dai_id)
88 89
#define rsnd_ssi_of_node(priv) \
	of_get_child_by_name(rsnd_priv_to_dev(priv)->of_node, "rcar_sound,ssi")
90

91
int rsnd_ssi_use_busif(struct rsnd_dai_stream *io)
92
{
93
	struct rsnd_mod *mod = rsnd_io_to_mod_ssi(io);
94 95 96
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	int use_busif = 0;

97 98 99
	if (!rsnd_ssi_is_dma_mode(mod))
		return 0;

100 101 102 103 104 105 106 107
	if (!(rsnd_ssi_mode_flags(ssi) & RSND_SSI_NO_BUSIF))
		use_busif = 1;
	if (rsnd_io_to_mod_src(io))
		use_busif = 1;

	return use_busif;
}

108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126
static void rsnd_ssi_status_check(struct rsnd_mod *mod,
				  u32 bit)
{
	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
	struct device *dev = rsnd_priv_to_dev(priv);
	u32 status;
	int i;

	for (i = 0; i < 1024; i++) {
		status = rsnd_mod_read(mod, SSISR);
		if (status & bit)
			return;

		udelay(50);
	}

	dev_warn(dev, "status check failed\n");
}

127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154
static int rsnd_ssi_irq_enable(struct rsnd_mod *ssi_mod)
{
	struct rsnd_priv *priv = rsnd_mod_to_priv(ssi_mod);

	if (rsnd_is_gen1(priv))
		return 0;

	/* enable SSI interrupt if Gen2 */
	rsnd_mod_write(ssi_mod, SSI_INT_ENABLE,
		       rsnd_ssi_is_dma_mode(ssi_mod) ?
		       0x0e000000 : 0x0f000000);

	return 0;
}

static int rsnd_ssi_irq_disable(struct rsnd_mod *ssi_mod)
{
	struct rsnd_priv *priv = rsnd_mod_to_priv(ssi_mod);

	if (rsnd_is_gen1(priv))
		return 0;

	/* disable SSI interrupt if Gen2 */
	rsnd_mod_write(ssi_mod, SSI_INT_ENABLE, 0x00000000);

	return 0;
}

155
static int rsnd_ssi_master_clk_start(struct rsnd_ssi *ssi,
156
				     struct rsnd_dai_stream *io)
157
{
158
	struct rsnd_priv *priv = rsnd_io_to_priv(io);
159
	struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
160
	struct device *dev = rsnd_priv_to_dev(priv);
161
	struct rsnd_mod *mod = rsnd_mod_get(ssi);
162
	int j, ret;
163 164 165 166
	int ssi_clk_mul_table[] = {
		1, 2, 4, 8, 16, 6, 12,
	};
	unsigned int main_rate;
167
	unsigned int rate = rsnd_src_get_ssi_rate(priv, io, runtime);
168 169 170 171

	/*
	 * Find best clock, and try to start ADG
	 */
172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190
	for (j = 0; j < ARRAY_SIZE(ssi_clk_mul_table); j++) {

		/*
		 * this driver is assuming that
		 * system word is 64fs (= 2 x 32bit)
		 * see rsnd_ssi_init()
		 */
		main_rate = rate * 32 * 2 * ssi_clk_mul_table[j];

		ret = rsnd_adg_ssi_clk_try_start(mod, main_rate);
		if (0 == ret) {
			ssi->cr_clk	= FORCE | SWL_32 |
				SCKD | SWSD | CKDV(j);

			dev_dbg(dev, "%s[%d] outputs %u Hz\n",
				rsnd_mod_name(mod),
				rsnd_mod_id(mod), rate);

			return 0;
191 192 193 194 195 196 197 198 199
		}
	}

	dev_err(dev, "unsupported clock rate\n");
	return -EIO;
}

static void rsnd_ssi_master_clk_stop(struct rsnd_ssi *ssi)
{
200 201
	struct rsnd_mod *mod = rsnd_mod_get(ssi);

202
	ssi->cr_clk = 0;
203
	rsnd_adg_ssi_clk_stop(mod);
204 205 206 207 208
}

static void rsnd_ssi_hw_start(struct rsnd_ssi *ssi,
			      struct rsnd_dai_stream *io)
{
209
	struct rsnd_priv *priv = rsnd_io_to_priv(io);
210
	struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
211
	struct device *dev = rsnd_priv_to_dev(priv);
212
	struct rsnd_mod *mod = rsnd_mod_get(ssi);
213
	u32 cr_mode;
214 215 216
	u32 cr;

	if (0 == ssi->usrcnt) {
217
		rsnd_mod_power_on(mod);
218

219
		if (rsnd_rdai_is_clk_master(rdai)) {
220 221 222 223
			struct rsnd_ssi *ssi_parent = rsnd_ssi_parent(ssi);

			if (ssi_parent)
				rsnd_ssi_hw_start(ssi_parent, io);
224
			else
225
				rsnd_ssi_master_clk_start(ssi, io);
226 227 228
		}
	}

229
	if (rsnd_ssi_is_dma_mode(mod)) {
230 231 232 233 234
		cr_mode = UIEN | OIEN |	/* over/under run */
			  DMEN;		/* DMA : enable DMA */
	} else {
		cr_mode = DIEN;		/* PIO : enable Data interrupt */
	}
235

236 237
	cr  =	ssi->cr_own	|
		ssi->cr_clk	|
238
		cr_mode		|
239
		EN;
240

241
	rsnd_mod_write(mod, SSICR, cr);
242

243
	/* enable WS continue */
244
	if (rsnd_rdai_is_clk_master(rdai))
245
		rsnd_mod_write(mod, SSIWSR, CONT);
246

247
	/* clear error status */
248
	rsnd_mod_write(mod, SSISR, 0);
249

250 251
	ssi->usrcnt++;

252
	dev_dbg(dev, "%s[%d] hw started\n",
253
		rsnd_mod_name(mod), rsnd_mod_id(mod));
254 255
}

256
static void rsnd_ssi_hw_stop(struct rsnd_dai_stream *io, struct rsnd_ssi *ssi)
257
{
258 259
	struct rsnd_mod *mod = rsnd_mod_get(ssi);
	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
260
	struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
261 262 263
	struct device *dev = rsnd_priv_to_dev(priv);
	u32 cr;

264 265
	if (0 == ssi->usrcnt) {
		dev_err(dev, "%s called without starting\n", __func__);
266
		return;
267
	}
268 269 270 271 272 273 274 275 276 277 278

	ssi->usrcnt--;

	if (0 == ssi->usrcnt) {
		/*
		 * disable all IRQ,
		 * and, wait all data was sent
		 */
		cr  =	ssi->cr_own	|
			ssi->cr_clk;

279 280
		rsnd_mod_write(mod, SSICR, cr | EN);
		rsnd_ssi_status_check(mod, DIRQ);
281 282 283 284 285

		/*
		 * disable SSI,
		 * and, wait idle state
		 */
286 287
		rsnd_mod_write(mod, SSICR, cr);	/* disabled all */
		rsnd_ssi_status_check(mod, IIRQ);
288

289
		if (rsnd_rdai_is_clk_master(rdai)) {
290 291 292
			struct rsnd_ssi *ssi_parent = rsnd_ssi_parent(ssi);

			if (ssi_parent)
293
				rsnd_ssi_hw_stop(io, ssi_parent);
294 295 296 297
			else
				rsnd_ssi_master_clk_stop(ssi);
		}

298
		rsnd_mod_power_off(mod);
299 300

		ssi->chan = 0;
301 302
	}

303
	dev_dbg(dev, "%s[%d] hw stopped\n",
304
		rsnd_mod_name(mod), rsnd_mod_id(mod));
305 306 307 308 309 310
}

/*
 *	SSI mod common functions
 */
static int rsnd_ssi_init(struct rsnd_mod *mod,
311
			 struct rsnd_dai_stream *io,
312
			 struct rsnd_priv *priv)
313 314
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
315
	struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348
	struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
	u32 cr;

	cr = FORCE;

	/*
	 * always use 32bit system word for easy clock calculation.
	 * see also rsnd_ssi_master_clk_enable()
	 */
	cr |= SWL_32;

	/*
	 * init clock settings for SSICR
	 */
	switch (runtime->sample_bits) {
	case 16:
		cr |= DWL_16;
		break;
	case 32:
		cr |= DWL_24;
		break;
	default:
		return -EIO;
	}

	if (rdai->bit_clk_inv)
		cr |= SCKP;
	if (rdai->frm_clk_inv)
		cr |= SWSP;
	if (rdai->data_alignment)
		cr |= SDTA;
	if (rdai->sys_delay)
		cr |= DEL;
349
	if (rsnd_io_is_play(io))
350 351 352 353 354 355 356 357 358 359 360 361
		cr |= TRMD;

	/*
	 * set ssi parameter
	 */
	ssi->cr_own	= cr;
	ssi->err	= -1; /* ignore 1st error */

	return 0;
}

static int rsnd_ssi_quit(struct rsnd_mod *mod,
362
			 struct rsnd_dai_stream *io,
363
			 struct rsnd_priv *priv)
364 365 366 367 368
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	struct device *dev = rsnd_priv_to_dev(priv);

	if (ssi->err > 0)
369 370
		dev_warn(dev, "%s[%d] under/over flow err = %d\n",
			 rsnd_mod_name(mod), rsnd_mod_id(mod), ssi->err);
371 372 373 374 375 376 377

	ssi->cr_own	= 0;
	ssi->err	= 0;

	return 0;
}

378
static int rsnd_ssi_hw_params(struct rsnd_mod *mod,
379
			      struct rsnd_dai_stream *io,
380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402
			      struct snd_pcm_substream *substream,
			      struct snd_pcm_hw_params *params)
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	struct rsnd_ssi *ssi_parent = rsnd_ssi_parent(ssi);
	int chan = params_channels(params);

	/*
	 * Already working.
	 * It will happen if SSI has parent/child connection.
	 */
	if (ssi->usrcnt) {
		/*
		 * it is error if child <-> parent SSI uses
		 * different channels.
		 */
		if (ssi->chan != chan)
			return -EIO;
	}

	/* It will be removed on rsnd_ssi_hw_stop */
	ssi->chan = chan;
	if (ssi_parent)
403
		return rsnd_ssi_hw_params(rsnd_mod_get(ssi_parent), io,
404
					  substream, params);
405 406 407 408

	return 0;
}

409 410
static void rsnd_ssi_record_error(struct rsnd_ssi *ssi, u32 status)
{
411 412
	struct rsnd_mod *mod = rsnd_mod_get(ssi);

413 414 415 416 417
	/* under/over flow error */
	if (status & (UIRQ | OIRQ)) {
		ssi->err++;

		/* clear error status */
418
		rsnd_mod_write(mod, SSISR, 0);
419 420 421
	}
}

422
static int rsnd_ssi_start(struct rsnd_mod *mod,
423
			  struct rsnd_dai_stream *io,
424
			  struct rsnd_priv *priv)
425 426 427
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);

428
	rsnd_src_ssiu_start(mod, io, rsnd_ssi_use_busif(io));
429

430
	rsnd_ssi_hw_start(ssi, io);
431

432
	rsnd_ssi_irq_enable(mod);
433 434 435 436 437

	return 0;
}

static int rsnd_ssi_stop(struct rsnd_mod *mod,
438
			 struct rsnd_dai_stream *io,
439
			 struct rsnd_priv *priv)
440 441 442
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);

443
	rsnd_ssi_irq_disable(mod);
444 445 446

	rsnd_ssi_record_error(ssi, rsnd_mod_read(mod, SSISR));

447
	rsnd_ssi_hw_stop(io, ssi);
448

449
	rsnd_src_ssiu_stop(mod, io);
450 451 452 453

	return 0;
}

454 455
static void __rsnd_ssi_interrupt(struct rsnd_mod *mod,
				 struct rsnd_dai_stream *io)
456
{
457
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
458
	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
459
	int is_dma = rsnd_ssi_is_dma_mode(mod);
460
	u32 status;
461
	bool elapsed = false;
462 463

	spin_lock(&priv->lock);
464

465
	/* ignore all cases if not working */
466
	if (!rsnd_io_is_working(io))
467 468 469
		goto rsnd_ssi_interrupt_out;

	status = rsnd_mod_read(mod, SSISR);
470 471

	/* PIO only */
472
	if (!is_dma && (status & DIRQ)) {
473 474 475 476 477 478 479 480 481
		struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
		u32 *buf = (u32 *)(runtime->dma_area +
				   rsnd_dai_pointer_offset(io, 0));

		/*
		 * 8/16/32 data can be assesse to TDR/RDR register
		 * directly as 32bit data
		 * see rsnd_ssi_init()
		 */
482
		if (rsnd_io_is_play(io))
483
			rsnd_mod_write(mod, SSITDR, *buf);
484
		else
485
			*buf = rsnd_mod_read(mod, SSIRDR);
486

487
		elapsed = rsnd_dai_pointer_update(io, sizeof(*buf));
488
	}
489

490 491
	/* DMA only */
	if (is_dma && (status & (UIRQ | OIRQ))) {
492 493 494 495 496 497 498
		struct device *dev = rsnd_priv_to_dev(priv);

		/*
		 * restart SSI
		 */
		dev_dbg(dev, "%s[%d] restart\n",
			rsnd_mod_name(mod), rsnd_mod_id(mod));
499

500
		rsnd_ssi_stop(mod, io, priv);
501
		if (ssi->err < 1024)
502
			rsnd_ssi_start(mod, io, priv);
503 504
		else
			dev_warn(dev, "no more SSI restart\n");
505 506
	}

507 508
	rsnd_ssi_record_error(ssi, status);

509 510 511
rsnd_ssi_interrupt_out:
	spin_unlock(&priv->lock);

512 513
	if (elapsed)
		rsnd_dai_period_elapsed(io);
514 515 516 517 518 519 520
}

static irqreturn_t rsnd_ssi_interrupt(int irq, void *data)
{
	struct rsnd_mod *mod = data;

	rsnd_mod_interrupt(mod, __rsnd_ssi_interrupt);
521

522
	return IRQ_HANDLED;
523 524
}

525 526 527
/*
 *		SSI PIO
 */
528
static int rsnd_ssi_pio_probe(struct rsnd_mod *mod,
529
			      struct rsnd_dai_stream *io,
530
			      struct rsnd_priv *priv)
531 532 533 534 535
{
	struct device *dev = rsnd_priv_to_dev(priv);
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	int ret;

536 537
	ret = devm_request_irq(dev, ssi->info->irq,
			       rsnd_ssi_interrupt,
538
			       IRQF_SHARED,
539
			       dev_name(dev), mod);
540

541 542 543
	return ret;
}

544
static struct rsnd_mod_ops rsnd_ssi_pio_ops = {
545
	.name	= SSI_NAME,
546
	.probe	= rsnd_ssi_pio_probe,
547 548
	.init	= rsnd_ssi_init,
	.quit	= rsnd_ssi_quit,
549 550
	.start	= rsnd_ssi_start,
	.stop	= rsnd_ssi_stop,
551
	.hw_params = rsnd_ssi_hw_params,
552 553
};

554
static int rsnd_ssi_dma_probe(struct rsnd_mod *mod,
555
			      struct rsnd_dai_stream *io,
556
			      struct rsnd_priv *priv)
557 558 559 560 561 562
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	struct device *dev = rsnd_priv_to_dev(priv);
	int dma_id = ssi->info->dma_id;
	int ret;

563 564
	ret = devm_request_irq(dev, ssi->info->irq,
			       rsnd_ssi_interrupt,
565
			       IRQF_SHARED,
566
			       dev_name(dev), mod);
567
	if (ret)
568
		return ret;
569

570
	ssi->dma = rsnd_dma_attach(io, mod, dma_id);
571 572
	if (IS_ERR(ssi->dma))
		return PTR_ERR(ssi->dma);
573

574 575 576 577
	return ret;
}

static int rsnd_ssi_dma_remove(struct rsnd_mod *mod,
578
			       struct rsnd_dai_stream *io,
579
			       struct rsnd_priv *priv)
580
{
581 582
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	struct device *dev = rsnd_priv_to_dev(priv);
583
	int irq = ssi->info->irq;
584

585
	rsnd_dma_quit(io, rsnd_ssi_to_dma(ssi));
586

587
	/* PIO will request IRQ again */
588
	devm_free_irq(dev, irq, mod);
589

590 591 592 593
	return 0;
}

static int rsnd_ssi_fallback(struct rsnd_mod *mod,
594
			     struct rsnd_dai_stream *io,
595
			     struct rsnd_priv *priv)
596
{
597 598 599 600 601 602 603 604 605 606 607 608 609 610
	struct device *dev = rsnd_priv_to_dev(priv);

	/*
	 * fallback to PIO
	 *
	 * SSI .probe might be called again.
	 * see
	 *	rsnd_rdai_continuance_probe()
	 */
	mod->ops = &rsnd_ssi_pio_ops;

	dev_info(dev, "%s[%d] fallback to PIO mode\n",
		 rsnd_mod_name(mod), rsnd_mod_id(mod));

611 612 613
	return 0;
}

614
static int rsnd_ssi_dma_start(struct rsnd_mod *mod,
615
			      struct rsnd_dai_stream *io,
616
			      struct rsnd_priv *priv)
617
{
618 619
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	struct rsnd_dma *dma = rsnd_ssi_to_dma(ssi);
620

621
	rsnd_dma_start(io, dma);
622

623
	rsnd_ssi_start(mod, io, priv);
624

625 626 627 628
	return 0;
}

static int rsnd_ssi_dma_stop(struct rsnd_mod *mod,
629
			     struct rsnd_dai_stream *io,
630
			     struct rsnd_priv *priv)
631
{
632 633
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	struct rsnd_dma *dma = rsnd_ssi_to_dma(ssi);
634

635
	rsnd_ssi_stop(mod, io, priv);
636

637
	rsnd_dma_stop(io, dma);
638

639 640 641
	return 0;
}

642 643
static struct dma_chan *rsnd_ssi_dma_req(struct rsnd_dai_stream *io,
					 struct rsnd_mod *mod)
644
{
645 646 647 648
	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
	int is_play = rsnd_io_is_play(io);
	char *name;

649
	if (rsnd_ssi_use_busif(io))
650 651 652 653 654 655
		name = is_play ? "rxu" : "txu";
	else
		name = is_play ? "rx" : "tx";

	return rsnd_dma_request_channel(rsnd_ssi_of_node(priv),
					mod, name);
656 657
}

658
static struct rsnd_mod_ops rsnd_ssi_dma_ops = {
659
	.name	= SSI_NAME,
660
	.dma_req = rsnd_ssi_dma_req,
661 662
	.probe	= rsnd_ssi_dma_probe,
	.remove	= rsnd_ssi_dma_remove,
663 664 665 666
	.init	= rsnd_ssi_init,
	.quit	= rsnd_ssi_quit,
	.start	= rsnd_ssi_dma_start,
	.stop	= rsnd_ssi_dma_stop,
667
	.fallback = rsnd_ssi_fallback,
668
	.hw_params = rsnd_ssi_hw_params,
669 670
};

671 672 673 674 675 676
int rsnd_ssi_is_dma_mode(struct rsnd_mod *mod)
{
	return mod->ops == &rsnd_ssi_dma_ops;
}


677 678 679 680
/*
 *		Non SSI
 */
static struct rsnd_mod_ops rsnd_ssi_non_ops = {
681
	.name	= SSI_NAME,
682 683 684 685 686 687 688
};

/*
 *		ssi mod function
 */
struct rsnd_mod *rsnd_ssi_mod_get(struct rsnd_priv *priv, int id)
{
689 690
	if (WARN_ON(id < 0 || id >= rsnd_ssi_nr(priv)))
		id = 0;
691

692
	return rsnd_mod_get((struct rsnd_ssi *)(priv->ssi) + id);
693 694
}

695
int __rsnd_ssi_is_pin_sharing(struct rsnd_mod *mod)
696 697 698 699 700 701
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);

	return !!(rsnd_ssi_mode_flags(ssi) & RSND_SSI_CLK_PIN_SHARE);
}

702
static void rsnd_ssi_parent_setup(struct rsnd_priv *priv, struct rsnd_ssi *ssi)
703
{
704 705
	struct rsnd_mod *mod = rsnd_mod_get(ssi);

706
	if (!__rsnd_ssi_is_pin_sharing(mod))
707 708
		return;

709
	switch (rsnd_mod_id(mod)) {
710 711 712 713 714 715 716 717 718 719 720 721 722
	case 1:
	case 2:
		ssi->parent = rsnd_mod_to_ssi(rsnd_ssi_mod_get(priv, 0));
		break;
	case 4:
		ssi->parent = rsnd_mod_to_ssi(rsnd_ssi_mod_get(priv, 3));
		break;
	case 8:
		ssi->parent = rsnd_mod_to_ssi(rsnd_ssi_mod_get(priv, 7));
		break;
	}
}

723 724 725 726 727 728 729 730 731 732 733 734

static void rsnd_of_parse_ssi(struct platform_device *pdev,
			      const struct rsnd_of_data *of_data,
			      struct rsnd_priv *priv)
{
	struct device_node *node;
	struct device_node *np;
	struct rsnd_ssi_platform_info *ssi_info;
	struct rcar_snd_info *info = rsnd_priv_to_info(priv);
	struct device *dev = &pdev->dev;
	int nr, i;

735
	node = rsnd_ssi_of_node(priv);
736 737 738 739 740
	if (!node)
		return;

	nr = of_get_child_count(node);
	if (!nr)
741
		goto rsnd_of_parse_ssi_end;
742 743 744 745 746 747

	ssi_info = devm_kzalloc(dev,
				sizeof(struct rsnd_ssi_platform_info) * nr,
				GFP_KERNEL);
	if (!ssi_info) {
		dev_err(dev, "ssi info allocation error\n");
748
		goto rsnd_of_parse_ssi_end;
749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768
	}

	info->ssi_info		= ssi_info;
	info->ssi_info_nr	= nr;

	i = -1;
	for_each_child_of_node(node, np) {
		i++;

		ssi_info = info->ssi_info + i;

		/*
		 * pin settings
		 */
		if (of_get_property(np, "shared-pin", NULL))
			ssi_info->flags |= RSND_SSI_CLK_PIN_SHARE;

		/*
		 * irq
		 */
769
		ssi_info->irq = irq_of_parse_and_map(np, 0);
770 771 772 773 774 775

		/*
		 * DMA
		 */
		ssi_info->dma_id = of_get_property(np, "pio-transfer", NULL) ?
			0 : 1;
776 777 778

		if (of_get_property(np, "no-busif", NULL))
			ssi_info->flags |= RSND_SSI_NO_BUSIF;
779
	}
780 781 782

rsnd_of_parse_ssi_end:
	of_node_put(node);
783 784
}

785
int rsnd_ssi_probe(struct platform_device *pdev,
786
		   const struct rsnd_of_data *of_data,
787 788
		   struct rsnd_priv *priv)
{
789
	struct rcar_snd_info *info = rsnd_priv_to_info(priv);
790 791 792 793 794 795
	struct rsnd_ssi_platform_info *pinfo;
	struct device *dev = rsnd_priv_to_dev(priv);
	struct rsnd_mod_ops *ops;
	struct clk *clk;
	struct rsnd_ssi *ssi;
	char name[RSND_SSI_NAME_SIZE];
796
	int i, nr, ret;
797

798 799
	rsnd_of_parse_ssi(pdev, of_data, priv);

800 801 802 803
	/*
	 *	init SSI
	 */
	nr	= info->ssi_info_nr;
804
	ssi	= devm_kzalloc(dev, sizeof(*ssi) * nr, GFP_KERNEL);
805
	if (!ssi)
806 807
		return -ENOMEM;

808 809
	priv->ssi	= ssi;
	priv->ssi_nr	= nr;
810 811 812 813

	for_each_rsnd_ssi(ssi, priv, i) {
		pinfo = &info->ssi_info[i];

814 815
		snprintf(name, RSND_SSI_NAME_SIZE, "%s.%d",
			 SSI_NAME, i);
816

817
		clk = devm_clk_get(dev, name);
818 819 820 821 822 823
		if (IS_ERR(clk))
			return PTR_ERR(clk);

		ssi->info	= pinfo;

		ops = &rsnd_ssi_non_ops;
824 825 826 827
		if (pinfo->dma_id > 0)
			ops = &rsnd_ssi_dma_ops;
		else if (rsnd_ssi_pio_available(ssi))
			ops = &rsnd_ssi_pio_ops;
828

829 830
		ret = rsnd_mod_init(priv, rsnd_mod_get(ssi), ops, clk,
				    RSND_MOD_SSI, i);
831 832
		if (ret)
			return ret;
833

834
		rsnd_ssi_parent_setup(priv, ssi);
835 836 837 838
	}

	return 0;
}
839 840 841 842 843 844 845 846

void rsnd_ssi_remove(struct platform_device *pdev,
		     struct rsnd_priv *priv)
{
	struct rsnd_ssi *ssi;
	int i;

	for_each_rsnd_ssi(ssi, priv, i) {
847
		rsnd_mod_quit(rsnd_mod_get(ssi));
848 849
	}
}