[deliverable/linux.git] / sound / soc / sh / rcar / ssi.c

/*
 * 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 */
#define	DMEN		(1 << 28)	/* DMA Enable */
#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 */

/*
 * SSIWSR
 */
#define CONT		(1 << 8)	/* WS Continue Function */

#define SSI_NAME "ssi"

struct rsnd_ssi {
	struct rsnd_ssi_platform_info *info; /* rcar_snd.h */
	struct rsnd_ssi *parent;
	struct rsnd_mod mod;

	struct rsnd_dai *rdai;
	u32 cr_own;
	u32 cr_clk;
	int err;
	unsigned int usrcnt;
};

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

#define rsnd_ssi_nr(priv) ((priv)->ssi_nr)
#define rsnd_mod_to_ssi(_mod) container_of((_mod), struct rsnd_ssi, mod)
#define rsnd_dma_to_ssi(dma)  rsnd_mod_to_ssi(rsnd_dma_to_mod(dma))
#define rsnd_ssi_pio_available(ssi) ((ssi)->info->irq > 0)
#define rsnd_ssi_dma_available(ssi) \
	rsnd_dma_available(rsnd_mod_to_dma(&(ssi)->mod))
#define rsnd_ssi_clk_from_parent(ssi) ((ssi)->parent)
#define rsnd_ssi_mode_flags(p) ((p)->info->flags)
#define rsnd_ssi_dai_id(ssi) ((ssi)->info->dai_id)

static int rsnd_ssi_use_busif(struct rsnd_mod *mod)
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
	int use_busif = 0;

	if (!rsnd_ssi_is_dma_mode(mod))
		return 0;

	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;
}

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,
				     struct rsnd_dai_stream *io)
{
	struct rsnd_priv *priv = rsnd_mod_to_priv(&ssi->mod);
	struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
	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;
	unsigned int rate = rsnd_src_get_ssi_rate(priv, io, runtime);

	/*
	 * 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)
			 * see rsnd_ssi_init()
			 */
			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);

				dev_dbg(dev, "%s[%d] outputs %u Hz\n",
					rsnd_mod_name(&ssi->mod),
					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 *rdai,
			      struct rsnd_dai_stream *io)
{
	struct rsnd_priv *priv = rsnd_mod_to_priv(&ssi->mod);
	struct device *dev = rsnd_priv_to_dev(priv);
	u32 cr_mode;
	u32 cr;

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

		if (rsnd_rdai_is_clk_master(rdai)) {
			if (rsnd_ssi_clk_from_parent(ssi))
				rsnd_ssi_hw_start(ssi->parent, rdai, io);
			else
				rsnd_ssi_master_clk_start(ssi, io);
		}
	}

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


	cr  =	ssi->cr_own	|
		ssi->cr_clk	|
		cr_mode		|
		UIEN | OIEN | EN;

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

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

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

	ssi->usrcnt++;

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

static void rsnd_ssi_hw_stop(struct rsnd_ssi *ssi,
			     struct rsnd_dai *rdai)
{
	struct rsnd_priv *priv = rsnd_mod_to_priv(&ssi->mod);
	struct device *dev = rsnd_priv_to_dev(priv);
	u32 cr;

	if (0 == ssi->usrcnt) /* stop might be called without start */
		return;

	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);

		if (rsnd_rdai_is_clk_master(rdai)) {
			if (rsnd_ssi_clk_from_parent(ssi))
				rsnd_ssi_hw_stop(ssi->parent, rdai);
			else
				rsnd_ssi_master_clk_stop(ssi);
		}

		rsnd_mod_hw_stop(&ssi->mod);
	}

	dev_dbg(dev, "%s[%d] hw stopped\n",
		rsnd_mod_name(&ssi->mod), rsnd_mod_id(&ssi->mod));
}

/*
 *	SSI mod common functions
 */
static int rsnd_ssi_init(struct rsnd_mod *mod,
			 struct rsnd_dai *rdai)
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
	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;
	if (rsnd_dai_is_play(rdai, io))
		cr |= TRMD;

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

	return 0;
}

static int rsnd_ssi_quit(struct rsnd_mod *mod,
			 struct rsnd_dai *rdai)
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
	struct device *dev = rsnd_priv_to_dev(priv);

	if (ssi->err > 0)
		dev_warn(dev, "ssi under/over flow err = %d\n", ssi->err);

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

	return 0;
}

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

static int rsnd_ssi_start(struct rsnd_mod *mod,
			  struct rsnd_dai *rdai)
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);

	rsnd_src_ssiu_start(mod, rdai, rsnd_ssi_use_busif(mod));

	rsnd_ssi_hw_start(ssi, rdai, io);

	rsnd_src_ssi_irq_enable(mod, rdai);

	return 0;
}

static int rsnd_ssi_stop(struct rsnd_mod *mod,
			 struct rsnd_dai *rdai)
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);

	rsnd_src_ssi_irq_disable(mod, rdai);

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

	rsnd_ssi_hw_stop(ssi, rdai);

	rsnd_src_ssiu_stop(mod, rdai);

	return 0;
}

