[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 */

struct rsnd_ssi {
	struct clk *clk;
	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;
	u32 cr_etc;
	int err;
	unsigned int usrcnt;
	unsigned int rate;
};

#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->pio_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 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->rate	= rate;
				ssi->cr_clk	= FORCE | SWL_32 |
						  SCKD | SWSD | CKDV(j);

				dev_dbg(dev, "ssi%d outputs %u Hz\n",
					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->rate = 0;
	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;

	if (0 == ssi->usrcnt) {
		clk_enable(ssi->clk);

		if (rsnd_dai_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  =	ssi->cr_own	|
		ssi->cr_clk	|
		ssi->cr_etc	|
		EN;

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

	ssi->usrcnt++;

	dev_dbg(dev, "ssi%d hw started\n", 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_dai_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);
		}

		clk_disable(ssi->clk);
	}

	dev_dbg(dev, "ssi%d hw stopped\n", 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 */

	rsnd_src_ssi_mode_init(mod, rdai);

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

/*
 *		SSI PIO
 */
static irqreturn_t rsnd_ssi_pio_interrupt(int irq, void *data)
{
	struct rsnd_ssi *ssi = data;
	struct rsnd_mod *mod = &ssi->mod;
	struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
	u32 status = rsnd_mod_read(mod, SSISR);
	irqreturn_t ret = IRQ_NONE;

	if (io && (status & DIRQ)) {
		struct rsnd_dai *rdai = ssi->rdai;
		struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
		u32 *buf = (u32 *)(runtime->dma_area +
				   rsnd_dai_pointer_offset(io, 0));

		rsnd_ssi_record_error(ssi, status);

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

		ret = IRQ_HANDLED;
	}

	return ret;
}

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 irq = ssi->info->pio_irq;
	int ret;

	ret = devm_request_irq(dev, irq,
			       rsnd_ssi_pio_interrupt,
			       IRQF_SHARED,
			       dev_name(dev), ssi);
	if (ret)
		dev_err(dev, "SSI request interrupt failed\n");

	return ret;
}

static int rsnd_ssi_pio_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);

	/* enable PIO IRQ */
	ssi->cr_etc = UIEN | OIEN | DIEN;

	rsnd_src_enable_ssi_irq(mod, rdai);

	rsnd_ssi_hw_start(ssi, rdai, io);

	return 0;
}

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

	ssi->cr_etc = 0;

	rsnd_ssi_hw_stop(ssi, rdai);

	return 0;
}

static struct rsnd_mod_ops rsnd_ssi_pio_ops = {
	.name	= "ssi (pio)",
	.probe	= rsnd_ssi_pio_probe,
	.init	= rsnd_ssi_init,
	.quit	= rsnd_ssi_quit,
	.start	= rsnd_ssi_pio_start,
	.stop	= rsnd_ssi_pio_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 = rsnd_dma_init(
		priv, rsnd_mod_to_dma(mod),
		rsnd_info_is_playback(priv, ssi),
		dma_id);

	if (ret < 0)
		dev_err(dev, "SSI DMA failed\n");

	return ret;
}

static int rsnd_ssi_dma_remove(struct rsnd_mod *mod,
			       struct rsnd_dai *rdai)
{
	rsnd_dma_quit(rsnd_mod_to_priv(mod), rsnd_mod_to_dma(mod));

	return 0;
}

static int rsnd_ssi_dma_start(struct rsnd_mod *mod,
			      struct rsnd_dai *rdai)
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	struct rsnd_dma *dma = rsnd_mod_to_dma(&ssi->mod);
	struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);

	/* enable DMA transfer */
	ssi->cr_etc = DMEN;

	rsnd_dma_start(dma);

	rsnd_ssi_hw_start(ssi, ssi->rdai, io);

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

	return 0;
}

static int rsnd_ssi_dma_stop(struct rsnd_mod *mod,
			     struct rsnd_dai *rdai)
{
	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	struct rsnd_dma *dma = rsnd_mod_to_dma(&ssi->mod);

	ssi->cr_etc = 0;

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

	rsnd_ssi_hw_stop(ssi, rdai);

