[linux-2.6-block.git] / sound / soc / intel / boards / sof_pcm512x.c

// SPDX-License-Identifier: GPL-2.0-only
// Copyright(c) 2018-2020 Intel Corporation.

/*
 * Intel SOF Machine Driver for Intel platforms with TI PCM512x codec,
 * e.g. Up or Up2 with Hifiberry DAC+ HAT
 */
#include <linux/clk.h>
#include <linux/dmi.h>
#include <linux/i2c.h>
#include <linux/input.h>
#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/types.h>
#include <sound/core.h>
#include <sound/jack.h>
#include <sound/pcm.h>
#include <sound/pcm_params.h>
#include <sound/soc.h>
#include <sound/soc-acpi.h>
#include "../../codecs/pcm512x.h"
#include "../common/soc-intel-quirks.h"
#include "hda_dsp_common.h"

#define NAME_SIZE 32

#define SOF_PCM512X_SSP_CODEC(quirk)		((quirk) & GENMASK(3, 0))
#define SOF_PCM512X_SSP_CODEC_MASK			(GENMASK(3, 0))

#define IDISP_CODEC_MASK	0x4

/* Default: SSP5 */
static unsigned long sof_pcm512x_quirk = SOF_PCM512X_SSP_CODEC(5);

static bool is_legacy_cpu;

struct sof_hdmi_pcm {
	struct list_head head;
	struct snd_soc_dai *codec_dai;
	int device;
};

struct sof_card_private {
	struct list_head hdmi_pcm_list;
	bool idisp_codec;
};

static int sof_pcm512x_quirk_cb(const struct dmi_system_id *id)
{
	sof_pcm512x_quirk = (unsigned long)id->driver_data;
	return 1;
}

static const struct dmi_system_id sof_pcm512x_quirk_table[] = {
	{
		.callback = sof_pcm512x_quirk_cb,
		.matches = {
			DMI_MATCH(DMI_SYS_VENDOR, "AAEON"),
			DMI_MATCH(DMI_PRODUCT_NAME, "UP-CHT01"),
		},
		.driver_data = (void *)(SOF_PCM512X_SSP_CODEC(2)),
	},
	{}
};

static int sof_hdmi_init(struct snd_soc_pcm_runtime *rtd)
{
	struct sof_card_private *ctx = snd_soc_card_get_drvdata(rtd->card);
	struct snd_soc_dai *dai = asoc_rtd_to_codec(rtd, 0);
	struct sof_hdmi_pcm *pcm;

	pcm = devm_kzalloc(rtd->card->dev, sizeof(*pcm), GFP_KERNEL);
	if (!pcm)
		return -ENOMEM;

	/* dai_link id is 1:1 mapped to the PCM device */
	pcm->device = rtd->dai_link->id;
	pcm->codec_dai = dai;

	list_add_tail(&pcm->head, &ctx->hdmi_pcm_list);

	return 0;
}

static int sof_pcm512x_codec_init(struct snd_soc_pcm_runtime *rtd)
{
	struct snd_soc_component *codec = asoc_rtd_to_codec(rtd, 0)->component;

	snd_soc_component_update_bits(codec, PCM512x_GPIO_EN, 0x08, 0x08);
	snd_soc_component_update_bits(codec, PCM512x_GPIO_OUTPUT_4, 0x0f, 0x02);
	snd_soc_component_update_bits(codec, PCM512x_GPIO_CONTROL_1,
				      0x08, 0x08);

	return 0;
}

static int aif1_startup(struct snd_pcm_substream *substream)
{
	struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
	struct snd_soc_component *codec = asoc_rtd_to_codec(rtd, 0)->component;

	snd_soc_component_update_bits(codec, PCM512x_GPIO_CONTROL_1,
				      0x08, 0x08);

	return 0;
}

static void aif1_shutdown(struct snd_pcm_substream *substream)
{
	struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
	struct snd_soc_component *codec = asoc_rtd_to_codec(rtd, 0)->component;

	snd_soc_component_update_bits(codec, PCM512x_GPIO_CONTROL_1,
				      0x08, 0x00);
}

static const struct snd_soc_ops sof_pcm512x_ops = {
	.startup = aif1_startup,
	.shutdown = aif1_shutdown,
};

static struct snd_soc_dai_link_component platform_component[] = {
	{
		/* name might be overridden during probe */
		.name = "0000:00:1f.3"
	}
};

