media: venus: firmware: move load firmware in a separate function
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>
This commit is contained in:
parent
5df317c878
commit
a4cf7e3c06
@ -84,7 +84,7 @@ static void venus_sys_error_handler(struct work_struct *work)
|
|||||||
|
|
||||||
pm_runtime_get_sync(core->dev);
|
pm_runtime_get_sync(core->dev);
|
||||||
|
|
||||||
ret |= venus_boot(core->dev, core->res->fwname);
|
ret |= venus_boot(core);
|
||||||
|
|
||||||
ret |= hfi_core_resume(core, true);
|
ret |= hfi_core_resume(core, true);
|
||||||
|
|
||||||
@ -284,7 +284,7 @@ static int venus_probe(struct platform_device *pdev)
|
|||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
goto err_runtime_disable;
|
goto err_runtime_disable;
|
||||||
|
|
||||||
ret = venus_boot(dev, core->res->fwname);
|
ret = venus_boot(core);
|
||||||
if (ret)
|
if (ret)
|
||||||
goto err_runtime_disable;
|
goto err_runtime_disable;
|
||||||
|
|
||||||
|
@ -60,20 +60,18 @@ int venus_set_hw_state(struct venus_core *core, bool resume)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
int venus_boot(struct device *dev, const char *fwname)
|
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;
|
const struct firmware *mdt;
|
||||||
struct device_node *node;
|
struct device_node *node;
|
||||||
phys_addr_t mem_phys;
|
struct device *dev;
|
||||||
struct resource r;
|
struct resource r;
|
||||||
ssize_t fw_size;
|
ssize_t fw_size;
|
||||||
size_t mem_size;
|
|
||||||
void *mem_va;
|
void *mem_va;
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
if (!IS_ENABLED(CONFIG_QCOM_MDT_LOADER) || !qcom_scm_is_available())
|
dev = core->dev;
|
||||||
return -EPROBE_DEFER;
|
|
||||||
|
|
||||||
node = of_parse_phandle(dev->of_node, "memory-region", 0);
|
node = of_parse_phandle(dev->of_node, "memory-region", 0);
|
||||||
if (!node) {
|
if (!node) {
|
||||||
dev_err(dev, "no memory-region specified\n");
|
dev_err(dev, "no memory-region specified\n");
|
||||||
@ -84,16 +82,16 @@ int venus_boot(struct device *dev, const char *fwname)
|
|||||||
if (ret)
|
if (ret)
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
mem_phys = r.start;
|
*mem_phys = r.start;
|
||||||
mem_size = resource_size(&r);
|
*mem_size = resource_size(&r);
|
||||||
|
|
||||||
if (mem_size < VENUS_FW_MEM_SIZE)
|
if (*mem_size < VENUS_FW_MEM_SIZE)
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
|
|
||||||
mem_va = memremap(r.start, mem_size, MEMREMAP_WC);
|
mem_va = memremap(r.start, *mem_size, MEMREMAP_WC);
|
||||||
if (!mem_va) {
|
if (!mem_va) {
|
||||||
dev_err(dev, "unable to map memory region: %pa+%zx\n",
|
dev_err(dev, "unable to map memory region: %pa+%zx\n",
|
||||||
&r.start, mem_size);
|
&r.start, *mem_size);
|
||||||
return -ENOMEM;
|
return -ENOMEM;
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -108,23 +106,40 @@ int venus_boot(struct device *dev, const char *fwname)
|
|||||||
goto err_unmap;
|
goto err_unmap;
|
||||||
}
|
}
|
||||||
|
|
||||||
ret = qcom_mdt_load(dev, mdt, fwname, VENUS_PAS_ID, mem_va, mem_phys,
|
if (core->use_tz)
|
||||||
mem_size, NULL);
|
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);
|
release_firmware(mdt);
|
||||||
|
|
||||||
if (ret)
|
|
||||||
goto err_unmap;
|
|
||||||
|
|
||||||
ret = qcom_scm_pas_auth_and_reset(VENUS_PAS_ID);
|
|
||||||
if (ret)
|
|
||||||
goto err_unmap;
|
|
||||||
|
|
||||||
err_unmap:
|
err_unmap:
|
||||||
memunmap(mem_va);
|
memunmap(mem_va);
|
||||||
return ret;
|
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)
|
int venus_shutdown(struct device *dev)
|
||||||
{
|
{
|
||||||
return qcom_scm_pas_shutdown(VENUS_PAS_ID);
|
return qcom_scm_pas_shutdown(VENUS_PAS_ID);
|
||||||
|
@ -16,7 +16,7 @@
|
|||||||
|
|
||||||
struct device;
|
struct device;
|
||||||
|
|
||||||
int venus_boot(struct device *dev, const char *fwname);
|
int venus_boot(struct venus_core *core);
|
||||||
int venus_shutdown(struct device *dev);
|
int venus_shutdown(struct device *dev);
|
||||||
int venus_set_hw_state(struct venus_core *core, bool suspend);
|
int venus_set_hw_state(struct venus_core *core, bool suspend);
|
||||||
|
|
||||||
|
Loading…
x
Reference in New Issue
Block a user