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
iris_load_fw_to_memory(struct iris_core * core,const char * fw_name)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
iris_fw_load(struct iris_core * core)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
iris_fw_unload(struct iris_core * core)110 int iris_fw_unload(struct iris_core *core)
111 {
112 return qcom_scm_pas_shutdown(core->iris_platform_data->pas_id);
113 }
114
iris_set_hw_state(struct iris_core * core,bool resume)115 int iris_set_hw_state(struct iris_core *core, bool resume)
116 {
117 return qcom_scm_set_remote_state(resume, 0);
118 }
119