1 /* 2 * mtk-afe-platform-driver.c -- Mediatek afe platform driver 3 * 4 * Copyright (c) 2016 MediaTek Inc. 5 * Author: Garlic Tseng <garlic.tseng@mediatek.com> 6 * 7 * This program is free software; you can redistribute it and/or modify 8 * it under the terms of the GNU General Public License version 2 and 9 * only version 2 as published by the Free Software Foundation. 10 * 11 * This program is distributed in the hope that it will be useful, 12 * but WITHOUT ANY WARRANTY; without even the implied warranty of 13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14 * GNU General Public License for more details. 15 */ 16 17 #include <linux/module.h> 18 #include <linux/dma-mapping.h> 19 #include <sound/soc.h> 20 21 #include "mtk-afe-platform-driver.h" 22 #include "mtk-base-afe.h" 23 24 static snd_pcm_uframes_t mtk_afe_pcm_pointer 25 (struct snd_pcm_substream *substream) 26 { 27 struct snd_soc_pcm_runtime *rtd = substream->private_data; 28 struct mtk_base_afe *afe = snd_soc_platform_get_drvdata(rtd->platform); 29 struct mtk_base_afe_memif *memif = &afe->memif[rtd->cpu_dai->id]; 30 const struct mtk_base_memif_data *memif_data = memif->data; 31 struct regmap *regmap = afe->regmap; 32 struct device *dev = afe->dev; 33 int reg_ofs_base = memif_data->reg_ofs_base; 34 int reg_ofs_cur = memif_data->reg_ofs_cur; 35 unsigned int hw_ptr = 0, hw_base = 0; 36 int ret, pcm_ptr_bytes; 37 38 ret = regmap_read(regmap, reg_ofs_cur, &hw_ptr); 39 if (ret || hw_ptr == 0) { 40 dev_err(dev, "%s hw_ptr err\n", __func__); 41 pcm_ptr_bytes = 0; 42 goto POINTER_RETURN_FRAMES; 43 } 44 45 ret = regmap_read(regmap, reg_ofs_base, &hw_base); 46 if (ret || hw_base == 0) { 47 dev_err(dev, "%s hw_ptr err\n", __func__); 48 pcm_ptr_bytes = 0; 49 goto POINTER_RETURN_FRAMES; 50 } 51 52 pcm_ptr_bytes = hw_ptr - hw_base; 53 54 POINTER_RETURN_FRAMES: 55 return bytes_to_frames(substream->runtime, pcm_ptr_bytes); 56 } 57 58 static const struct snd_pcm_ops mtk_afe_pcm_ops = { 59 .ioctl = snd_pcm_lib_ioctl, 60 .pointer = mtk_afe_pcm_pointer, 61 }; 62 63 static int mtk_afe_pcm_new(struct snd_soc_pcm_runtime *rtd) 64 { 65 size_t size; 66 struct snd_card *card = rtd->card->snd_card; 67 struct snd_pcm *pcm = rtd->pcm; 68 struct mtk_base_afe *afe = snd_soc_platform_get_drvdata(rtd->platform); 69 70 size = afe->mtk_afe_hardware->buffer_bytes_max; 71 return snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV, 72 card->dev, size, size); 73 } 74 75 static void mtk_afe_pcm_free(struct snd_pcm *pcm) 76 { 77 snd_pcm_lib_preallocate_free_for_all(pcm); 78 } 79 80 const struct snd_soc_platform_driver mtk_afe_pcm_platform = { 81 .ops = &mtk_afe_pcm_ops, 82 .pcm_new = mtk_afe_pcm_new, 83 .pcm_free = mtk_afe_pcm_free, 84 }; 85 EXPORT_SYMBOL_GPL(mtk_afe_pcm_platform); 86 87 MODULE_DESCRIPTION("Mediatek simple platform driver"); 88 MODULE_AUTHOR("Garlic Tseng <garlic.tseng@mediatek.com>"); 89 MODULE_LICENSE("GPL v2"); 90 91