static irqreturn_t rsnd_ssi_interrupt(int irq, void *data)
{
	struct rsnd_ssi *ssi = data;
	struct rsnd_dai *rdai = ssi->rdai;
	struct rsnd_mod *mod = &ssi->mod;
	struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
	u32 status = rsnd_mod_read(mod, SSISR);

	if (!io)
		return IRQ_NONE;

	/* PIO only */
	if (status & DIRQ) {
		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()
		 */
		if (rsnd_dai_is_play(rdai, io))
			rsnd_mod_write(mod, SSITDR, *buf);
		else
			*buf = rsnd_mod_read(mod, SSIRDR);

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

	/* PIO / DMA */
	if (status & (UIRQ | OIRQ)) {
		struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
		struct device *dev = rsnd_priv_to_dev(priv);

		/*
		 * restart SSI
		 */
		rsnd_ssi_stop(mod, rdai);
		rsnd_ssi_start(mod, rdai);

		dev_dbg(dev, "%s[%d] restart\n",
			rsnd_mod_name(mod), rsnd_mod_id(mod));
	}

	rsnd_ssi_record_error(ssi, status);

	return IRQ_HANDLED;
}

/*
 *		SSI PIO
 */
static int rsnd_ssi_pio_probe(struct rsnd_mod *mod,
			      struct rsnd_dai *rdai)
{
	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
	struct device *dev = rsnd_priv_to_dev(priv);
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	int ret;

	ret = devm_request_irq(dev, ssi->info->irq,
			       rsnd_ssi_interrupt,
			       IRQF_SHARED,
			       dev_name(dev), ssi);
	if (ret)
		dev_err(dev, "%s[%d] (PIO) request interrupt failed\n",
			rsnd_mod_name(mod), rsnd_mod_id(mod));
	else
		dev_dbg(dev, "%s[%d] (PIO) is probed\n",
			rsnd_mod_name(mod), rsnd_mod_id(mod));

	return ret;
}

static struct rsnd_mod_ops rsnd_ssi_pio_ops = {
	.name	= SSI_NAME,
	.probe	= rsnd_ssi_pio_probe,
	.init	= rsnd_ssi_init,
	.quit	= rsnd_ssi_quit,
	.start	= rsnd_ssi_start,
	.stop	= rsnd_ssi_stop,
};

static int rsnd_ssi_dma_probe(struct rsnd_mod *mod,
			  struct rsnd_dai *rdai)
{
	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
	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;

	ret = devm_request_irq(dev, ssi->info->irq,
			       rsnd_ssi_interrupt,
			       IRQF_SHARED,
			       dev_name(dev), ssi);
	if (ret)
		goto rsnd_ssi_dma_probe_fail;

	ret = rsnd_dma_init(
		priv, rsnd_mod_to_dma(mod),
		rsnd_info_is_playback(priv, ssi),
		dma_id);
	if (ret)
		goto rsnd_ssi_dma_probe_fail;

	dev_dbg(dev, "%s[%d] (DMA) is probed\n",
		rsnd_mod_name(mod), rsnd_mod_id(mod));

	return ret;

rsnd_ssi_dma_probe_fail:
	dev_err(dev, "%s[%d] (DMA) is failed\n",
		rsnd_mod_name(mod), rsnd_mod_id(mod));

	return ret;
}

static int rsnd_ssi_dma_remove(struct rsnd_mod *mod,
			       struct rsnd_dai *rdai)
{
	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	struct device *dev = rsnd_priv_to_dev(priv);
	int irq = ssi->info->irq;

	rsnd_dma_quit(rsnd_mod_to_priv(mod), rsnd_mod_to_dma(mod));

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

	return 0;
}

static int rsnd_ssi_fallback(struct rsnd_mod *mod,
			     struct rsnd_dai *rdai)
{
	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
	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));

	return 0;
}

static int rsnd_ssi_dma_start(struct rsnd_mod *mod,
			      struct rsnd_dai *rdai)
{
	struct rsnd_dma *dma = rsnd_mod_to_dma(mod);

	rsnd_ssi_start(mod, rdai);

	rsnd_dma_start(dma);

	return 0;
}

static int rsnd_ssi_dma_stop(struct rsnd_mod *mod,
			     struct rsnd_dai *rdai)
{
	struct rsnd_dma *dma = rsnd_mod_to_dma(mod);

	rsnd_dma_stop(dma);

	rsnd_ssi_stop(mod, rdai);

	return 0;
}

static char *rsnd_ssi_dma_name(struct rsnd_mod *mod)
{
	return rsnd_ssi_use_busif(mod) ? "ssiu" : SSI_NAME;
}

static struct rsnd_mod_ops rsnd_ssi_dma_ops = {
	.name	= SSI_NAME,
	.dma_name = rsnd_ssi_dma_name,
	.probe	= rsnd_ssi_dma_probe,
	.remove	= rsnd_ssi_dma_remove,
	.init	= rsnd_ssi_init,
	.quit	= rsnd_ssi_quit,
	.start	= rsnd_ssi_dma_start,
	.stop	= rsnd_ssi_dma_stop,
	.fallback = rsnd_ssi_fallback,
};

int rsnd_ssi_is_dma_mode(struct rsnd_mod *mod)
{
	return mod->ops == &rsnd_ssi_dma_ops;
}


/*
 *		Non SSI
 */
static struct rsnd_mod_ops rsnd_ssi_non_ops = {
	.name	= SSI_NAME,
};

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

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

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

static void rsnd_ssi_parent_clk_setup(struct rsnd_priv *priv, struct rsnd_ssi *ssi)
{
	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;
	}
}


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;

	node = of_get_child_by_name(dev->of_node, "rcar_sound,ssi");
	if (!node)
		return;

	nr = of_get_child_count(node);
	if (!nr)
		goto rsnd_of_parse_ssi_end;

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

	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
		 */
		ssi_info->irq = irq_of_parse_and_map(np, 0);

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

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

rsnd_of_parse_ssi_end:
	of_node_put(node);
}

