1// SPDX-License-Identifier: GPL-2.0-only
2// Based on sof_sdw_rt5682.c
3// Copyright (c) 2023 Intel Corporation
4
5/*
6 *  sof_sdw_cs42l43 - Helpers to handle CS42L43 from generic machine driver
7 */
8#include <linux/device.h>
9#include <linux/errno.h>
10#include <linux/input.h>
11#include <sound/jack.h>
12#include <linux/soundwire/sdw.h>
13#include <linux/soundwire/sdw_type.h>
14#include <sound/cs42l43.h>
15#include <sound/control.h>
16#include <sound/soc.h>
17#include <sound/soc-acpi.h>
18#include <sound/soc-dapm.h>
19#include "sof_sdw_common.h"
20
21static const struct snd_soc_dapm_widget cs42l43_hs_widgets[] = {
22	SND_SOC_DAPM_HP("Headphone", NULL),
23	SND_SOC_DAPM_MIC("Headset Mic", NULL),
24};
25
26static const struct snd_soc_dapm_route cs42l43_hs_map[] = {
27	{ "Headphone", NULL, "cs42l43 AMP3_OUT" },
28	{ "Headphone", NULL, "cs42l43 AMP4_OUT" },
29	{ "cs42l43 ADC1_IN1_P", NULL, "Headset Mic" },
30	{ "cs42l43 ADC1_IN1_N", NULL, "Headset Mic" },
31};
32
33static const struct snd_soc_dapm_widget cs42l43_dmic_widgets[] = {
34	SND_SOC_DAPM_MIC("DMIC", NULL),
35};
36
37static const struct snd_soc_dapm_route cs42l43_dmic_map[] = {
38	{ "cs42l43 PDM1_DIN", NULL, "DMIC" },
39	{ "cs42l43 PDM2_DIN", NULL, "DMIC" },
40};
41
42static struct snd_soc_jack_pin sof_jack_pins[] = {
43	{
44		.pin    = "Headphone",
45		.mask   = SND_JACK_HEADPHONE,
46	},
47	{
48		.pin    = "Headset Mic",
49		.mask   = SND_JACK_MICROPHONE,
50	},
51};
52
53int cs42l43_hs_rtd_init(struct snd_soc_pcm_runtime *rtd)
54{
55	struct snd_soc_component *component = snd_soc_rtd_to_codec(rtd, 0)->component;
56	struct mc_private *ctx = snd_soc_card_get_drvdata(rtd->card);
57	struct snd_soc_jack *jack = &ctx->sdw_headset;
58	struct snd_soc_card *card = rtd->card;
59	int ret;
60
61	card->components = devm_kasprintf(card->dev, GFP_KERNEL, "%s hs:cs42l43",
62					  card->components);
63	if (!card->components)
64		return -ENOMEM;
65
66	ret = snd_soc_dapm_new_controls(&card->dapm, cs42l43_hs_widgets,
67					ARRAY_SIZE(cs42l43_hs_widgets));
68	if (ret) {
69		dev_err(card->dev, "cs42l43 hs widgets addition failed: %d\n", ret);
70		return ret;
71	}
72
73	ret = snd_soc_dapm_add_routes(&card->dapm, cs42l43_hs_map,
74				      ARRAY_SIZE(cs42l43_hs_map));
75	if (ret) {
76		dev_err(card->dev, "cs42l43 hs map addition failed: %d\n", ret);
77		return ret;
78	}
79
80	ret = snd_soc_card_jack_new_pins(card, "Jack",
81					 SND_JACK_MECHANICAL | SND_JACK_AVOUT |
82					 SND_JACK_HEADSET | SND_JACK_LINEOUT |
83					 SND_JACK_BTN_0 | SND_JACK_BTN_1 |
84					 SND_JACK_BTN_2 | SND_JACK_BTN_3,
85					 jack, sof_jack_pins,
86					 ARRAY_SIZE(sof_jack_pins));
87	if (ret) {
88		dev_err(card->dev, "Failed to create jack: %d\n", ret);
89		return ret;
90	}
91
92	snd_jack_set_key(jack->jack, SND_JACK_BTN_0, KEY_PLAYPAUSE);
93	snd_jack_set_key(jack->jack, SND_JACK_BTN_1, KEY_VOICECOMMAND);
94	snd_jack_set_key(jack->jack, SND_JACK_BTN_2, KEY_VOLUMEUP);
95	snd_jack_set_key(jack->jack, SND_JACK_BTN_3, KEY_VOLUMEDOWN);
96
97	ret = snd_soc_component_set_jack(component, jack, NULL);
98	if (ret) {
99		dev_err(card->dev, "Failed to register jack: %d\n", ret);
100		return ret;
101	}
102
103	ret = snd_soc_component_set_sysclk(component, CS42L43_SYSCLK, CS42L43_SYSCLK_SDW,
104					   0, SND_SOC_CLOCK_IN);
105	if (ret)
106		dev_err(card->dev, "Failed to set sysclk: %d\n", ret);
107
108	return ret;
109}
110
111int cs42l43_dmic_rtd_init(struct snd_soc_pcm_runtime *rtd)
112{
113	struct snd_soc_card *card = rtd->card;
114	int ret;
115
116	card->components = devm_kasprintf(card->dev, GFP_KERNEL, "%s mic:cs42l43-dmic",
117					  card->components);
118	if (!card->components)
119		return -ENOMEM;
120
121	ret = snd_soc_dapm_new_controls(&card->dapm, cs42l43_dmic_widgets,
122					ARRAY_SIZE(cs42l43_dmic_widgets));
123	if (ret) {
124		dev_err(card->dev, "cs42l43 dmic widgets addition failed: %d\n", ret);
125		return ret;
126	}
127
128	ret = snd_soc_dapm_add_routes(&card->dapm, cs42l43_dmic_map,
129				      ARRAY_SIZE(cs42l43_dmic_map));
130	if (ret)
131		dev_err(card->dev, "cs42l43 dmic map addition failed: %d\n", ret);
132
133	return ret;
134}
135
136