	rsnd_dma_stop(dma);

	return 0;
}

static struct rsnd_mod_ops rsnd_ssi_dma_ops = {
	.name	= "ssi (dma)",
	.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,
};

/*
 *		Non SSI
 */
static struct rsnd_mod_ops rsnd_ssi_non_ops = {
	.name	= "ssi (non)",
};

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

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, "ssi.%d", i);

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

		ssi->info	= pinfo;
		ssi->clk	= clk;

		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, 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
ae5c3223 KM	60	struct rsnd_ssi {
	61	struct clk *clk;
	62	struct rsnd_ssi_platform_info info; / rcar_snd.h */
	63	struct rsnd_ssi *parent;
	64	struct rsnd_mod mod;
	65
	66	struct rsnd_dai *rdai;
ae5c3223 KM	67	u32 cr_own;
	68	u32 cr_clk;
	69	u32 cr_etc;
	70	int err;
	71	unsigned int usrcnt;
	72	unsigned int rate;
	73	};
	74
ae5c3223 KM	75	#define for_each_rsnd_ssi(pos, priv, i) \
	76	for (i = 0; \
	77	(i < rsnd_ssi_nr(priv)) && \
dd27d808	78	((pos) = ((struct rsnd_ssi *)(priv)->ssi + i)); \
ae5c3223 KM	79	i++)
ae5c3223 KM	80
dd27d808	81	#define rsnd_ssi_nr(priv) ((priv)->ssi_nr)
ae5c3223	82	#define rsnd_mod_to_ssi(_mod) container_of((_mod), struct rsnd_ssi, mod)
849fc82a KM	83	#define rsnd_dma_to_ssi(dma) rsnd_mod_to_ssi(rsnd_dma_to_mod(dma))
	84	#define rsnd_ssi_pio_available(ssi) ((ssi)->info->pio_irq > 0)
	85	#define rsnd_ssi_dma_available(ssi) \
	86	rsnd_dma_available(rsnd_mod_to_dma(&(ssi)->mod))
