ssi.c 19.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
#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 */
27 28 29
#define	CHNL_4		(1 << 22)	/* Channels */
#define	CHNL_6		(2 << 22)	/* Channels */
#define	CHNL_8		(3 << 22)	/* Channels */
30 31 32 33 34 35 36 37 38 39 40 41 42 43
#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 */
44
#define	PDTA		(1 <<  9)	/* Parallel Data Alignment */
45 46 47 48 49 50 51 52 53 54 55 56 57
#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 */

58 59 60 61
/*
 * SSIWSR
 */
#define CONT		(1 << 8)	/* WS Continue Function */
62
#define WS_MODE		(1 << 0)	/* WS Mode */
63

64 65
#define SSI_NAME "ssi"

66 67
struct rsnd_ssi {
	struct rsnd_mod mod;
68
	struct rsnd_mod *dma;
69

70
	u32 flags;
71 72
	u32 cr_own;
	u32 cr_clk;
73
	u32 cr_mode;
74
	u32 wsr;
75
	int chan;
76
	int rate;
77
	int irq;
78 79 80
	unsigned int usrcnt;
};

81 82 83 84
/* flags */
#define RSND_SSI_CLK_PIN_SHARE		(1 << 0)
#define RSND_SSI_NO_BUSIF		(1 << 1) /* SSI+DMA without BUSIF */

85 86 87
#define for_each_rsnd_ssi(pos, priv, i)					\
	for (i = 0;							\
	     (i < rsnd_ssi_nr(priv)) &&					\
88
		((pos) = ((struct rsnd_ssi *)(priv)->ssi + i));		\
89 90
	     i++)

91
#define rsnd_ssi_get(priv, id) ((struct rsnd_ssi *)(priv->ssi) + id)
92
#define rsnd_ssi_to_dma(mod) ((ssi)->dma)
93
#define rsnd_ssi_nr(priv) ((priv)->ssi_nr)
94
#define rsnd_mod_to_ssi(_mod) container_of((_mod), struct rsnd_ssi, mod)
95
#define rsnd_ssi_mode_flags(p) ((p)->flags)
96
#define rsnd_ssi_is_parent(ssi, io) ((ssi) == rsnd_io_to_mod_ssip(io))
97 98
#define rsnd_ssi_is_multi_slave(mod, io) \
	(rsnd_ssi_multi_slaves(io) & (1 << rsnd_mod_id(mod)))
99

100
int rsnd_ssi_use_busif(struct rsnd_dai_stream *io)
101
{
102
	struct rsnd_mod *mod = rsnd_io_to_mod_ssi(io);
103 104 105
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	int use_busif = 0;

106 107 108
	if (!rsnd_ssi_is_dma_mode(mod))
		return 0;

109 110 111 112 113 114 115 116
	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;
}

117 118 119 120 121 122 123 124 125 126
static void rsnd_ssi_status_clear(struct rsnd_mod *mod)
{
	rsnd_mod_write(mod, SSISR, 0);
}

static u32 rsnd_ssi_status_get(struct rsnd_mod *mod)
{
	return rsnd_mod_read(mod, SSISR);
}

127 128 129 130 131 132 133 134 135
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++) {
136
		status = rsnd_ssi_status_get(mod);
137 138 139 140 141 142 143 144 145
		if (status & bit)
			return;

		udelay(50);
	}

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

146 147 148 149
static int rsnd_ssi_irq(struct rsnd_mod *mod,
			struct rsnd_dai_stream *io,
			struct rsnd_priv *priv,
			int enable)
150
{
151 152
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	u32 val = 0;
153 154 155 156

	if (rsnd_is_gen1(priv))
		return 0;

157
	if (ssi->usrcnt != 1)
158 159
		return 0;

160 161 162 163
	if (enable)
		val = rsnd_ssi_is_dma_mode(mod) ? 0x0e000000 : 0x0f000000;

	rsnd_mod_write(mod, SSI_INT_ENABLE, val);
164 165 166 167

	return 0;
}

168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189
u32 rsnd_ssi_multi_slaves(struct rsnd_dai_stream *io)
{
	struct rsnd_mod *mod;
	enum rsnd_mod_type types[] = {
		RSND_MOD_SSIM1,
		RSND_MOD_SSIM2,
		RSND_MOD_SSIM3,
	};
	int i, mask;

	mask = 0;
	for (i = 0; i < ARRAY_SIZE(types); i++) {
		mod = rsnd_io_to_mod(io, types[i]);
		if (!mod)
			continue;

		mask |= 1 << rsnd_mod_id(mod);
	}

	return mask;
}