int rsnd_ssi_probe(struct platform_device *pdev,
		   const struct rsnd_of_data *of_data,
		   struct rsnd_priv *priv)
{
	struct rcar_snd_info *info = rsnd_priv_to_info(priv);
	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];
	int i, nr;

	rsnd_of_parse_ssi(pdev, of_data, priv);

	/*
	 *	init SSI
	 */
	nr	= info->ssi_info_nr;
	ssi	= devm_kzalloc(dev, sizeof(*ssi) * nr, GFP_KERNEL);
	if (!ssi) {
		dev_err(dev, "SSI allocate failed\n");
		return -ENOMEM;
	}

	priv->ssi	= ssi;
	priv->ssi_nr	= nr;

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

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

		clk = devm_clk_get(dev, name);
		if (IS_ERR(clk))
			return PTR_ERR(clk);

		ssi->info	= pinfo;

		ops = &rsnd_ssi_non_ops;
		if (pinfo->dma_id > 0)
			ops = &rsnd_ssi_dma_ops;
		else if (rsnd_ssi_pio_available(ssi))
			ops = &rsnd_ssi_pio_ops;

		rsnd_mod_init(priv, &ssi->mod, ops, clk, RSND_MOD_SSI, i);

		rsnd_ssi_parent_clk_setup(priv, ssi);
	}

	return 0;
}
Commit	Line	Data
ae5c3223 KM	1	/*
	2	* Renesas R-Car SSIU/SSI support
	3	*
	4	* Copyright (C) 2013 Renesas Solutions Corp.
	5	* Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
	6	*
	7	* Based on fsi.c
	8	* Kuninori Morimoto <morimoto.kuninori@renesas.com>
	9	*
	10	* This program is free software; you can redistribute it and/or modify
	11	* it under the terms of the GNU General Public License version 2 as
	12	* published by the Free Software Foundation.
	13	*/
	14	#include <linux/delay.h>
	15	#include "rsnd.h"
	16	#define RSND_SSI_NAME_SIZE 16
	17
	18	/*
	19	* SSICR
	20	*/
	21	#define FORCE (1 << 31) /* Fixed */
849fc82a	22	#define DMEN (1 << 28) /* DMA Enable */
ae5c3223 KM	23	#define UIEN (1 << 27) /* Underflow Interrupt Enable */
	24	#define OIEN (1 << 26) /* Overflow Interrupt Enable */
	25	#define IIEN (1 << 25) /* Idle Mode Interrupt Enable */
	26	#define DIEN (1 << 24) /* Data Interrupt Enable */
	27
	28	#define DWL_8 (0 << 19) /* Data Word Length */
	29	#define DWL_16 (1 << 19) /* Data Word Length */
	30	#define DWL_18 (2 << 19) /* Data Word Length */
	31	#define DWL_20 (3 << 19) /* Data Word Length */
	32	#define DWL_22 (4 << 19) /* Data Word Length */
	33	#define DWL_24 (5 << 19) /* Data Word Length */
	34	#define DWL_32 (6 << 19) /* Data Word Length */
	35
	36	#define SWL_32 (3 << 16) /* R/W System Word Length */
	37	#define SCKD (1 << 15) /* Serial Bit Clock Direction */
	38	#define SWSD (1 << 14) /* Serial WS Direction */
	39	#define SCKP (1 << 13) /* Serial Bit Clock Polarity */
	40	#define SWSP (1 << 12) /* Serial WS Polarity */
	41	#define SDTA (1 << 10) /* Serial Data Alignment */
	42	#define DEL (1 << 8) /* Serial Data Delay */
	43	#define CKDV(v) (v << 4) /* Serial Clock Division Ratio */
	44	#define TRMD (1 << 1) /* Transmit/Receive Mode Select */
	45	#define EN (1 << 0) /* SSI Module Enable */
	46
	47	/*
	48	* SSISR
	49	*/
	50	#define UIRQ (1 << 27) /* Underflow Error Interrupt Status */
	51	#define OIRQ (1 << 26) /* Overflow Error Interrupt Status */
	52	#define IIRQ (1 << 25) /* Idle Mode Interrupt Status */
	53	#define DIRQ (1 << 24) /* Data Interrupt Status Flag */
	54
849fc82a KM	55	/*
	56	* SSIWSR
	57	*/
	58	#define CONT (1 << 8) /* WS Continue Function */
	59
8aefda50 KM	60	#define SSI_NAME "ssi"
8aefda50 KM	61
ae5c3223	62	struct rsnd_ssi {
ae5c3223 KM	63	struct rsnd_ssi_platform_info info; / rcar_snd.h */
	64	struct rsnd_ssi *parent;
	65	struct rsnd_mod mod;
	66
	67	struct rsnd_dai *rdai;
ae5c3223 KM	68	u32 cr_own;
ae5c3223 KM	69	u32 cr_clk;
ae5c3223 KM	70	int err;
ae5c3223 KM	71	unsigned int usrcnt;
ae5c3223 KM	72	};
ae5c3223 KM	73
ae5c3223 KM	74	#define for_each_rsnd_ssi(pos, priv, i) \
	75	for (i = 0; \
	76	(i < rsnd_ssi_nr(priv)) && \
dd27d808	77	((pos) = ((struct rsnd_ssi *)(priv)->ssi + i)); \
ae5c3223 KM	78	i++)
ae5c3223 KM	79
dd27d808	80	#define rsnd_ssi_nr(priv) ((priv)->ssi_nr)
ae5c3223	81	#define rsnd_mod_to_ssi(_mod) container_of((_mod), struct rsnd_ssi, mod)
849fc82a	82	#define rsnd_dma_to_ssi(dma) rsnd_mod_to_ssi(rsnd_dma_to_mod(dma))
6cfad789	83	#define rsnd_ssi_pio_available(ssi) ((ssi)->info->irq > 0)
849fc82a KM	84	#define rsnd_ssi_dma_available(ssi) \
849fc82a KM	85	rsnd_dma_available(rsnd_mod_to_dma(&(ssi)->mod))
ae5c3223	86	#define rsnd_ssi_clk_from_parent(ssi) ((ssi)->parent)
ae5c3223	87	#define rsnd_ssi_mode_flags(p) ((p)->info->flags)
4b4dab82	88	#define rsnd_ssi_dai_id(ssi) ((ssi)->info->dai_id)
ae5c3223	89
d9288d0b KM	90	static int rsnd_ssi_use_busif(struct rsnd_mod *mod)
	91	{
	92	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	93	struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
	94	int use_busif = 0;
	95
7b466fc6 KM	96	if (!rsnd_ssi_is_dma_mode(mod))
	97	return 0;
	98
d9288d0b KM	99	if (!(rsnd_ssi_mode_flags(ssi) & RSND_SSI_NO_BUSIF))
	100	use_busif = 1;
	101	if (rsnd_io_to_mod_src(io))
	102	use_busif = 1;
	103
	104	return use_busif;
	105	}
	106
