1 // SPDX-License-Identifier: GPL-2.0
2 //
3 // CS42L43 CODEC driver SoundWire handling
4 //
5 // Copyright (C) 2022-2023 Cirrus Logic, Inc. and
6 // Cirrus Logic International Semiconductor Ltd.
7
8 #include <linux/errno.h>
9 #include <linux/mfd/cs42l43.h>
10 #include <linux/mfd/cs42l43-regs.h>
11 #include <linux/module.h>
12 #include <sound/pcm.h>
13 #include <sound/sdw.h>
14 #include <sound/soc-component.h>
15 #include <sound/soc-dai.h>
16 #include <sound/soc.h>
17
18 #include "cs42l43.h"
19
cs42l43_sdw_add_peripheral(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * params,struct snd_soc_dai * dai)20 int cs42l43_sdw_add_peripheral(struct snd_pcm_substream *substream,
21 struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)
22 {
23 struct cs42l43_codec *priv = snd_soc_component_get_drvdata(dai->component);
24 struct sdw_stream_runtime *sdw_stream = snd_soc_dai_get_dma_data(dai, substream);
25 struct sdw_slave *sdw = dev_to_sdw_dev(priv->dev->parent);
26 struct sdw_stream_config sconfig = {0};
27 struct sdw_port_config pconfig = {0};
28 int ret;
29
30 if (!sdw_stream)
31 return -EINVAL;
32
33 snd_sdw_params_to_config(substream, params, &sconfig, &pconfig);
34
35 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
36 pconfig.num = dai->id;
37 else
38 pconfig.num = dai->id;
39
40 ret = sdw_stream_add_slave(sdw, &sconfig, &pconfig, 1, sdw_stream);
41 if (ret) {
42 dev_err(priv->dev, "Failed to add sdw stream: %d\n", ret);
43 return ret;
44 }
45
46 return 0;
47 }
48 EXPORT_SYMBOL_NS_GPL(cs42l43_sdw_add_peripheral, SND_SOC_CS42L43);
49
cs42l43_sdw_remove_peripheral(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)50 int cs42l43_sdw_remove_peripheral(struct snd_pcm_substream *substream,
51 struct snd_soc_dai *dai)
52 {
53 struct cs42l43_codec *priv = snd_soc_component_get_drvdata(dai->component);
54 struct sdw_stream_runtime *sdw_stream = snd_soc_dai_get_dma_data(dai, substream);
55 struct sdw_slave *sdw = dev_to_sdw_dev(priv->dev->parent);
56
57 if (!sdw_stream)
58 return -EINVAL;
59
60 return sdw_stream_remove_slave(sdw, sdw_stream);
61 }
62 EXPORT_SYMBOL_NS_GPL(cs42l43_sdw_remove_peripheral, SND_SOC_CS42L43);
63
cs42l43_sdw_set_stream(struct snd_soc_dai * dai,void * sdw_stream,int direction)64 int cs42l43_sdw_set_stream(struct snd_soc_dai *dai, void *sdw_stream, int direction)
65 {
66 snd_soc_dai_dma_data_set(dai, direction, sdw_stream);
67
68 return 0;
69 }
70 EXPORT_SYMBOL_NS_GPL(cs42l43_sdw_set_stream, SND_SOC_CS42L43);
71
72 MODULE_DESCRIPTION("CS42L43 CODEC SoundWire Driver");
73 MODULE_AUTHOR("Charles Keepax <ckeepax@opensource.cirrus.com>");
74 MODULE_LICENSE("GPL");
75