[deliverable/linux.git] / sound / soc / sh / rcar / rsrc-card.c

/*
 * Renesas Sampling Rate Convert Sound Card for DPCM
 *
 * Copyright (C) 2015 Renesas Solutions Corp.
 * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
 *
 * based on ${LINUX}/sound/soc/generic/simple-card.c
 *
 * 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/clk.h>
#include <linux/device.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/of_device.h>
#include <linux/platform_device.h>
#include <linux/string.h>
#include <sound/jack.h>
#include <sound/soc.h>
#include <sound/soc-dai.h>

struct rsrc_card_of_data {
	const char *prefix;
	const struct snd_soc_dapm_route *routes;
	int num_routes;
};

static const struct snd_soc_dapm_route routes_ssi0_ak4642[] = {
	{"ak4642 Playback", NULL, "DAI0 Playback"},
	{"DAI0 Capture", NULL, "ak4642 Capture"},
};

static const struct rsrc_card_of_data routes_of_ssi0_ak4642 = {
	.prefix		= "ak4642",
	.routes		= routes_ssi0_ak4642,
	.num_routes	= ARRAY_SIZE(routes_ssi0_ak4642),
};

static const struct of_device_id rsrc_card_of_match[] = {
	{ .compatible = "renesas,rsrc-card,lager",	.data = &routes_of_ssi0_ak4642 },
	{ .compatible = "renesas,rsrc-card,koelsch",	.data = &routes_of_ssi0_ak4642 },
	{},
};
MODULE_DEVICE_TABLE(of, rsrc_card_of_match);

struct rsrc_card_dai {
	unsigned int fmt;
	unsigned int sysclk;
	struct clk *clk;
};

#define IDX_CPU		0
#define IDX_CODEC	1
#define DAI_NAME_NUM	32
struct rsrc_card_priv {
	struct snd_soc_card snd_card;
	struct rsrc_card_dai_props {
		struct rsrc_card_dai cpu_dai;
		struct rsrc_card_dai codec_dai;
		char dai_name[DAI_NAME_NUM];
	} *dai_props;
	struct snd_soc_codec_conf codec_conf;
	struct snd_soc_dai_link *dai_link;
	int dai_num;
	u32 convert_rate;
};

#define rsrc_priv_to_dev(priv) ((priv)->snd_card.dev)
#define rsrc_priv_to_link(priv, i) ((priv)->snd_card.dai_link + (i))
#define rsrc_priv_to_props(priv, i) ((priv)->dai_props + (i))
#define rsrc_dev_to_of_data(dev) (of_match_device(rsrc_card_of_match, (dev))->data)

static int rsrc_card_startup(struct snd_pcm_substream *substream)
{
	struct snd_soc_pcm_runtime *rtd = substream->private_data;
	struct rsrc_card_priv *priv =	snd_soc_card_get_drvdata(rtd->card);
	struct rsrc_card_dai_props *dai_props =
		rsrc_priv_to_props(priv, rtd - rtd->card->rtd);
	int ret;

	ret = clk_prepare_enable(dai_props->cpu_dai.clk);
	if (ret)
		return ret;

	ret = clk_prepare_enable(dai_props->codec_dai.clk);
	if (ret)
		clk_disable_unprepare(dai_props->cpu_dai.clk);

	return ret;
}

static void rsrc_card_shutdown(struct snd_pcm_substream *substream)
{
	struct snd_soc_pcm_runtime *rtd = substream->private_data;
	struct rsrc_card_priv *priv =	snd_soc_card_get_drvdata(rtd->card);
	struct rsrc_card_dai_props *dai_props =
		rsrc_priv_to_props(priv, rtd - rtd->card->rtd);

	clk_disable_unprepare(dai_props->cpu_dai.clk);

	clk_disable_unprepare(dai_props->codec_dai.clk);
}

static struct snd_soc_ops rsrc_card_ops = {
	.startup = rsrc_card_startup,
	.shutdown = rsrc_card_shutdown,
};

static int __rsrc_card_dai_init(struct snd_soc_dai *dai,
				struct rsrc_card_dai *set)
{
	int ret;

	if (set->fmt) {
		ret = snd_soc_dai_set_fmt(dai, set->fmt);
		if (ret && ret != -ENOTSUPP) {
			dev_err(dai->dev, "set_fmt error\n");
			goto err;
		}
	}

	if (set->sysclk) {
		ret = snd_soc_dai_set_sysclk(dai, 0, set->sysclk, 0);
		if (ret && ret != -ENOTSUPP) {
			dev_err(dai->dev, "set_sysclk error\n");
			goto err;
		}
	}

	ret = 0;

err:
	return ret;
}

static int rsrc_card_dai_init(struct snd_soc_pcm_runtime *rtd)
{
	struct rsrc_card_priv *priv =	snd_soc_card_get_drvdata(rtd->card);
	struct snd_soc_dai *codec = rtd->codec_dai;
	struct snd_soc_dai *cpu = rtd->cpu_dai;
	struct rsrc_card_dai_props *dai_props;
	int num, ret;

	num = rtd - rtd->card->rtd;
	dai_props = &priv->dai_props[num];
	ret = __rsrc_card_dai_init(codec, &dai_props->codec_dai);
	if (ret < 0)
		return ret;

	ret = __rsrc_card_dai_init(cpu, &dai_props->cpu_dai);
	if (ret < 0)
		return ret;

	return 0;
}

static int rsrc_card_be_hw_params_fixup(struct snd_soc_pcm_runtime *rtd,
					struct snd_pcm_hw_params *params)
{
	struct rsrc_card_priv *priv = snd_soc_card_get_drvdata(rtd->card);
	struct snd_interval *rate = hw_param_interval(params,
						      SNDRV_PCM_HW_PARAM_RATE);

	if (!priv->convert_rate)
		return 0;

	rate->min = rate->max = priv->convert_rate;

	return 0;
}

static int rsrc_card_parse_daifmt(struct device_node *node,
				  struct rsrc_card_priv *priv,
				  struct device_node *codec,
				  int idx)
{
	struct device_node *bitclkmaster = NULL;
	struct device_node *framemaster = NULL;
	struct rsrc_card_dai_props *dai_props = rsrc_priv_to_props(priv, idx);
	struct rsrc_card_dai *cpu_dai = &dai_props->cpu_dai;
	struct rsrc_card_dai *codec_dai = &dai_props->codec_dai;
	unsigned int daifmt;

	daifmt = snd_soc_of_parse_daifmt(node, NULL,
					 &bitclkmaster, &framemaster);
	daifmt &= ~SND_SOC_DAIFMT_MASTER_MASK;

	if (!bitclkmaster && !framemaster)
		return -EINVAL;

	if (codec == bitclkmaster)
		daifmt |= (codec == framemaster) ?
			SND_SOC_DAIFMT_CBM_CFM : SND_SOC_DAIFMT_CBM_CFS;
	else
		daifmt |= (codec == framemaster) ?
			SND_SOC_DAIFMT_CBS_CFM : SND_SOC_DAIFMT_CBS_CFS;

	cpu_dai->fmt	= daifmt;
	codec_dai->fmt	= daifmt;

	of_node_put(bitclkmaster);
	of_node_put(framemaster);

	return 0;
}

static int
rsrc_card_sub_parse_of(struct rsrc_card_priv *priv,
		       struct device_node *np,
		       struct rsrc_card_dai *dai,
		       struct snd_soc_dai_link *dai_link,
		       int *args_count)
{
	struct device *dev = rsrc_priv_to_dev(priv);
	const struct rsrc_card_of_data *of_data = rsrc_dev_to_of_data(dev);
	struct of_phandle_args args;
	struct device_node **p_node;
	struct clk *clk;
	const char **dai_name;
	const char **name;
	u32 val;
	int ret;

	if (args_count) {
		p_node		= &dai_link->cpu_of_node;
		dai_name	= &dai_link->cpu_dai_name;
		name		= &dai_link->cpu_name;
	} else {
		p_node		= &dai_link->codec_of_node;
		dai_name	= &dai_link->codec_dai_name;
		name		= &dai_link->codec_name;
	}

	if (!np) {
		/* use snd-soc-dummy */
		*p_node		= NULL;
		*dai_name	= "snd-soc-dummy-dai";
		*name		= "snd-soc-dummy";
		return 0;
	}

	/*
	 * Get node via "sound-dai = <&phandle port>"
	 * it will be used as xxx_of_node on soc_bind_dai_link()
	 */
	ret = of_parse_phandle_with_args(np, "sound-dai",
					 "#sound-dai-cells", 0, &args);
	if (ret)
		return ret;

	*p_node = args.np;

	/* Get dai->name */
	ret = snd_soc_of_get_dai_name(np, dai_name);
	if (ret < 0)
		return ret;

	/*
	 * FIXME
	 *
	 * rsrc assumes DPCM playback/capture
	 */
	dai_link->dpcm_playback = 1;
	dai_link->dpcm_capture = 1;

	if (args_count) {
		*args_count = args.args_count;
		dai_link->dynamic = 1;
		dai_link->dpcm_merged_format = 1;
	} else {
		dai_link->no_pcm = 1;
		priv->codec_conf.of_node = (*p_node);
		priv->codec_conf.name_prefix = of_data->prefix;
	}

	/*
	 * Parse dai->sysclk come from "clocks = <&xxx>"
	 * (if system has common clock)
	 *  or "system-clock-frequency = <xxx>"
	 *  or device's module clock.
	 */
	if (of_property_read_bool(np, "clocks")) {
		clk = of_clk_get(np, 0);
		if (IS_ERR(clk)) {
			ret = PTR_ERR(clk);
			return ret;
		}

		dai->sysclk = clk_get_rate(clk);
		dai->clk = clk;
	} else if (!of_property_read_u32(np, "system-clock-frequency", &val)) {
		dai->sysclk = val;
	} else {
		clk = of_clk_get(args.np, 0);
		if (!IS_ERR(clk))
			dai->sysclk = clk_get_rate(clk);
	}

	return 0;
}