190
static int rsnd_ssi_master_clk_start(struct rsnd_ssi *ssi,
191
				     struct rsnd_dai_stream *io)
192
{
193
	struct rsnd_priv *priv = rsnd_io_to_priv(io);
194
	struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
195
	struct device *dev = rsnd_priv_to_dev(priv);
196
	struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
197
	struct rsnd_mod *mod = rsnd_mod_get(ssi);
198
	struct rsnd_mod *ssi_parent_mod = rsnd_io_to_mod_ssip(io);
199
	int slots = rsnd_get_slot_width(io);
200
	int j, ret;
201 202 203 204
	int ssi_clk_mul_table[] = {
		1, 2, 4, 8, 16, 6, 12,
	};
	unsigned int main_rate;
205
	unsigned int rate = rsnd_src_get_ssi_rate(priv, io, runtime);
206

207 208 209 210 211 212
	if (!rsnd_rdai_is_clk_master(rdai))
		return 0;

	if (ssi_parent_mod && !rsnd_ssi_is_parent(mod, io))
		return 0;

213 214 215
	if (rsnd_ssi_is_multi_slave(mod, io))
		return 0;

216 217 218 219 220 221 222 223 224
	if (ssi->usrcnt > 1) {
		if (ssi->rate != rate) {
			dev_err(dev, "SSI parent/child should use same rate\n");
			return -EINVAL;
		}

		return 0;
	}

225 226 227
	/*
	 * Find best clock, and try to start ADG
	 */
228 229 230 231
	for (j = 0; j < ARRAY_SIZE(ssi_clk_mul_table); j++) {

		/*
		 * this driver is assuming that
232
		 * system word is 32bit x slots
233 234
		 * see rsnd_ssi_init()
		 */
235
		main_rate = rate * 32 * slots * ssi_clk_mul_table[j];
236 237 238 239 240

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

243 244
			ssi->rate = rate;

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

			return 0;
250 251 252 253 254 255 256
		}
	}

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

257 258
static void rsnd_ssi_master_clk_stop(struct rsnd_ssi *ssi,
				     struct rsnd_dai_stream *io)
259
{
260
	struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
261
	struct rsnd_mod *mod = rsnd_mod_get(ssi);
262
	struct rsnd_mod *ssi_parent_mod = rsnd_io_to_mod_ssip(io);
263

264
	if (!rsnd_rdai_is_clk_master(rdai))
265 266
		return;

267 268
	if (ssi_parent_mod && !rsnd_ssi_is_parent(mod, io))
		return;
269

270 271
	if (ssi->usrcnt > 1)
		return;
272

273 274
	ssi->cr_clk	= 0;
	ssi->rate	= 0;
275

276
	rsnd_adg_ssi_clk_stop(mod);
277 278
}

279 280 281 282 283 284 285
static int rsnd_ssi_config_init(struct rsnd_ssi *ssi,
				struct rsnd_dai_stream *io)
{
	struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
	struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
	u32 cr_own;
	u32 cr_mode;
286
	u32 wsr;
287 288
	int is_tdm;

289
	is_tdm = (rsnd_get_slot_width(io) >= 6) ? 1 : 0;
290 291 292 293 294 295 296 297 298

	/*
	 * always use 32bit system word.
	 * see also rsnd_ssi_master_clk_enable()
	 */
	cr_own = FORCE | SWL_32 | PDTA;

	if (rdai->bit_clk_inv)
		cr_own |= SCKP;
299
	if (rdai->frm_clk_inv ^ is_tdm)
300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325
		cr_own |= SWSP;
	if (rdai->data_alignment)
		cr_own |= SDTA;
	if (rdai->sys_delay)
		cr_own |= DEL;
	if (rsnd_io_is_play(io))
		cr_own |= TRMD;

	switch (runtime->sample_bits) {
	case 16:
		cr_own |= DWL_16;
		break;
	case 32:
		cr_own |= DWL_24;
		break;
	default:
		return -EINVAL;
	}

	if (rsnd_ssi_is_dma_mode(rsnd_mod_get(ssi))) {
		cr_mode = UIEN | OIEN |	/* over/under run */
			  DMEN;		/* DMA : enable DMA */
	} else {
		cr_mode = DIEN;		/* PIO : enable Data interrupt */
	}

326 327 328 329 330 331
	/*
	 * TDM Extend Mode
	 * see
	 *	rsnd_ssiu_init_gen2()
	 */
	wsr = ssi->wsr;
332
	if (is_tdm) {
333 334 335 336
		wsr	|= WS_MODE;
		cr_own	|= CHNL_8;
	}

337 338
	ssi->cr_own	= cr_own;
	ssi->cr_mode	= cr_mode;
339
	ssi->wsr	= wsr;
340 341 342 343

