[mirror_ubuntu-jammy-kernel.git] / sound / soc / sh / migor.c

// SPDX-License-Identifier: GPL-2.0
//
// ALSA SoC driver for Migo-R
//
// Copyright (C) 2009-2010 Guennadi Liakhovetski <g.liakhovetski@gmx.de>

#include <linux/clkdev.h>
#include <linux/device.h>
#include <linux/firmware.h>
#include <linux/module.h>

#include <asm/clock.h>

#include <cpu/sh7722.h>

#include <sound/core.h>
#include <sound/pcm.h>
#include <sound/soc.h>

#include "../codecs/wm8978.h"
#include "siu.h"

/* Default 8000Hz sampling frequency */
static unsigned long codec_freq = 8000 * 512;

static unsigned int use_count;

/* External clock, sourced from the codec at the SIUMCKB pin */
static unsigned long siumckb_recalc(struct clk *clk)
{
	return codec_freq;
}

static struct sh_clk_ops siumckb_clk_ops = {
	.recalc = siumckb_recalc,
};

static struct clk siumckb_clk = {
	.ops		= &siumckb_clk_ops,
	.rate		= 0, /* initialised at run-time */
};

static struct clk_lookup *siumckb_lookup;

static int migor_hw_params(struct snd_pcm_substream *substream,
			   struct snd_pcm_hw_params *params)
{
	struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
	struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0);
	int ret;
	unsigned int rate = params_rate(params);

	ret = snd_soc_dai_set_sysclk(codec_dai, WM8978_PLL, 13000000,
				     SND_SOC_CLOCK_IN);
	if (ret < 0)
		return ret;

	ret = snd_soc_dai_set_clkdiv(codec_dai, WM8978_OPCLKRATE, rate * 512);
	if (ret < 0)
		return ret;

	codec_freq = rate * 512;
	/*
	 * This propagates the parent frequency change to children and
	 * recalculates the frequency table
	 */
	clk_set_rate(&siumckb_clk, codec_freq);
	dev_dbg(codec_dai->dev, "%s: configure %luHz\n", __func__, codec_freq);

	ret = snd_soc_dai_set_sysclk(asoc_rtd_to_cpu(rtd, 0), SIU_CLKB_EXT,
				     codec_freq / 2, SND_SOC_CLOCK_IN);

	if (!ret)
		use_count++;

	return ret;
}

static int migor_hw_free(struct snd_pcm_substream *substream)
{
	struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
	struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0);

	if (use_count) {
		use_count--;

		if (!use_count)
			snd_soc_dai_set_sysclk(codec_dai, WM8978_PLL, 0,
					       SND_SOC_CLOCK_IN);
	} else {
		dev_dbg(codec_dai->dev, "Unbalanced hw_free!\n");
	}

	return 0;
}

static const struct snd_soc_ops migor_dai_ops = {
	.hw_params = migor_hw_params,
	.hw_free = migor_hw_free,
};

static const struct snd_soc_dapm_widget migor_dapm_widgets[] = {
	SND_SOC_DAPM_HP("Headphone", NULL),
	SND_SOC_DAPM_MIC("Onboard Microphone", NULL),
	SND_SOC_DAPM_MIC("External Microphone", NULL),
};

static const struct snd_soc_dapm_route audio_map[] = {
	/* Headphone output connected to LHP/RHP, enable OUT4 for VMID */
	{ "Headphone", NULL,  "OUT4 VMID" },
	{ "OUT4 VMID", NULL,  "LHP" },
	{ "OUT4 VMID", NULL,  "RHP" },

	/* On-board microphone */
	{ "RMICN", NULL, "Mic Bias" },
	{ "RMICP", NULL, "Mic Bias" },
	{ "Mic Bias", NULL, "Onboard Microphone" },

	/* External microphone */
	{ "LMICN", NULL, "Mic Bias" },
	{ "LMICP", NULL, "Mic Bias" },
	{ "Mic Bias", NULL, "External Microphone" },
};

