195 lines · c
1// SPDX-License-Identifier: GPL-2.02// Copyright (c) 2020, Linaro Limited3 4#include <dt-bindings/sound/qcom,q6afe.h>5#include <linux/module.h>6#include <linux/platform_device.h>7#include <sound/soc.h>8#include <sound/soc-dapm.h>9#include <sound/pcm.h>10#include <linux/soundwire/sdw.h>11#include <sound/jack.h>12#include <linux/input-event-codes.h>13#include "qdsp6/q6afe.h"14#include "common.h"15#include "sdw.h"16 17#define DRIVER_NAME "sm8250"18#define MI2S_BCLK_RATE 153600019 20struct sm8250_snd_data {21 bool stream_prepared[AFE_PORT_MAX];22 struct snd_soc_card *card;23 struct sdw_stream_runtime *sruntime[AFE_PORT_MAX];24 struct snd_soc_jack jack;25 bool jack_setup;26};27 28static int sm8250_snd_init(struct snd_soc_pcm_runtime *rtd)29{30 struct sm8250_snd_data *data = snd_soc_card_get_drvdata(rtd->card);31 32 return qcom_snd_wcd_jack_setup(rtd, &data->jack, &data->jack_setup);33}34 35static int sm8250_be_hw_params_fixup(struct snd_soc_pcm_runtime *rtd,36 struct snd_pcm_hw_params *params)37{38 struct snd_interval *rate = hw_param_interval(params,39 SNDRV_PCM_HW_PARAM_RATE);40 struct snd_interval *channels = hw_param_interval(params,41 SNDRV_PCM_HW_PARAM_CHANNELS);42 43 rate->min = rate->max = 48000;44 channels->min = channels->max = 2;45 46 return 0;47}48 49static int sm8250_snd_startup(struct snd_pcm_substream *substream)50{51 unsigned int fmt = SND_SOC_DAIFMT_BP_FP;52 unsigned int codec_dai_fmt = SND_SOC_DAIFMT_BC_FC;53 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);54 struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0);55 struct snd_soc_dai *codec_dai = snd_soc_rtd_to_codec(rtd, 0);56 57 switch (cpu_dai->id) {58 case PRIMARY_MI2S_RX:59 codec_dai_fmt |= SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_I2S;60 snd_soc_dai_set_sysclk(cpu_dai,61 Q6AFE_LPASS_CLK_ID_PRI_MI2S_IBIT,62 MI2S_BCLK_RATE, SNDRV_PCM_STREAM_PLAYBACK);63 snd_soc_dai_set_fmt(cpu_dai, fmt);64 snd_soc_dai_set_fmt(codec_dai, codec_dai_fmt);65 break;66 case TERTIARY_MI2S_RX:67 codec_dai_fmt |= SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_I2S;68 snd_soc_dai_set_sysclk(cpu_dai,69 Q6AFE_LPASS_CLK_ID_TER_MI2S_IBIT,70 MI2S_BCLK_RATE, SNDRV_PCM_STREAM_PLAYBACK);71 snd_soc_dai_set_fmt(cpu_dai, fmt);72 snd_soc_dai_set_fmt(codec_dai, codec_dai_fmt);73 break;74 default:75 break;76 }77 78 return qcom_snd_sdw_startup(substream);79}80 81static void sm2450_snd_shutdown(struct snd_pcm_substream *substream)82{83 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);84 struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0);85 struct sm8250_snd_data *data = snd_soc_card_get_drvdata(rtd->card);86 struct sdw_stream_runtime *sruntime = data->sruntime[cpu_dai->id];87 88 data->sruntime[cpu_dai->id] = NULL;89 sdw_release_stream(sruntime);90}91 92static int sm8250_snd_hw_params(struct snd_pcm_substream *substream,93 struct snd_pcm_hw_params *params)94{95 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);96 struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0);97 struct sm8250_snd_data *pdata = snd_soc_card_get_drvdata(rtd->card);98 99 return qcom_snd_sdw_hw_params(substream, params, &pdata->sruntime[cpu_dai->id]);100}101 102static int sm8250_snd_prepare(struct snd_pcm_substream *substream)103{104 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);105 struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0);106 struct sm8250_snd_data *data = snd_soc_card_get_drvdata(rtd->card);107 struct sdw_stream_runtime *sruntime = data->sruntime[cpu_dai->id];108 109 return qcom_snd_sdw_prepare(substream, sruntime,110 &data->stream_prepared[cpu_dai->id]);111}112 113static int sm8250_snd_hw_free(struct snd_pcm_substream *substream)114{115 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);116 struct sm8250_snd_data *data = snd_soc_card_get_drvdata(rtd->card);117 struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0);118 struct sdw_stream_runtime *sruntime = data->sruntime[cpu_dai->id];119 120 return qcom_snd_sdw_hw_free(substream, sruntime,121 &data->stream_prepared[cpu_dai->id]);122}123 124static const struct snd_soc_ops sm8250_be_ops = {125 .startup = sm8250_snd_startup,126 .shutdown = sm2450_snd_shutdown,127 .hw_params = sm8250_snd_hw_params,128 .hw_free = sm8250_snd_hw_free,129 .prepare = sm8250_snd_prepare,130};131 132static void sm8250_add_be_ops(struct snd_soc_card *card)133{134 struct snd_soc_dai_link *link;135 int i;136 137 for_each_card_prelinks(card, i, link) {138 if (link->no_pcm == 1) {139 link->init = sm8250_snd_init;140 link->be_hw_params_fixup = sm8250_be_hw_params_fixup;141 link->ops = &sm8250_be_ops;142 }143 }144}145 146static int sm8250_platform_probe(struct platform_device *pdev)147{148 struct snd_soc_card *card;149 struct sm8250_snd_data *data;150 struct device *dev = &pdev->dev;151 int ret;152 153 card = devm_kzalloc(dev, sizeof(*card), GFP_KERNEL);154 if (!card)155 return -ENOMEM;156 157 card->owner = THIS_MODULE;158 /* Allocate the private data */159 data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);160 if (!data)161 return -ENOMEM;162 163 card->dev = dev;164 dev_set_drvdata(dev, card);165 snd_soc_card_set_drvdata(card, data);166 ret = qcom_snd_parse_of(card);167 if (ret)168 return ret;169 170 card->driver_name = DRIVER_NAME;171 sm8250_add_be_ops(card);172 return devm_snd_soc_register_card(dev, card);173}174 175static const struct of_device_id snd_sm8250_dt_match[] = {176 {.compatible = "qcom,sm8250-sndcard"},177 {.compatible = "qcom,qrb4210-rb2-sndcard"},178 {.compatible = "qcom,qrb5165-rb5-sndcard"},179 {}180};181 182MODULE_DEVICE_TABLE(of, snd_sm8250_dt_match);183 184static struct platform_driver snd_sm8250_driver = {185 .probe = sm8250_platform_probe,186 .driver = {187 .name = "snd-sm8250",188 .of_match_table = snd_sm8250_dt_match,189 },190};191module_platform_driver(snd_sm8250_driver);192MODULE_AUTHOR("Srinivas Kandagatla <srinivas.kandagatla@linaro.org");193MODULE_DESCRIPTION("SM8250 ASoC Machine Driver");194MODULE_LICENSE("GPL");195