ssi.c 17.0 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 66 67 68
struct rsnd_ssi {
	struct rsnd_ssi_platform_info *info; /* rcar_snd.h */
	struct rsnd_ssi *parent;
	struct rsnd_mod mod;

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

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

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

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

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

99 100 101 102 103 104 105 106
	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;
}

107 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");
}

static int rsnd_ssi_master_clk_start(struct rsnd_ssi *ssi,
127
				     struct rsnd_dai_stream *io)
128
{
129
	struct rsnd_priv *priv = rsnd_io_to_priv(io);
130
	struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
131 132 133 134 135 136 137 138 139
	struct device *dev = rsnd_priv_to_dev(priv);
	int i, j, ret;
	int adg_clk_div_table[] = {
		1, 6, /* see adg.c */
	};
	int ssi_clk_mul_table[] = {
		1, 2, 4, 8, 16, 6, 12,
	};
	unsigned int main_rate;
140
	unsigned int rate = rsnd_src_get_ssi_rate(priv, io, runtime);
141 142 143 144 145 146 147 148 149 150

	/*
	 * Find best clock, and try to start ADG
	 */
	for (i = 0; i < ARRAY_SIZE(adg_clk_div_table); i++) {
		for (j = 0; j < ARRAY_SIZE(ssi_clk_mul_table); j++) {

			/*
			 * this driver is assuming that
			 * system word is 64fs (= 2 x 32bit)
K
Kuninori Morimoto 已提交
151
			 * see rsnd_ssi_init()
152 153 154 155 156 157 158 159 160
			 */
			main_rate = rate / adg_clk_div_table[i]
				* 32 * 2 * ssi_clk_mul_table[j];

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

161 162
				dev_dbg(dev, "%s[%d] outputs %u Hz\n",
					rsnd_mod_name(&ssi->mod),
163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182
					rsnd_mod_id(&ssi->mod), rate);

				return 0;
			}
		}
	}

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

static void rsnd_ssi_master_clk_stop(struct rsnd_ssi *ssi)
{
	ssi->cr_clk = 0;
	rsnd_adg_ssi_clk_stop(&ssi->mod);
}

static void rsnd_ssi_hw_start(struct rsnd_ssi *ssi,
			      struct rsnd_dai_stream *io)
{
183
	struct rsnd_priv *priv = rsnd_io_to_priv(io);
184
	struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
185
	struct device *dev = rsnd_priv_to_dev(priv);
186
	u32 cr_mode;
187 188 189
	u32 cr;

	if (0 == ssi->usrcnt) {
190
		rsnd_mod_hw_start(&ssi->mod);
191

192
		if (rsnd_rdai_is_clk_master(rdai)) {
193 194 195 196
			struct rsnd_ssi *ssi_parent = rsnd_ssi_parent(ssi);

			if (ssi_parent)
				rsnd_ssi_hw_start(ssi_parent, io);
197
			else
198
				rsnd_ssi_master_clk_start(ssi, io);
199 200 201
		}
	}

202
	cr_mode = rsnd_ssi_is_dma_mode(&ssi->mod) ?
203 204
		DMEN :	/* DMA : enable DMA */
		DIEN;	/* PIO : enable Data interrupt */
205 206


207 208
	cr  =	ssi->cr_own	|
		ssi->cr_clk	|
209
		cr_mode		|
210
		UIEN | OIEN | EN;
211 212 213

	rsnd_mod_write(&ssi->mod, SSICR, cr);

214
	/* enable WS continue */
215
	if (rsnd_rdai_is_clk_master(rdai))
216 217
		rsnd_mod_write(&ssi->mod, SSIWSR, CONT);

218 219 220
	/* clear error status */
	rsnd_mod_write(&ssi->mod, SSISR, 0);

221 222
	ssi->usrcnt++;

223 224
	dev_dbg(dev, "%s[%d] hw started\n",
		rsnd_mod_name(&ssi->mod), rsnd_mod_id(&ssi->mod));
225 226
}