static int sof_card_late_probe(struct snd_soc_card *card)
{
	struct sof_card_private *ctx = snd_soc_card_get_drvdata(card);
	struct sof_hdmi_pcm *pcm;

	/* HDMI is not supported by SOF on Baytrail/CherryTrail */
	if (is_legacy_cpu)
		return 0;

	if (list_empty(&ctx->hdmi_pcm_list))
		return -EINVAL;

	if (!ctx->idisp_codec)
		return 0;

	pcm = list_first_entry(&ctx->hdmi_pcm_list, struct sof_hdmi_pcm, head);

	return hda_dsp_hdmi_build_controls(card, pcm->codec_dai->component);
}

static const struct snd_kcontrol_new sof_controls[] = {
	SOC_DAPM_PIN_SWITCH("Ext Spk"),
};

static const struct snd_soc_dapm_widget sof_widgets[] = {
	SND_SOC_DAPM_SPK("Ext Spk", NULL),
};

static const struct snd_soc_dapm_widget dmic_widgets[] = {
	SND_SOC_DAPM_MIC("SoC DMIC", NULL),
};

static const struct snd_soc_dapm_route sof_map[] = {
	/* Speaker */
	{"Ext Spk", NULL, "OUTR"},
	{"Ext Spk", NULL, "OUTL"},
};

static const struct snd_soc_dapm_route dmic_map[] = {
	/* digital mics */
	{"DMic", NULL, "SoC DMIC"},
};

static int dmic_init(struct snd_soc_pcm_runtime *rtd)
{
	struct snd_soc_card *card = rtd->card;
	int ret;

	ret = snd_soc_dapm_new_controls(&card->dapm, dmic_widgets,
					ARRAY_SIZE(dmic_widgets));
	if (ret) {
		dev_err(card->dev, "DMic widget addition failed: %d\n", ret);
		/* Don't need to add routes if widget addition failed */
		return ret;
	}

	ret = snd_soc_dapm_add_routes(&card->dapm, dmic_map,
				      ARRAY_SIZE(dmic_map));

	if (ret)
		dev_err(card->dev, "DMic map addition failed: %d\n", ret);

	return ret;
}

/* sof audio machine driver for pcm512x codec */
static struct snd_soc_card sof_audio_card_pcm512x = {
	.name = "pcm512x",
	.owner = THIS_MODULE,
	.controls = sof_controls,
	.num_controls = ARRAY_SIZE(sof_controls),
	.dapm_widgets = sof_widgets,
	.num_dapm_widgets = ARRAY_SIZE(sof_widgets),
	.dapm_routes = sof_map,
	.num_dapm_routes = ARRAY_SIZE(sof_map),
	.fully_routed = true,
	.late_probe = sof_card_late_probe,
};

SND_SOC_DAILINK_DEF(pcm512x_component,
	DAILINK_COMP_ARRAY(COMP_CODEC("i2c-104C5122:00", "pcm512x-hifi")));
SND_SOC_DAILINK_DEF(dmic_component,
	DAILINK_COMP_ARRAY(COMP_CODEC("dmic-codec", "dmic-hifi")));

