a4cf7e3c06
Separate firmware loading part into a new function. Signed-off-by: Vikash Garodia <vgarodia@codeaurora.org> Acked-by: Stanimir Varbanov <stanimir.varbanov@linaro.org> Reviewed-by: Alexandre Courbot <acourbot@chromium.org> Tested-by: Alexandre Courbot <acourbot@chromium.org> Signed-off-by: Hans Verkuil <hverkuil-cisco@xs4all.nl> Signed-off-by: Mauro Carvalho Chehab <mchehab+samsung@kernel.org>
147 lines
3.5 KiB
C
147 lines
3.5 KiB
C
/*
|
|
* Copyright (C) 2017 Linaro Ltd.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 and
|
|
* only version 2 as published by the Free Software Foundation.
|
|
*
|
|
* 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/device.h>
|
|
#include <linux/firmware.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/io.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of_address.h>
|
|
#include <linux/qcom_scm.h>
|
|
#include <linux/sizes.h>
|
|
#include <linux/soc/qcom/mdt_loader.h>
|
|
|
|
#include "core.h"
|
|
#include "firmware.h"
|
|
#include "hfi_venus_io.h"
|
|
|
|
#define VENUS_PAS_ID 9
|
|
#define VENUS_FW_MEM_SIZE (6 * SZ_1M)
|
|
#define VENUS_FW_START_ADDR 0x0
|
|
|
|
static void venus_reset_cpu(struct venus_core *core)
|
|
{
|
|
void __iomem *base = core->base;
|
|
|
|
writel(0, base + WRAPPER_FW_START_ADDR);
|
|
writel(VENUS_FW_MEM_SIZE, base + WRAPPER_FW_END_ADDR);
|
|
writel(0, base + WRAPPER_CPA_START_ADDR);
|
|
writel(VENUS_FW_MEM_SIZE, base + WRAPPER_CPA_END_ADDR);
|
|
writel(VENUS_FW_MEM_SIZE, base + WRAPPER_NONPIX_START_ADDR);
|
|
writel(VENUS_FW_MEM_SIZE, base + WRAPPER_NONPIX_END_ADDR);
|
|
writel(0x0, base + WRAPPER_CPU_CGC_DIS);
|
|
writel(0x0, base + WRAPPER_CPU_CLOCK_CONFIG);
|
|
|
|
/* Bring ARM9 out of reset */
|
|
writel(0, base + WRAPPER_A9SS_SW_RESET);
|
|
}
|
|
|
|
int venus_set_hw_state(struct venus_core *core, bool resume)
|
|
{
|
|
if (core->use_tz)
|
|
return qcom_scm_set_remote_state(resume, 0);
|
|
|
|
if (resume)
|
|
venus_reset_cpu(core);
|
|
else
|
|
writel(1, core->base + WRAPPER_A9SS_SW_RESET);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int venus_load_fw(struct venus_core *core, const char *fwname,
|
|
phys_addr_t *mem_phys, size_t *mem_size)
|
|
{
|
|
const struct firmware *mdt;
|
|
struct device_node *node;
|
|
struct device *dev;
|
|
struct resource r;
|
|
ssize_t fw_size;
|
|
void *mem_va;
|
|
int ret;
|
|
|
|
dev = core->dev;
|
|
node = of_parse_phandle(dev->of_node, "memory-region", 0);
|
|
if (!node) {
|
|
dev_err(dev, "no memory-region specified\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
ret = of_address_to_resource(node, 0, &r);
|
|
if (ret)
|
|
return ret;
|
|
|
|
*mem_phys = r.start;
|
|
*mem_size = resource_size(&r);
|
|
|
|
if (*mem_size < VENUS_FW_MEM_SIZE)
|
|
return -EINVAL;
|
|
|
|
mem_va = memremap(r.start, *mem_size, MEMREMAP_WC);
|
|
if (!mem_va) {
|
|
dev_err(dev, "unable to map memory region: %pa+%zx\n",
|
|
&r.start, *mem_size);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
ret = request_firmware(&mdt, fwname, dev);
|
|
if (ret < 0)
|
|
goto err_unmap;
|
|
|
|
fw_size = qcom_mdt_get_size(mdt);
|
|
if (fw_size < 0) {
|
|
ret = fw_size;
|
|
release_firmware(mdt);
|
|
goto err_unmap;
|
|
}
|
|
|
|
if (core->use_tz)
|
|
ret = qcom_mdt_load(dev, mdt, fwname, VENUS_PAS_ID,
|
|
mem_va, *mem_phys, *mem_size, NULL);
|
|
else
|
|
ret = qcom_mdt_load_no_init(dev, mdt, fwname, VENUS_PAS_ID,
|
|
mem_va, *mem_phys, *mem_size, NULL);
|
|
|
|
release_firmware(mdt);
|
|
|
|
err_unmap:
|
|
memunmap(mem_va);
|
|
return ret;
|
|
}
|
|
|
|
int venus_boot(struct venus_core *core)
|
|
{
|
|
struct device *dev = core->dev;
|
|
phys_addr_t mem_phys;
|
|
size_t mem_size;
|
|
int ret;
|
|
|
|
if (!IS_ENABLED(CONFIG_QCOM_MDT_LOADER) ||
|
|
(core->use_tz && !qcom_scm_is_available()))
|
|
return -EPROBE_DEFER;
|
|
|
|
ret = venus_load_fw(core, core->res->fwname, &mem_phys, &mem_size);
|
|
if (ret) {
|
|
dev_err(dev, "fail to load video firmware\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
return qcom_scm_pas_auth_and_reset(VENUS_PAS_ID);
|
|
}
|
|
|
|
int venus_shutdown(struct device *dev)
|
|
{
|
|
return qcom_scm_pas_shutdown(VENUS_PAS_ID);
|
|
}
|