ae5c3223	87	#define rsnd_ssi_clk_from_parent(ssi) ((ssi)->parent)
ae5c3223	88	#define rsnd_ssi_mode_flags(p) ((p)->info->flags)
4b4dab82	89	#define rsnd_ssi_dai_id(ssi) ((ssi)->info->dai_id)
ae5c3223	90
ae5c3223 KM	91	static void rsnd_ssi_status_check(struct rsnd_mod *mod,
	92	u32 bit)
	93	{
	94	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
	95	struct device *dev = rsnd_priv_to_dev(priv);
	96	u32 status;
	97	int i;
	98
	99	for (i = 0; i < 1024; i++) {
	100	status = rsnd_mod_read(mod, SSISR);
	101	if (status & bit)
	102	return;
	103
	104	udelay(50);
	105	}
	106
	107	dev_warn(dev, "status check failed\n");
	108	}
	109
	110	static int rsnd_ssi_master_clk_start(struct rsnd_ssi *ssi,
adcf7d5e	111	struct rsnd_dai_stream *io)
ae5c3223 KM	112	{
ae5c3223 KM	113	struct rsnd_priv *priv = rsnd_mod_to_priv(&ssi->mod);
adcf7d5e	114	struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
ae5c3223 KM	115	struct device *dev = rsnd_priv_to_dev(priv);
	116	int i, j, ret;
	117	int adg_clk_div_table[] = {
	118	1, 6, /* see adg.c */
	119	};
	120	int ssi_clk_mul_table[] = {
	121	1, 2, 4, 8, 16, 6, 12,
	122	};
	123	unsigned int main_rate;
ba9c949f	124	unsigned int rate = rsnd_src_get_ssi_rate(priv, io, runtime);
ae5c3223 KM	125
	126	/*
	127	* Find best clock, and try to start ADG
	128	*/
	129	for (i = 0; i < ARRAY_SIZE(adg_clk_div_table); i++) {
	130	for (j = 0; j < ARRAY_SIZE(ssi_clk_mul_table); j++) {
	131
	132	/*
	133	* this driver is assuming that
	134	* system word is 64fs (= 2 x 32bit)
729aca51	135	* see rsnd_ssi_init()
ae5c3223 KM	136	*/
	137	main_rate = rate / adg_clk_div_table[i]
	138	* 32 * 2 * ssi_clk_mul_table[j];
	139
	140	ret = rsnd_adg_ssi_clk_try_start(&ssi->mod, main_rate);
	141	if (0 == ret) {
	142	ssi->rate = rate;
	143	ssi->cr_clk = FORCE \| SWL_32 \|
	144	SCKD \| SWSD \| CKDV(j);
	145
	146	dev_dbg(dev, "ssi%d outputs %u Hz\n",
	147	rsnd_mod_id(&ssi->mod), rate);
	148
	149	return 0;
	150	}
	151	}
	152	}
	153
	154	dev_err(dev, "unsupported clock rate\n");
	155	return -EIO;
	156	}
	157
	158	static void rsnd_ssi_master_clk_stop(struct rsnd_ssi *ssi)
	159	{
	160	ssi->rate = 0;
	161	ssi->cr_clk = 0;
	162	rsnd_adg_ssi_clk_stop(&ssi->mod);
	163	}
	164
	165	static void rsnd_ssi_hw_start(struct rsnd_ssi *ssi,
	166	struct rsnd_dai *rdai,
	167	struct rsnd_dai_stream *io)
	168	{
	169	struct rsnd_priv *priv = rsnd_mod_to_priv(&ssi->mod);
	170	struct device *dev = rsnd_priv_to_dev(priv);
	171	u32 cr;
	172
	173	if (0 == ssi->usrcnt) {
	174	clk_enable(ssi->clk);
	175
e779a20d	176	if (rsnd_dai_is_clk_master(rdai)) {
ae5c3223 KM	177	if (rsnd_ssi_clk_from_parent(ssi))
	178	rsnd_ssi_hw_start(ssi->parent, rdai, io);
	179	else
adcf7d5e	180	rsnd_ssi_master_clk_start(ssi, io);
ae5c3223 KM	181	}
	182	}
	183
	184	cr = ssi->cr_own \|
	185	ssi->cr_clk \|
	186	ssi->cr_etc \|
	187	EN;
	188
	189	rsnd_mod_write(&ssi->mod, SSICR, cr);
	190
	191	ssi->usrcnt++;
	192
	193	dev_dbg(dev, "ssi%d hw started\n", rsnd_mod_id(&ssi->mod));
	194	}
	195
	196	static void rsnd_ssi_hw_stop(struct rsnd_ssi *ssi,
	197	struct rsnd_dai *rdai)
	198	{
	199	struct rsnd_priv *priv = rsnd_mod_to_priv(&ssi->mod);
	200	struct device *dev = rsnd_priv_to_dev(priv);
	201	u32 cr;
	202
	203	if (0 == ssi->usrcnt) /* stop might be called without start */
	204	return;
	205
	206	ssi->usrcnt--;
	207
	208	if (0 == ssi->usrcnt) {
	209	/*
	210	* disable all IRQ,
	211	* and, wait all data was sent
	212	*/
	213	cr = ssi->cr_own \|
	214	ssi->cr_clk;
	215
	216	rsnd_mod_write(&ssi->mod, SSICR, cr \| EN);
	217	rsnd_ssi_status_check(&ssi->mod, DIRQ);
	218
	219	/*
	220	* disable SSI,
	221	* and, wait idle state
	222	*/
	223	rsnd_mod_write(&ssi->mod, SSICR, cr); /* disabled all */
	224	rsnd_ssi_status_check(&ssi->mod, IIRQ);
	225
e779a20d	226	if (rsnd_dai_is_clk_master(rdai)) {
ae5c3223 KM	227	if (rsnd_ssi_clk_from_parent(ssi))
	228	rsnd_ssi_hw_stop(ssi->parent, rdai);
	229	else
	230	rsnd_ssi_master_clk_stop(ssi);
	231	}
	232
	233	clk_disable(ssi->clk);
	234	}
	235
	236	dev_dbg(dev, "ssi%d hw stopped\n", rsnd_mod_id(&ssi->mod));
	237	}
	238
	239	/*
	240	* SSI mod common functions
	241	*/
	242	static int rsnd_ssi_init(struct rsnd_mod *mod,
b42fccf6	243	struct rsnd_dai *rdai)
ae5c3223 KM	244	{
ae5c3223 KM	245	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
b42fccf6	246	struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
ae5c3223 KM	247	struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
	248	u32 cr;
	249
	250	cr = FORCE;
	251
	252	/*
	253	* always use 32bit system word for easy clock calculation.
	254	* see also rsnd_ssi_master_clk_enable()
	255	*/
	256	cr \|= SWL_32;
	257
	258	/*
	259	* init clock settings for SSICR
	260	*/
	261	switch (runtime->sample_bits) {
	262	case 16:
	263	cr \|= DWL_16;
	264	break;
	265	case 32:
	266	cr \|= DWL_24;
	267	break;
	268	default:
	269	return -EIO;
	270	}
	271
	272	if (rdai->bit_clk_inv)
	273	cr \|= SCKP;
	274	if (rdai->frm_clk_inv)
	275	cr \|= SWSP;
	276	if (rdai->data_alignment)
	277	cr \|= SDTA;
	278	if (rdai->sys_delay)
	279	cr \|= DEL;
	280	if (rsnd_dai_is_play(rdai, io))
	281	cr \|= TRMD;
	282
	283	/*
	284	* set ssi parameter
	285	*/
	286	ssi->rdai = rdai;
ae5c3223 KM	287	ssi->cr_own = cr;
	288	ssi->err = -1; /* ignore 1st error */
	289
b42fccf6	290	rsnd_src_ssi_mode_init(mod, rdai);
221bf523	291
ae5c3223 KM	292	return 0;
	293	}
	294
	295	static int rsnd_ssi_quit(struct rsnd_mod *mod,
b42fccf6	296	struct rsnd_dai *rdai)
ae5c3223 KM	297	{
	298	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	299	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
	300	struct device *dev = rsnd_priv_to_dev(priv);
	301
ae5c3223 KM	302	if (ssi->err > 0)
	303	dev_warn(dev, "ssi under/over flow err = %d\n", ssi->err);
	304
	305	ssi->rdai = NULL;
ae5c3223 KM	306	ssi->cr_own = 0;
	307	ssi->err = 0;
	308
	309	return 0;
	310	}
	311
	312	static void rsnd_ssi_record_error(struct rsnd_ssi *ssi, u32 status)
	313	{
	314	/* under/over flow error */
	315	if (status & (UIRQ \| OIRQ)) {
	316	ssi->err++;
	317
	318	/* clear error status */
	319	rsnd_mod_write(&ssi->mod, SSISR, 0);
	320	}
	321	}
	322
	323	/*
	324	* SSI PIO
	325	*/
	326	static irqreturn_t rsnd_ssi_pio_interrupt(int irq, void *data)
	327	{
	328	struct rsnd_ssi *ssi = data;
4686a0ad KM	329	struct rsnd_mod *mod = &ssi->mod;
	330	struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
	331	u32 status = rsnd_mod_read(mod, SSISR);
ae5c3223 KM	332	irqreturn_t ret = IRQ_NONE;
	333
	334	if (io && (status & DIRQ)) {
	335	struct rsnd_dai *rdai = ssi->rdai;
	336	struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
	337	u32 buf = (u32 )(runtime->dma_area +
	338	rsnd_dai_pointer_offset(io, 0));
	339
	340	rsnd_ssi_record_error(ssi, status);
	341
	342	/*
	343	* 8/16/32 data can be assesse to TDR/RDR register
	344	* directly as 32bit data
	345	* see rsnd_ssi_init()
	346	*/
	347	if (rsnd_dai_is_play(rdai, io))
4686a0ad	348	rsnd_mod_write(mod, SSITDR, *buf);
ae5c3223	349	else
4686a0ad	350	*buf = rsnd_mod_read(mod, SSIRDR);
ae5c3223 KM	351
	352	rsnd_dai_pointer_update(io, sizeof(*buf));
	353
	354	ret = IRQ_HANDLED;
	355	}
	356
	357	return ret;
	358	}
	359