/* migor digital audio interface glue - connects codec <--> CPU */
SND_SOC_DAILINK_DEFS(wm8978,
	DAILINK_COMP_ARRAY(COMP_CPU("siu-pcm-audio")),
	DAILINK_COMP_ARRAY(COMP_CODEC("wm8978.0-001a", "wm8978-hifi")),
	DAILINK_COMP_ARRAY(COMP_PLATFORM("siu-pcm-audio")));

static struct snd_soc_dai_link migor_dai = {
	.name = "wm8978",
	.stream_name = "WM8978",
	.dai_fmt = SND_SOC_DAIFMT_NB_IF | SND_SOC_DAIFMT_I2S |
		   SND_SOC_DAIFMT_CBS_CFS,
	.ops = &migor_dai_ops,
	SND_SOC_DAILINK_REG(wm8978),
};

/* migor audio machine driver */
static struct snd_soc_card snd_soc_migor = {
	.name = "Migo-R",
	.owner = THIS_MODULE,
	.dai_link = &migor_dai,
	.num_links = 1,

	.dapm_widgets = migor_dapm_widgets,
	.num_dapm_widgets = ARRAY_SIZE(migor_dapm_widgets),
	.dapm_routes = audio_map,
	.num_dapm_routes = ARRAY_SIZE(audio_map),
};

static struct platform_device *migor_snd_device;

static int __init migor_init(void)
{
	int ret;

	ret = clk_register(&siumckb_clk);
	if (ret < 0)
		return ret;

	siumckb_lookup = clkdev_create(&siumckb_clk, "siumckb_clk", NULL);
	if (!siumckb_lookup) {
		ret = -ENOMEM;
		goto eclkdevalloc;
	}

	/* Port number used on this machine: port B */
	migor_snd_device = platform_device_alloc("soc-audio", 1);
	if (!migor_snd_device) {
		ret = -ENOMEM;
		goto epdevalloc;
	}

	platform_set_drvdata(migor_snd_device, &snd_soc_migor);

	ret = platform_device_add(migor_snd_device);
	if (ret)
		goto epdevadd;

	return 0;

epdevadd:
	platform_device_put(migor_snd_device);
epdevalloc:
	clkdev_drop(siumckb_lookup);
eclkdevalloc:
	clk_unregister(&siumckb_clk);
	return ret;
}

static void __exit migor_exit(void)
{
	clkdev_drop(siumckb_lookup);
	clk_unregister(&siumckb_clk);
	platform_device_unregister(migor_snd_device);
}

module_init(migor_init);
module_exit(migor_exit);

MODULE_AUTHOR("Guennadi Liakhovetski <g.liakhovetski@gmx.de>");
MODULE_DESCRIPTION("ALSA SoC Migor");
MODULE_LICENSE("GPL v2");
Commit	Line	Data
0026c551 KM	1	// SPDX-License-Identifier: GPL-2.0
	2	//
	3	// ALSA SoC driver for Migo-R
	4	//
	5	// Copyright (C) 2009-2010 Guennadi Liakhovetski <g.liakhovetski@gmx.de>
9f5b64b7	6
f4fd58d6	7	#include <linux/clkdev.h>
9f5b64b7 GL	8	#include <linux/device.h>
	9	#include <linux/firmware.h>
	10	#include <linux/module.h>
	11
	12	#include <asm/clock.h>
	13
	14	#include <cpu/sh7722.h>
	15
	16	#include <sound/core.h>
	17	#include <sound/pcm.h>
	18	#include <sound/soc.h>
9f5b64b7 GL	19
	20	#include "../codecs/wm8978.h"
	21	#include "siu.h"
	22
	23	/* Default 8000Hz sampling frequency */
	24	static unsigned long codec_freq = 8000 * 512;
	25
	26	static unsigned int use_count;
	27
	28	/* External clock, sourced from the codec at the SIUMCKB pin */
	29	static unsigned long siumckb_recalc(struct clk *clk)
	30	{
	31	return codec_freq;
	32	}
	33