	return 0;
}

344 345 346 347
/*
 *	SSI mod common functions
 */
static int rsnd_ssi_init(struct rsnd_mod *mod,
348
			 struct rsnd_dai_stream *io,
349
			 struct rsnd_priv *priv)
350 351
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
352 353 354 355 356 357 358 359 360 361 362 363
	int ret;

	ssi->usrcnt++;

	rsnd_mod_power_on(mod);

	ret = rsnd_ssi_master_clk_start(ssi, io);
	if (ret < 0)
		return ret;

	if (rsnd_ssi_is_parent(mod, io))
		return 0;
364

365 366 367
	ret = rsnd_ssi_config_init(ssi, io);
	if (ret < 0)
		return ret;
368 369 370 371

	/* clear error status */
	rsnd_ssi_status_clear(mod);

372 373 374 375
	return 0;
}

static int rsnd_ssi_quit(struct rsnd_mod *mod,
376
			 struct rsnd_dai_stream *io,
377
			 struct rsnd_priv *priv)
378 379 380 381
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	struct device *dev = rsnd_priv_to_dev(priv);

382 383 384 385 386
	if (!ssi->usrcnt) {
		dev_err(dev, "%s[%d] usrcnt error\n",
			rsnd_mod_name(mod), rsnd_mod_id(mod));
		return -EIO;
	}
387

388
	if (!rsnd_ssi_is_parent(mod, io))
389
		ssi->cr_own	= 0;
390

391 392 393 394 395 396
	rsnd_ssi_master_clk_stop(ssi, io);

	rsnd_mod_power_off(mod);

	ssi->usrcnt--;

397 398 399
	return 0;
}

400
static int rsnd_ssi_hw_params(struct rsnd_mod *mod,
401
			      struct rsnd_dai_stream *io,
402 403 404 405 406 407 408 409 410 411
			      struct snd_pcm_substream *substream,
			      struct snd_pcm_hw_params *params)
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	int chan = params_channels(params);

	/*
	 * Already working.
	 * It will happen if SSI has parent/child connection.
	 */
412
	if (ssi->usrcnt > 1) {
413 414 415 416 417 418 419 420 421 422 423 424 425
		/*
		 * it is error if child <-> parent SSI uses
		 * different channels.
		 */
		if (ssi->chan != chan)
			return -EIO;
	}

	ssi->chan = chan;

	return 0;
}

426 427 428
static int rsnd_ssi_start(struct rsnd_mod *mod,
			  struct rsnd_dai_stream *io,
			  struct rsnd_priv *priv)
429 430 431 432 433 434
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	u32 cr;

	cr  =	ssi->cr_own	|
		ssi->cr_clk	|
435 436 437 438 439 440 441 442
		ssi->cr_mode;

	/*
	 * EN will be set via SSIU :: SSI_CONTROL
	 * if Multi channel mode
	 */
	if (!rsnd_ssi_multi_slaves(io))
		cr |= EN;
443 444

	rsnd_mod_write(mod, SSICR, cr);
445
	rsnd_mod_write(mod, SSIWSR, ssi->wsr);
446 447 448 449

	return 0;
}

450 451 452
static int rsnd_ssi_stop(struct rsnd_mod *mod,
			 struct rsnd_dai_stream *io,
			 struct rsnd_priv *priv)
453
{
454 455 456
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	u32 cr;

457
	/*
458
	 * don't stop if not last user
459
	 * see also
460
	 *	rsnd_ssi_start
461 462
	 *	rsnd_ssi_interrupt
	 */
463 464
	if (ssi->usrcnt > 1)
		return 0;
465 466 467 468 469 470 471

	/*
	 * disable all IRQ,
	 * and, wait all data was sent
	 */
	cr  =	ssi->cr_own	|
		ssi->cr_clk;
472

473 474
	rsnd_mod_write(mod, SSICR, cr | EN);
	rsnd_ssi_status_check(mod, DIRQ);
475

476 477 478 479 480 481
	/*
	 * disable SSI,
	 * and, wait idle state
	 */
	rsnd_mod_write(mod, SSICR, cr);	/* disabled all */
	rsnd_ssi_status_check(mod, IIRQ);
482 483 484 485

	return 0;
}

