123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150 |
- // SPDX-License-Identifier: GPL-2.0-only
- /*
- * Copyright (c) 2020-2021, The Linux Foundation. All rights reserved.
- */
- #include <linux/of.h>
- #include <linux/pm_qos.h>
- #include <linux/platform_device.h>
- #include <linux/qcom_scm.h>
- #include "msm_cvp_debug.h"
- #include "cvp_comm_def.h"
- #include "cvp_core_hfi.h"
- #include "cvp_hfi.h"
- #include <linux/of_address.h>
- #include <linux/firmware.h>
- #include <linux/soc/qcom/mdt_loader.h>
- #include "cvp_dump.h"
- #define MAX_FIRMWARE_NAME_SIZE 128
- static int __load_fw_to_memory(struct platform_device *pdev,
- const char *fw_name)
- {
- int rc = 0;
- const struct firmware *firmware = NULL;
- char firmware_name[MAX_FIRMWARE_NAME_SIZE] = {0};
- struct device_node *node = NULL;
- struct resource res = {0};
- phys_addr_t phys = 0;
- size_t res_size = 0;
- ssize_t fw_size = 0;
- void *virt = NULL;
- int pas_id = 0;
- if (!fw_name || !(*fw_name) || !pdev) {
- dprintk(CVP_ERR, "%s: Invalid inputs\n", __func__);
- return -EINVAL;
- }
- if (strlen(fw_name) >= MAX_FIRMWARE_NAME_SIZE - 4) {
- dprintk(CVP_ERR, "%s: Invalid fw name\n", __func__);
- return -EINVAL;
- }
- scnprintf(firmware_name, ARRAY_SIZE(firmware_name), "%s.mbn", fw_name);
- rc = of_property_read_u32(pdev->dev.of_node, "pas-id", &pas_id);
- if (rc) {
- dprintk(CVP_ERR,
- "%s: error %d while reading DT for \"pas-id\"\n",
- __func__, rc);
- goto exit;
- }
- node = of_parse_phandle(pdev->dev.of_node, "memory-region", 0);
- if (!node) {
- dprintk(CVP_ERR,
- "%s: DT error getting \"memory-region\" property\n",
- __func__);
- return -EINVAL;
- }
- rc = of_address_to_resource(node, 0, &res);
- if (rc) {
- dprintk(CVP_ERR,
- "%s: error %d getting \"memory-region\" resource\n",
- __func__, rc);
- goto exit;
- }
- phys = res.start;
- res_size = (size_t)resource_size(&res);
- rc = request_firmware(&firmware, firmware_name, &pdev->dev);
- if (rc) {
- dprintk(CVP_ERR, "%s: error %d requesting \"%s\"\n",
- __func__, rc, firmware_name);
- goto exit;
- }
- fw_size = qcom_mdt_get_size(firmware);
- if (fw_size < 0 || res_size < (size_t)fw_size) {
- rc = -EINVAL;
- dprintk(CVP_ERR,
- "%s: Corrupted fw image. Alloc size: %lu, fw size: %ld",
- __func__, res_size, fw_size);
- goto exit;
- }
- virt = memremap(phys, res_size, MEMREMAP_WC);
- if (!virt) {
- rc = -ENOMEM;
- dprintk(CVP_ERR, "%s: unable to remap firmware memory\n",
- __func__);
- goto exit;
- }
- rc = qcom_mdt_load(&pdev->dev, firmware, firmware_name,
- pas_id, virt, phys, res_size, NULL);
- if (rc) {
- dprintk(CVP_ERR, "%s: error %d loading \"%s\"\n",
- __func__, rc, firmware_name);
- goto exit;
- }
- rc = qcom_scm_pas_auth_and_reset(pas_id);
- if (rc) {
- dprintk(CVP_ERR, "%s: error %d authenticating \"%s\"\n",
- __func__, rc, firmware_name);
- goto exit;
- }
- rc = md_eva_dump("evafwdata", (uintptr_t)virt, phys, EVAFW_IMAGE_SIZE);
- if (rc) {
- dprintk(CVP_ERR, "%s: error %d in dumping \"%s\"\n",
- __func__, rc, firmware_name);
- }
- memunmap(virt);
- release_firmware(firmware);
- dprintk(CVP_CORE, "%s: firmware \"%s\" loaded successfully\n",
- __func__, firmware_name);
- return pas_id;
- exit:
- if (virt)
- memunmap(virt);
- if (firmware)
- release_firmware(firmware);
- return rc;
- }
- int load_cvp_fw_impl(struct iris_hfi_device *device)
- {
- int rc = 0;
- if (!device->resources.fw.cookie) {
- device->resources.fw.cookie =
- __load_fw_to_memory(device->res->pdev,
- device->res->fw_name);
- if (device->resources.fw.cookie <= 0) {
- dprintk(CVP_ERR, "Failed to download firmware\n");
- device->resources.fw.cookie = 0;
- rc = -ENOMEM;
- }
- }
- return rc;
- }
- int unload_cvp_fw_impl(struct iris_hfi_device *device)
- {
- qcom_scm_pas_shutdown(device->resources.fw.cookie);
- device->resources.fw.cookie = 0;
- return 0;
- }
|