static struct snd_soc_dai_link *sof_card_dai_links_create(struct device *dev,
							  int ssp_codec,
							  int dmic_be_num,
							  int hdmi_num,
							  bool idisp_codec)
{
	struct snd_soc_dai_link_component *idisp_components;
	struct snd_soc_dai_link_component *cpus;
	struct snd_soc_dai_link *links;
	int i, id = 0;

	links = devm_kcalloc(dev, sof_audio_card_pcm512x.num_links,
			sizeof(struct snd_soc_dai_link), GFP_KERNEL);
	cpus = devm_kcalloc(dev, sof_audio_card_pcm512x.num_links,
			sizeof(struct snd_soc_dai_link_component), GFP_KERNEL);
	if (!links || !cpus)
		goto devm_err;

	/* codec SSP */
	links[id].name = devm_kasprintf(dev, GFP_KERNEL,
					"SSP%d-Codec", ssp_codec);
	if (!links[id].name)
		goto devm_err;

	links[id].id = id;
	links[id].codecs = pcm512x_component;
	links[id].num_codecs = ARRAY_SIZE(pcm512x_component);
	links[id].platforms = platform_component;
	links[id].num_platforms = ARRAY_SIZE(platform_component);
	links[id].init = sof_pcm512x_codec_init;
	links[id].ops = &sof_pcm512x_ops;
	links[id].nonatomic = true;
	links[id].dpcm_playback = 1;
	/*
	 * capture only supported with specific versions of the Hifiberry DAC+
	 * links[id].dpcm_capture = 1;
	 */
	links[id].no_pcm = 1;
	links[id].cpus = &cpus[id];
	links[id].num_cpus = 1;
	if (is_legacy_cpu) {
		links[id].cpus->dai_name = devm_kasprintf(dev, GFP_KERNEL,
							  "ssp%d-port",
							  ssp_codec);
		if (!links[id].cpus->dai_name)
			goto devm_err;
	} else {
		links[id].cpus->dai_name = devm_kasprintf(dev, GFP_KERNEL,
							  "SSP%d Pin",
							  ssp_codec);
		if (!links[id].cpus->dai_name)
			goto devm_err;
	}
	id++;

	/* dmic */
	if (dmic_be_num > 0) {
		/* at least we have dmic01 */
		links[id].name = "dmic01";
		links[id].cpus = &cpus[id];
		links[id].cpus->dai_name = "DMIC01 Pin";
		links[id].init = dmic_init;
		if (dmic_be_num > 1) {
			/* set up 2 BE links at most */
			links[id + 1].name = "dmic16k";
			links[id + 1].cpus = &cpus[id + 1];
			links[id + 1].cpus->dai_name = "DMIC16k Pin";
			dmic_be_num = 2;
		}
	}

	for (i = 0; i < dmic_be_num; i++) {
		links[id].id = id;
		links[id].num_cpus = 1;
		links[id].codecs = dmic_component;
		links[id].num_codecs = ARRAY_SIZE(dmic_component);
		links[id].platforms = platform_component;
		links[id].num_platforms = ARRAY_SIZE(platform_component);
		links[id].ignore_suspend = 1;
		links[id].dpcm_capture = 1;
		links[id].no_pcm = 1;
		id++;
	}

	/* HDMI */
	if (hdmi_num > 0) {
		idisp_components = devm_kcalloc(dev, hdmi_num,
				sizeof(struct snd_soc_dai_link_component),
				GFP_KERNEL);
		if (!idisp_components)
			goto devm_err;
	}
	for (i = 1; i <= hdmi_num; i++) {
		links[id].name = devm_kasprintf(dev, GFP_KERNEL,
						"iDisp%d", i);
		if (!links[id].name)
			goto devm_err;

		links[id].id = id;
		links[id].cpus = &cpus[id];
		links[id].num_cpus = 1;
		links[id].cpus->dai_name = devm_kasprintf(dev, GFP_KERNEL,
							  "iDisp%d Pin", i);
		if (!links[id].cpus->dai_name)
			goto devm_err;

		/*
		 * topology cannot be loaded if codec is missing, so
		 * use the dummy codec if needed
		 */
		if (idisp_codec) {
			idisp_components[i - 1].name = "ehdaudio0D2";
			idisp_components[i - 1].dai_name =
				devm_kasprintf(dev, GFP_KERNEL,
					       "intel-hdmi-hifi%d", i);
		} else {
			idisp_components[i - 1].name = "snd-soc-dummy";
			idisp_components[i - 1].dai_name = "snd-soc-dummy-dai";
		}
		if (!idisp_components[i - 1].dai_name)
			goto devm_err;

		links[id].codecs = &idisp_components[i - 1];
		links[id].num_codecs = 1;
		links[id].platforms = platform_component;
		links[id].num_platforms = ARRAY_SIZE(platform_component);
		links[id].init = sof_hdmi_init;
		links[id].dpcm_playback = 1;
		links[id].no_pcm = 1;
		id++;
	}

	return links;
devm_err:
	return NULL;
}