227
static void rsnd_ssi_hw_stop(struct rsnd_ssi *ssi)
228 229
{
	struct rsnd_priv *priv = rsnd_mod_to_priv(&ssi->mod);
230 231
	struct rsnd_dai_stream *io = rsnd_mod_to_io(&ssi->mod);
	struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
232 233 234
	struct device *dev = rsnd_priv_to_dev(priv);
	u32 cr;

235 236
	if (0 == ssi->usrcnt) {
		dev_err(dev, "%s called without starting\n", __func__);
237
		return;
238
	}
239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259

	ssi->usrcnt--;

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

		rsnd_mod_write(&ssi->mod, SSICR, cr | EN);
		rsnd_ssi_status_check(&ssi->mod, DIRQ);

		/*
		 * disable SSI,
		 * and, wait idle state
		 */
		rsnd_mod_write(&ssi->mod, SSICR, cr);	/* disabled all */
		rsnd_ssi_status_check(&ssi->mod, IIRQ);

260
		if (rsnd_rdai_is_clk_master(rdai)) {
261 262 263 264
			struct rsnd_ssi *ssi_parent = rsnd_ssi_parent(ssi);

			if (ssi_parent)
				rsnd_ssi_hw_stop(ssi_parent);
265 266 267 268
			else
				rsnd_ssi_master_clk_stop(ssi);
		}

269
		rsnd_mod_hw_stop(&ssi->mod);
270 271

		ssi->chan = 0;
272 273
	}

274 275
	dev_dbg(dev, "%s[%d] hw stopped\n",
		rsnd_mod_name(&ssi->mod), rsnd_mod_id(&ssi->mod));
276 277 278 279 280 281
}

/*
 *	SSI mod common functions
 */
static int rsnd_ssi_init(struct rsnd_mod *mod,
282
			 struct rsnd_priv *priv)
283 284
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
285
	struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
286
	struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319
	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;
320
	if (rsnd_io_is_play(io))
321 322 323 324 325 326 327 328 329 330 331 332
		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,
333
			 struct rsnd_priv *priv)
334 335 336 337 338
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	struct device *dev = rsnd_priv_to_dev(priv);

	if (ssi->err > 0)
339 340
		dev_warn(dev, "%s[%d] under/over flow err = %d\n",
			 rsnd_mod_name(mod), rsnd_mod_id(mod), ssi->err);
341 342 343 344 345 346 347

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

	return 0;
}

348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376
static int rsnd_ssi_hw_params(struct rsnd_mod *mod,
			      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)
		return rsnd_ssi_hw_params(&ssi_parent->mod, substream, params);

	return 0;
}

377 378 379 380 381 382 383 384 385 386 387
static void rsnd_ssi_record_error(struct rsnd_ssi *ssi, u32 status)
{
	/* under/over flow error */
	if (status & (UIRQ | OIRQ)) {
		ssi->err++;

		/* clear error status */
		rsnd_mod_write(&ssi->mod, SSISR, 0);
	}
}

388
static int rsnd_ssi_start(struct rsnd_mod *mod,
389
			  struct rsnd_priv *priv)
390 391 392 393
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);

394
	rsnd_src_ssiu_start(mod, rsnd_ssi_use_busif(mod));
395

396
	rsnd_ssi_hw_start(ssi, io);
397

398
	rsnd_src_ssi_irq_enable(mod);
399 400 401 402 403

	return 0;
}

static int rsnd_ssi_stop(struct rsnd_mod *mod,
404
			 struct rsnd_priv *priv)
405 406 407
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);

408
	rsnd_src_ssi_irq_disable(mod);
409 410 411

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

412
	rsnd_ssi_hw_stop(ssi);
413

414
	rsnd_src_ssiu_stop(mod);
415 416 417 418

	return 0;
}

419
static irqreturn_t rsnd_ssi_interrupt(int irq, void *data)
420 421
{
	struct rsnd_ssi *ssi = data;
422
	struct rsnd_mod *mod = &ssi->mod;
423
	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
424
	struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
425
	int is_dma = rsnd_ssi_is_dma_mode(mod);
426
	u32 status = rsnd_mod_read(mod, SSISR);
427

428 429 430 431
	if (!io)
		return IRQ_NONE;

	/* PIO only */
432
	if (!is_dma && (status & DIRQ)) {
433 434 435 436 437 438 439 440 441
		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()
		 */
442
		if (rsnd_io_is_play(io))
443
			rsnd_mod_write(mod, SSITDR, *buf);
444
		else
445
			*buf = rsnd_mod_read(mod, SSIRDR);
446 447

		rsnd_dai_pointer_update(io, sizeof(*buf));
448
	}
449

450 451 452 453 454 455 456 457 458
	/* PIO / DMA */
	if (status & (UIRQ | OIRQ)) {
		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));
