forked from rrcarlosr/Jetpack
105 lines
2.8 KiB
C
105 lines
2.8 KiB
C
/*
|
|
* Copyright (C) 2015-2019, NVIDIA Corporation. All rights reserved.
|
|
*
|
|
* This software is licensed under the terms of the GNU General Public
|
|
* License version 2, as published by the Free Software Foundation, and
|
|
* may be copied, distributed, and modified under those terms.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
*/
|
|
|
|
#include <linux/platform_device.h>
|
|
#include <linux/tegra_nvadsp.h>
|
|
#include <linux/tegra-hsp.h>
|
|
#include <linux/irqchip/tegra-agic.h>
|
|
|
|
#include "dev.h"
|
|
#include "os.h"
|
|
|
|
static void nvadsp_dbell_handler(void *data)
|
|
{
|
|
struct platform_device *pdev = data;
|
|
struct device *dev = &pdev->dev;
|
|
|
|
dev_info(dev, "APE DBELL handler\n");
|
|
}
|
|
|
|
|
|
/* Function to return the ADMA page number (0 indexed) used by guest */
|
|
static int tegra_adma_query_dma_page(void)
|
|
{
|
|
struct device_node *np = NULL;
|
|
int adma_page = 0, ret = 0, i = 0;
|
|
|
|
static const char *compatible[] = {
|
|
"nvidia,tegra210-adma",
|
|
"nvidia,tegra210-adma-hv",
|
|
"nvidia,tegra186-adma",
|
|
"nvidia,tegra194-adma-hv",
|
|
NULL,
|
|
};
|
|
|
|
for (i = 0; compatible[i] != NULL; i++) {
|
|
np = of_find_compatible_node(NULL, NULL, compatible[i]);
|
|
if (np == NULL)
|
|
continue;
|
|
|
|
/*
|
|
* In DT, "adma-page" property is 1 indexed
|
|
* If property is present, update return value to be 0 indexed
|
|
* If property is absent, return default value as page 0
|
|
*/
|
|
ret = of_property_read_u32(np, "adma-page", &adma_page);
|
|
if (ret == 0)
|
|
adma_page = adma_page - 1;
|
|
|
|
break;
|
|
}
|
|
|
|
pr_info("%s: adma-page %d\n", __func__, adma_page);
|
|
return adma_page;
|
|
}
|
|
|
|
int nvadsp_os_t18x_init(struct platform_device *pdev)
|
|
{
|
|
struct device *dev = &pdev->dev;
|
|
struct nvadsp_drv_data *drv_data = platform_get_drvdata(pdev);
|
|
struct device_node *node = dev->of_node;
|
|
int ret, adma_ch_page, val = 0;
|
|
|
|
if (of_device_is_compatible(node, "nvidia,tegra18x-adsp-hv")) {
|
|
|
|
adma_ch_page = tegra_adma_query_dma_page();
|
|
|
|
/* Set ADSP to do decompression again */
|
|
val = ADSP_CONFIG_DECOMPRESS_EN << ADSP_CONFIG_DECOMPRESS_SHIFT;
|
|
|
|
/* Set ADSP to know its virtualized configuration */
|
|
val = val | (ADSP_CONFIG_VIRT_EN << ADSP_CONFIG_VIRT_SHIFT);
|
|
|
|
/* Encode DMA Page Bits with DMA page information */
|
|
val = val | (adma_ch_page << ADSP_CONFIG_DMA_PAGE_SHIFT);
|
|
|
|
/* Write to HWMBOX5 */
|
|
hwmbox_writel(val, drv_data->chip_data->hwmb.hwmbox5_reg);
|
|
|
|
/* Clear HWMBOX0 for ADSP Guest reset handling */
|
|
hwmbox_writel(0, drv_data->chip_data->hwmb.hwmbox0_reg);
|
|
|
|
return 0;
|
|
}
|
|
|
|
ret = tegra_hsp_db_add_handler(HSP_MASTER_APE,
|
|
nvadsp_dbell_handler, pdev);
|
|
if (ret) {
|
|
dev_err(dev, "failed to add HSP_MASTER_APE DB handler\n");
|
|
goto end;
|
|
}
|
|
end:
|
|
return ret;
|
|
}
|