static int sof_audio_probe(struct platform_device *pdev)
{
	struct snd_soc_acpi_mach *mach = pdev->dev.platform_data;
	struct snd_soc_dai_link *dai_links;
	struct sof_card_private *ctx;
	int dmic_be_num, hdmi_num;
	int ret, ssp_codec;

	ctx = devm_kzalloc(&pdev->dev, sizeof(*ctx), GFP_KERNEL);
	if (!ctx)
		return -ENOMEM;

	hdmi_num = 0;
	if (soc_intel_is_byt() || soc_intel_is_cht()) {
		is_legacy_cpu = true;
		dmic_be_num = 0;
		/* default quirk for legacy cpu */
		sof_pcm512x_quirk = SOF_PCM512X_SSP_CODEC(2);
	} else {
		dmic_be_num = 2;
		if (mach->mach_params.common_hdmi_codec_drv &&
		    (mach->mach_params.codec_mask & IDISP_CODEC_MASK))
			ctx->idisp_codec = true;

		/* links are always present in topology */
		hdmi_num = 3;
	}

	dmi_check_system(sof_pcm512x_quirk_table);

	dev_dbg(&pdev->dev, "sof_pcm512x_quirk = %lx\n", sof_pcm512x_quirk);

	ssp_codec = sof_pcm512x_quirk & SOF_PCM512X_SSP_CODEC_MASK;

	/* compute number of dai links */
	sof_audio_card_pcm512x.num_links = 1 + dmic_be_num + hdmi_num;

	dai_links = sof_card_dai_links_create(&pdev->dev, ssp_codec,
					      dmic_be_num, hdmi_num,
					      ctx->idisp_codec);
	if (!dai_links)
		return -ENOMEM;

	sof_audio_card_pcm512x.dai_link = dai_links;

	INIT_LIST_HEAD(&ctx->hdmi_pcm_list);

	sof_audio_card_pcm512x.dev = &pdev->dev;

	/* set platform name for each dailink */
	ret = snd_soc_fixup_dai_links_platform_name(&sof_audio_card_pcm512x,
						    mach->mach_params.platform);
	if (ret)
		return ret;

	snd_soc_card_set_drvdata(&sof_audio_card_pcm512x, ctx);

	return devm_snd_soc_register_card(&pdev->dev,
					  &sof_audio_card_pcm512x);
}

static int sof_pcm512x_remove(struct platform_device *pdev)
{
	struct snd_soc_card *card = platform_get_drvdata(pdev);
	struct snd_soc_component *component = NULL;

	for_each_card_components(card, component) {
		if (!strcmp(component->name, pcm512x_component[0].name)) {
			snd_soc_component_set_jack(component, NULL, NULL);
			break;
		}
	}

	return 0;
}

static struct platform_driver sof_audio = {
	.probe = sof_audio_probe,
	.remove = sof_pcm512x_remove,
	.driver = {
		.name = "sof_pcm512x",
		.pm = &snd_soc_pm_ops,
	},
};
module_platform_driver(sof_audio)

MODULE_DESCRIPTION("ASoC Intel(R) SOF + PCM512x Machine driver");
MODULE_AUTHOR("Pierre-Louis Bossart");
MODULE_LICENSE("GPL v2");
MODULE_ALIAS("platform:sof_pcm512x");
Commit	Line	Data
e149ca29	1	// SPDX-License-Identifier: GPL-2.0-only
f40ed2e8 PLB	2	// Copyright(c) 2018-2020 Intel Corporation.
	3
	4	/*
	5	* Intel SOF Machine Driver for Intel platforms with TI PCM512x codec,
	6	* e.g. Up or Up2 with Hifiberry DAC+ HAT
	7	*/
	8	#include <linux/clk.h>
	9	#include <linux/dmi.h>
	10	#include <linux/i2c.h>
	11	#include <linux/input.h>
	12	#include <linux/module.h>
	13	#include <linux/platform_device.h>
	14	#include <linux/types.h>
	15	#include <sound/core.h>
	16	#include <sound/jack.h>
	17	#include <sound/pcm.h>
	18	#include <sound/pcm_params.h>
	19	#include <sound/soc.h>
	20	#include <sound/soc-acpi.h>
	21	#include "../../codecs/pcm512x.h"
	22	#include "../common/soc-intel-quirks.h"
	23	#include "hda_dsp_common.h"
	24
	25	#define NAME_SIZE 32
	26
	27	#define SOF_PCM512X_SSP_CODEC(quirk) ((quirk) & GENMASK(3, 0))
	28	#define SOF_PCM512X_SSP_CODEC_MASK (GENMASK(3, 0))
	29