459 460 461 462 463 464

		rsnd_ssi_stop(mod, priv);
		if (ssi->err < 1024)
			rsnd_ssi_start(mod, priv);
		else
			dev_warn(dev, "no more SSI restart\n");
465 466
	}

467 468 469
	rsnd_ssi_record_error(ssi, status);

	return IRQ_HANDLED;
470 471
}

472 473 474
/*
 *		SSI PIO
 */
475
static int rsnd_ssi_pio_probe(struct rsnd_mod *mod,
476
			      struct rsnd_priv *priv)
477 478 479 480 481
{
	struct device *dev = rsnd_priv_to_dev(priv);
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	int ret;

482 483
	ret = devm_request_irq(dev, ssi->info->irq,
			       rsnd_ssi_interrupt,
484 485
			       IRQF_SHARED,
			       dev_name(dev), ssi);
486

487 488 489
	return ret;
}

490
static struct rsnd_mod_ops rsnd_ssi_pio_ops = {
491
	.name	= SSI_NAME,
492
	.probe	= rsnd_ssi_pio_probe,
493 494
	.init	= rsnd_ssi_init,
	.quit	= rsnd_ssi_quit,
495 496
	.start	= rsnd_ssi_start,
	.stop	= rsnd_ssi_stop,
497
	.hw_params = rsnd_ssi_hw_params,
498 499
};

500
static int rsnd_ssi_dma_probe(struct rsnd_mod *mod,
501
			      struct rsnd_priv *priv)
502 503 504 505 506 507
{
	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;

508 509
	ret = devm_request_irq(dev, ssi->info->irq,
			       rsnd_ssi_interrupt,
510 511 512
			       IRQF_SHARED,
			       dev_name(dev), ssi);
	if (ret)
513
		return ret;
514

515 516 517
	ret = rsnd_dma_init(
		priv, rsnd_mod_to_dma(mod),
		dma_id);
518

519 520 521 522
	return ret;
}

static int rsnd_ssi_dma_remove(struct rsnd_mod *mod,
523
			       struct rsnd_priv *priv)
524
{
525 526
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	struct device *dev = rsnd_priv_to_dev(priv);
527
	int irq = ssi->info->irq;
528

529
	rsnd_dma_quit(rsnd_mod_to_dma(mod));
530

531 532 533
	/* PIO will request IRQ again */
	devm_free_irq(dev, irq, ssi);

534 535 536 537
	return 0;
}

static int rsnd_ssi_fallback(struct rsnd_mod *mod,
538
			     struct rsnd_priv *priv)
539
{
540 541 542 543 544 545 546 547 548 549 550 551 552 553
	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));

554 555 556
	return 0;
}

557
static int rsnd_ssi_dma_start(struct rsnd_mod *mod,
558
			      struct rsnd_priv *priv)
559
{
560
	struct rsnd_dma *dma = rsnd_mod_to_dma(mod);
561

562 563
	rsnd_dma_start(dma);

564 565
	rsnd_ssi_start(mod, priv);

566 567 568 569
	return 0;
}

static int rsnd_ssi_dma_stop(struct rsnd_mod *mod,
570
			     struct rsnd_priv *priv)
571
{
572
	struct rsnd_dma *dma = rsnd_mod_to_dma(mod);
573

574
	rsnd_ssi_stop(mod, priv);
575

576 577
	rsnd_dma_stop(dma);

578 579 580
	return 0;
}

581
static struct dma_chan *rsnd_ssi_dma_req(struct rsnd_mod *mod)
582
{
583 584 585 586 587 588 589 590 591 592 593 594
	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
	struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
	int is_play = rsnd_io_is_play(io);
	char *name;

	if (rsnd_ssi_use_busif(mod))
		name = is_play ? "rxu" : "txu";
	else
		name = is_play ? "rx" : "tx";

	return rsnd_dma_request_channel(rsnd_ssi_of_node(priv),
					mod, name);
595 596
}