static int rsrc_card_dai_link_of(struct device_node *node,
				 struct rsrc_card_priv *priv,
				 int idx)
{
	struct device *dev = rsrc_priv_to_dev(priv);
	struct snd_soc_dai_link *dai_link = rsrc_priv_to_link(priv, idx);
	struct rsrc_card_dai_props *dai_props = rsrc_priv_to_props(priv, idx);
	struct device_node *cpu = NULL;
	struct device_node *codec = NULL;
	char *name = dai_props->dai_name;
	char prop[128];
	int ret, cpu_args;

	cpu = of_get_child_by_name(node, "cpu");
	codec = of_get_child_by_name(node, "codec");

	if (!cpu || !codec) {
		ret = -EINVAL;
		dev_err(dev, "%s: Can't find %s DT node\n", __func__, prop);
		goto dai_link_of_err;
	}

	ret = rsrc_card_parse_daifmt(node, priv, codec, idx);
	if (ret < 0)
		goto dai_link_of_err;

	ret = rsrc_card_sub_parse_of(priv, (idx == IDX_CPU) ? cpu : NULL,
				     &dai_props->cpu_dai,
				     dai_link,
				     &cpu_args);
	if (ret < 0)
		goto dai_link_of_err;

	ret = rsrc_card_sub_parse_of(priv, (idx == IDX_CODEC) ? codec : NULL,
				     &dai_props->codec_dai,
				     dai_link,
				     NULL);
	if (ret < 0)
		goto dai_link_of_err;

	if (!dai_link->cpu_dai_name || !dai_link->codec_dai_name) {
		ret = -EINVAL;
		goto dai_link_of_err;
	}

	/* Simple Card assumes platform == cpu */
	dai_link->platform_of_node = dai_link->cpu_of_node;

	snprintf(name, DAI_NAME_NUM, "%s.%s",
		dai_link->dynamic ? "fe" : "be",
		dai_link->dynamic ? dai_link->cpu_dai_name :
				    dai_link->codec_dai_name);
	dai_link->name = dai_link->stream_name = name;
	dai_link->ops = &rsrc_card_ops;
	dai_link->init = rsrc_card_dai_init;

	if (idx == IDX_CODEC)
		dai_link->be_hw_params_fixup = rsrc_card_be_hw_params_fixup;

	dev_dbg(dev, "\tname : %s\n", dai_link->stream_name);
	dev_dbg(dev, "\tcpu : %s / %04x / %d\n",
		dai_link->cpu_dai_name,
		dai_props->cpu_dai.fmt,
		dai_props->cpu_dai.sysclk);
	dev_dbg(dev, "\tcodec : %s / %04x / %d\n",
		dai_link->codec_dai_name,
		dai_props->codec_dai.fmt,
		dai_props->codec_dai.sysclk);

	/*
	 * In soc_bind_dai_link() will check cpu name after
	 * of_node matching if dai_link has cpu_dai_name.
	 * but, it will never match if name was created by
	 * fmt_single_name() remove cpu_dai_name if cpu_args
	 * was 0. See:
	 *	fmt_single_name()
	 *	fmt_multiple_name()
	 */
	if (!cpu_args)
		dai_link->cpu_dai_name = NULL;

dai_link_of_err:
	of_node_put(cpu);
	of_node_put(codec);

	return ret;
}

