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 17 static 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 reserved_mem *rmem; 23 struct device_node *node; 24 phys_addr_t mem_phys; 25 size_t res_size; 26 ssize_t fw_size; 27 void *mem_virt; 28 int ret; 29 30 if (strlen(fw_name) >= MAX_FIRMWARE_NAME_SIZE - 4) 31 return -EINVAL; 32 33 node = of_parse_phandle(dev->of_node, "memory-region", 0); 34 if (!node) 35 return -EINVAL; 36 37 rmem = of_reserved_mem_lookup(node); 38 of_node_put(node); 39 if (!rmem) 40 return -EINVAL; 41 42 mem_phys = rmem->base; 43 res_size = rmem->size; 44 45 ret = request_firmware(&firmware, fw_name, dev); 46 if (ret) 47 return ret; 48 49 fw_size = qcom_mdt_get_size(firmware); 50 if (fw_size < 0 || res_size < (size_t)fw_size) { 51 ret = -EINVAL; 52 goto err_release_fw; 53 } 54 55 mem_virt = memremap(mem_phys, res_size, MEMREMAP_WC); 56 if (!mem_virt) { 57 ret = -ENOMEM; 58 goto err_release_fw; 59 } 60 61 ret = qcom_mdt_load(dev, firmware, fw_name, 62 pas_id, mem_virt, mem_phys, res_size, NULL); 63 if (ret) 64 goto err_mem_unmap; 65 66 ret = qcom_scm_pas_auth_and_reset(pas_id); 67 if (ret) 68 goto err_mem_unmap; 69 70 return ret; 71 72 err_mem_unmap: 73 memunmap(mem_virt); 74 err_release_fw: 75 release_firmware(firmware); 76 77 return ret; 78 } 79 80 int iris_fw_load(struct iris_core *core) 81 { 82 struct tz_cp_config *cp_config = core->iris_platform_data->tz_cp_config_data; 83 const char *fwpath = NULL; 84 int ret; 85 86 ret = of_property_read_string_index(core->dev->of_node, "firmware-name", 0, 87 &fwpath); 88 if (ret) 89 fwpath = core->iris_platform_data->fwname; 90 91 ret = iris_load_fw_to_memory(core, fwpath); 92 if (ret) { 93 dev_err(core->dev, "firmware download failed\n"); 94 return -ENOMEM; 95 } 96 97 ret = qcom_scm_mem_protect_video_var(cp_config->cp_start, 98 cp_config->cp_size, 99 cp_config->cp_nonpixel_start, 100 cp_config->cp_nonpixel_size); 101 if (ret) { 102 dev_err(core->dev, "protect memory failed\n"); 103 qcom_scm_pas_shutdown(core->iris_platform_data->pas_id); 104 return ret; 105 } 106 107 return ret; 108 } 109 110 int iris_fw_unload(struct iris_core *core) 111 { 112 return qcom_scm_pas_shutdown(core->iris_platform_data->pas_id); 113 } 114 115 int iris_set_hw_state(struct iris_core *core, bool resume) 116 { 117 return qcom_scm_set_remote_state(resume, 0); 118 } 119