ae5c3223 KM	107	static void rsnd_ssi_status_check(struct rsnd_mod *mod,
	108	u32 bit)
	109	{
	110	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
	111	struct device *dev = rsnd_priv_to_dev(priv);
	112	u32 status;
	113	int i;
	114
	115	for (i = 0; i < 1024; i++) {
	116	status = rsnd_mod_read(mod, SSISR);
	117	if (status & bit)
	118	return;
	119
	120	udelay(50);
	121	}
	122
	123	dev_warn(dev, "status check failed\n");
	124	}
	125
	126	static int rsnd_ssi_master_clk_start(struct rsnd_ssi *ssi,
adcf7d5e	127	struct rsnd_dai_stream *io)
ae5c3223 KM	128	{
ae5c3223 KM	129	struct rsnd_priv *priv = rsnd_mod_to_priv(&ssi->mod);
adcf7d5e	130	struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
ae5c3223 KM	131	struct device *dev = rsnd_priv_to_dev(priv);
	132	int i, j, ret;
	133	int adg_clk_div_table[] = {
	134	1, 6, /* see adg.c */
	135	};
	136	int ssi_clk_mul_table[] = {
	137	1, 2, 4, 8, 16, 6, 12,
	138	};
	139	unsigned int main_rate;
ba9c949f	140	unsigned int rate = rsnd_src_get_ssi_rate(priv, io, runtime);
ae5c3223 KM	141
	142	/*
	143	* Find best clock, and try to start ADG
	144	*/
	145	for (i = 0; i < ARRAY_SIZE(adg_clk_div_table); i++) {
	146	for (j = 0; j < ARRAY_SIZE(ssi_clk_mul_table); j++) {
	147
	148	/*
	149	* this driver is assuming that
	150	* system word is 64fs (= 2 x 32bit)
729aca51	151	* see rsnd_ssi_init()
ae5c3223 KM	152	*/
	153	main_rate = rate / adg_clk_div_table[i]
	154	* 32 * 2 * ssi_clk_mul_table[j];
	155
	156	ret = rsnd_adg_ssi_clk_try_start(&ssi->mod, main_rate);
	157	if (0 == ret) {
ae5c3223 KM	158	ssi->cr_clk = FORCE \| SWL_32 \|
	159	SCKD \| SWSD \| CKDV(j);
	160
30cc4faf KM	161	dev_dbg(dev, "%s[%d] outputs %u Hz\n",
30cc4faf KM	162	rsnd_mod_name(&ssi->mod),
ae5c3223 KM	163	rsnd_mod_id(&ssi->mod), rate);
	164
	165	return 0;
	166	}
	167	}
	168	}
	169
	170	dev_err(dev, "unsupported clock rate\n");
	171	return -EIO;
	172	}
	173
	174	static void rsnd_ssi_master_clk_stop(struct rsnd_ssi *ssi)
	175	{
ae5c3223 KM	176	ssi->cr_clk = 0;
	177	rsnd_adg_ssi_clk_stop(&ssi->mod);
	178	}
	179
	180	static void rsnd_ssi_hw_start(struct rsnd_ssi *ssi,
	181	struct rsnd_dai *rdai,
	182	struct rsnd_dai_stream *io)
	183	{
	184	struct rsnd_priv *priv = rsnd_mod_to_priv(&ssi->mod);
	185	struct device *dev = rsnd_priv_to_dev(priv);
05795411	186	u32 cr_mode;
ae5c3223 KM	187	u32 cr;
	188
	189	if (0 == ssi->usrcnt) {
85642952	190	rsnd_mod_hw_start(&ssi->mod);
ae5c3223	191
3ed6448c	192	if (rsnd_rdai_is_clk_master(rdai)) {
ae5c3223 KM	193	if (rsnd_ssi_clk_from_parent(ssi))
	194	rsnd_ssi_hw_start(ssi->parent, rdai, io);
	195	else
adcf7d5e	196	rsnd_ssi_master_clk_start(ssi, io);
ae5c3223 KM	197	}
	198	}
	199
05795411	200	cr_mode = rsnd_ssi_is_dma_mode(&ssi->mod) ?
4e7d606c KM	201	DMEN : /* DMA : enable DMA */
4e7d606c KM	202	DIEN; /* PIO : enable Data interrupt */
05795411 KM	203
05795411 KM	204
ae5c3223 KM	205	cr = ssi->cr_own \|
ae5c3223 KM	206	ssi->cr_clk \|
05795411	207	cr_mode \|
4e7d606c	208	UIEN \| OIEN \| EN;
ae5c3223 KM	209
	210	rsnd_mod_write(&ssi->mod, SSICR, cr);
	211
d1b64056	212	/* enable WS continue */
3ed6448c	213	if (rsnd_rdai_is_clk_master(rdai))
d1b64056 KM	214	rsnd_mod_write(&ssi->mod, SSIWSR, CONT);
d1b64056 KM	215
3ba84f45 KM	216	/* clear error status */
	217	rsnd_mod_write(&ssi->mod, SSISR, 0);
	218
ae5c3223 KM	219	ssi->usrcnt++;
ae5c3223 KM	220
30cc4faf KM	221	dev_dbg(dev, "%s[%d] hw started\n",
30cc4faf KM	222	rsnd_mod_name(&ssi->mod), rsnd_mod_id(&ssi->mod));
ae5c3223 KM	223	}
	224
	225	static void rsnd_ssi_hw_stop(struct rsnd_ssi *ssi,
	226	struct rsnd_dai *rdai)
	227	{
	228	struct rsnd_priv *priv = rsnd_mod_to_priv(&ssi->mod);
	229	struct device *dev = rsnd_priv_to_dev(priv);
	230	u32 cr;
	231
	232	if (0 == ssi->usrcnt) /* stop might be called without start */
	233	return;
	234
	235	ssi->usrcnt--;
	236
	237	if (0 == ssi->usrcnt) {
	238	/*
	239	* disable all IRQ,
	240	* and, wait all data was sent
	241	*/
	242	cr = ssi->cr_own \|
	243	ssi->cr_clk;
	244
	245	rsnd_mod_write(&ssi->mod, SSICR, cr \| EN);
	246	rsnd_ssi_status_check(&ssi->mod, DIRQ);
	247
	248	/*
	249	* disable SSI,
	250	* and, wait idle state
	251	*/
	252	rsnd_mod_write(&ssi->mod, SSICR, cr); /* disabled all */
	253	rsnd_ssi_status_check(&ssi->mod, IIRQ);
	254
3ed6448c	255	if (rsnd_rdai_is_clk_master(rdai)) {
ae5c3223 KM	256	if (rsnd_ssi_clk_from_parent(ssi))
	257	rsnd_ssi_hw_stop(ssi->parent, rdai);
	258	else
	259	rsnd_ssi_master_clk_stop(ssi);
	260	}
	261
85642952	262	rsnd_mod_hw_stop(&ssi->mod);
ae5c3223 KM	263	}
ae5c3223 KM	264
30cc4faf KM	265	dev_dbg(dev, "%s[%d] hw stopped\n",
30cc4faf KM	266	rsnd_mod_name(&ssi->mod), rsnd_mod_id(&ssi->mod));
ae5c3223 KM	267	}
	268
	269	/*
	270	* SSI mod common functions
	271	*/
	272	static int rsnd_ssi_init(struct rsnd_mod *mod,
b42fccf6	273	struct rsnd_dai *rdai)
ae5c3223 KM	274	{
ae5c3223 KM	275	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
b42fccf6	276	struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
ae5c3223 KM	277	struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
	278	u32 cr;
	279
	280	cr = FORCE;
	281
	282	/*
	283	* always use 32bit system word for easy clock calculation.
	284	* see also rsnd_ssi_master_clk_enable()
	285	*/
	286	cr \|= SWL_32;
	287
	288	/*
	289	* init clock settings for SSICR
	290	*/
	291	switch (runtime->sample_bits) {
	292	case 16:
	293	cr \|= DWL_16;
	294	break;
	295	case 32:
	296	cr \|= DWL_24;
	297	break;
	298	default:
	299	return -EIO;
	300	}
	301
	302	if (rdai->bit_clk_inv)
	303	cr \|= SCKP;
	304	if (rdai->frm_clk_inv)
	305	cr \|= SWSP;
	306	if (rdai->data_alignment)
	307	cr \|= SDTA;
	308	if (rdai->sys_delay)
	309	cr \|= DEL;
	310	if (rsnd_dai_is_play(rdai, io))
	311	cr \|= TRMD;
	312
	313	/*
	314	* set ssi parameter
	315	*/
	316	ssi->rdai = rdai;
ae5c3223 KM	317	ssi->cr_own = cr;
	318	ssi->err = -1; /* ignore 1st error */
	319
ae5c3223 KM	320	return 0;
	321	}
	322
	323	static int rsnd_ssi_quit(struct rsnd_mod *mod,
b42fccf6	324	struct rsnd_dai *rdai)
ae5c3223 KM	325	{
	326	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	327	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
	328	struct device *dev = rsnd_priv_to_dev(priv);
	329
ae5c3223 KM	330	if (ssi->err > 0)
	331	dev_warn(dev, "ssi under/over flow err = %d\n", ssi->err);
	332
	333	ssi->rdai = NULL;
ae5c3223 KM	334	ssi->cr_own = 0;
	335	ssi->err = 0;
	336
	337	return 0;
	338	}
	339
	340	static void rsnd_ssi_record_error(struct rsnd_ssi *ssi, u32 status)
	341	{
	342	/* under/over flow error */
	343	if (status & (UIRQ \| OIRQ)) {
	344	ssi->err++;
	345
	346	/* clear error status */
	347	rsnd_mod_write(&ssi->mod, SSISR, 0);
	348	}
	349	}
	350