static int rsrc_card_parse_of(struct device_node *node,
			      struct rsrc_card_priv *priv,
			      struct device *dev)
{
	const struct rsrc_card_of_data *of_data = rsrc_dev_to_of_data(dev);
	struct rsrc_card_dai_props *props;
	struct snd_soc_dai_link *links;

	int ret;
	int i, num;

	if (!node)
		return -EINVAL;

	num = of_get_child_count(node);
	props = devm_kzalloc(dev, sizeof(*props) * num, GFP_KERNEL);
	links = devm_kzalloc(dev, sizeof(*links) * num, GFP_KERNEL);
	if (!props || !links)
		return -ENOMEM;

	priv->dai_props	= props;
	priv->dai_link	= links;
	priv->dai_num	= num;

	/* Parse the card name from DT */
	snd_soc_of_parse_card_name(&priv->snd_card, "card-name");

	/* Init snd_soc_card */
	priv->snd_card.owner			= THIS_MODULE;
	priv->snd_card.dev			= dev;
	priv->snd_card.dai_link			= priv->dai_link;
	priv->snd_card.num_links		= num;
	priv->snd_card.codec_conf		= &priv->codec_conf;
	priv->snd_card.num_configs		= 1;
	priv->snd_card.of_dapm_routes		= of_data->routes;
	priv->snd_card.num_of_dapm_routes	= of_data->num_routes;

