148 lines · c
1// SPDX-License-Identifier: GPL-2.02//3// Copyright (c) 2019 BayLibre, SAS.4// Author: Jerome Brunet <jbrunet@baylibre.com>5 6#include <linux/module.h>7#include <sound/pcm_params.h>8#include <sound/soc.h>9#include <sound/soc-dai.h>10 11#include "meson-codec-glue.h"12 13static struct snd_soc_dapm_widget *14meson_codec_glue_get_input(struct snd_soc_dapm_widget *w)15{16 struct snd_soc_dapm_path *p;17 struct snd_soc_dapm_widget *in;18 19 snd_soc_dapm_widget_for_each_source_path(w, p) {20 if (!p->connect)21 continue;22 23 /* Check that we still are in the same component */24 if (snd_soc_dapm_to_component(w->dapm) !=25 snd_soc_dapm_to_component(p->source->dapm))26 continue;27 28 if (p->source->id == snd_soc_dapm_dai_in)29 return p->source;30 31 in = meson_codec_glue_get_input(p->source);32 if (in)33 return in;34 }35 36 return NULL;37}38 39static void meson_codec_glue_input_set_data(struct snd_soc_dai *dai,40 struct meson_codec_glue_input *data)41{42 snd_soc_dai_dma_data_set_playback(dai, data);43}44 45struct meson_codec_glue_input *46meson_codec_glue_input_get_data(struct snd_soc_dai *dai)47{48 return snd_soc_dai_dma_data_get_playback(dai);49}50EXPORT_SYMBOL_GPL(meson_codec_glue_input_get_data);51 52static struct meson_codec_glue_input *53meson_codec_glue_output_get_input_data(struct snd_soc_dapm_widget *w)54{55 struct snd_soc_dapm_widget *in =56 meson_codec_glue_get_input(w);57 struct snd_soc_dai *dai;58 59 if (WARN_ON(!in))60 return NULL;61 62 dai = in->priv;63 64 return meson_codec_glue_input_get_data(dai);65}66 67int meson_codec_glue_input_hw_params(struct snd_pcm_substream *substream,68 struct snd_pcm_hw_params *params,69 struct snd_soc_dai *dai)70{71 struct meson_codec_glue_input *data =72 meson_codec_glue_input_get_data(dai);73 74 data->params.rates = snd_pcm_rate_to_rate_bit(params_rate(params));75 data->params.rate_min = params_rate(params);76 data->params.rate_max = params_rate(params);77 data->params.formats = 1ULL << (__force int) params_format(params);78 data->params.channels_min = params_channels(params);79 data->params.channels_max = params_channels(params);80 data->params.sig_bits = dai->driver->playback.sig_bits;81 82 return 0;83}84EXPORT_SYMBOL_GPL(meson_codec_glue_input_hw_params);85 86int meson_codec_glue_input_set_fmt(struct snd_soc_dai *dai,87 unsigned int fmt)88{89 struct meson_codec_glue_input *data =90 meson_codec_glue_input_get_data(dai);91 92 /* Save the source stream format for the downstream link */93 data->fmt = fmt;94 return 0;95}96EXPORT_SYMBOL_GPL(meson_codec_glue_input_set_fmt);97 98int meson_codec_glue_output_startup(struct snd_pcm_substream *substream,99 struct snd_soc_dai *dai)100{101 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);102 struct snd_soc_dapm_widget *w = snd_soc_dai_get_widget_capture(dai);103 struct meson_codec_glue_input *in_data = meson_codec_glue_output_get_input_data(w);104 105 if (!in_data)106 return -ENODEV;107 108 if (WARN_ON(!rtd->dai_link->c2c_params)) {109 dev_warn(dai->dev, "codec2codec link expected\n");110 return -EINVAL;111 }112 113 /* Replace link params with the input params */114 rtd->dai_link->c2c_params = &in_data->params;115 rtd->dai_link->num_c2c_params = 1;116 117 return snd_soc_runtime_set_dai_fmt(rtd, in_data->fmt);118}119EXPORT_SYMBOL_GPL(meson_codec_glue_output_startup);120 121int meson_codec_glue_input_dai_probe(struct snd_soc_dai *dai)122{123 struct meson_codec_glue_input *data;124 125 data = kzalloc(sizeof(*data), GFP_KERNEL);126 if (!data)127 return -ENOMEM;128 129 meson_codec_glue_input_set_data(dai, data);130 return 0;131}132EXPORT_SYMBOL_GPL(meson_codec_glue_input_dai_probe);133 134int meson_codec_glue_input_dai_remove(struct snd_soc_dai *dai)135{136 struct meson_codec_glue_input *data =137 meson_codec_glue_input_get_data(dai);138 139 kfree(data);140 return 0;141}142EXPORT_SYMBOL_GPL(meson_codec_glue_input_dai_remove);143 144MODULE_AUTHOR("Jerome Brunet <jbrunet@baylibre.com>");145MODULE_DESCRIPTION("Amlogic Codec Glue Helpers");146MODULE_LICENSE("GPL v2");147 148