1 // SPDX-License-Identifier: GPL-2.0-only 2 // 3 // Copyright(c) 2021-2022 Intel Corporation. All rights reserved. 4 // 5 // Authors: Cezary Rojewski <cezary.rojewski@intel.com> 6 // Amadeusz Slawinski <amadeuszx.slawinski@linux.intel.com> 7 // 8 9 #include <linux/input.h> 10 #include <linux/module.h> 11 #include <linux/platform_device.h> 12 #include <sound/core.h> 13 #include <sound/jack.h> 14 #include <sound/pcm.h> 15 #include <sound/pcm_params.h> 16 #include <sound/soc.h> 17 #include <sound/soc-acpi.h> 18 #include "../../../codecs/nau8825.h" 19 20 #define SKL_NUVOTON_CODEC_DAI "nau8825-hifi" 21 22 static int 23 avs_nau8825_clock_control(struct snd_soc_dapm_widget *w, struct snd_kcontrol *control, int event) 24 { 25 struct snd_soc_dapm_context *dapm = w->dapm; 26 struct snd_soc_card *card = dapm->card; 27 struct snd_soc_dai *codec_dai; 28 int ret; 29 30 codec_dai = snd_soc_card_get_codec_dai(card, SKL_NUVOTON_CODEC_DAI); 31 if (!codec_dai) { 32 dev_err(card->dev, "Codec dai not found\n"); 33 return -EINVAL; 34 } 35 36 if (SND_SOC_DAPM_EVENT_ON(event)) 37 ret = snd_soc_dai_set_sysclk(codec_dai, NAU8825_CLK_MCLK, 24000000, 38 SND_SOC_CLOCK_IN); 39 else 40 ret = snd_soc_dai_set_sysclk(codec_dai, NAU8825_CLK_INTERNAL, 0, SND_SOC_CLOCK_IN); 41 if (ret < 0) 42 dev_err(card->dev, "Set sysclk failed: %d\n", ret); 43 44 return ret; 45 } 46 47 static const struct snd_kcontrol_new card_controls[] = { 48 SOC_DAPM_PIN_SWITCH("Headphone Jack"), 49 SOC_DAPM_PIN_SWITCH("Headset Mic"), 50 }; 51 52 static const struct snd_soc_dapm_widget card_widgets[] = { 53 SND_SOC_DAPM_HP("Headphone Jack", NULL), 54 SND_SOC_DAPM_MIC("Headset Mic", NULL), 55 SND_SOC_DAPM_SUPPLY("Platform Clock", SND_SOC_NOPM, 0, 0, avs_nau8825_clock_control, 56 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), 57 }; 58 59 static const struct snd_soc_dapm_route card_base_routes[] = { 60 { "Headphone Jack", NULL, "HPOL" }, 61 { "Headphone Jack", NULL, "HPOR" }, 62 63 { "MIC", NULL, "Headset Mic" }, 64 65 { "Headphone Jack", NULL, "Platform Clock" }, 66 { "Headset Mic", NULL, "Platform Clock" }, 67 }; 68 69 static struct snd_soc_jack_pin card_headset_pins[] = { 70 { 71 .pin = "Headphone Jack", 72 .mask = SND_JACK_HEADPHONE, 73 }, 74 { 75 .pin = "Headset Mic", 76 .mask = SND_JACK_MICROPHONE, 77 }, 78 }; 79 80 static int avs_nau8825_codec_init(struct snd_soc_pcm_runtime *runtime) 81 { 82 struct snd_soc_card *card = runtime->card; 83 struct snd_soc_jack_pin *pins; 84 struct snd_soc_jack *jack; 85 int num_pins, ret; 86 87 jack = snd_soc_card_get_drvdata(card); 88 num_pins = ARRAY_SIZE(card_headset_pins); 89 90 pins = devm_kmemdup(card->dev, card_headset_pins, sizeof(*pins) * num_pins, GFP_KERNEL); 91 if (!pins) 92 return -ENOMEM; 93 94 /* 95 * 4 buttons here map to the google Reference headset. 96 * The use of these buttons can be decided by the user space. 97 */ 98 ret = snd_soc_card_jack_new_pins(card, "Headset", SND_JACK_HEADSET | SND_JACK_BTN_0 | 99 SND_JACK_BTN_1 | SND_JACK_BTN_2 | SND_JACK_BTN_3, 100 jack, pins, num_pins); 101 if (ret) 102 return ret; 103 104 snd_jack_set_key(jack->jack, SND_JACK_BTN_0, KEY_PLAYPAUSE); 105 snd_jack_set_key(jack->jack, SND_JACK_BTN_1, KEY_VOICECOMMAND); 106 snd_jack_set_key(jack->jack, SND_JACK_BTN_2, KEY_VOLUMEUP); 107 snd_jack_set_key(jack->jack, SND_JACK_BTN_3, KEY_VOLUMEDOWN); 108 109 return snd_soc_component_set_jack(asoc_rtd_to_codec(runtime, 0)->component, jack, NULL); 110 } 111 112 static void avs_nau8825_codec_exit(struct snd_soc_pcm_runtime *rtd) 113 { 114 snd_soc_component_set_jack(asoc_rtd_to_codec(rtd, 0)->component, NULL, NULL); 115 } 116 117 static int 118 avs_nau8825_be_fixup(struct snd_soc_pcm_runtime *runtime, struct snd_pcm_hw_params *params) 119 { 120 struct snd_interval *rate, *channels; 121 struct snd_mask *fmt; 122 123 rate = hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE); 124 channels = hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS); 125 fmt = hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT); 126 127 /* The ADSP will convert the FE rate to 48k, stereo */ 128 rate->min = rate->max = 48000; 129 channels->min = channels->max = 2; 130 131 /* set SSP to 24 bit */ 132 snd_mask_none(fmt); 133 snd_mask_set_format(fmt, SNDRV_PCM_FORMAT_S24_LE); 134 135 return 0; 136 } 137 138 static int avs_nau8825_trigger(struct snd_pcm_substream *substream, int cmd) 139 { 140 struct snd_pcm_runtime *runtime = substream->runtime; 141 struct snd_soc_pcm_runtime *rtm = asoc_substream_to_rtd(substream); 142 struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtm, 0); 143 int ret = 0; 144 145 switch (cmd) { 146 case SNDRV_PCM_TRIGGER_START: 147 ret = snd_soc_dai_set_sysclk(codec_dai, NAU8825_CLK_FLL_FS, 0, SND_SOC_CLOCK_IN); 148 if (ret < 0) { 149 dev_err(codec_dai->dev, "can't set FS clock %d\n", ret); 150 break; 151 } 152 153 ret = snd_soc_dai_set_pll(codec_dai, 0, 0, runtime->rate, runtime->rate * 256); 154 if (ret < 0) 155 dev_err(codec_dai->dev, "can't set FLL: %d\n", ret); 156 break; 157 158 case SNDRV_PCM_TRIGGER_RESUME: 159 ret = snd_soc_dai_set_pll(codec_dai, 0, 0, runtime->rate, runtime->rate * 256); 160 if (ret < 0) 161 dev_err(codec_dai->dev, "can't set FLL: %d\n", ret); 162 break; 163 } 164 165 return ret; 166 } 167 168 169 static const struct snd_soc_ops avs_nau8825_ops = { 170 .trigger = avs_nau8825_trigger, 171 }; 172 173 static int avs_create_dai_link(struct device *dev, const char *platform_name, int ssp_port, 174 struct snd_soc_dai_link **dai_link) 175 { 176 struct snd_soc_dai_link_component *platform; 177 struct snd_soc_dai_link *dl; 178 179 dl = devm_kzalloc(dev, sizeof(*dl), GFP_KERNEL); 180 platform = devm_kzalloc(dev, sizeof(*platform), GFP_KERNEL); 181 if (!dl || !platform) 182 return -ENOMEM; 183 184 platform->name = platform_name; 185 186 dl->name = devm_kasprintf(dev, GFP_KERNEL, "SSP%d-Codec", ssp_port); 187 dl->cpus = devm_kzalloc(dev, sizeof(*dl->cpus), GFP_KERNEL); 188 dl->codecs = devm_kzalloc(dev, sizeof(*dl->codecs), GFP_KERNEL); 189 if (!dl->name || !dl->cpus || !dl->codecs) 190 return -ENOMEM; 191 192 dl->cpus->dai_name = devm_kasprintf(dev, GFP_KERNEL, "SSP%d Pin", ssp_port); 193 dl->codecs->name = devm_kasprintf(dev, GFP_KERNEL, "i2c-10508825:00"); 194 dl->codecs->dai_name = devm_kasprintf(dev, GFP_KERNEL, SKL_NUVOTON_CODEC_DAI); 195 if (!dl->cpus->dai_name || !dl->codecs->name || !dl->codecs->dai_name) 196 return -ENOMEM; 197 198 dl->num_cpus = 1; 199 dl->num_codecs = 1; 200 dl->platforms = platform; 201 dl->num_platforms = 1; 202 dl->id = 0; 203 dl->dai_fmt = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBS_CFS; 204 dl->init = avs_nau8825_codec_init; 205 dl->exit = avs_nau8825_codec_exit; 206 dl->be_hw_params_fixup = avs_nau8825_be_fixup; 207 dl->ops = &avs_nau8825_ops; 208 dl->nonatomic = 1; 209 dl->no_pcm = 1; 210 dl->dpcm_capture = 1; 211 dl->dpcm_playback = 1; 212 213 *dai_link = dl; 214 215 return 0; 216 } 217 218 static int avs_create_dapm_routes(struct device *dev, int ssp_port, 219 struct snd_soc_dapm_route **routes, int *num_routes) 220 { 221 struct snd_soc_dapm_route *dr; 222 const int num_base = ARRAY_SIZE(card_base_routes); 223 const int num_dr = num_base + 2; 224 int idx; 225 226 dr = devm_kcalloc(dev, num_dr, sizeof(*dr), GFP_KERNEL); 227 if (!dr) 228 return -ENOMEM; 229 230 memcpy(dr, card_base_routes, num_base * sizeof(*dr)); 231 232 idx = num_base; 233 dr[idx].sink = devm_kasprintf(dev, GFP_KERNEL, "Playback"); 234 dr[idx].source = devm_kasprintf(dev, GFP_KERNEL, "ssp%d Tx", ssp_port); 235 if (!dr[idx].sink || !dr[idx].source) 236 return -ENOMEM; 237 238 idx++; 239 dr[idx].sink = devm_kasprintf(dev, GFP_KERNEL, "ssp%d Rx", ssp_port); 240 dr[idx].source = devm_kasprintf(dev, GFP_KERNEL, "Capture"); 241 if (!dr[idx].sink || !dr[idx].source) 242 return -ENOMEM; 243 244 *routes = dr; 245 *num_routes = num_dr; 246 247 return 0; 248 } 249 250 static int avs_card_suspend_pre(struct snd_soc_card *card) 251 { 252 struct snd_soc_dai *codec_dai = snd_soc_card_get_codec_dai(card, SKL_NUVOTON_CODEC_DAI); 253 254 return snd_soc_component_set_jack(codec_dai->component, NULL, NULL); 255 } 256 257 static int avs_card_resume_post(struct snd_soc_card *card) 258 { 259 struct snd_soc_dai *codec_dai = snd_soc_card_get_codec_dai(card, SKL_NUVOTON_CODEC_DAI); 260 struct snd_soc_jack *jack = snd_soc_card_get_drvdata(card); 261 int stream = SNDRV_PCM_STREAM_PLAYBACK; 262 263 if (!codec_dai) { 264 dev_err(card->dev, "Codec dai not found\n"); 265 return -EINVAL; 266 } 267 268 if (snd_soc_dai_stream_active(codec_dai, stream) && 269 snd_soc_dai_get_widget(codec_dai, stream)->active) 270 snd_soc_dai_set_sysclk(codec_dai, NAU8825_CLK_FLL_FS, 0, SND_SOC_CLOCK_IN); 271 272 return snd_soc_component_set_jack(codec_dai->component, jack, NULL); 273 } 274 275 static int avs_nau8825_probe(struct platform_device *pdev) 276 { 277 struct snd_soc_dapm_route *routes; 278 struct snd_soc_dai_link *dai_link; 279 struct snd_soc_acpi_mach *mach; 280 struct snd_soc_card *card; 281 struct snd_soc_jack *jack; 282 struct device *dev = &pdev->dev; 283 const char *pname; 284 int num_routes, ssp_port, ret; 285 286 mach = dev_get_platdata(dev); 287 pname = mach->mach_params.platform; 288 ssp_port = __ffs(mach->mach_params.i2s_link_mask); 289 290 ret = avs_create_dai_link(dev, pname, ssp_port, &dai_link); 291 if (ret) { 292 dev_err(dev, "Failed to create dai link: %d", ret); 293 return ret; 294 } 295 296 ret = avs_create_dapm_routes(dev, ssp_port, &routes, &num_routes); 297 if (ret) { 298 dev_err(dev, "Failed to create dapm routes: %d", ret); 299 return ret; 300 } 301 302 jack = devm_kzalloc(dev, sizeof(*jack), GFP_KERNEL); 303 card = devm_kzalloc(dev, sizeof(*card), GFP_KERNEL); 304 if (!jack || !card) 305 return -ENOMEM; 306 307 card->name = "avs_nau8825"; 308 card->dev = dev; 309 card->owner = THIS_MODULE; 310 card->suspend_pre = avs_card_suspend_pre; 311 card->resume_post = avs_card_resume_post; 312 card->dai_link = dai_link; 313 card->num_links = 1; 314 card->controls = card_controls; 315 card->num_controls = ARRAY_SIZE(card_controls); 316 card->dapm_widgets = card_widgets; 317 card->num_dapm_widgets = ARRAY_SIZE(card_widgets); 318 card->dapm_routes = routes; 319 card->num_dapm_routes = num_routes; 320 card->fully_routed = true; 321 snd_soc_card_set_drvdata(card, jack); 322 323 ret = snd_soc_fixup_dai_links_platform_name(card, pname); 324 if (ret) 325 return ret; 326 327 return devm_snd_soc_register_card(dev, card); 328 } 329 330 static struct platform_driver avs_nau8825_driver = { 331 .probe = avs_nau8825_probe, 332 .driver = { 333 .name = "avs_nau8825", 334 .pm = &snd_soc_pm_ops, 335 }, 336 }; 337 338 module_platform_driver(avs_nau8825_driver) 339 340 MODULE_LICENSE("GPL"); 341 MODULE_ALIAS("platform:avs_nau8825"); 342