	/* sampling rate convert */
	of_property_read_u32(node, "convert-rate", &priv->convert_rate);

	dev_dbg(dev, "New rsrc-audio-card: %s (%d)\n",
		priv->snd_card.name ? priv->snd_card.name : "",
		priv->convert_rate);

	/* FE/BE */
	for (i = 0; i < num; i++) {
		ret = rsrc_card_dai_link_of(node, priv, i);
		if (ret < 0)
			return ret;
	}

	if (!priv->snd_card.name)
		priv->snd_card.name = priv->snd_card.dai_link->name;

	return 0;
}

/* Decrease the reference count of the device nodes */
static int rsrc_card_unref(struct snd_soc_card *card)
{
	struct snd_soc_dai_link *dai_link;
	int num_links;

	for (num_links = 0, dai_link = card->dai_link;
	     num_links < card->num_links;
	     num_links++, dai_link++) {
		of_node_put(dai_link->cpu_of_node);
		of_node_put(dai_link->codec_of_node);
	}
	return 0;
}

static int rsrc_card_probe(struct platform_device *pdev)
{
	struct rsrc_card_priv *priv;
	struct device_node *np = pdev->dev.of_node;
	struct device *dev = &pdev->dev;
	int ret;

	/* Allocate the private data */
	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
	if (!priv)
		return -ENOMEM;

	ret = rsrc_card_parse_of(np, priv, dev);
	if (ret < 0) {
		if (ret != -EPROBE_DEFER)
			dev_err(dev, "parse error %d\n", ret);
		goto err;
	}

	snd_soc_card_set_drvdata(&priv->snd_card, priv);

	ret = devm_snd_soc_register_card(&pdev->dev, &priv->snd_card);
	if (ret >= 0)
		return ret;
err:
	rsrc_card_unref(&priv->snd_card);

	return ret;
}

static int rsrc_card_remove(struct platform_device *pdev)
{
	struct snd_soc_card *card = platform_get_drvdata(pdev);

	return rsrc_card_unref(card);
}

static struct platform_driver rsrc_card = {
	.driver = {
		.name = "renesas-src-audio-card",
		.of_match_table = rsrc_card_of_match,
	},
	.probe = rsrc_card_probe,
	.remove = rsrc_card_remove,
};

module_platform_driver(rsrc_card);

MODULE_ALIAS("platform:renesas-src-audio-card");
MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("Renesas Sampling Rate Convert Sound Card");
MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>");
Commit	Line	Data
415f1cb2 KM	1	/*
	2	* Renesas Sampling Rate Convert Sound Card for DPCM
	3	*
	4	* Copyright (C) 2015 Renesas Solutions Corp.
	5	* Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
	6	*
	7	* based on ${LINUX}/sound/soc/generic/simple-card.c
	8	*
	9	* This program is free software; you can redistribute it and/or modify
	10	* it under the terms of the GNU General Public License version 2 as
	11	* published by the Free Software Foundation.
	12	*/
	13	#include <linux/clk.h>
	14	#include <linux/device.h>
	15	#include <linux/module.h>
	16	#include <linux/of.h>
	17	#include <linux/of_device.h>
	18	#include <linux/platform_device.h>
	19	#include <linux/string.h>
	20	#include <sound/jack.h>
	21	#include <sound/soc.h>
	22	#include <sound/soc-dai.h>
	23
	24	struct rsrc_card_of_data {
	25	const char *prefix;
	26	const struct snd_soc_dapm_route *routes;
	27	int num_routes;
	28	};
	29
	30	static const struct snd_soc_dapm_route routes_ssi0_ak4642[] = {
	31	{"ak4642 Playback", NULL, "DAI0 Playback"},
	32	{"DAI0 Capture", NULL, "ak4642 Capture"},
	33	};
	34
	35	static const struct rsrc_card_of_data routes_of_ssi0_ak4642 = {
	36	.prefix = "ak4642",
	37	.routes = routes_ssi0_ak4642,
	38	.num_routes = ARRAY_SIZE(routes_ssi0_ak4642),
	39	};
	40
	41	static const struct of_device_id rsrc_card_of_match[] = {
	42	{ .compatible = "renesas,rsrc-card,lager", .data = &routes_of_ssi0_ak4642 },
	43	{ .compatible = "renesas,rsrc-card,koelsch", .data = &routes_of_ssi0_ak4642 },
	44	{},
	45	};
	46	MODULE_DEVICE_TABLE(of, rsrc_card_of_match);
	47
	48	struct rsrc_card_dai {
415f1cb2 KM	49	unsigned int fmt;
	50	unsigned int sysclk;
	51	struct clk *clk;
	52	};
	53