15a5a895 KV	30	#define IDISP_CODEC_MASK 0x4
15a5a895 KV	31
f40ed2e8 PLB	32	/* Default: SSP5 */
	33	static unsigned long sof_pcm512x_quirk = SOF_PCM512X_SSP_CODEC(5);
	34
	35	static bool is_legacy_cpu;
	36
	37	struct sof_hdmi_pcm {
	38	struct list_head head;
	39	struct snd_soc_dai *codec_dai;
	40	int device;
	41	};
	42
	43	struct sof_card_private {
	44	struct list_head hdmi_pcm_list;
15a5a895	45	bool idisp_codec;
f40ed2e8 PLB	46	};
	47
	48	static int sof_pcm512x_quirk_cb(const struct dmi_system_id *id)
	49	{
	50	sof_pcm512x_quirk = (unsigned long)id->driver_data;
	51	return 1;
	52	}
	53
	54	static const struct dmi_system_id sof_pcm512x_quirk_table[] = {
	55	{
	56	.callback = sof_pcm512x_quirk_cb,
	57	.matches = {
	58	DMI_MATCH(DMI_SYS_VENDOR, "AAEON"),
	59	DMI_MATCH(DMI_PRODUCT_NAME, "UP-CHT01"),
	60	},
	61	.driver_data = (void *)(SOF_PCM512X_SSP_CODEC(2)),
	62	},
	63	{}
	64	};
	65
	66	static int sof_hdmi_init(struct snd_soc_pcm_runtime *rtd)
	67	{
	68	struct sof_card_private *ctx = snd_soc_card_get_drvdata(rtd->card);
0d1571c1	69	struct snd_soc_dai *dai = asoc_rtd_to_codec(rtd, 0);
f40ed2e8 PLB	70	struct sof_hdmi_pcm *pcm;
	71
	72	pcm = devm_kzalloc(rtd->card->dev, sizeof(*pcm), GFP_KERNEL);
	73	if (!pcm)
	74	return -ENOMEM;
	75
	76	/* dai_link id is 1:1 mapped to the PCM device */
	77	pcm->device = rtd->dai_link->id;
	78	pcm->codec_dai = dai;
	79
	80	list_add_tail(&pcm->head, &ctx->hdmi_pcm_list);
	81
	82	return 0;
	83	}
	84
	85	static int sof_pcm512x_codec_init(struct snd_soc_pcm_runtime *rtd)
	86	{
0d1571c1	87	struct snd_soc_component *codec = asoc_rtd_to_codec(rtd, 0)->component;
f40ed2e8 PLB	88
	89	snd_soc_component_update_bits(codec, PCM512x_GPIO_EN, 0x08, 0x08);
	90	snd_soc_component_update_bits(codec, PCM512x_GPIO_OUTPUT_4, 0x0f, 0x02);
	91	snd_soc_component_update_bits(codec, PCM512x_GPIO_CONTROL_1,
	92	0x08, 0x08);
	93
	94	return 0;
	95	}
	96
	97	static int aif1_startup(struct snd_pcm_substream *substream)
	98	{
2207b93b	99	struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
0d1571c1	100	struct snd_soc_component *codec = asoc_rtd_to_codec(rtd, 0)->component;
f40ed2e8 PLB	101
	102	snd_soc_component_update_bits(codec, PCM512x_GPIO_CONTROL_1,
	103	0x08, 0x08);
	104
	105	return 0;
	106	}
	107
	108	static void aif1_shutdown(struct snd_pcm_substream *substream)
	109	{
2207b93b	110	struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
0d1571c1	111	struct snd_soc_component *codec = asoc_rtd_to_codec(rtd, 0)->component;
f40ed2e8 PLB	112
	113	snd_soc_component_update_bits(codec, PCM512x_GPIO_CONTROL_1,
	114	0x08, 0x00);
	115	}
	116
	117	static const struct snd_soc_ops sof_pcm512x_ops = {
	118	.startup = aif1_startup,
	119	.shutdown = aif1_shutdown,
	120	};
	121
	122	static struct snd_soc_dai_link_component platform_component[] = {
	123	{
	124	/* name might be overridden during probe */
	125	.name = "0000:00:1f.3"
	126	}
	127	};
	128