ff8f30e6	360	static int rsnd_ssi_pio_probe(struct rsnd_mod *mod,
b42fccf6	361	struct rsnd_dai *rdai)
ff8f30e6 KM	362	{
	363	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
	364	struct device *dev = rsnd_priv_to_dev(priv);
	365	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	366	int irq = ssi->info->pio_irq;
	367	int ret;
	368
	369	ret = devm_request_irq(dev, irq,
	370	rsnd_ssi_pio_interrupt,
	371	IRQF_SHARED,
	372	dev_name(dev), ssi);
	373	if (ret)
	374	dev_err(dev, "SSI request interrupt failed\n");
	375
	376	return ret;
	377	}
	378
ae5c3223	379	static int rsnd_ssi_pio_start(struct rsnd_mod *mod,
b42fccf6	380	struct rsnd_dai *rdai)
ae5c3223	381	{
ae5c3223	382	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
b42fccf6	383	struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
ae5c3223 KM	384
	385	/* enable PIO IRQ */
	386	ssi->cr_etc = UIEN \| OIEN \| DIEN;
	387
b42fccf6	388	rsnd_src_enable_ssi_irq(mod, rdai);
b8cc41e9	389
ae5c3223 KM	390	rsnd_ssi_hw_start(ssi, rdai, io);
ae5c3223 KM	391
ae5c3223 KM	392	return 0;
	393	}
	394
	395	static int rsnd_ssi_pio_stop(struct rsnd_mod *mod,
b42fccf6	396	struct rsnd_dai *rdai)
ae5c3223	397	{
ae5c3223 KM	398	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
ae5c3223 KM	399
ae5c3223 KM	400	ssi->cr_etc = 0;
	401
	402	rsnd_ssi_hw_stop(ssi, rdai);
	403
	404	return 0;
	405	}
	406
	407	static struct rsnd_mod_ops rsnd_ssi_pio_ops = {
	408	.name = "ssi (pio)",
ff8f30e6	409	.probe = rsnd_ssi_pio_probe,
ae5c3223 KM	410	.init = rsnd_ssi_init,
	411	.quit = rsnd_ssi_quit,
	412	.start = rsnd_ssi_pio_start,
	413	.stop = rsnd_ssi_pio_stop,
	414	};
	415