415f1cb2 KM	54	#define IDX_CPU 0
415f1cb2 KM	55	#define IDX_CODEC 1
d72f4a88	56	#define DAI_NAME_NUM 32
415f1cb2 KM	57	struct rsrc_card_priv {
	58	struct snd_soc_card snd_card;
	59	struct rsrc_card_dai_props {
	60	struct rsrc_card_dai cpu_dai;
	61	struct rsrc_card_dai codec_dai;
d72f4a88	62	char dai_name[DAI_NAME_NUM];
3433bf07	63	} *dai_props;
415f1cb2	64	struct snd_soc_codec_conf codec_conf;
3433bf07 KM	65	struct snd_soc_dai_link *dai_link;
3433bf07 KM	66	int dai_num;
af7e2be9	67	u32 convert_rate;
415f1cb2 KM	68	};
	69
	70	#define rsrc_priv_to_dev(priv) ((priv)->snd_card.dev)
8bd616c4 KM	71	#define rsrc_priv_to_link(priv, i) ((priv)->snd_card.dai_link + (i))
8bd616c4 KM	72	#define rsrc_priv_to_props(priv, i) ((priv)->dai_props + (i))
415f1cb2 KM	73	#define rsrc_dev_to_of_data(dev) (of_match_device(rsrc_card_of_match, (dev))->data)
	74
	75	static int rsrc_card_startup(struct snd_pcm_substream *substream)
	76	{
	77	struct snd_soc_pcm_runtime *rtd = substream->private_data;
	78	struct rsrc_card_priv *priv = snd_soc_card_get_drvdata(rtd->card);
	79	struct rsrc_card_dai_props *dai_props =
8bd616c4	80	rsrc_priv_to_props(priv, rtd - rtd->card->rtd);
415f1cb2 KM	81	int ret;
	82
	83	ret = clk_prepare_enable(dai_props->cpu_dai.clk);
	84	if (ret)
	85	return ret;
	86
	87	ret = clk_prepare_enable(dai_props->codec_dai.clk);
	88	if (ret)
	89	clk_disable_unprepare(dai_props->cpu_dai.clk);
	90
	91	return ret;
	92	}
	93
	94	static void rsrc_card_shutdown(struct snd_pcm_substream *substream)
	95	{
	96	struct snd_soc_pcm_runtime *rtd = substream->private_data;
	97	struct rsrc_card_priv *priv = snd_soc_card_get_drvdata(rtd->card);
	98	struct rsrc_card_dai_props *dai_props =
8bd616c4	99	rsrc_priv_to_props(priv, rtd - rtd->card->rtd);
415f1cb2 KM	100
	101	clk_disable_unprepare(dai_props->cpu_dai.clk);
	102
	103	clk_disable_unprepare(dai_props->codec_dai.clk);
	104	}
	105
	106	static struct snd_soc_ops rsrc_card_ops = {
	107	.startup = rsrc_card_startup,
	108	.shutdown = rsrc_card_shutdown,
	109	};
	110
	111	static int __rsrc_card_dai_init(struct snd_soc_dai *dai,
	112	struct rsrc_card_dai *set)
	113	{
	114	int ret;
	115
	116	if (set->fmt) {
	117	ret = snd_soc_dai_set_fmt(dai, set->fmt);
	118	if (ret && ret != -ENOTSUPP) {
	119	dev_err(dai->dev, "set_fmt error\n");
	120	goto err;
	121	}
	122	}
	123
	124	if (set->sysclk) {
	125	ret = snd_soc_dai_set_sysclk(dai, 0, set->sysclk, 0);
	126	if (ret && ret != -ENOTSUPP) {
	127	dev_err(dai->dev, "set_sysclk error\n");
	128	goto err;
	129	}
	130	}
	131
	132	ret = 0;
	133
	134	err:
	135	return ret;
	136	}
	137
	138	static int rsrc_card_dai_init(struct snd_soc_pcm_runtime *rtd)
	139	{
	140	struct rsrc_card_priv *priv = snd_soc_card_get_drvdata(rtd->card);
	141	struct snd_soc_dai *codec = rtd->codec_dai;
	142	struct snd_soc_dai *cpu = rtd->cpu_dai;
	143	struct rsrc_card_dai_props *dai_props;
	144	int num, ret;
	145
	146	num = rtd - rtd->card->rtd;
	147	dai_props = &priv->dai_props[num];
	148	ret = __rsrc_card_dai_init(codec, &dai_props->codec_dai);
	149	if (ret < 0)
	150	return ret;
	151
	152	ret = __rsrc_card_dai_init(cpu, &dai_props->cpu_dai);
	153	if (ret < 0)
	154	return ret;
	155
	156	return 0;
	157	}
	158
