forked from torvalds/linux
-
Notifications
You must be signed in to change notification settings - Fork 14
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
ASoC: Intel: avs: Add ssm4567 machine board
To support AVS-ssm4567 configuration add machine board connecting AVS platform component driver with ssm4567 codec one. Signed-off-by: Amadeusz Sławiński <amadeuszx.slawinski@linux.intel.com> Signed-off-by: Cezary Rojewski <cezary.rojewski@intel.com> Link: https://lore.kernel.org/r/20220511162403.3987658-12-cezary.rojewski@intel.com Signed-off-by: Mark Brown <broonie@kernel.org>
- Loading branch information
1 parent
32ee40b
commit 69ea14e
Showing
3 changed files
with
284 additions
and
0 deletions.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,271 @@ | ||
// SPDX-License-Identifier: GPL-2.0-only | ||
// | ||
// Copyright(c) 2021-2022 Intel Corporation. All rights reserved. | ||
// | ||
// Authors: Cezary Rojewski <cezary.rojewski@intel.com> | ||
// Amadeusz Slawinski <amadeuszx.slawinski@linux.intel.com> | ||
// | ||
|
||
#include <linux/module.h> | ||
#include <linux/platform_device.h> | ||
#include <sound/core.h> | ||
#include <sound/pcm.h> | ||
#include <sound/pcm_params.h> | ||
#include <sound/soc.h> | ||
#include <sound/soc-acpi.h> | ||
#include "../../../codecs/nau8825.h" | ||
|
||
#define SKL_NUVOTON_CODEC_DAI "nau8825-hifi" | ||
#define SKL_SSM_CODEC_DAI "ssm4567-hifi" | ||
|
||
static struct snd_soc_codec_conf card_codec_conf[] = { | ||
{ | ||
.dlc = COMP_CODEC_CONF("i2c-INT343B:00"), | ||
.name_prefix = "Left", | ||
}, | ||
{ | ||
.dlc = COMP_CODEC_CONF("i2c-INT343B:01"), | ||
.name_prefix = "Right", | ||
}, | ||
}; | ||
|
||
static const struct snd_kcontrol_new card_controls[] = { | ||
SOC_DAPM_PIN_SWITCH("Left Speaker"), | ||
SOC_DAPM_PIN_SWITCH("Right Speaker"), | ||
}; | ||
|
||
static int | ||
platform_clock_control(struct snd_soc_dapm_widget *w, struct snd_kcontrol *control, int event) | ||
{ | ||
struct snd_soc_dapm_context *dapm = w->dapm; | ||
struct snd_soc_card *card = dapm->card; | ||
struct snd_soc_dai *codec_dai; | ||
int ret; | ||
|
||
codec_dai = snd_soc_card_get_codec_dai(card, SKL_NUVOTON_CODEC_DAI); | ||
if (!codec_dai) { | ||
dev_err(card->dev, "Codec dai not found\n"); | ||
return -EINVAL; | ||
} | ||
|
||
if (SND_SOC_DAPM_EVENT_ON(event)) { | ||
ret = snd_soc_dai_set_sysclk(codec_dai, NAU8825_CLK_MCLK, 24000000, | ||
SND_SOC_CLOCK_IN); | ||
if (ret < 0) | ||
dev_err(card->dev, "set sysclk err = %d\n", ret); | ||
} else { | ||
ret = snd_soc_dai_set_sysclk(codec_dai, NAU8825_CLK_INTERNAL, 0, SND_SOC_CLOCK_IN); | ||
if (ret < 0) | ||
dev_err(card->dev, "set sysclk err = %d\n", ret); | ||
} | ||
|
||
return ret; | ||
} | ||
|
||
static const struct snd_soc_dapm_widget card_widgets[] = { | ||
SND_SOC_DAPM_SPK("Left Speaker", NULL), | ||
SND_SOC_DAPM_SPK("Right Speaker", NULL), | ||
SND_SOC_DAPM_SPK("DP1", NULL), | ||
SND_SOC_DAPM_SPK("DP2", NULL), | ||
SND_SOC_DAPM_SUPPLY("Platform Clock", SND_SOC_NOPM, 0, 0, platform_clock_control, | ||
SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), | ||
}; | ||
|
||
static const struct snd_soc_dapm_route card_base_routes[] = { | ||
{"Left Speaker", NULL, "Left OUT"}, | ||
{"Right Speaker", NULL, "Right OUT"}, | ||
}; | ||
|
||
static int avs_ssm4567_codec_init(struct snd_soc_pcm_runtime *runtime) | ||
{ | ||
int ret; | ||
|
||
/* Slot 1 for left */ | ||
ret = snd_soc_dai_set_tdm_slot(asoc_rtd_to_codec(runtime, 0), 0x01, 0x01, 2, 48); | ||
if (ret < 0) | ||
return ret; | ||
|
||
/* Slot 2 for right */ | ||
ret = snd_soc_dai_set_tdm_slot(asoc_rtd_to_codec(runtime, 1), 0x02, 0x02, 2, 48); | ||
if (ret < 0) | ||
return ret; | ||
|
||
return 0; | ||
} | ||
|
||
static int | ||
avs_ssm4567_be_fixup(struct snd_soc_pcm_runtime *runrime, struct snd_pcm_hw_params *params) | ||
{ | ||
struct snd_interval *rate, *channels; | ||
struct snd_mask *fmt; | ||
|
||
rate = hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE); | ||
channels = hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS); | ||
fmt = hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT); | ||
|
||
/* The ADSP will covert the FE rate to 48k, stereo */ | ||
rate->min = rate->max = 48000; | ||
channels->min = channels->max = 2; | ||
|
||
/* set SSP0 to 24 bit */ | ||
snd_mask_none(fmt); | ||
snd_mask_set_format(fmt, SNDRV_PCM_FORMAT_S24_LE); | ||
return 0; | ||
} | ||
|
||
static int avs_create_dai_link(struct device *dev, const char *platform_name, int ssp_port, | ||
struct snd_soc_dai_link **dai_link) | ||
{ | ||
struct snd_soc_dai_link_component *platform; | ||
struct snd_soc_dai_link *dl; | ||
|
||
dl = devm_kzalloc(dev, sizeof(*dl), GFP_KERNEL); | ||
platform = devm_kzalloc(dev, sizeof(*platform), GFP_KERNEL); | ||
if (!dl || !platform) | ||
return -ENOMEM; | ||
|
||
platform->name = platform_name; | ||
|
||
dl->name = devm_kasprintf(dev, GFP_KERNEL, "SSP%d-Codec", ssp_port); | ||
dl->cpus = devm_kzalloc(dev, sizeof(*dl->cpus), GFP_KERNEL); | ||
dl->codecs = devm_kzalloc(dev, sizeof(*dl->codecs) * 2, GFP_KERNEL); | ||
if (!dl->name || !dl->cpus || !dl->codecs) | ||
return -ENOMEM; | ||
|
||
dl->cpus->dai_name = devm_kasprintf(dev, GFP_KERNEL, "SSP%d Pin", ssp_port); | ||
dl->codecs[0].name = devm_kasprintf(dev, GFP_KERNEL, "i2c-INT343B:00"); | ||
dl->codecs[0].dai_name = devm_kasprintf(dev, GFP_KERNEL, "ssm4567-hifi"); | ||
dl->codecs[1].name = devm_kasprintf(dev, GFP_KERNEL, "i2c-INT343B:01"); | ||
dl->codecs[1].dai_name = devm_kasprintf(dev, GFP_KERNEL, "ssm4567-hifi"); | ||
if (!dl->cpus->dai_name || !dl->codecs[0].name || !dl->codecs[0].dai_name || | ||
!dl->codecs[1].name || !dl->codecs[1].dai_name) | ||
return -ENOMEM; | ||
|
||
dl->num_cpus = 1; | ||
dl->num_codecs = 2; | ||
dl->platforms = platform; | ||
dl->num_platforms = 1; | ||
dl->id = 0; | ||
dl->dai_fmt = SND_SOC_DAIFMT_DSP_A | SND_SOC_DAIFMT_IB_NF | SND_SOC_DAIFMT_CBS_CFS; | ||
dl->init = avs_ssm4567_codec_init; | ||
dl->be_hw_params_fixup = avs_ssm4567_be_fixup; | ||
dl->nonatomic = 1; | ||
dl->no_pcm = 1; | ||
dl->dpcm_capture = 1; | ||
dl->dpcm_playback = 1; | ||
dl->ignore_pmdown_time = 1; | ||
|
||
*dai_link = dl; | ||
|
||
return 0; | ||
} | ||
|
||
static int avs_create_dapm_routes(struct device *dev, int ssp_port, | ||
struct snd_soc_dapm_route **routes, int *num_routes) | ||
{ | ||
struct snd_soc_dapm_route *dr; | ||
const int num_base = ARRAY_SIZE(card_base_routes); | ||
const int num_dr = num_base + 4; | ||
int idx; | ||
|
||
dr = devm_kcalloc(dev, num_dr, sizeof(*dr), GFP_KERNEL); | ||
if (!dr) | ||
return -ENOMEM; | ||
|
||
memcpy(dr, card_base_routes, num_base * sizeof(*dr)); | ||
|
||
idx = num_base; | ||
dr[idx].sink = devm_kasprintf(dev, GFP_KERNEL, "Left Playback"); | ||
dr[idx].source = devm_kasprintf(dev, GFP_KERNEL, "ssp%d Tx", ssp_port); | ||
if (!dr[idx].sink || !dr[idx].source) | ||
return -ENOMEM; | ||
|
||
idx++; | ||
dr[idx].sink = devm_kasprintf(dev, GFP_KERNEL, "Right Playback"); | ||
dr[idx].source = devm_kasprintf(dev, GFP_KERNEL, "ssp%d Tx", ssp_port); | ||
if (!dr[idx].sink || !dr[idx].source) | ||
return -ENOMEM; | ||
|
||
idx++; | ||
dr[idx].sink = devm_kasprintf(dev, GFP_KERNEL, "ssp%d Rx", ssp_port); | ||
dr[idx].source = devm_kasprintf(dev, GFP_KERNEL, "Left Capture Sense"); | ||
if (!dr[idx].sink || !dr[idx].source) | ||
return -ENOMEM; | ||
|
||
idx++; | ||
dr[idx].sink = devm_kasprintf(dev, GFP_KERNEL, "ssp%d Rx", ssp_port); | ||
dr[idx].source = devm_kasprintf(dev, GFP_KERNEL, "Right Capture Sense"); | ||
if (!dr[idx].sink || !dr[idx].source) | ||
return -ENOMEM; | ||
|
||
*routes = dr; | ||
*num_routes = num_dr; | ||
|
||
return 0; | ||
} | ||
|
||
static int avs_ssm4567_probe(struct platform_device *pdev) | ||
{ | ||
struct snd_soc_dapm_route *routes; | ||
struct snd_soc_dai_link *dai_link; | ||
struct snd_soc_acpi_mach *mach; | ||
struct snd_soc_card *card; | ||
struct device *dev = &pdev->dev; | ||
const char *pname; | ||
int num_routes, ssp_port, ret; | ||
|
||
mach = dev_get_platdata(dev); | ||
pname = mach->mach_params.platform; | ||
ssp_port = __ffs(mach->mach_params.i2s_link_mask); | ||
|
||
ret = avs_create_dai_link(dev, pname, ssp_port, &dai_link); | ||
if (ret) { | ||
dev_err(dev, "Failed to create dai link: %d", ret); | ||
return ret; | ||
} | ||
|
||
ret = avs_create_dapm_routes(dev, ssp_port, &routes, &num_routes); | ||
if (ret) { | ||
dev_err(dev, "Failed to create dapm routes: %d", ret); | ||
return ret; | ||
} | ||
|
||
card = devm_kzalloc(dev, sizeof(*card), GFP_KERNEL); | ||
if (!card) | ||
return -ENOMEM; | ||
|
||
card->name = "avs_ssm4567-adi"; | ||
card->dev = dev; | ||
card->owner = THIS_MODULE; | ||
card->dai_link = dai_link; | ||
card->num_links = 1; | ||
card->codec_conf = card_codec_conf; | ||
card->num_configs = ARRAY_SIZE(card_codec_conf); | ||
card->controls = card_controls; | ||
card->num_controls = ARRAY_SIZE(card_controls); | ||
card->dapm_widgets = card_widgets; | ||
card->num_dapm_widgets = ARRAY_SIZE(card_widgets); | ||
card->dapm_routes = routes; | ||
card->num_dapm_routes = num_routes; | ||
card->fully_routed = true; | ||
card->disable_route_checks = true; | ||
|
||
ret = snd_soc_fixup_dai_links_platform_name(card, pname); | ||
if (ret) | ||
return ret; | ||
|
||
return devm_snd_soc_register_card(dev, card); | ||
} | ||
|
||
static struct platform_driver avs_ssm4567_driver = { | ||
.probe = avs_ssm4567_probe, | ||
.driver = { | ||
.name = "avs_ssm4567", | ||
.pm = &snd_soc_pm_ops, | ||
}, | ||
}; | ||
|
||
module_platform_driver(avs_ssm4567_driver) | ||
|
||
MODULE_LICENSE("GPL"); | ||
MODULE_ALIAS("platform:avs_ssm4567"); |