ff8f30e6	416	static int rsnd_ssi_dma_probe(struct rsnd_mod *mod,
b42fccf6	417	struct rsnd_dai *rdai)
ff8f30e6 KM	418	{
	419	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
	420	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
ff8f30e6 KM	421	struct device *dev = rsnd_priv_to_dev(priv);
ff8f30e6 KM	422	int dma_id = ssi->info->dma_id;
ff8f30e6 KM	423	int ret;
ff8f30e6 KM	424
ff8f30e6 KM	425	ret = rsnd_dma_init(
ff8f30e6 KM	426	priv, rsnd_mod_to_dma(mod),
29e69fd2	427	rsnd_info_is_playback(priv, ssi),
ff8f30e6 KM	428	dma_id);
	429
	430	if (ret < 0)
	431	dev_err(dev, "SSI DMA failed\n");
	432
	433	return ret;
	434	}
	435
	436	static int rsnd_ssi_dma_remove(struct rsnd_mod *mod,
b42fccf6	437	struct rsnd_dai *rdai)
ff8f30e6 KM	438	{
	439	rsnd_dma_quit(rsnd_mod_to_priv(mod), rsnd_mod_to_dma(mod));
	440
	441	return 0;
	442	}
	443
849fc82a	444	static int rsnd_ssi_dma_start(struct rsnd_mod *mod,
b42fccf6	445	struct rsnd_dai *rdai)
849fc82a KM	446	{
	447	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	448	struct rsnd_dma *dma = rsnd_mod_to_dma(&ssi->mod);
b42fccf6	449	struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
849fc82a KM	450
	451	/* enable DMA transfer */
	452	ssi->cr_etc = DMEN;
849fc82a KM	453
	454	rsnd_dma_start(dma);
	455
	456	rsnd_ssi_hw_start(ssi, ssi->rdai, io);
	457
	458	/* enable WS continue */
e779a20d	459	if (rsnd_dai_is_clk_master(rdai))
849fc82a KM	460	rsnd_mod_write(&ssi->mod, SSIWSR, CONT);
	461
	462	return 0;
	463	}
	464
	465	static int rsnd_ssi_dma_stop(struct rsnd_mod *mod,
b42fccf6	466	struct rsnd_dai *rdai)
849fc82a KM	467	{
	468	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	469	struct rsnd_dma *dma = rsnd_mod_to_dma(&ssi->mod);
	470
	471	ssi->cr_etc = 0;
	472
4686a0ad KM	473	rsnd_ssi_record_error(ssi, rsnd_mod_read(mod, SSISR));
4686a0ad KM	474
849fc82a KM	475	rsnd_ssi_hw_stop(ssi, rdai);
	476
	477	rsnd_dma_stop(dma);
	478
	479	return 0;
	480	}
	481
	482	static struct rsnd_mod_ops rsnd_ssi_dma_ops = {
	483	.name = "ssi (dma)",
ff8f30e6 KM	484	.probe = rsnd_ssi_dma_probe,
ff8f30e6 KM	485	.remove = rsnd_ssi_dma_remove,
849fc82a KM	486	.init = rsnd_ssi_init,
	487	.quit = rsnd_ssi_quit,
	488	.start = rsnd_ssi_dma_start,
	489	.stop = rsnd_ssi_dma_stop,
	490	};
	491