486 487
static void __rsnd_ssi_interrupt(struct rsnd_mod *mod,
				 struct rsnd_dai_stream *io)
488
{
489
	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
490
	int is_dma = rsnd_ssi_is_dma_mode(mod);
491
	u32 status;
492
	bool elapsed = false;
493
	bool stop = false;
494 495

	spin_lock(&priv->lock);
496

497
	/* ignore all cases if not working */
498
	if (!rsnd_io_is_working(io))
499 500
		goto rsnd_ssi_interrupt_out;

501
	status = rsnd_ssi_status_get(mod);
502 503

	/* PIO only */
504
	if (!is_dma && (status & DIRQ)) {
505 506 507 508 509 510 511 512 513
		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()
		 */
514
		if (rsnd_io_is_play(io))
515
			rsnd_mod_write(mod, SSITDR, *buf);
516
		else
517
			*buf = rsnd_mod_read(mod, SSIRDR);
518

519
		elapsed = rsnd_dai_pointer_update(io, sizeof(*buf));
520
	}
521

522
	/* DMA only */
523 524
	if (is_dma && (status & (UIRQ | OIRQ)))
		stop = true;
525

526
	rsnd_ssi_status_clear(mod);
527 528 529
rsnd_ssi_interrupt_out:
	spin_unlock(&priv->lock);

530 531
	if (elapsed)
		rsnd_dai_period_elapsed(io);
532 533 534 535

	if (stop)
		snd_pcm_stop_xrun(io->substream);

536 537 538 539 540 541 542
}

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

	rsnd_mod_interrupt(mod, __rsnd_ssi_interrupt);
543

544
	return IRQ_HANDLED;
545 546
}

547 548 549
/*
 *		SSI PIO
 */
550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570
static void rsnd_ssi_parent_attach(struct rsnd_mod *mod,
				   struct rsnd_dai_stream *io,
				   struct rsnd_priv *priv)
{
	if (!__rsnd_ssi_is_pin_sharing(mod))
		return;

	switch (rsnd_mod_id(mod)) {
	case 1:
	case 2:
		rsnd_dai_connect(rsnd_ssi_mod_get(priv, 0), io, RSND_MOD_SSIP);
		break;
	case 4:
		rsnd_dai_connect(rsnd_ssi_mod_get(priv, 3), io, RSND_MOD_SSIP);
		break;
	case 8:
		rsnd_dai_connect(rsnd_ssi_mod_get(priv, 7), io, RSND_MOD_SSIP);
		break;
	}
}

571 572 573
static int rsnd_ssi_common_probe(struct rsnd_mod *mod,
				 struct rsnd_dai_stream *io,
				 struct rsnd_priv *priv)
574 575 576 577 578
{
	struct device *dev = rsnd_priv_to_dev(priv);
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	int ret;

579 580 581 582 583 584 585
	/*
	 * SSIP/SSIU/IRQ are not needed on
	 * SSI Multi slaves
	 */
	if (rsnd_ssi_is_multi_slave(mod, io))
		return 0;

586 587
	rsnd_ssi_parent_attach(mod, io, priv);

588 589 590 591
	ret = rsnd_ssiu_attach(io, mod);
	if (ret < 0)
		return ret;

592
	ret = devm_request_irq(dev, ssi->irq,
593
			       rsnd_ssi_interrupt,
594
			       IRQF_SHARED,
595
			       dev_name(dev), mod);
596

597 598 599
	return ret;
}

600
static struct rsnd_mod_ops rsnd_ssi_pio_ops = {
601
	.name	= SSI_NAME,
602
	.probe	= rsnd_ssi_common_probe,
603 604
	.init	= rsnd_ssi_init,
	.quit	= rsnd_ssi_quit,
605 606
	.start	= rsnd_ssi_start,
	.stop	= rsnd_ssi_stop,
607
	.irq	= rsnd_ssi_irq,
608
	.hw_params = rsnd_ssi_hw_params,
609 610
};

611
static int rsnd_ssi_dma_probe(struct rsnd_mod *mod,
612
			      struct rsnd_dai_stream *io,
613
			      struct rsnd_priv *priv)
614 615
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
616
	int dma_id = 0; /* not needed */
617 618
	int ret;

619 620 621 622 623 624 625
	/*
	 * SSIP/SSIU/IRQ/DMA are not needed on
	 * SSI Multi slaves
	 */
	if (rsnd_ssi_is_multi_slave(mod, io))
		return 0;