4e7d606c KM	351	static int rsnd_ssi_start(struct rsnd_mod *mod,
	352	struct rsnd_dai *rdai)
	353	{
	354	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	355	struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
	356
	357	rsnd_src_ssiu_start(mod, rdai, rsnd_ssi_use_busif(mod));
	358
	359	rsnd_ssi_hw_start(ssi, rdai, io);
	360
	361	rsnd_src_ssi_irq_enable(mod, rdai);
	362
	363	return 0;
	364	}
	365
	366	static int rsnd_ssi_stop(struct rsnd_mod *mod,
	367	struct rsnd_dai *rdai)
	368	{
	369	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	370
	371	rsnd_src_ssi_irq_disable(mod, rdai);
	372
	373	rsnd_ssi_record_error(ssi, rsnd_mod_read(mod, SSISR));
	374
	375	rsnd_ssi_hw_stop(ssi, rdai);
	376
	377	rsnd_src_ssiu_stop(mod, rdai);
	378
	379	return 0;
	380	}
	381
6cfad789	382	static irqreturn_t rsnd_ssi_interrupt(int irq, void *data)
ae5c3223 KM	383	{
ae5c3223 KM	384	struct rsnd_ssi *ssi = data;
4e7d606c	385	struct rsnd_dai *rdai = ssi->rdai;
4686a0ad KM	386	struct rsnd_mod *mod = &ssi->mod;
	387	struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
	388	u32 status = rsnd_mod_read(mod, SSISR);
ae5c3223	389
4e7d606c KM	390	if (!io)
	391	return IRQ_NONE;
	392
	393	/* PIO only */
	394	if (status & DIRQ) {
ae5c3223 KM	395	struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
	396	u32 buf = (u32 )(runtime->dma_area +
	397	rsnd_dai_pointer_offset(io, 0));
	398
ae5c3223 KM	399	/*
	400	* 8/16/32 data can be assesse to TDR/RDR register
	401	* directly as 32bit data
	402	* see rsnd_ssi_init()
	403	*/
	404	if (rsnd_dai_is_play(rdai, io))
4686a0ad	405	rsnd_mod_write(mod, SSITDR, *buf);
ae5c3223	406	else
4686a0ad	407	*buf = rsnd_mod_read(mod, SSIRDR);
ae5c3223 KM	408
ae5c3223 KM	409	rsnd_dai_pointer_update(io, sizeof(*buf));
4e7d606c	410	}
ae5c3223	411
4e7d606c KM	412	/* PIO / DMA */
	413	if (status & (UIRQ \| OIRQ)) {
	414	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
	415	struct device *dev = rsnd_priv_to_dev(priv);
	416
	417	/*
	418	* restart SSI
	419	*/
	420	rsnd_ssi_stop(mod, rdai);
	421	rsnd_ssi_start(mod, rdai);
	422
	423	dev_dbg(dev, "%s[%d] restart\n",
	424	rsnd_mod_name(mod), rsnd_mod_id(mod));
ae5c3223 KM	425	}
ae5c3223 KM	426
4e7d606c KM	427	rsnd_ssi_record_error(ssi, status);
	428
	429	return IRQ_HANDLED;
ae5c3223 KM	430	}
ae5c3223 KM	431
6cfad789 KM	432	/*
	433	* SSI PIO
	434	*/