f40ed2e8 PLB	129	static int sof_card_late_probe(struct snd_soc_card *card)
	130	{
	131	struct sof_card_private *ctx = snd_soc_card_get_drvdata(card);
	132	struct sof_hdmi_pcm *pcm;
	133
	134	/* HDMI is not supported by SOF on Baytrail/CherryTrail */
	135	if (is_legacy_cpu)
	136	return 0;
	137
	138	if (list_empty(&ctx->hdmi_pcm_list))
	139	return -EINVAL;
	140
15a5a895 KV	141	if (!ctx->idisp_codec)
	142	return 0;
	143
f40ed2e8 PLB	144	pcm = list_first_entry(&ctx->hdmi_pcm_list, struct sof_hdmi_pcm, head);
	145
	146	return hda_dsp_hdmi_build_controls(card, pcm->codec_dai->component);
	147	}
f40ed2e8 PLB	148
	149	static const struct snd_kcontrol_new sof_controls[] = {
	150	SOC_DAPM_PIN_SWITCH("Ext Spk"),
	151	};
	152
	153	static const struct snd_soc_dapm_widget sof_widgets[] = {
	154	SND_SOC_DAPM_SPK("Ext Spk", NULL),
	155	};
	156
	157	static const struct snd_soc_dapm_widget dmic_widgets[] = {
	158	SND_SOC_DAPM_MIC("SoC DMIC", NULL),
	159	};
	160
	161	static const struct snd_soc_dapm_route sof_map[] = {
	162	/* Speaker */
	163	{"Ext Spk", NULL, "OUTR"},
	164	{"Ext Spk", NULL, "OUTL"},
	165	};
	166
	167	static const struct snd_soc_dapm_route dmic_map[] = {
	168	/* digital mics */
	169	{"DMic", NULL, "SoC DMIC"},
	170	};
	171
	172	static int dmic_init(struct snd_soc_pcm_runtime *rtd)
	173	{
	174	struct snd_soc_card *card = rtd->card;
	175	int ret;
	176
	177	ret = snd_soc_dapm_new_controls(&card->dapm, dmic_widgets,
	178	ARRAY_SIZE(dmic_widgets));
	179	if (ret) {
	180	dev_err(card->dev, "DMic widget addition failed: %d\n", ret);
	181	/* Don't need to add routes if widget addition failed */
	182	return ret;
	183	}
	184
	185	ret = snd_soc_dapm_add_routes(&card->dapm, dmic_map,
	186	ARRAY_SIZE(dmic_map));
	187
	188	if (ret)
	189	dev_err(card->dev, "DMic map addition failed: %d\n", ret);
	190
	191	return ret;
	192	}
	193
	194	/* sof audio machine driver for pcm512x codec */
	195	static struct snd_soc_card sof_audio_card_pcm512x = {
	196	.name = "pcm512x",
	197	.owner = THIS_MODULE,
	198	.controls = sof_controls,
	199	.num_controls = ARRAY_SIZE(sof_controls),
	200	.dapm_widgets = sof_widgets,
	201	.num_dapm_widgets = ARRAY_SIZE(sof_widgets),
	202	.dapm_routes = sof_map,
	203	.num_dapm_routes = ARRAY_SIZE(sof_map),
	204	.fully_routed = true,
	205	.late_probe = sof_card_late_probe,
	206	};
	207
	208	SND_SOC_DAILINK_DEF(pcm512x_component,
	209	DAILINK_COMP_ARRAY(COMP_CODEC("i2c-104C5122:00", "pcm512x-hifi")));
	210	SND_SOC_DAILINK_DEF(dmic_component,
	211	DAILINK_COMP_ARRAY(COMP_CODEC("dmic-codec", "dmic-hifi")));