626
	ret = rsnd_ssi_common_probe(mod, io, priv);
627
	if (ret)
628
		return ret;
629

630 631
	/* SSI probe might be called many times in MUX multi path */
	ret = rsnd_dma_attach(io, mod, &ssi->dma, dma_id);
632

633 634 635 636
	return ret;
}

static int rsnd_ssi_dma_remove(struct rsnd_mod *mod,
637
			       struct rsnd_dai_stream *io,
638
			       struct rsnd_priv *priv)
639
{
640 641
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	struct device *dev = rsnd_priv_to_dev(priv);
642
	int irq = ssi->irq;
643 644

	/* PIO will request IRQ again */
645
	devm_free_irq(dev, irq, mod);
646

647 648 649 650
	return 0;
}

static int rsnd_ssi_fallback(struct rsnd_mod *mod,
651
			     struct rsnd_dai_stream *io,
652
			     struct rsnd_priv *priv)
653
{
654 655 656 657 658 659 660 661 662 663 664 665 666 667
	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));

668 669 670
	return 0;
}

671 672
static struct dma_chan *rsnd_ssi_dma_req(struct rsnd_dai_stream *io,
					 struct rsnd_mod *mod)
673
{
674 675 676 677
	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
	int is_play = rsnd_io_is_play(io);
	char *name;

678
	if (rsnd_ssi_use_busif(io))
679 680 681 682 683 684
		name = is_play ? "rxu" : "txu";
	else
		name = is_play ? "rx" : "tx";

	return rsnd_dma_request_channel(rsnd_ssi_of_node(priv),
					mod, name);
685 686
}

687
static struct rsnd_mod_ops rsnd_ssi_dma_ops = {
688
	.name	= SSI_NAME,
689
	.dma_req = rsnd_ssi_dma_req,
690 691
	.probe	= rsnd_ssi_dma_probe,
	.remove	= rsnd_ssi_dma_remove,
692 693
	.init	= rsnd_ssi_init,
	.quit	= rsnd_ssi_quit,
694 695
	.start	= rsnd_ssi_start,
	.stop	= rsnd_ssi_stop,
696
	.fallback = rsnd_ssi_fallback,
697
	.hw_params = rsnd_ssi_hw_params,
698 699
};

700 701 702 703 704 705
int rsnd_ssi_is_dma_mode(struct rsnd_mod *mod)
{
	return mod->ops == &rsnd_ssi_dma_ops;
}


706 707 708 709
/*
 *		Non SSI
 */
static struct rsnd_mod_ops rsnd_ssi_non_ops = {
710
	.name	= SSI_NAME,
711 712 713 714 715
};

/*
 *		ssi mod function
 */
716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766
static void rsnd_ssi_connect(struct rsnd_mod *mod,
			     struct rsnd_dai_stream *io)
{
	struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
	enum rsnd_mod_type types[] = {
		RSND_MOD_SSI,
		RSND_MOD_SSIM1,
		RSND_MOD_SSIM2,
		RSND_MOD_SSIM3,
	};
	enum rsnd_mod_type type;
	int i;

	/* try SSI -> SSIM1 -> SSIM2 -> SSIM3 */
	for (i = 0; i < ARRAY_SIZE(types); i++) {
		type = types[i];
		if (!rsnd_io_to_mod(io, type)) {
			rsnd_dai_connect(mod, io, type);
			rsnd_set_slot(rdai, 2 * (i + 1), (i + 1));
			return;
		}
	}
}

void rsnd_parse_connect_ssi(struct rsnd_dai *rdai,
			    struct device_node *playback,
			    struct device_node *capture)
{
	struct rsnd_priv *priv = rsnd_rdai_to_priv(rdai);
	struct device_node *node;
	struct device_node *np;
	struct rsnd_mod *mod;
	int i;

	node = rsnd_ssi_of_node(priv);
	if (!node)
		return;

	i = 0;
	for_each_child_of_node(node, np) {
		mod = rsnd_ssi_mod_get(priv, i);
		if (np == playback)
			rsnd_ssi_connect(mod, &rdai->playback);
		if (np == capture)
			rsnd_ssi_connect(mod, &rdai->capture);
		i++;
	}

	of_node_put(node);
}

767 768
struct rsnd_mod *rsnd_ssi_mod_get(struct rsnd_priv *priv, int id)
{
769 770
	if (WARN_ON(id < 0 || id >= rsnd_ssi_nr(priv)))
		id = 0;
771

772
	return rsnd_mod_get(rsnd_ssi_get(priv, id));
773 774
}

