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

mtk-afe-platform-driver.c (3934B)

      1// SPDX-License-Identifier: GPL-2.0
      2/*
      3 * mtk-afe-platform-driver.c  --  Mediatek afe platform driver
      4 *
      5 * Copyright (c) 2016 MediaTek Inc.
      6 * Author: Garlic Tseng <garlic.tseng@mediatek.com>
      7 */
      8
      9#include <linux/module.h>
     10#include <linux/dma-mapping.h>
     11#include <sound/soc.h>
     12
     13#include "mtk-afe-platform-driver.h"
     14#include "mtk-base-afe.h"
     15
     16int mtk_afe_combine_sub_dai(struct mtk_base_afe *afe)
     17{
     18	struct mtk_base_afe_dai *dai;
     19	size_t num_dai_drivers = 0, dai_idx = 0;
     20
     21	/* calcualte total dai driver size */
     22	list_for_each_entry(dai, &afe->sub_dais, list) {
     23		num_dai_drivers += dai->num_dai_drivers;
     24	}
     25
     26	dev_info(afe->dev, "%s(), num of dai %zd\n", __func__, num_dai_drivers);
     27
     28	/* combine sub_dais */
     29	afe->num_dai_drivers = num_dai_drivers;
     30	afe->dai_drivers = devm_kcalloc(afe->dev,
     31					num_dai_drivers,
     32					sizeof(struct snd_soc_dai_driver),
     33					GFP_KERNEL);
     34	if (!afe->dai_drivers)
     35		return -ENOMEM;
     36
     37	list_for_each_entry(dai, &afe->sub_dais, list) {
     38		/* dai driver */
     39		memcpy(&afe->dai_drivers[dai_idx],
     40		       dai->dai_drivers,
     41		       dai->num_dai_drivers *
     42		       sizeof(struct snd_soc_dai_driver));
     43		dai_idx += dai->num_dai_drivers;
     44	}
     45	return 0;
     46}
     47EXPORT_SYMBOL_GPL(mtk_afe_combine_sub_dai);
     48
     49int mtk_afe_add_sub_dai_control(struct snd_soc_component *component)
     50{
     51	struct mtk_base_afe *afe = snd_soc_component_get_drvdata(component);
     52	struct mtk_base_afe_dai *dai;
     53
     54	list_for_each_entry(dai, &afe->sub_dais, list) {
     55		if (dai->controls)
     56			snd_soc_add_component_controls(component,
     57						       dai->controls,
     58						       dai->num_controls);
     59
     60		if (dai->dapm_widgets)
     61			snd_soc_dapm_new_controls(&component->dapm,
     62						  dai->dapm_widgets,
     63						  dai->num_dapm_widgets);
     64	}
     65	/* add routes after all widgets are added */
     66	list_for_each_entry(dai, &afe->sub_dais, list) {
     67		if (dai->dapm_routes)
     68			snd_soc_dapm_add_routes(&component->dapm,
     69						dai->dapm_routes,
     70						dai->num_dapm_routes);
     71	}
     72
     73	snd_soc_dapm_new_widgets(component->dapm.card);
     74
     75	return 0;
     76
     77}
     78EXPORT_SYMBOL_GPL(mtk_afe_add_sub_dai_control);
     79
     80snd_pcm_uframes_t mtk_afe_pcm_pointer(struct snd_soc_component *component,
     81				      struct snd_pcm_substream *substream)
     82{
     83	struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
     84	struct mtk_base_afe *afe = snd_soc_component_get_drvdata(component);
     85	struct mtk_base_afe_memif *memif = &afe->memif[asoc_rtd_to_cpu(rtd, 0)->id];
     86	const struct mtk_base_memif_data *memif_data = memif->data;
     87	struct regmap *regmap = afe->regmap;
     88	struct device *dev = afe->dev;
     89	int reg_ofs_base = memif_data->reg_ofs_base;
     90	int reg_ofs_cur = memif_data->reg_ofs_cur;
     91	unsigned int hw_ptr = 0, hw_base = 0;
     92	int ret, pcm_ptr_bytes;
     93
     94	ret = regmap_read(regmap, reg_ofs_cur, &hw_ptr);
     95	if (ret || hw_ptr == 0) {
     96		dev_err(dev, "%s hw_ptr err\n", __func__);
     97		pcm_ptr_bytes = 0;
     98		goto POINTER_RETURN_FRAMES;
     99	}
    100
    101	ret = regmap_read(regmap, reg_ofs_base, &hw_base);
    102	if (ret || hw_base == 0) {
    103		dev_err(dev, "%s hw_ptr err\n", __func__);
    104		pcm_ptr_bytes = 0;
    105		goto POINTER_RETURN_FRAMES;
    106	}
    107
    108	pcm_ptr_bytes = hw_ptr - hw_base;
    109
    110POINTER_RETURN_FRAMES:
    111	return bytes_to_frames(substream->runtime, pcm_ptr_bytes);
    112}
    113EXPORT_SYMBOL_GPL(mtk_afe_pcm_pointer);
    114
    115int mtk_afe_pcm_new(struct snd_soc_component *component,
    116		    struct snd_soc_pcm_runtime *rtd)
    117{
    118	size_t size;
    119	struct snd_pcm *pcm = rtd->pcm;
    120	struct mtk_base_afe *afe = snd_soc_component_get_drvdata(component);
    121
    122	size = afe->mtk_afe_hardware->buffer_bytes_max;
    123	snd_pcm_set_managed_buffer_all(pcm, SNDRV_DMA_TYPE_DEV,
    124				       afe->dev, size, size);
    125	return 0;
    126}
    127EXPORT_SYMBOL_GPL(mtk_afe_pcm_new);
    128
    129const struct snd_soc_component_driver mtk_afe_pcm_platform = {
    130	.name		= AFE_PCM_NAME,
    131	.pointer	= mtk_afe_pcm_pointer,
    132	.pcm_construct	= mtk_afe_pcm_new,
    133};
    134EXPORT_SYMBOL_GPL(mtk_afe_pcm_platform);
    135
    136MODULE_DESCRIPTION("Mediatek simple platform driver");
    137MODULE_AUTHOR("Garlic Tseng <garlic.tseng@mediatek.com>");
    138MODULE_LICENSE("GPL v2");
    139