ff8f30e6	435	static int rsnd_ssi_pio_probe(struct rsnd_mod *mod,
b42fccf6	436	struct rsnd_dai *rdai)
ff8f30e6 KM	437	{
	438	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
	439	struct device *dev = rsnd_priv_to_dev(priv);
	440	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
ff8f30e6 KM	441	int ret;
ff8f30e6 KM	442
6cfad789 KM	443	ret = devm_request_irq(dev, ssi->info->irq,
6cfad789 KM	444	rsnd_ssi_interrupt,
ff8f30e6 KM	445	IRQF_SHARED,
	446	dev_name(dev), ssi);
	447	if (ret)
30cc4faf KM	448	dev_err(dev, "%s[%d] (PIO) request interrupt failed\n",
	449	rsnd_mod_name(mod), rsnd_mod_id(mod));
	450	else
	451	dev_dbg(dev, "%s[%d] (PIO) is probed\n",
	452	rsnd_mod_name(mod), rsnd_mod_id(mod));
8aefda50	453
ff8f30e6 KM	454	return ret;
	455	}
	456
ae5c3223	457	static struct rsnd_mod_ops rsnd_ssi_pio_ops = {
8aefda50	458	.name = SSI_NAME,
ff8f30e6	459	.probe = rsnd_ssi_pio_probe,
ae5c3223 KM	460	.init = rsnd_ssi_init,
ae5c3223 KM	461	.quit = rsnd_ssi_quit,
49229850 KM	462	.start = rsnd_ssi_start,
49229850 KM	463	.stop = rsnd_ssi_stop,
ae5c3223 KM	464	};
ae5c3223 KM	465
ff8f30e6	466	static int rsnd_ssi_dma_probe(struct rsnd_mod *mod,
b42fccf6	467	struct rsnd_dai *rdai)
ff8f30e6 KM	468	{
	469	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
	470	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
ff8f30e6 KM	471	struct device *dev = rsnd_priv_to_dev(priv);
ff8f30e6 KM	472	int dma_id = ssi->info->dma_id;
ff8f30e6 KM	473	int ret;
ff8f30e6 KM	474
6cfad789 KM	475	ret = devm_request_irq(dev, ssi->info->irq,
6cfad789 KM	476	rsnd_ssi_interrupt,
4e7d606c KM	477	IRQF_SHARED,
	478	dev_name(dev), ssi);
	479	if (ret)
	480	goto rsnd_ssi_dma_probe_fail;
	481
ff8f30e6 KM	482	ret = rsnd_dma_init(
ff8f30e6 KM	483	priv, rsnd_mod_to_dma(mod),
29e69fd2	484	rsnd_info_is_playback(priv, ssi),
ff8f30e6	485	dma_id);
4e7d606c KM	486	if (ret)
4e7d606c KM	487	goto rsnd_ssi_dma_probe_fail;
ff8f30e6	488
4e7d606c KM	489	dev_dbg(dev, "%s[%d] (DMA) is probed\n",
	490	rsnd_mod_name(mod), rsnd_mod_id(mod));
	491
	492	return ret;
	493
	494	rsnd_ssi_dma_probe_fail:
	495	dev_err(dev, "%s[%d] (DMA) is failed\n",
	496	rsnd_mod_name(mod), rsnd_mod_id(mod));
8aefda50	497
ff8f30e6 KM	498	return ret;
	499	}
	500
	501	static int rsnd_ssi_dma_remove(struct rsnd_mod *mod,
b42fccf6	502	struct rsnd_dai *rdai)
97463e19	503	{
4e7d606c KM	504	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
	505	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	506	struct device *dev = rsnd_priv_to_dev(priv);
6cfad789	507	int irq = ssi->info->irq;
4e7d606c	508
97463e19 KM	509	rsnd_dma_quit(rsnd_mod_to_priv(mod), rsnd_mod_to_dma(mod));
97463e19 KM	510
4e7d606c KM	511	/* PIO will request IRQ again */
	512	devm_free_irq(dev, irq, ssi);
	513
97463e19 KM	514	return 0;
	515	}
	516
	517	static int rsnd_ssi_fallback(struct rsnd_mod *mod,
	518	struct rsnd_dai *rdai)
