cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

meson-codec-glue.c (3761B)

      1// SPDX-License-Identifier: GPL-2.0
      2//
      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 = NULL;
     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	dai->playback_dma_data = data;
     43}
     44
     45struct meson_codec_glue_input *
     46meson_codec_glue_input_get_data(struct snd_soc_dai *dai)
     47{
     48	return dai->playback_dma_data;
     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 = asoc_substream_to_rtd(substream);
    102	struct meson_codec_glue_input *in_data =
    103		meson_codec_glue_output_get_input_data(dai->capture_widget);
    104
    105	if (!in_data)
    106		return -ENODEV;
    107
    108	if (WARN_ON(!rtd->dai_link->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->params = &in_data->params;
    115
    116	return snd_soc_runtime_set_dai_fmt(rtd, in_data->fmt);
    117}
    118EXPORT_SYMBOL_GPL(meson_codec_glue_output_startup);
    119
    120int meson_codec_glue_input_dai_probe(struct snd_soc_dai *dai)
    121{
    122	struct meson_codec_glue_input *data;
    123
    124	data = kzalloc(sizeof(*data), GFP_KERNEL);
    125	if (!data)
    126		return -ENOMEM;
    127
    128	meson_codec_glue_input_set_data(dai, data);
    129	return 0;
    130}
    131EXPORT_SYMBOL_GPL(meson_codec_glue_input_dai_probe);
    132
    133int meson_codec_glue_input_dai_remove(struct snd_soc_dai *dai)
    134{
    135	struct meson_codec_glue_input *data =
    136		meson_codec_glue_input_get_data(dai);
    137
    138	kfree(data);
    139	return 0;
    140}
    141EXPORT_SYMBOL_GPL(meson_codec_glue_input_dai_remove);
    142
    143MODULE_AUTHOR("Jerome Brunet <jbrunet@baylibre.com>");
    144MODULE_DESCRIPTION("Amlogic Codec Glue Helpers");
    145MODULE_LICENSE("GPL v2");
    146