af7e2be9 KM	159	static int rsrc_card_be_hw_params_fixup(struct snd_soc_pcm_runtime *rtd,
	160	struct snd_pcm_hw_params *params)
	161	{
	162	struct rsrc_card_priv *priv = snd_soc_card_get_drvdata(rtd->card);
	163	struct snd_interval *rate = hw_param_interval(params,
	164	SNDRV_PCM_HW_PARAM_RATE);
	165
	166	if (!priv->convert_rate)
	167	return 0;
	168
	169	rate->min = rate->max = priv->convert_rate;
	170
	171	return 0;
	172	}
	173
fe3bd184 KM	174	static int rsrc_card_parse_daifmt(struct device_node *node,
	175	struct rsrc_card_priv *priv,
	176	struct device_node *codec,
	177	int idx)
	178	{
	179	struct device_node *bitclkmaster = NULL;
	180	struct device_node *framemaster = NULL;
	181	struct rsrc_card_dai_props *dai_props = rsrc_priv_to_props(priv, idx);
	182	struct rsrc_card_dai *cpu_dai = &dai_props->cpu_dai;
	183	struct rsrc_card_dai *codec_dai = &dai_props->codec_dai;
	184	unsigned int daifmt;
	185
	186	daifmt = snd_soc_of_parse_daifmt(node, NULL,
	187	&bitclkmaster, &framemaster);
	188	daifmt &= ~SND_SOC_DAIFMT_MASTER_MASK;
	189
	190	if (!bitclkmaster && !framemaster)
	191	return -EINVAL;
	192
	193	if (codec == bitclkmaster)
	194	daifmt \|= (codec == framemaster) ?
	195	SND_SOC_DAIFMT_CBM_CFM : SND_SOC_DAIFMT_CBM_CFS;
	196	else
	197	daifmt \|= (codec == framemaster) ?
	198	SND_SOC_DAIFMT_CBS_CFM : SND_SOC_DAIFMT_CBS_CFS;
	199
	200	cpu_dai->fmt = daifmt;
	201	codec_dai->fmt = daifmt;
	202
	203	of_node_put(bitclkmaster);
	204	of_node_put(framemaster);
	205
	206	return 0;
	207	}
	208
415f1cb2 KM	209	static int
	210	rsrc_card_sub_parse_of(struct rsrc_card_priv *priv,
	211	struct device_node *np,
	212	struct rsrc_card_dai *dai,
	213	struct snd_soc_dai_link *dai_link,
	214	int *args_count)
	215	{
	216	struct device *dev = rsrc_priv_to_dev(priv);
	217	const struct rsrc_card_of_data *of_data = rsrc_dev_to_of_data(dev);
	218	struct of_phandle_args args;
	219	struct device_node **p_node;
	220	struct clk *clk;
	221	const char **dai_name;
	222	const char **name;
	223	u32 val;
	224	int ret;
	225
	226	if (args_count) {
	227	p_node = &dai_link->cpu_of_node;
	228	dai_name = &dai_link->cpu_dai_name;
	229	name = &dai_link->cpu_name;
	230	} else {
	231	p_node = &dai_link->codec_of_node;
	232	dai_name = &dai_link->codec_dai_name;
	233	name = &dai_link->codec_name;
	234	}
	235
	236	if (!np) {
	237	/* use snd-soc-dummy */
	238	*p_node = NULL;
	239	*dai_name = "snd-soc-dummy-dai";
	240	*name = "snd-soc-dummy";
	241	return 0;
	242	}
	243
	244	/*
	245	* Get node via "sound-dai = <&phandle port>"
	246	* it will be used as xxx_of_node on soc_bind_dai_link()
	247	*/
	248	ret = of_parse_phandle_with_args(np, "sound-dai",
	249	"#sound-dai-cells", 0, &args);
	250	if (ret)
	251	return ret;
	252
	253	*p_node = args.np;
	254
	255	/* Get dai->name */
	256	ret = snd_soc_of_get_dai_name(np, dai_name);
	257	if (ret < 0)
	258	return ret;
	259
	260	/*
	261	* FIXME
	262	*
	263	* rsrc assumes DPCM playback/capture
	264	*/
	265	dai_link->dpcm_playback = 1;
	266	dai_link->dpcm_capture = 1;
	267
	268	if (args_count) {
	269	*args_count = args.args_count;
	270	dai_link->dynamic = 1;
b723550d	271	dai_link->dpcm_merged_format = 1;
415f1cb2 KM	272	} else {
	273	dai_link->no_pcm = 1;
	274	priv->codec_conf.of_node = (*p_node);
	275	priv->codec_conf.name_prefix = of_data->prefix;
	276	}
	277
	278	/*
	279	* Parse dai->sysclk come from "clocks = <&xxx>"
	280	* (if system has common clock)
	281	* or "system-clock-frequency = <xxx>"
	282	* or device's module clock.
	283	*/
	284	if (of_property_read_bool(np, "clocks")) {
	285	clk = of_clk_get(np, 0);
	286	if (IS_ERR(clk)) {
	287	ret = PTR_ERR(clk);
	288	return ret;
	289	}
	290
	291	dai->sysclk = clk_get_rate(clk);
	292	dai->clk = clk;
	293	} else if (!of_property_read_u32(np, "system-clock-frequency", &val)) {
	294	dai->sysclk = val;
	295	} else {
	296	clk = of_clk_get(args.np, 0);
	297	if (!IS_ERR(clk))
	298	dai->sysclk = clk_get_rate(clk);
	299	}
	300
	301	return 0;
	302	}
	303