ff8f30e6	519	{
d3a76823 KM	520	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
	521	struct device *dev = rsnd_priv_to_dev(priv);
	522
d3a76823 KM	523	/*
	524	* fallback to PIO
	525	*
	526	* SSI .probe might be called again.
	527	* see
	528	* rsnd_rdai_continuance_probe()
	529	*/
	530	mod->ops = &rsnd_ssi_pio_ops;
	531
	532	dev_info(dev, "%s[%d] fallback to PIO mode\n",
	533	rsnd_mod_name(mod), rsnd_mod_id(mod));
	534
ff8f30e6 KM	535	return 0;
	536	}
	537
849fc82a	538	static int rsnd_ssi_dma_start(struct rsnd_mod *mod,
b42fccf6	539	struct rsnd_dai *rdai)
849fc82a	540	{
49229850	541	struct rsnd_dma *dma = rsnd_mod_to_dma(mod);
d9288d0b	542
49229850	543	rsnd_ssi_start(mod, rdai);
849fc82a	544
7b466fc6 KM	545	rsnd_dma_start(dma);
7b466fc6 KM	546
849fc82a KM	547	return 0;
	548	}
	549
	550	static int rsnd_ssi_dma_stop(struct rsnd_mod *mod,
b42fccf6	551	struct rsnd_dai *rdai)
849fc82a	552	{
49229850	553	struct rsnd_dma *dma = rsnd_mod_to_dma(mod);
849fc82a	554
7b466fc6 KM	555	rsnd_dma_stop(dma);
7b466fc6 KM	556
49229850	557	rsnd_ssi_stop(mod, rdai);
d9288d0b	558
849fc82a KM	559	return 0;
	560	}
	561
d9288d0b KM	562	static char rsnd_ssi_dma_name(struct rsnd_mod mod)
	563	{
	564	return rsnd_ssi_use_busif(mod) ? "ssiu" : SSI_NAME;
	565	}
	566
849fc82a	567	static struct rsnd_mod_ops rsnd_ssi_dma_ops = {
8aefda50	568	.name = SSI_NAME,
d9288d0b	569	.dma_name = rsnd_ssi_dma_name,
ff8f30e6 KM	570	.probe = rsnd_ssi_dma_probe,
ff8f30e6 KM	571	.remove = rsnd_ssi_dma_remove,
849fc82a KM	572	.init = rsnd_ssi_init,
	573	.quit = rsnd_ssi_quit,
	574	.start = rsnd_ssi_dma_start,
	575	.stop = rsnd_ssi_dma_stop,
97463e19	576	.fallback = rsnd_ssi_fallback,
849fc82a KM	577	};
849fc82a KM	578
05795411 KM	579	int rsnd_ssi_is_dma_mode(struct rsnd_mod *mod)
	580	{
	581	return mod->ops == &rsnd_ssi_dma_ops;
	582	}
	583
	584
ae5c3223 KM	585	/*
	586	* Non SSI
	587	*/
ae5c3223	588	static struct rsnd_mod_ops rsnd_ssi_non_ops = {
8aefda50	589	.name = SSI_NAME,
ae5c3223 KM	590	};
	591
	592	/*
	593	* ssi mod function
	594	*/
	595	struct rsnd_mod rsnd_ssi_mod_get(struct rsnd_priv priv, int id)
	596	{
8b14719b TI	597	if (WARN_ON(id < 0 \|\| id >= rsnd_ssi_nr(priv)))
8b14719b TI	598	id = 0;
ae5c3223	599
dd27d808	600	return &((struct rsnd_ssi *)(priv->ssi) + id)->mod;
ae5c3223 KM	601	}
ae5c3223 KM	602
7b5ce975 KM	603	int rsnd_ssi_is_pin_sharing(struct rsnd_mod *mod)
	604	{
	605	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	606
	607	return !!(rsnd_ssi_mode_flags(ssi) & RSND_SSI_CLK_PIN_SHARE);
	608	}
	609
	610	static void rsnd_ssi_parent_clk_setup(struct rsnd_priv priv, struct rsnd_ssi ssi)
	611	{
	612	if (!rsnd_ssi_is_pin_sharing(&ssi->mod))
	613	return;
	614
	615	switch (rsnd_mod_id(&ssi->mod)) {
	616	case 1:
	617	case 2:
	618	ssi->parent = rsnd_mod_to_ssi(rsnd_ssi_mod_get(priv, 0));
	619	break;
	620	case 4:
	621	ssi->parent = rsnd_mod_to_ssi(rsnd_ssi_mod_get(priv, 3));
	622	break;
	623	case 8:
	624	ssi->parent = rsnd_mod_to_ssi(rsnd_ssi_mod_get(priv, 7));
	625	break;
	626	}
	627	}
	628
