From 0000000000000000000000000000000000000000 Mon Sep 17 00:00:00 2001 From: Hardik T Shah Date: Sat, 23 Apr 2016 18:58:44 +0530 Subject: [PATCH] ASoC:Intel: Add machine driver for SoundWire SV PDM Codec. This patch is for testing. Not to be upstreamed. Change-Id: Ia92c5543d94fb3ac045f8c13414b9af3ffa8d7d3 Signed-off-by: Hardik T Shah Reviewed-on: --- sound/soc/intel/boards/Kconfig | 11 ++ sound/soc/intel/boards/Makefile | 2 + sound/soc/intel/boards/cnl_svfpga.c | 273 ++++++++++++++++++++++++++++ 3 files changed, 286 insertions(+) create mode 100644 sound/soc/intel/boards/cnl_svfpga.c diff --git a/sound/soc/intel/boards/Kconfig b/sound/soc/intel/boards/Kconfig index 35787e69f31b..ca140a77d992 100644 --- a/sound/soc/intel/boards/Kconfig +++ b/sound/soc/intel/boards/Kconfig @@ -306,6 +306,17 @@ config SND_SOC_INTEL_CNL_CS42L42_MACH Say Y or m if you have such a device. This is a recommended option. If unsure select "N". +config SND_SOC_INTEL_CNL_SVFPGA_MACH + tristate "Cannonlake with SVFPGA PDM SDW mode" + depends on MFD_INTEL_LPSS && I2C && ACPI + select SND_SOC_SVFPGA + select SND_SOC_DMIC + help + This adds support for ASoC SVFPGA PDM codec SDW machine driver. This + will create an alsa sound card for SVFPGA. + Say Y or m if you have such a device. This is a recommended option. + If unsure select "N". + endif ## SND_SOC_INTEL_SKYLAKE endif ## SND_SOC_INTEL_MACH diff --git a/sound/soc/intel/boards/Makefile b/sound/soc/intel/boards/Makefile index 4298c5ad8ca0..4f2b9b38edd0 100644 --- a/sound/soc/intel/boards/Makefile +++ b/sound/soc/intel/boards/Makefile @@ -23,6 +23,7 @@ snd-soc-skl_rt286-objs := skl_rt286.o snd-skl_nau88l25_max98357a-objs := skl_nau88l25_max98357a.o snd-soc-skl_nau88l25_ssm4567-objs := skl_nau88l25_ssm4567.o snd-soc-cnl_cs42l42-objs := cnl_cs42l42.o +snd-soc-cnl_svfpga-objs := cnl_svfpga.o obj-$(CONFIG_SND_SOC_INTEL_HASWELL_MACH) += snd-soc-sst-haswell.o obj-$(CONFIG_SND_SOC_INTEL_BYT_RT5640_MACH) += snd-soc-sst-byt-rt5640-mach.o @@ -48,3 +49,4 @@ obj-$(CONFIG_SND_SOC_INTEL_SKL_RT286_MACH) += snd-soc-skl_rt286.o obj-$(CONFIG_SND_SOC_INTEL_SKL_NAU88L25_MAX98357A_MACH) += snd-skl_nau88l25_max98357a.o obj-$(CONFIG_SND_SOC_INTEL_SKL_NAU88L25_SSM4567_MACH) += snd-soc-skl_nau88l25_ssm4567.o obj-$(CONFIG_SND_SOC_INTEL_CNL_CS42L42_MACH) += snd-soc-cnl_cs42l42.o +obj-$(CONFIG_SND_SOC_INTEL_CNL_SVFPGA_MACH) += snd-soc-cnl_svfpga.o diff --git a/sound/soc/intel/boards/cnl_svfpga.c b/sound/soc/intel/boards/cnl_svfpga.c new file mode 100644 index 000000000000..312c0437ac15 --- /dev/null +++ b/sound/soc/intel/boards/cnl_svfpga.c @@ -0,0 +1,273 @@ +/* + * cnl_svfpga.c - ASOC Machine driver for Intel cnl_svfpga platform + * with SVFPGA PDM soundwire codec. + * + * Copyright (C) 2016 Intel Corp + * Author: Hardik Shah + * + * Based on + * moor_dpcm_florida.c - ASOC Machine driver for Intel Moorefield platform + * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; version 2 of the License. + * + * This program is distributed in the hope that it will be useful, but + * WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU + * General Public License for more details. + * + * + * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ + */ +#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +struct cnl_svfpga_mc_private { + u8 pmic_id; + void __iomem *osc_clk0_reg; + int bt_mode; +}; + +static const struct snd_soc_dapm_widget cnl_svfpga_widgets[] = { + SND_SOC_DAPM_HP("Headphones", NULL), + SND_SOC_DAPM_MIC("AMIC", NULL), + SND_SOC_DAPM_MIC("SoC DMIC", NULL), +}; + +static const struct snd_soc_dapm_route cnl_svfpga_map[] = { + /*Headphones*/ + { "Headphones", NULL, "HP" }, + { "I2NP", NULL, "AMIC" }, + + /* SWM map link the SWM outs to codec AIF */ + { "Playback", NULL, "SDW Tx"}, + { "SDW Tx", NULL, "sdw_codec0_out"}, + + + { "sdw_codec1_in", NULL, "SDW Rx1" }, + { "SDW Rx1", NULL, "Capture" }, + + {"DMic", NULL, "SoC DMIC"}, + {"DMIC01 Rx", NULL, "Capture"}, + {"dmic01_hifi", NULL, "DMIC01 Rx"}, + +}; + +static const struct snd_kcontrol_new cnl_svfpga_controls[] = { + SOC_DAPM_PIN_SWITCH("Headphones"), +}; + +static int cnl_svfpga_init(struct snd_soc_pcm_runtime *runtime) +{ + int ret; + struct snd_soc_card *card = runtime->card; + + pr_info("Entry %s\n", __func__); + card->dapm.idle_bias_off = true; + + ret = snd_soc_add_card_controls(card, cnl_svfpga_controls, + ARRAY_SIZE(cnl_svfpga_controls)); + if (ret) { + pr_err("unable to add card controls\n"); + return ret; + } + return 0; +} + +static unsigned int rates_48000[] = { + 48000, + 16000, + 8000, +}; + +static struct snd_pcm_hw_constraint_list constraints_48000 = { + .count = ARRAY_SIZE(rates_48000), + .list = rates_48000, +}; + +static int cnl_svfpga_startup(struct snd_pcm_substream *substream) +{ + return snd_pcm_hw_constraint_list(substream->runtime, 0, + SNDRV_PCM_HW_PARAM_RATE, + &constraints_48000); +} + +static struct snd_soc_ops cnl_svfpga_ops = { + .startup = cnl_svfpga_startup, +}; + +static int cnl_svfpga_codec_fixup(struct snd_soc_pcm_runtime *rtd, + struct snd_pcm_hw_params *params) +{ + struct snd_soc_dai *be_cpu_dai; + int slot_width = 24; + struct snd_interval *rate = hw_param_interval(params, + SNDRV_PCM_HW_PARAM_RATE); + struct snd_interval *channels = hw_param_interval(params, + SNDRV_PCM_HW_PARAM_CHANNELS); + + pr_debug("Invoked %s for dailink %s\n", __func__, rtd->dai_link->name); + slot_width = 24; + rate->min = rate->max = 48000; + channels->min = channels->max = 1; + snd_mask_none(hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT)); + snd_mask_set(hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT), + SNDRV_PCM_FORMAT_S16_LE); + + pr_info("param width set to:0x%x\n", + snd_pcm_format_width(params_format(params))); + pr_info("Slot width = %d\n", slot_width); + + be_cpu_dai = rtd->cpu_dai; + return 0; +} + +static int cnl_dmic_fixup(struct snd_soc_pcm_runtime *rtd, + struct snd_pcm_hw_params *params) +{ + struct snd_interval *channels = hw_param_interval(params, + SNDRV_PCM_HW_PARAM_CHANNELS); + channels->min = channels->max = 2; + + return 0; +} + +struct snd_soc_dai_link cnl_svfpga_msic_dailink[] = { + { + .name = "Bxtn Audio Port", + .stream_name = "Audio", + .cpu_dai_name = "System Pin", + .codec_name = "snd-soc-dummy", + .codec_dai_name = "snd-soc-dummy-dai", + .platform_name = "0000:02:18.0", + .init = cnl_svfpga_init, + .ignore_suspend = 1, + .nonatomic = 1, + .dynamic = 1, + .dpcm_playback = 1, + .dpcm_capture = 1, + .ops = &cnl_svfpga_ops, + }, + { + .name = "SDW0-Codec", + .id = 3, + .cpu_dai_name = "SDW PDM Pin", + .platform_name = "0000:02:18.0", + .codec_name = "sdw-slave0-14:13:20:05:86:80", + .codec_dai_name = "svfpga", + .be_hw_params_fixup = cnl_svfpga_codec_fixup, + .ignore_suspend = 1, + .no_pcm = 1, + .dpcm_playback = 1, + .dpcm_capture = 1, + }, + { + .name = "dmic01", + .id = 4, + .cpu_dai_name = "DMIC01 Pin", + .codec_name = "dmic-codec", + .codec_dai_name = "dmic-hifi", + .platform_name = "0000:02:18.0", + .ignore_suspend = 1, + .no_pcm = 1, + .dpcm_capture = 1, + .be_hw_params_fixup = cnl_dmic_fixup, + }, + +}; + +/* SoC card */ +static struct snd_soc_card snd_soc_card_cnl_svfpga = { + .name = "cnl_svfpga-audio", + .dai_link = cnl_svfpga_msic_dailink, + .num_links = ARRAY_SIZE(cnl_svfpga_msic_dailink), + .dapm_widgets = cnl_svfpga_widgets, + .num_dapm_widgets = ARRAY_SIZE(cnl_svfpga_widgets), + .dapm_routes = cnl_svfpga_map, + .num_dapm_routes = ARRAY_SIZE(cnl_svfpga_map), +}; + + +static int snd_cnl_svfpga_mc_probe(struct platform_device *pdev) +{ + int ret_val = 0; + struct cnl_svfpga_mc_private *drv; + + pr_debug("Entry %s\n", __func__); + + drv = devm_kzalloc(&pdev->dev, sizeof(*drv), GFP_KERNEL); + if (!drv) + return -ENOMEM; + + snd_soc_card_cnl_svfpga.dev = &pdev->dev; + snd_soc_card_set_drvdata(&snd_soc_card_cnl_svfpga, drv); + /* Register the card */ + ret_val = snd_soc_register_card(&snd_soc_card_cnl_svfpga); + if (ret_val && (ret_val != -EPROBE_DEFER)) { + pr_err("snd_soc_register_card failed %d\n", ret_val); + goto unalloc; + } + platform_set_drvdata(pdev, &snd_soc_card_cnl_svfpga); + pr_info("%s successful\n", __func__); + return ret_val; + +unalloc: + return ret_val; +} + +static int snd_cnl_svfpga_mc_remove(struct platform_device *pdev) +{ + struct snd_soc_card *soc_card = platform_get_drvdata(pdev); + struct cnl_svfpga_mc_private *drv = snd_soc_card_get_drvdata(soc_card); + + pr_debug("In %s\n", __func__); + + devm_kfree(&pdev->dev, drv); + snd_soc_card_set_drvdata(soc_card, NULL); + snd_soc_unregister_card(soc_card); + platform_set_drvdata(pdev, NULL); + return 0; +} + +static struct platform_driver snd_cnl_svfpga_mc_driver = { + .driver = { + .name = "cnl_svfpga", + }, + .probe = snd_cnl_svfpga_mc_probe, + .remove = snd_cnl_svfpga_mc_remove, +}; + +static int snd_cnl_svfpga_driver_init(void) +{ + pr_info("Canonlake Machine Driver cnl_svfpga: svfpga registered\n"); + return platform_driver_register(&snd_cnl_svfpga_mc_driver); +} +module_init(snd_cnl_svfpga_driver_init); + +static void snd_cnl_svfpga_driver_exit(void) +{ + pr_debug("In %s\n", __func__); + platform_driver_unregister(&snd_cnl_svfpga_mc_driver); +} +module_exit(snd_cnl_svfpga_driver_exit) + +MODULE_DESCRIPTION("ASoC CNL Machine driver"); +MODULE_AUTHOR("Hardik Shah "); +MODULE_LICENSE("GPL v2"); +MODULE_ALIAS("platform:cnl_svfpga"); -- https://clearlinux.org