415f1cb2 KM	304	static int rsrc_card_dai_link_of(struct device_node *node,
	305	struct rsrc_card_priv *priv,
	306	int idx)
	307	{
	308	struct device *dev = rsrc_priv_to_dev(priv);
	309	struct snd_soc_dai_link *dai_link = rsrc_priv_to_link(priv, idx);
	310	struct rsrc_card_dai_props *dai_props = rsrc_priv_to_props(priv, idx);
	311	struct device_node *cpu = NULL;
	312	struct device_node *codec = NULL;
d72f4a88	313	char *name = dai_props->dai_name;
415f1cb2 KM	314	char prop[128];
	315	int ret, cpu_args;
	316
	317	cpu = of_get_child_by_name(node, "cpu");
	318	codec = of_get_child_by_name(node, "codec");
	319
	320	if (!cpu \|\| !codec) {
	321	ret = -EINVAL;
	322	dev_err(dev, "%s: Can't find %s DT node\n", __func__, prop);
	323	goto dai_link_of_err;
	324	}
	325
	326	ret = rsrc_card_parse_daifmt(node, priv, codec, idx);
	327	if (ret < 0)
	328	goto dai_link_of_err;
	329
	330	ret = rsrc_card_sub_parse_of(priv, (idx == IDX_CPU) ? cpu : NULL,
	331	&dai_props->cpu_dai,
	332	dai_link,
	333	&cpu_args);
	334	if (ret < 0)
	335	goto dai_link_of_err;
	336
	337	ret = rsrc_card_sub_parse_of(priv, (idx == IDX_CODEC) ? codec : NULL,
	338	&dai_props->codec_dai,
	339	dai_link,
	340	NULL);
	341	if (ret < 0)
	342	goto dai_link_of_err;
	343
	344	if (!dai_link->cpu_dai_name \|\| !dai_link->codec_dai_name) {
	345	ret = -EINVAL;
	346	goto dai_link_of_err;
	347	}
	348
	349	/* Simple Card assumes platform == cpu */
	350	dai_link->platform_of_node = dai_link->cpu_of_node;
	351
d72f4a88 KM	352	snprintf(name, DAI_NAME_NUM, "%s.%s",
	353	dai_link->dynamic ? "fe" : "be",
	354	dai_link->dynamic ? dai_link->cpu_dai_name :
	355	dai_link->codec_dai_name);
415f1cb2 KM	356	dai_link->name = dai_link->stream_name = name;
	357	dai_link->ops = &rsrc_card_ops;
	358	dai_link->init = rsrc_card_dai_init;
	359
af7e2be9 KM	360	if (idx == IDX_CODEC)
	361	dai_link->be_hw_params_fixup = rsrc_card_be_hw_params_fixup;
	362
415f1cb2 KM	363	dev_dbg(dev, "\tname : %s\n", dai_link->stream_name);
	364	dev_dbg(dev, "\tcpu : %s / %04x / %d\n",
	365	dai_link->cpu_dai_name,
	366	dai_props->cpu_dai.fmt,
	367	dai_props->cpu_dai.sysclk);
	368	dev_dbg(dev, "\tcodec : %s / %04x / %d\n",
	369	dai_link->codec_dai_name,
	370	dai_props->codec_dai.fmt,
	371	dai_props->codec_dai.sysclk);
	372
	373	/*
	374	* In soc_bind_dai_link() will check cpu name after
	375	* of_node matching if dai_link has cpu_dai_name.
	376	* but, it will never match if name was created by
	377	* fmt_single_name() remove cpu_dai_name if cpu_args
	378	* was 0. See:
	379	* fmt_single_name()
	380	* fmt_multiple_name()
	381	*/
	382	if (!cpu_args)
	383	dai_link->cpu_dai_name = NULL;
	384
	385	dai_link_of_err:
	386	of_node_put(cpu);
	387	of_node_put(codec);
	388
	389	return ret;
	390	}
	391
	392	static int rsrc_card_parse_of(struct device_node *node,
3c7e64dd KM	393	struct rsrc_card_priv *priv,
3c7e64dd KM	394	struct device *dev)
415f1cb2	395	{
415f1cb2	396	const struct rsrc_card_of_data *of_data = rsrc_dev_to_of_data(dev);
3433bf07 KM	397	struct rsrc_card_dai_props *props;
	398	struct snd_soc_dai_link *links;
	399
415f1cb2	400	int ret;
3433bf07	401	int i, num;
415f1cb2 KM	402
	403	if (!node)
	404	return -EINVAL;
	405
3433bf07 KM	406	num = of_get_child_count(node);
	407	props = devm_kzalloc(dev, sizeof(props) num, GFP_KERNEL);
	408	links = devm_kzalloc(dev, sizeof(links) num, GFP_KERNEL);
	409	if (!props \|\| !links)
	410	return -ENOMEM;
	411
	412	priv->dai_props = props;
	413	priv->dai_link = links;
	414	priv->dai_num = num;
	415
415f1cb2 KM	416	/* Parse the card name from DT */
	417	snd_soc_of_parse_card_name(&priv->snd_card, "card-name");
	418
3c7e64dd KM	419	/* Init snd_soc_card */
	420	priv->snd_card.owner = THIS_MODULE;
	421	priv->snd_card.dev = dev;
	422	priv->snd_card.dai_link = priv->dai_link;
3433bf07	423	priv->snd_card.num_links = num;
3c7e64dd KM	424	priv->snd_card.codec_conf = &priv->codec_conf;
3c7e64dd KM	425	priv->snd_card.num_configs = 1;
415f1cb2 KM	426	priv->snd_card.of_dapm_routes = of_data->routes;
	427	priv->snd_card.num_of_dapm_routes = of_data->num_routes;
	428
af7e2be9 KM	429	/* sampling rate convert */
	430	of_property_read_u32(node, "convert-rate", &priv->convert_rate);
	431
	432	dev_dbg(dev, "New rsrc-audio-card: %s (%d)\n",
	433	priv->snd_card.name ? priv->snd_card.name : "",
	434	priv->convert_rate);
415f1cb2 KM	435
415f1cb2 KM	436	/* FE/BE */
3433bf07	437	for (i = 0; i < num; i++) {
415f1cb2 KM	438	ret = rsrc_card_dai_link_of(node, priv, i);
	439	if (ret < 0)
	440	return ret;
	441	}
	442
	443	if (!priv->snd_card.name)
	444	priv->snd_card.name = priv->snd_card.dai_link->name;
	445
	446	return 0;
	447	}
	448
	449	/* Decrease the reference count of the device nodes */
	450	static int rsrc_card_unref(struct snd_soc_card *card)
	451	{
	452	struct snd_soc_dai_link *dai_link;
	453	int num_links;
	454
	455	for (num_links = 0, dai_link = card->dai_link;
	456	num_links < card->num_links;
	457	num_links++, dai_link++) {
	458	of_node_put(dai_link->cpu_of_node);
	459	of_node_put(dai_link->codec_of_node);
	460	}
	461	return 0;
	462	}
	463
	464	static int rsrc_card_probe(struct platform_device *pdev)
	465	{
	466	struct rsrc_card_priv *priv;
415f1cb2 KM	467	struct device_node *np = pdev->dev.of_node;
	468	struct device *dev = &pdev->dev;
	469	int ret;
	470
	471	/* Allocate the private data */
	472	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
	473	if (!priv)
	474	return -ENOMEM;
	475
3c7e64dd	476	ret = rsrc_card_parse_of(np, priv, dev);
415f1cb2 KM	477	if (ret < 0) {
	478	if (ret != -EPROBE_DEFER)
	479	dev_err(dev, "parse error %d\n", ret);
	480	goto err;
	481	}
	482
	483	snd_soc_card_set_drvdata(&priv->snd_card, priv);
	484
	485	ret = devm_snd_soc_register_card(&pdev->dev, &priv->snd_card);
	486	if (ret >= 0)
	487	return ret;
	488	err:
	489	rsrc_card_unref(&priv->snd_card);
	490
	491	return ret;
	492	}
	493
	494	static int rsrc_card_remove(struct platform_device *pdev)
	495	{
	496	struct snd_soc_card *card = platform_get_drvdata(pdev);
	497
	498	return rsrc_card_unref(card);
	499	}
	500
	501	static struct platform_driver rsrc_card = {
	502	.driver = {
	503	.name = "renesas-src-audio-card",
	504	.of_match_table = rsrc_card_of_match,
	505	},
	506	.probe = rsrc_card_probe,
	507	.remove = rsrc_card_remove,
	508	};
	509
	510	module_platform_driver(rsrc_card);
	511
	512	MODULE_ALIAS("platform:renesas-src-audio-card");
	513	MODULE_LICENSE("GPL");
	514	MODULE_DESCRIPTION("Renesas Sampling Rate Convert Sound Card");
	515	MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>");