597
static struct rsnd_mod_ops rsnd_ssi_dma_ops = {
598
	.name	= SSI_NAME,
599
	.dma_req = rsnd_ssi_dma_req,
600 601
	.probe	= rsnd_ssi_dma_probe,
	.remove	= rsnd_ssi_dma_remove,
602 603 604 605
	.init	= rsnd_ssi_init,
	.quit	= rsnd_ssi_quit,
	.start	= rsnd_ssi_dma_start,
	.stop	= rsnd_ssi_dma_stop,
606
	.fallback = rsnd_ssi_fallback,
607
	.hw_params = rsnd_ssi_hw_params,
608 609
};

610 611 612 613 614 615
int rsnd_ssi_is_dma_mode(struct rsnd_mod *mod)
{
	return mod->ops == &rsnd_ssi_dma_ops;
}


616 617 618 619
/*
 *		Non SSI
 */
static struct rsnd_mod_ops rsnd_ssi_non_ops = {
620
	.name	= SSI_NAME,
621 622 623 624 625 626 627
};

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

631
	return &((struct rsnd_ssi *)(priv->ssi) + id)->mod;
632 633
}

634 635 636 637 638 639 640
int rsnd_ssi_is_pin_sharing(struct rsnd_mod *mod)
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);

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

641
static void rsnd_ssi_parent_setup(struct rsnd_priv *priv, struct rsnd_ssi *ssi)
642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659
{
	if (!rsnd_ssi_is_pin_sharing(&ssi->mod))
		return;

	switch (rsnd_mod_id(&ssi->mod)) {
	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;
	}
}

660 661 662 663 664 665 666 667 668 669 670 671 672 673 674

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;

	if (!of_data)
		return;

675
	node = rsnd_ssi_of_node(priv);
676 677 678 679 680
	if (!node)
		return;

	nr = of_get_child_count(node);
	if (!nr)
681
		goto rsnd_of_parse_ssi_end;
682 683 684 685 686 687

	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");
688
		goto rsnd_of_parse_ssi_end;
689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708
	}

	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
		 */
709
		ssi_info->irq = irq_of_parse_and_map(np, 0);
710 711 712 713 714 715

		/*
		 * DMA
		 */
		ssi_info->dma_id = of_get_property(np, "pio-transfer", NULL) ?
			0 : 1;
716 717 718

		if (of_get_property(np, "no-busif", NULL))
			ssi_info->flags |= RSND_SSI_NO_BUSIF;
719
	}
720 721 722

rsnd_of_parse_ssi_end:
	of_node_put(node);
723 724
}

725
int rsnd_ssi_probe(struct platform_device *pdev,
726
		   const struct rsnd_of_data *of_data,
727 728
		   struct rsnd_priv *priv)
{
729
	struct rcar_snd_info *info = rsnd_priv_to_info(priv);
730 731 732 733 734 735
	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];
736
	int i, nr, ret;
737

738 739
	rsnd_of_parse_ssi(pdev, of_data, priv);

740 741 742 743
	/*
	 *	init SSI
	 */
	nr	= info->ssi_info_nr;
744 745
	ssi	= devm_kzalloc(dev, sizeof(*ssi) * nr, GFP_KERNEL);
	if (!ssi) {
746 747 748 749
		dev_err(dev, "SSI allocate failed\n");
		return -ENOMEM;
	}

750 751
	priv->ssi	= ssi;
	priv->ssi_nr	= nr;
752 753 754 755

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

756 757
		snprintf(name, RSND_SSI_NAME_SIZE, "%s.%d",
			 SSI_NAME, i);
758

759
		clk = devm_clk_get(dev, name);
760 761 762 763 764 765
		if (IS_ERR(clk))
			return PTR_ERR(clk);

		ssi->info	= pinfo;

		ops = &rsnd_ssi_non_ops;
766 767 768 769
		if (pinfo->dma_id > 0)
			ops = &rsnd_ssi_dma_ops;
		else if (rsnd_ssi_pio_available(ssi))
			ops = &rsnd_ssi_pio_ops;
770

771 772 773
		ret = rsnd_mod_init(&ssi->mod, ops, clk, RSND_MOD_SSI, i);
		if (ret)
			return ret;
774

775
		rsnd_ssi_parent_setup(priv, ssi);
776 777 778 779
	}

	return 0;
}
780 781 782 783 784 785 786 787 788 789 790

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) {
		rsnd_mod_quit(&ssi->mod);
	}
}