c8587193	34	static struct sh_clk_ops siumckb_clk_ops = {
9f5b64b7 GL	35	.recalc = siumckb_recalc,
	36	};
	37
	38	static struct clk siumckb_clk = {
9f5b64b7 GL	39	.ops = &siumckb_clk_ops,
	40	.rate = 0, /* initialised at run-time */
	41	};
	42
cbfa5184 GL	43	static struct clk_lookup *siumckb_lookup;
cbfa5184 GL	44
9f5b64b7 GL	45	static int migor_hw_params(struct snd_pcm_substream *substream,
	46	struct snd_pcm_hw_params *params)
	47	{
28ec78b0	48	struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
34a43780	49	struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0);
9f5b64b7 GL	50	int ret;
	51	unsigned int rate = params_rate(params);
	52
	53	ret = snd_soc_dai_set_sysclk(codec_dai, WM8978_PLL, 13000000,
	54	SND_SOC_CLOCK_IN);
	55	if (ret < 0)
	56	return ret;
	57
9f5b64b7 GL	58	ret = snd_soc_dai_set_clkdiv(codec_dai, WM8978_OPCLKRATE, rate * 512);
	59	if (ret < 0)
	60	return ret;
	61
9f5b64b7 GL	62	codec_freq = rate * 512;
	63	/*
	64	* This propagates the parent frequency change to children and
	65	* recalculates the frequency table
	66	*/
	67	clk_set_rate(&siumckb_clk, codec_freq);
	68	dev_dbg(codec_dai->dev, "%s: configure %luHz\n", __func__, codec_freq);
	69
34a43780	70	ret = snd_soc_dai_set_sysclk(asoc_rtd_to_cpu(rtd, 0), SIU_CLKB_EXT,
9f5b64b7 GL	71	codec_freq / 2, SND_SOC_CLOCK_IN);
	72
	73	if (!ret)
	74	use_count++;
	75
	76	return ret;
	77	}
	78
	79	static int migor_hw_free(struct snd_pcm_substream *substream)
	80	{
28ec78b0	81	struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
34a43780	82	struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0);
9f5b64b7 GL	83
	84	if (use_count) {
	85	use_count--;
	86
	87	if (!use_count)
	88	snd_soc_dai_set_sysclk(codec_dai, WM8978_PLL, 0,
	89	SND_SOC_CLOCK_IN);
	90	} else {
	91	dev_dbg(codec_dai->dev, "Unbalanced hw_free!\n");
	92	}
	93
	94	return 0;
	95	}
	96
a46d0592	97	static const struct snd_soc_ops migor_dai_ops = {
9f5b64b7 GL	98	.hw_params = migor_hw_params,
	99	.hw_free = migor_hw_free,
	100	};
	101
	102	static const struct snd_soc_dapm_widget migor_dapm_widgets[] = {
	103	SND_SOC_DAPM_HP("Headphone", NULL),
	104	SND_SOC_DAPM_MIC("Onboard Microphone", NULL),
	105	SND_SOC_DAPM_MIC("External Microphone", NULL),
	106	};
	107
	108	static const struct snd_soc_dapm_route audio_map[] = {
	109	/* Headphone output connected to LHP/RHP, enable OUT4 for VMID */
	110	{ "Headphone", NULL, "OUT4 VMID" },
	111	{ "OUT4 VMID", NULL, "LHP" },
	112	{ "OUT4 VMID", NULL, "RHP" },
	113
	114	/* On-board microphone */
	115	{ "RMICN", NULL, "Mic Bias" },
	116	{ "RMICP", NULL, "Mic Bias" },
	117	{ "Mic Bias", NULL, "Onboard Microphone" },
	118
	119	/* External microphone */
	120	{ "LMICN", NULL, "Mic Bias" },
	121	{ "LMICP", NULL, "Mic Bias" },
	122	{ "Mic Bias", NULL, "External Microphone" },
	123	};
	124