775
int __rsnd_ssi_is_pin_sharing(struct rsnd_mod *mod)
776 777 778 779 780 781
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);

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

782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816
static u32 *rsnd_ssi_get_status(struct rsnd_dai_stream *io,
				struct rsnd_mod *mod,
				enum rsnd_mod_type type)
{
	/*
	 * SSIP (= SSI parent) needs to be special, otherwise,
	 * 2nd SSI might doesn't start. see also rsnd_mod_call()
	 *
	 * We can't include parent SSI status on SSI, because we don't know
	 * how many SSI requests parent SSI. Thus, it is localed on "io" now.
	 * ex) trouble case
	 *	Playback: SSI0
	 *	Capture : SSI1 (needs SSI0)
	 *
	 * 1) start Capture  ->	SSI0/SSI1 are started.
	 * 2) start Playback ->	SSI0 doesn't work, because it is already
	 *			marked as "started" on 1)
	 *
	 * OTOH, using each mod's status is good for MUX case.
	 * It doesn't need to start in 2nd start
	 * ex)
	 *	IO-0: SRC0 -> CTU1 -+-> MUX -> DVC -> SSIU -> SSI0
	 *			    |
	 *	IO-1: SRC1 -> CTU2 -+
	 *
	 * 1) start IO-0 ->	start SSI0
	 * 2) start IO-1 ->	SSI0 doesn't need to start, because it is
	 *			already started on 1)
	 */
	if (type == RSND_MOD_SSIP)
		return &io->parent_ssi_status;

	return rsnd_mod_get_status(io, mod, type);
}

817
int rsnd_ssi_probe(struct rsnd_priv *priv)
818
{
819 820
	struct device_node *node;
	struct device_node *np;
821 822 823 824 825
	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];
826
	int i, nr, ret;
827

828 829 830 831 832 833 834 835 836
	node = rsnd_ssi_of_node(priv);
	if (!node)
		return -EINVAL;

	nr = of_get_child_count(node);
	if (!nr) {
		ret = -EINVAL;
		goto rsnd_ssi_probe_done;
	}
837

838
	ssi	= devm_kzalloc(dev, sizeof(*ssi) * nr, GFP_KERNEL);
839 840 841 842
	if (!ssi) {
		ret = -ENOMEM;
		goto rsnd_ssi_probe_done;
	}
843

844 845
	priv->ssi	= ssi;
	priv->ssi_nr	= nr;
846

847 848 849
	i = 0;
	for_each_child_of_node(node, np) {
		ssi = rsnd_ssi_get(priv, i);
850

851 852
		snprintf(name, RSND_SSI_NAME_SIZE, "%s.%d",
			 SSI_NAME, i);
853

854
		clk = devm_clk_get(dev, name);
855 856 857 858
		if (IS_ERR(clk)) {
			ret = PTR_ERR(clk);
			goto rsnd_ssi_probe_done;
		}
859

860 861 862 863 864 865 866 867 868 869 870
		if (of_get_property(np, "shared-pin", NULL))
			ssi->flags |= RSND_SSI_CLK_PIN_SHARE;

		if (of_get_property(np, "no-busif", NULL))
			ssi->flags |= RSND_SSI_NO_BUSIF;

		ssi->irq = irq_of_parse_and_map(np, 0);
		if (!ssi->irq) {
			ret = -EINVAL;
			goto rsnd_ssi_probe_done;
		}
871 872

		ops = &rsnd_ssi_non_ops;
873
		if (of_get_property(np, "pio-transfer", NULL))
874
			ops = &rsnd_ssi_pio_ops;
875 876
		else
			ops = &rsnd_ssi_dma_ops;
877

878
		ret = rsnd_mod_init(priv, rsnd_mod_get(ssi), ops, clk,
879
				    rsnd_ssi_get_status, RSND_MOD_SSI, i);
880
		if (ret)
881 882 883
			goto rsnd_ssi_probe_done;

		i++;
884 885
	}

886 887 888 889 890 891
	ret = 0;

rsnd_ssi_probe_done:
	of_node_put(node);

	return ret;
892
}
893

894
void rsnd_ssi_remove(struct rsnd_priv *priv)
895 896 897 898 899
{
	struct rsnd_ssi *ssi;
	int i;

	for_each_rsnd_ssi(ssi, priv, i) {
900
		rsnd_mod_quit(rsnd_mod_get(ssi));
901 902
	}
}