258 lines
6.7 KiB
C
Executable file
258 lines
6.7 KiB
C
Executable file
// SPDX-License-Identifier: GPL-2.0
|
|
//
|
|
// Copyright (c) 2018 MediaTek Inc.
|
|
|
|
#include <linux/delay.h>
|
|
#include <linux/module.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of_address.h>
|
|
#include <linux/pm_runtime.h>
|
|
#include <sound/soc.h>
|
|
|
|
#include "mtk-dsp-platform-driver.h"
|
|
#include "mtk-base-dsp.h"
|
|
|
|
#include "mtk-dsp-common.h"
|
|
#include "mtk-dsp-mem-control.h"
|
|
#include "dsp-platform-mem-control.h"
|
|
|
|
#define SND_DSP_DTS_SIZE (4)
|
|
#define MTK_PCM_RATES (SNDRV_PCM_RATE_8000_48000 |\
|
|
SNDRV_PCM_RATE_88200 |\
|
|
SNDRV_PCM_RATE_96000 |\
|
|
SNDRV_PCM_RATE_176400 |\
|
|
SNDRV_PCM_RATE_192000)
|
|
|
|
#define MTK_PCM_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\
|
|
SNDRV_PCM_FMTBIT_S24_LE |\
|
|
SNDRV_PCM_FMTBIT_S32_LE)
|
|
|
|
static const struct snd_pcm_hardware audio_dsp_hardware = {
|
|
.info = (SNDRV_PCM_INFO_MMAP |
|
|
SNDRV_PCM_INFO_NO_PERIOD_WAKEUP |
|
|
SNDRV_PCM_INFO_INTERLEAVED |
|
|
SNDRV_PCM_INFO_RESUME |
|
|
SNDRV_PCM_INFO_MMAP_VALID),
|
|
.formats = (SNDRV_PCM_FMTBIT_S16_LE |
|
|
SNDRV_PCM_FMTBIT_S24_LE |
|
|
SNDRV_PCM_FMTBIT_S32_LE),
|
|
.rates = MTK_PCM_RATES,
|
|
.period_bytes_min = 256,
|
|
.period_bytes_max = 4 * 48 * 1024,
|
|
.periods_min = 2,
|
|
.periods_max = 4096,
|
|
.buffer_bytes_max = 4 * 48 * 1024,
|
|
.fifo_size = 0,
|
|
};
|
|
|
|
static char *dsp_task_dsp_name[AUDIO_TASK_DAI_NUM] = {
|
|
[AUDIO_TASK_VOIP_ID] = "mtk_dsp_voip",
|
|
[AUDIO_TASK_PRIMARY_ID] = "mtk_dsp_primary",
|
|
[AUDIO_TASK_OFFLOAD_ID] = "mtk_dsp_offload",
|
|
[AUDIO_TASK_DEEPBUFFER_ID] = "mtk_dsp_deep",
|
|
[AUDIO_TASK_PLAYBACK_ID] = "mtk_dsp_playback",
|
|
[AUDIO_TASK_MUSIC_ID] = "mtk_dsp_music",
|
|
[AUDIO_TASK_CAPTURE_UL1_ID] = "mtk_dsp_capture1",
|
|
[AUDIO_TASK_A2DP_ID] = "mtk_dsp_a2dp",
|
|
[AUDIO_TASK_BLEDL_ID] = "mtk_dsp_bledl",
|
|
[AUDIO_TASK_BLEUL_ID] = "mtk_dsp_bleul",
|
|
[AUDIO_TASK_DATAPROVIDER_ID] = "mtk_dsp_dataprovider",
|
|
[AUDIO_TASK_CALL_FINAL_ID] = "mtk_dsp_call_final",
|
|
[AUDIO_TASK_FAST_ID] = "mtk_dsp_fast",
|
|
[AUDIO_TASK_KTV_ID] = "mtk_dsp_ktv",
|
|
[AUDIO_TASK_CAPTURE_RAW_ID] = "mtk_dsp_capture_raw",
|
|
[AUDIO_TASK_FM_ADSP_ID] = "mtk_dsp_fm",
|
|
[AUDIO_TASK_UL_PROCESS_ID] = "mtk_dsp_ulproc",
|
|
[AUDIO_TASK_ECHO_REF_ID] = "mtk_dsp_echoref",
|
|
[AUDIO_TASK_ECHO_REF_DL_ID] = "mtk_dsp_echodl",
|
|
[AUDIO_TASK_USBDL_ID] = "mtk_dsp_usbdl",
|
|
[AUDIO_TASK_USBUL_ID] = "mtk_dsp_usbul",
|
|
[AUDIO_TASK_MDDL_ID] = "mtk_dsp_mddl",
|
|
[AUDIO_TASK_MDUL_ID] = "mtk_dsp_mdul",
|
|
};
|
|
|
|
static int dsp_runtime_suspend(struct device *dev)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static int dsp_runtime_resume(struct device *dev)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static int dsp_pcm_taskattr_init(struct platform_device *pdev)
|
|
{
|
|
struct mtk_adsp_task_attr task_attr;
|
|
struct mtk_base_dsp *dsp = platform_get_drvdata(pdev);
|
|
int ret = 0;
|
|
int dsp_id = 0;
|
|
pr_info("%s\n", __func__);
|
|
|
|
if (!dsp)
|
|
return -1;
|
|
|
|
if (pdev->dev.of_node) {
|
|
for (dsp_id = 0; dsp_id < AUDIO_TASK_DAI_NUM; dsp_id++) {
|
|
ret = of_property_read_u32_array(pdev->dev.of_node,
|
|
dsp_task_dsp_name[dsp_id],
|
|
(unsigned int *)&task_attr,
|
|
SND_DSP_DTS_SIZE);
|
|
if (ret != 0) {
|
|
pr_info("%s error dsp_id[%d]\n",
|
|
__func__, dsp_id);
|
|
continue;
|
|
}
|
|
set_task_attr(dsp_id,
|
|
ADSP_TASK_ATTR_DEFAULT,
|
|
task_attr.default_enable);
|
|
set_task_attr(dsp_id,
|
|
ADSP_TASK_ATTR_MEMDL,
|
|
task_attr.afe_memif_dl);
|
|
set_task_attr(dsp_id,
|
|
ADSP_TASK_ATTR_MEMUL,
|
|
task_attr.afe_memif_ul);
|
|
set_task_attr(dsp_id,
|
|
ADSP_TASK_ATTR_MEMREF,
|
|
task_attr.afe_memif_ref);
|
|
}
|
|
dump_all_task_attr();
|
|
|
|
/* get dsp version */
|
|
ret = of_property_read_u32(pdev->dev.of_node,
|
|
"mtk_dsp_ver",
|
|
&dsp->dsp_ver);
|
|
if (ret != 0)
|
|
pr_info("%s mtk_dsp_ver error\n", __func__);
|
|
|
|
ret = of_property_read_u32(pdev->dev.of_node,
|
|
"swdsp_smartpa_process_enable",
|
|
&(task_attr.spk_protect_in_dsp));
|
|
if (ret)
|
|
task_attr.spk_protect_in_dsp = 0;
|
|
set_task_attr(AUDIO_TASK_PLAYBACK_ID, ADSP_TASK_ATTR_SMARTPA,
|
|
task_attr.spk_protect_in_dsp);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int dsp_pcm_dev_probe(struct platform_device *pdev)
|
|
{
|
|
struct mtk_base_dsp *dsp;
|
|
int ret = 0;
|
|
struct device *dev;
|
|
|
|
dsp = devm_kzalloc(&pdev->dev, sizeof(struct mtk_base_dsp), GFP_KERNEL);
|
|
if (!dsp)
|
|
return -ENOMEM;
|
|
|
|
/* register dsp dai driver*/
|
|
dai_dsp_register(pdev, dsp);
|
|
dsp->mtk_dsp_hardware = &audio_dsp_hardware;
|
|
|
|
dsp->dev = &pdev->dev;
|
|
dev = dsp->dev;
|
|
|
|
dsp->runtime_resume = dsp_runtime_resume;
|
|
dsp->runtime_suspend = dsp_runtime_suspend;
|
|
|
|
dsp->request_dram_resource = dsp_dram_request;
|
|
dsp->release_dram_resource = dsp_dram_release;
|
|
|
|
dsp->dsp_ipi_ops.ipi_message_callback = mtk_dsp_pcm_ipi_recv;
|
|
dsp->dsp_ipi_ops.ipi_handler = mtk_dsp_handler;
|
|
|
|
platform_set_drvdata(pdev, dsp);
|
|
pm_runtime_enable(&pdev->dev);
|
|
|
|
if (pdev->dev.of_node) {
|
|
pr_info("%s of_node->name:%s fullname:%s\n", __func__,
|
|
pdev->dev.of_node->name, pdev->dev.of_node->full_name);
|
|
}
|
|
|
|
ret = snd_soc_register_component(&pdev->dev,
|
|
&mtk_dsp_pcm_platform, NULL, 0);
|
|
if (ret) {
|
|
dev_warn(&pdev->dev, "err_platform\n");
|
|
goto err_platform;
|
|
}
|
|
ret = devm_snd_soc_register_component(&pdev->dev,
|
|
dsp->component_driver,
|
|
dsp->dai_drivers,
|
|
dsp->num_dai_drivers);
|
|
|
|
set_ipi_recv_private((void *)dsp);
|
|
set_dsp_base((void *)dsp);
|
|
dsp_pcm_taskattr_init(pdev);
|
|
|
|
ret = init_mtk_adsp_dram_segment();
|
|
if (ret) {
|
|
pr_info("init_mtk_adsp_dram_segment fail\n");
|
|
goto err_platform;
|
|
}
|
|
dump_all_adsp_dram();
|
|
|
|
ret = mtk_adsp_init_gen_pool(dsp);
|
|
if (ret) {
|
|
pr_info("init_gen_pool fail\n");
|
|
goto err_platform;
|
|
}
|
|
|
|
/* set mpu with adsp common memory*/
|
|
if (get_mtk_enable_common_mem_mpu())
|
|
ret = set_mtk_adsp_mpu_sharedram(AUDIO_DSP_AFE_SHARE_MEM_ID);
|
|
if (ret)
|
|
pr_info("set_mtk_adsp_mpu_sharedram fail\n");
|
|
|
|
ret = mtk_init_adsp_audio_share_mem(dsp);
|
|
if (ret) {
|
|
pr_info("init share mem fail\n");
|
|
goto err_platform;
|
|
}
|
|
|
|
mtk_audio_register_notify();
|
|
|
|
return 0;
|
|
|
|
err_platform:
|
|
pr_err("%s\n", __func__);
|
|
snd_soc_unregister_component(&pdev->dev);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int dsp_pcm_dev_remove(struct platform_device *pdev)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static const struct of_device_id dsp_pcm_dt_match[] = {
|
|
{ .compatible = "mediatek,snd_audio_dsp", },
|
|
{},
|
|
};
|
|
MODULE_DEVICE_TABLE(of, dsp_pcm_dt_match);
|
|
|
|
static const struct dev_pm_ops audio_dsp_pm_ops = {
|
|
SET_RUNTIME_PM_OPS(dsp_runtime_suspend,
|
|
dsp_runtime_resume, NULL)
|
|
};
|
|
|
|
static struct platform_driver dsp_pcm_driver = {
|
|
.driver = {
|
|
.name = "snd_audio_dsp",
|
|
.owner = THIS_MODULE,
|
|
.of_match_table = dsp_pcm_dt_match,
|
|
#ifdef CONFIG_PM
|
|
.pm = &audio_dsp_pm_ops,
|
|
#endif
|
|
},
|
|
.probe = dsp_pcm_dev_probe,
|
|
.remove = dsp_pcm_dev_remove,
|
|
};
|
|
|
|
module_platform_driver(dsp_pcm_driver);
|
|
|
|
MODULE_DESCRIPTION("Mediatek ALSA SoC dsp platform driver for audio dsp");
|
|
MODULE_AUTHOR("Chipeng Chang <Chipeng.Chang@mediatek.com>");
|
|
MODULE_LICENSE("GPL v2");
|