9f5b64b7	125	/* migor digital audio interface glue - connects codec <--> CPU */
4f209c51 KM	126	SND_SOC_DAILINK_DEFS(wm8978,
	127	DAILINK_COMP_ARRAY(COMP_CPU("siu-pcm-audio")),
	128	DAILINK_COMP_ARRAY(COMP_CODEC("wm8978.0-001a", "wm8978-hifi")),
	129	DAILINK_COMP_ARRAY(COMP_PLATFORM("siu-pcm-audio")));
	130
9f5b64b7 GL	131	static struct snd_soc_dai_link migor_dai = {
	132	.name = "wm8978",
	133	.stream_name = "WM8978",
9cb2a25c LPC	134	.dai_fmt = SND_SOC_DAIFMT_NB_IF \| SND_SOC_DAIFMT_I2S \|
9cb2a25c LPC	135	SND_SOC_DAIFMT_CBS_CFS,
9f5b64b7	136	.ops = &migor_dai_ops,
4f209c51	137	SND_SOC_DAILINK_REG(wm8978),
9f5b64b7 GL	138	};
	139
	140	/* migor audio machine driver */
	141	static struct snd_soc_card snd_soc_migor = {
	142	.name = "Migo-R",
4a7042e5	143	.owner = THIS_MODULE,
9f5b64b7 GL	144	.dai_link = &migor_dai,
9f5b64b7 GL	145	.num_links = 1,
23a735cc LPC	146
	147	.dapm_widgets = migor_dapm_widgets,
	148	.num_dapm_widgets = ARRAY_SIZE(migor_dapm_widgets),
	149	.dapm_routes = audio_map,
	150	.num_dapm_routes = ARRAY_SIZE(audio_map),
9f5b64b7 GL	151	};
9f5b64b7 GL	152
9f5b64b7 GL	153	static struct platform_device *migor_snd_device;
	154
	155	static int __init migor_init(void)
	156	{
	157	int ret;
	158
	159	ret = clk_register(&siumckb_clk);
	160	if (ret < 0)
	161	return ret;
	162
d76a4476	163	siumckb_lookup = clkdev_create(&siumckb_clk, "siumckb_clk", NULL);
cbfa5184 GL	164	if (!siumckb_lookup) {
	165	ret = -ENOMEM;
	166	goto eclkdevalloc;
	167	}
cbfa5184	168
9f5b64b7 GL	169	/* Port number used on this machine: port B */
	170	migor_snd_device = platform_device_alloc("soc-audio", 1);
	171	if (!migor_snd_device) {
	172	ret = -ENOMEM;
	173	goto epdevalloc;
	174	}
	175
f0fba2ad	176	platform_set_drvdata(migor_snd_device, &snd_soc_migor);
9f5b64b7 GL	177
	178	ret = platform_device_add(migor_snd_device);
	179	if (ret)
	180	goto epdevadd;
	181
	182	return 0;
	183
	184	epdevadd:
	185	platform_device_put(migor_snd_device);
	186	epdevalloc:
cbfa5184 GL	187	clkdev_drop(siumckb_lookup);
cbfa5184 GL	188	eclkdevalloc:
9f5b64b7 GL	189	clk_unregister(&siumckb_clk);
	190	return ret;
	191	}
	192
	193	static void __exit migor_exit(void)
	194	{
cbfa5184	195	clkdev_drop(siumckb_lookup);
9f5b64b7 GL	196	clk_unregister(&siumckb_clk);
	197	platform_device_unregister(migor_snd_device);
	198	}
	199
	200	module_init(migor_init);
	201	module_exit(migor_exit);
	202
	203	MODULE_AUTHOR("Guennadi Liakhovetski <g.liakhovetski@gmx.de>");
	204	MODULE_DESCRIPTION("ALSA SoC Migor");
	205	MODULE_LICENSE("GPL v2");