90e8e50f KM	629
	630	static void rsnd_of_parse_ssi(struct platform_device *pdev,
	631	const struct rsnd_of_data *of_data,
	632	struct rsnd_priv *priv)
	633	{
	634	struct device_node *node;
	635	struct device_node *np;
	636	struct rsnd_ssi_platform_info *ssi_info;
	637	struct rcar_snd_info *info = rsnd_priv_to_info(priv);
	638	struct device *dev = &pdev->dev;
	639	int nr, i;
	640
	641	if (!of_data)
	642	return;
	643
	644	node = of_get_child_by_name(dev->of_node, "rcar_sound,ssi");
	645	if (!node)
	646	return;
	647
	648	nr = of_get_child_count(node);
	649	if (!nr)
f451e48d	650	goto rsnd_of_parse_ssi_end;
90e8e50f KM	651
	652	ssi_info = devm_kzalloc(dev,
	653	sizeof(struct rsnd_ssi_platform_info) * nr,
	654	GFP_KERNEL);
	655	if (!ssi_info) {
	656	dev_err(dev, "ssi info allocation error\n");
f451e48d	657	goto rsnd_of_parse_ssi_end;
90e8e50f KM	658	}
	659
	660	info->ssi_info = ssi_info;
	661	info->ssi_info_nr = nr;
	662
	663	i = -1;
	664	for_each_child_of_node(node, np) {
	665	i++;
	666
	667	ssi_info = info->ssi_info + i;
	668
	669	/*
	670	* pin settings
	671	*/
	672	if (of_get_property(np, "shared-pin", NULL))
	673	ssi_info->flags \|= RSND_SSI_CLK_PIN_SHARE;
	674
	675	/*
	676	* irq
	677	*/
6cfad789	678	ssi_info->irq = irq_of_parse_and_map(np, 0);
199e7688 KM	679
	680	/*
	681	* DMA
	682	*/
	683	ssi_info->dma_id = of_get_property(np, "pio-transfer", NULL) ?
	684	0 : 1;
d9288d0b KM	685
	686	if (of_get_property(np, "no-busif", NULL))
	687	ssi_info->flags \|= RSND_SSI_NO_BUSIF;
90e8e50f	688	}
f451e48d KM	689
	690	rsnd_of_parse_ssi_end:
	691	of_node_put(node);
90e8e50f KM	692	}
90e8e50f KM	693
ae5c3223	694	int rsnd_ssi_probe(struct platform_device *pdev,
90e8e50f	695	const struct rsnd_of_data *of_data,
ae5c3223 KM	696	struct rsnd_priv *priv)
ae5c3223 KM	697	{
5da39cf3	698	struct rcar_snd_info *info = rsnd_priv_to_info(priv);
ae5c3223 KM	699	struct rsnd_ssi_platform_info *pinfo;
	700	struct device *dev = rsnd_priv_to_dev(priv);
	701	struct rsnd_mod_ops *ops;
	702	struct clk *clk;
ae5c3223 KM	703	struct rsnd_ssi *ssi;
ae5c3223 KM	704	char name[RSND_SSI_NAME_SIZE];
ff8f30e6	705	int i, nr;
ae5c3223	706
90e8e50f KM	707	rsnd_of_parse_ssi(pdev, of_data, priv);
90e8e50f KM	708
ae5c3223 KM	709	/*
	710	* init SSI
	711	*/
	712	nr = info->ssi_info_nr;
dd27d808 KM	713	ssi = devm_kzalloc(dev, sizeof(ssi) nr, GFP_KERNEL);
dd27d808 KM	714	if (!ssi) {
ae5c3223 KM	715	dev_err(dev, "SSI allocate failed\n");
	716	return -ENOMEM;
	717	}
	718
dd27d808 KM	719	priv->ssi = ssi;
dd27d808 KM	720	priv->ssi_nr = nr;
ae5c3223 KM	721
	722	for_each_rsnd_ssi(ssi, priv, i) {
	723	pinfo = &info->ssi_info[i];
	724
8aefda50 KM	725	snprintf(name, RSND_SSI_NAME_SIZE, "%s.%d",
8aefda50 KM	726	SSI_NAME, i);
ae5c3223	727
60dbb4f1	728	clk = devm_clk_get(dev, name);
ae5c3223 KM	729	if (IS_ERR(clk))
	730	return PTR_ERR(clk);
	731
	732	ssi->info = pinfo;
ae5c3223 KM	733
ae5c3223 KM	734	ops = &rsnd_ssi_non_ops;
ff8f30e6 KM	735	if (pinfo->dma_id > 0)
	736	ops = &rsnd_ssi_dma_ops;
	737	else if (rsnd_ssi_pio_available(ssi))
	738	ops = &rsnd_ssi_pio_ops;
ae5c3223	739
85642952	740	rsnd_mod_init(priv, &ssi->mod, ops, clk, RSND_MOD_SSI, i);
7b5ce975 KM	741
7b5ce975 KM	742	rsnd_ssi_parent_clk_setup(priv, ssi);
ae5c3223 KM	743	}
ae5c3223 KM	744
ae5c3223 KM	745	return 0;
ae5c3223 KM	746	}