ae5c3223 KM	492	/*
	493	* Non SSI
	494	*/
ae5c3223 KM	495	static struct rsnd_mod_ops rsnd_ssi_non_ops = {
ae5c3223 KM	496	.name = "ssi (non)",
ae5c3223 KM	497	};
	498
	499	/*
	500	* ssi mod function
	501	*/
	502	struct rsnd_mod rsnd_ssi_mod_get(struct rsnd_priv priv, int id)
	503	{
8b14719b TI	504	if (WARN_ON(id < 0 \|\| id >= rsnd_ssi_nr(priv)))
8b14719b TI	505	id = 0;
ae5c3223	506
dd27d808	507	return &((struct rsnd_ssi *)(priv->ssi) + id)->mod;
ae5c3223 KM	508	}
ae5c3223 KM	509
7b5ce975 KM	510	int rsnd_ssi_is_pin_sharing(struct rsnd_mod *mod)
	511	{
	512	struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
	513
	514	return !!(rsnd_ssi_mode_flags(ssi) & RSND_SSI_CLK_PIN_SHARE);
	515	}
	516
	517	static void rsnd_ssi_parent_clk_setup(struct rsnd_priv priv, struct rsnd_ssi ssi)
	518	{
	519	if (!rsnd_ssi_is_pin_sharing(&ssi->mod))
	520	return;
	521
	522	switch (rsnd_mod_id(&ssi->mod)) {
	523	case 1:
	524	case 2:
	525	ssi->parent = rsnd_mod_to_ssi(rsnd_ssi_mod_get(priv, 0));
	526	break;
	527	case 4:
	528	ssi->parent = rsnd_mod_to_ssi(rsnd_ssi_mod_get(priv, 3));
	529	break;
	530	case 8:
	531	ssi->parent = rsnd_mod_to_ssi(rsnd_ssi_mod_get(priv, 7));
	532	break;
	533	}
	534	}
	535