212
213	static struct snd_soc_dai_link sof_card_dai_links_create(struct device dev,
214	int ssp_codec,
215	int dmic_be_num,
15a5a895 KV	216	int hdmi_num,
15a5a895 KV	217	bool idisp_codec)
f40ed2e8 PLB	218	{
	219	struct snd_soc_dai_link_component *idisp_components;
	220	struct snd_soc_dai_link_component *cpus;
	221	struct snd_soc_dai_link *links;
	222	int i, id = 0;
	223
	224	links = devm_kcalloc(dev, sof_audio_card_pcm512x.num_links,
	225	sizeof(struct snd_soc_dai_link), GFP_KERNEL);
	226	cpus = devm_kcalloc(dev, sof_audio_card_pcm512x.num_links,
	227	sizeof(struct snd_soc_dai_link_component), GFP_KERNEL);
	228	if (!links \|\| !cpus)
	229	goto devm_err;
	230
	231	/* codec SSP */
	232	links[id].name = devm_kasprintf(dev, GFP_KERNEL,
	233	"SSP%d-Codec", ssp_codec);
	234	if (!links[id].name)
	235	goto devm_err;
	236
	237	links[id].id = id;
	238	links[id].codecs = pcm512x_component;
	239	links[id].num_codecs = ARRAY_SIZE(pcm512x_component);
	240	links[id].platforms = platform_component;
	241	links[id].num_platforms = ARRAY_SIZE(platform_component);
	242	links[id].init = sof_pcm512x_codec_init;
	243	links[id].ops = &sof_pcm512x_ops;
	244	links[id].nonatomic = true;
	245	links[id].dpcm_playback = 1;
	246	/*
	247	* capture only supported with specific versions of the Hifiberry DAC+
	248	* links[id].dpcm_capture = 1;
	249	*/
	250	links[id].no_pcm = 1;
	251	links[id].cpus = &cpus[id];
	252	links[id].num_cpus = 1;
	253	if (is_legacy_cpu) {
	254	links[id].cpus->dai_name = devm_kasprintf(dev, GFP_KERNEL,
	255	"ssp%d-port",
	256	ssp_codec);
	257	if (!links[id].cpus->dai_name)
	258	goto devm_err;
	259	} else {
	260	links[id].cpus->dai_name = devm_kasprintf(dev, GFP_KERNEL,
	261	"SSP%d Pin",
	262	ssp_codec);
	263	if (!links[id].cpus->dai_name)
	264	goto devm_err;
	265	}
	266	id++;
	267
	268	/* dmic */
	269	if (dmic_be_num > 0) {
	270	/* at least we have dmic01 */
	271	links[id].name = "dmic01";
	272	links[id].cpus = &cpus[id];
	273	links[id].cpus->dai_name = "DMIC01 Pin";
	274	links[id].init = dmic_init;
	275	if (dmic_be_num > 1) {
	276	/* set up 2 BE links at most */
	277	links[id + 1].name = "dmic16k";
	278	links[id + 1].cpus = &cpus[id + 1];
	279	links[id + 1].cpus->dai_name = "DMIC16k Pin";
	280	dmic_be_num = 2;
	281	}
282	}
283
284	for (i = 0; i < dmic_be_num; i++) {
285	links[id].id = id;
286	links[id].num_cpus = 1;
287	links[id].codecs = dmic_component;
288	links[id].num_codecs = ARRAY_SIZE(dmic_component);
289	links[id].platforms = platform_component;
290	links[id].num_platforms = ARRAY_SIZE(platform_component);
291	links[id].ignore_suspend = 1;
292	links[id].dpcm_capture = 1;
293	links[id].no_pcm = 1;
294	id++;
295	}
296
297	/* HDMI */
298	if (hdmi_num > 0) {
299	idisp_components = devm_kcalloc(dev, hdmi_num,
300	sizeof(struct snd_soc_dai_link_component),
301	GFP_KERNEL);
302	if (!idisp_components)
303	goto devm_err;
304	}
305	for (i = 1; i <= hdmi_num; i++) {
306	links[id].name = devm_kasprintf(dev, GFP_KERNEL,
307	"iDisp%d", i);
308	if (!links[id].name)
309	goto devm_err;
310
311	links[id].id = id;
312	links[id].cpus = &cpus[id];
313	links[id].num_cpus = 1;
314	links[id].cpus->dai_name = devm_kasprintf(dev, GFP_KERNEL,
315	"iDisp%d Pin", i);
316	if (!links[id].cpus->dai_name)
317	goto devm_err;
318
15a5a895 KV	319	/*
	320	* topology cannot be loaded if codec is missing, so
	321	* use the dummy codec if needed
	322	*/
	323	if (idisp_codec) {
	324	idisp_components[i - 1].name = "ehdaudio0D2";
	325	idisp_components[i - 1].dai_name =
	326	devm_kasprintf(dev, GFP_KERNEL,
	327	"intel-hdmi-hifi%d", i);
	328	} else {
	329	idisp_components[i - 1].name = "snd-soc-dummy";
	330	idisp_components[i - 1].dai_name = "snd-soc-dummy-dai";
	331	}
f40ed2e8 PLB	332	if (!idisp_components[i - 1].dai_name)
	333	goto devm_err;
	334
	335	links[id].codecs = &idisp_components[i - 1];
	336	links[id].num_codecs = 1;
	337	links[id].platforms = platform_component;
	338	links[id].num_platforms = ARRAY_SIZE(platform_component);
	339	links[id].init = sof_hdmi_init;
	340	links[id].dpcm_playback = 1;
	341	links[id].no_pcm = 1;
	342	id++;
	343	}
	344
	345	return links;
	346	devm_err:
	347	return NULL;
	348	}
	349
	350	static int sof_audio_probe(struct platform_device *pdev)
	351	{
15a5a895	352	struct snd_soc_acpi_mach *mach = pdev->dev.platform_data;
f40ed2e8	353	struct snd_soc_dai_link *dai_links;
f40ed2e8 PLB	354	struct sof_card_private *ctx;
	355	int dmic_be_num, hdmi_num;
	356	int ret, ssp_codec;
	357
	358	ctx = devm_kzalloc(&pdev->dev, sizeof(*ctx), GFP_KERNEL);
	359	if (!ctx)
	360	return -ENOMEM;
	361
	362	hdmi_num = 0;
	363	if (soc_intel_is_byt() \|\| soc_intel_is_cht()) {
	364	is_legacy_cpu = true;
	365	dmic_be_num = 0;
	366	/* default quirk for legacy cpu */
	367	sof_pcm512x_quirk = SOF_PCM512X_SSP_CODEC(2);
	368	} else {
	369	dmic_be_num = 2;
15a5a895 KV	370	if (mach->mach_params.common_hdmi_codec_drv &&
	371	(mach->mach_params.codec_mask & IDISP_CODEC_MASK))
	372	ctx->idisp_codec = true;
	373
	374	/* links are always present in topology */
f40ed2e8	375	hdmi_num = 3;
f40ed2e8 PLB	376	}
	377
	378	dmi_check_system(sof_pcm512x_quirk_table);
	379
	380	dev_dbg(&pdev->dev, "sof_pcm512x_quirk = %lx\n", sof_pcm512x_quirk);
	381
	382	ssp_codec = sof_pcm512x_quirk & SOF_PCM512X_SSP_CODEC_MASK;
	383
	384	/* compute number of dai links */
	385	sof_audio_card_pcm512x.num_links = 1 + dmic_be_num + hdmi_num;
	386
	387	dai_links = sof_card_dai_links_create(&pdev->dev, ssp_codec,
15a5a895 KV	388	dmic_be_num, hdmi_num,
15a5a895 KV	389	ctx->idisp_codec);
f40ed2e8 PLB	390	if (!dai_links)
	391	return -ENOMEM;
	392
	393	sof_audio_card_pcm512x.dai_link = dai_links;
	394
	395	INIT_LIST_HEAD(&ctx->hdmi_pcm_list);
	396
	397	sof_audio_card_pcm512x.dev = &pdev->dev;
f40ed2e8 PLB	398
	399	/* set platform name for each dailink */
	400	ret = snd_soc_fixup_dai_links_platform_name(&sof_audio_card_pcm512x,
	401	mach->mach_params.platform);
	402	if (ret)
	403	return ret;
	404
	405	snd_soc_card_set_drvdata(&sof_audio_card_pcm512x, ctx);
	406
	407	return devm_snd_soc_register_card(&pdev->dev,
	408	&sof_audio_card_pcm512x);
	409	}
	410
	411	static int sof_pcm512x_remove(struct platform_device *pdev)
	412	{
	413	struct snd_soc_card *card = platform_get_drvdata(pdev);
	414	struct snd_soc_component *component = NULL;
	415
	416	for_each_card_components(card, component) {
	417	if (!strcmp(component->name, pcm512x_component[0].name)) {
	418	snd_soc_component_set_jack(component, NULL, NULL);
	419	break;
	420	}
	421	}
	422
	423	return 0;
	424	}
	425
	426	static struct platform_driver sof_audio = {
	427	.probe = sof_audio_probe,
	428	.remove = sof_pcm512x_remove,
	429	.driver = {
	430	.name = "sof_pcm512x",
	431	.pm = &snd_soc_pm_ops,
	432	},
	433	};
	434	module_platform_driver(sof_audio)
	435
	436	MODULE_DESCRIPTION("ASoC Intel(R) SOF + PCM512x Machine driver");
	437	MODULE_AUTHOR("Pierre-Louis Bossart");
	438	MODULE_LICENSE("GPL v2");
	439	MODULE_ALIAS("platform:sof_pcm512x");