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