90e8e50f KM	536
	537	static void rsnd_of_parse_ssi(struct platform_device *pdev,
	538	const struct rsnd_of_data *of_data,
	539	struct rsnd_priv *priv)
	540	{
	541	struct device_node *node;
	542	struct device_node *np;
	543	struct rsnd_ssi_platform_info *ssi_info;
	544	struct rcar_snd_info *info = rsnd_priv_to_info(priv);
	545	struct device *dev = &pdev->dev;
	546	int nr, i;
	547
	548	if (!of_data)
	549	return;
	550
	551	node = of_get_child_by_name(dev->of_node, "rcar_sound,ssi");
	552	if (!node)
	553	return;
	554
	555	nr = of_get_child_count(node);
	556	if (!nr)
f451e48d	557	goto rsnd_of_parse_ssi_end;
90e8e50f KM	558
	559	ssi_info = devm_kzalloc(dev,
	560	sizeof(struct rsnd_ssi_platform_info) * nr,
	561	GFP_KERNEL);
	562	if (!ssi_info) {
	563	dev_err(dev, "ssi info allocation error\n");
f451e48d	564	goto rsnd_of_parse_ssi_end;
90e8e50f KM	565	}
	566
	567	info->ssi_info = ssi_info;
	568	info->ssi_info_nr = nr;
	569
	570	i = -1;
	571	for_each_child_of_node(node, np) {
	572	i++;
	573
	574	ssi_info = info->ssi_info + i;
	575
	576	/*
	577	* pin settings
	578	*/
	579	if (of_get_property(np, "shared-pin", NULL))
	580	ssi_info->flags \|= RSND_SSI_CLK_PIN_SHARE;
	581
	582	/*
	583	* irq
	584	*/
	585	ssi_info->pio_irq = irq_of_parse_and_map(np, 0);
	586	}
f451e48d KM	587
	588	rsnd_of_parse_ssi_end:
	589	of_node_put(node);
90e8e50f KM	590	}
90e8e50f KM	591
ae5c3223	592	int rsnd_ssi_probe(struct platform_device *pdev,
90e8e50f	593	const struct rsnd_of_data *of_data,
ae5c3223 KM	594	struct rsnd_priv *priv)
ae5c3223 KM	595	{
5da39cf3	596	struct rcar_snd_info *info = rsnd_priv_to_info(priv);
ae5c3223 KM	597	struct rsnd_ssi_platform_info *pinfo;
	598	struct device *dev = rsnd_priv_to_dev(priv);
	599	struct rsnd_mod_ops *ops;
	600	struct clk *clk;
ae5c3223 KM	601	struct rsnd_ssi *ssi;
ae5c3223 KM	602	char name[RSND_SSI_NAME_SIZE];
ff8f30e6	603	int i, nr;
ae5c3223	604
90e8e50f KM	605	rsnd_of_parse_ssi(pdev, of_data, priv);
90e8e50f KM	606
ae5c3223 KM	607	/*
	608	* init SSI
	609	*/
	610	nr = info->ssi_info_nr;
dd27d808 KM	611	ssi = devm_kzalloc(dev, sizeof(ssi) nr, GFP_KERNEL);
dd27d808 KM	612	if (!ssi) {
ae5c3223 KM	613	dev_err(dev, "SSI allocate failed\n");
	614	return -ENOMEM;
	615	}
	616
dd27d808 KM	617	priv->ssi = ssi;
dd27d808 KM	618	priv->ssi_nr = nr;
ae5c3223 KM	619
	620	for_each_rsnd_ssi(ssi, priv, i) {
	621	pinfo = &info->ssi_info[i];
	622
	623	snprintf(name, RSND_SSI_NAME_SIZE, "ssi.%d", i);
	624
60dbb4f1	625	clk = devm_clk_get(dev, name);
ae5c3223 KM	626	if (IS_ERR(clk))
	627	return PTR_ERR(clk);
	628
	629	ssi->info = pinfo;
	630	ssi->clk = clk;
	631
	632	ops = &rsnd_ssi_non_ops;
ff8f30e6 KM	633	if (pinfo->dma_id > 0)
	634	ops = &rsnd_ssi_dma_ops;
	635	else if (rsnd_ssi_pio_available(ssi))
	636	ops = &rsnd_ssi_pio_ops;
ae5c3223	637
a126021d	638	rsnd_mod_init(priv, &ssi->mod, ops, RSND_MOD_SSI, i);
7b5ce975 KM	639
7b5ce975 KM	640	rsnd_ssi_parent_clk_setup(priv, ssi);
ae5c3223 KM	641	}
ae5c3223 KM	642
ae5c3223 KM	643	return 0;
ae5c3223 KM	644	}