iris_firmware.c

  1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 * Copyright (c) 2022-2024 Qualcomm Innovation Center, Inc. All rights reserved.
  4 */
  5
  6#include <linux/firmware.h>
  7#include <linux/firmware/qcom/qcom_scm.h>
  8#include <linux/of_address.h>
  9#include <linux/of_reserved_mem.h>
 10#include <linux/soc/qcom/mdt_loader.h>
 11
 12#include "iris_core.h"
 13#include "iris_firmware.h"
 14
 15#define MAX_FIRMWARE_NAME_SIZE	128
 16
 17static int iris_load_fw_to_memory(struct iris_core *core, const char *fw_name)
 18{
 19	u32 pas_id = core->iris_platform_data->pas_id;
 20	const struct firmware *firmware = NULL;
 21	struct device *dev = core->dev;
 22	struct resource res;
 23	phys_addr_t mem_phys;
 24	size_t res_size;
 25	ssize_t fw_size;
 26	void *mem_virt;
 27	int ret;
 28
 29	if (strlen(fw_name) >= MAX_FIRMWARE_NAME_SIZE - 4)
 30		return -EINVAL;
 31
 32	ret = of_reserved_mem_region_to_resource(dev->of_node, 0, &res);
 33	if (ret)
 34		return ret;
 35
 36	mem_phys = res.start;
 37	res_size = resource_size(&res);
 38
 39	ret = request_firmware(&firmware, fw_name, dev);
 40	if (ret)
 41		return ret;
 42
 43	fw_size = qcom_mdt_get_size(firmware);
 44	if (fw_size < 0 || res_size < (size_t)fw_size) {
 45		ret = -EINVAL;
 46		goto err_release_fw;
 47	}
 48
 49	mem_virt = memremap(mem_phys, res_size, MEMREMAP_WC);
 50	if (!mem_virt) {
 51		ret = -ENOMEM;
 52		goto err_release_fw;
 53	}
 54
 55	ret = qcom_mdt_load(dev, firmware, fw_name,
 56			    pas_id, mem_virt, mem_phys, res_size, NULL);
 57
 58	memunmap(mem_virt);
 59err_release_fw:
 60	release_firmware(firmware);
 61
 62	return ret;
 63}
 64
 65int iris_fw_load(struct iris_core *core)
 66{
 67	struct tz_cp_config *cp_config = core->iris_platform_data->tz_cp_config_data;
 68	const char *fwpath = NULL;
 69	int ret;
 70
 71	ret = of_property_read_string_index(core->dev->of_node, "firmware-name", 0,
 72					    &fwpath);
 73	if (ret)
 74		fwpath = core->iris_platform_data->fwname;
 75
 76	ret = iris_load_fw_to_memory(core, fwpath);
 77	if (ret) {
 78		dev_err(core->dev, "firmware download failed\n");
 79		return -ENOMEM;
 80	}
 81
 82	ret = qcom_scm_pas_auth_and_reset(core->iris_platform_data->pas_id);
 83	if (ret)  {
 84		dev_err(core->dev, "auth and reset failed: %d\n", ret);
 85		return ret;
 86	}
 87
 88	ret = qcom_scm_mem_protect_video_var(cp_config->cp_start,
 89					     cp_config->cp_size,
 90					     cp_config->cp_nonpixel_start,
 91					     cp_config->cp_nonpixel_size);
 92	if (ret) {
 93		dev_err(core->dev, "protect memory failed\n");
 94		qcom_scm_pas_shutdown(core->iris_platform_data->pas_id);
 95		return ret;
 96	}
 97
 98	return ret;
 99}
100
101int iris_fw_unload(struct iris_core *core)
102{
103	return qcom_scm_pas_shutdown(core->iris_platform_data->pas_id);
104}
105
106int iris_set_hw_state(struct iris_core *core, bool resume)
107{
108	return qcom_scm_set_remote_state(resume, 0);
109}