1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Copyright (C) IoT.bzh 2021 4 */ 5 6 #include <linux/limits.h> 7 #include <linux/module.h> 8 #include <linux/of.h> 9 #include <linux/of_reserved_mem.h> 10 #include <linux/platform_device.h> 11 #include <linux/pm_runtime.h> 12 #include <linux/remoteproc.h> 13 #include <linux/reset.h> 14 #include <linux/soc/renesas/rcar-rst.h> 15 16 #include "remoteproc_internal.h" 17 18 struct rcar_rproc { 19 struct reset_control *rst; 20 }; 21 22 static int rcar_rproc_mem_alloc(struct rproc *rproc, 23 struct rproc_mem_entry *mem) 24 { 25 struct device *dev = &rproc->dev; 26 void *va; 27 28 dev_dbg(dev, "map memory: %pa+%zx\n", &mem->dma, mem->len); 29 va = ioremap_wc(mem->dma, mem->len); 30 if (!va) { 31 dev_err(dev, "Unable to map memory region: %pa+%zx\n", 32 &mem->dma, mem->len); 33 return -ENOMEM; 34 } 35 36 /* Update memory entry va */ 37 mem->va = va; 38 39 return 0; 40 } 41 42 static int rcar_rproc_mem_release(struct rproc *rproc, 43 struct rproc_mem_entry *mem) 44 { 45 dev_dbg(&rproc->dev, "unmap memory: %pa\n", &mem->dma); 46 iounmap(mem->va); 47 48 return 0; 49 } 50 51 static int rcar_rproc_prepare(struct rproc *rproc) 52 { 53 struct device *dev = rproc->dev.parent; 54 struct device_node *np = dev->of_node; 55 struct of_phandle_iterator it; 56 struct rproc_mem_entry *mem; 57 struct reserved_mem *rmem; 58 u32 da; 59 60 /* Register associated reserved memory regions */ 61 of_phandle_iterator_init(&it, np, "memory-region", NULL, 0); 62 while (of_phandle_iterator_next(&it) == 0) { 63 64 rmem = of_reserved_mem_lookup(it.node); 65 if (!rmem) { 66 of_node_put(it.node); 67 dev_err(&rproc->dev, 68 "unable to acquire memory-region\n"); 69 return -EINVAL; 70 } 71 72 if (rmem->base > U32_MAX) { 73 of_node_put(it.node); 74 return -EINVAL; 75 } 76 77 /* No need to translate pa to da, R-Car use same map */ 78 da = rmem->base; 79 mem = rproc_mem_entry_init(dev, NULL, 80 rmem->base, 81 rmem->size, da, 82 rcar_rproc_mem_alloc, 83 rcar_rproc_mem_release, 84 it.node->name); 85 86 if (!mem) { 87 of_node_put(it.node); 88 return -ENOMEM; 89 } 90 91 rproc_add_carveout(rproc, mem); 92 } 93 94 return 0; 95 } 96 97 static int rcar_rproc_parse_fw(struct rproc *rproc, const struct firmware *fw) 98 { 99 int ret; 100 101 ret = rproc_elf_load_rsc_table(rproc, fw); 102 if (ret) 103 dev_info(&rproc->dev, "No resource table in elf\n"); 104 105 return 0; 106 } 107 108 static int rcar_rproc_start(struct rproc *rproc) 109 { 110 struct rcar_rproc *priv = rproc->priv; 111 int err; 112 113 if (!rproc->bootaddr) 114 return -EINVAL; 115 116 err = rcar_rst_set_rproc_boot_addr(rproc->bootaddr); 117 if (err) { 118 dev_err(&rproc->dev, "failed to set rproc boot addr\n"); 119 return err; 120 } 121 122 err = reset_control_deassert(priv->rst); 123 if (err) 124 dev_err(&rproc->dev, "failed to deassert reset\n"); 125 126 return err; 127 } 128 129 static int rcar_rproc_stop(struct rproc *rproc) 130 { 131 struct rcar_rproc *priv = rproc->priv; 132 int err; 133 134 err = reset_control_assert(priv->rst); 135 if (err) 136 dev_err(&rproc->dev, "failed to assert reset\n"); 137 138 return err; 139 } 140 141 static struct rproc_ops rcar_rproc_ops = { 142 .prepare = rcar_rproc_prepare, 143 .start = rcar_rproc_start, 144 .stop = rcar_rproc_stop, 145 .load = rproc_elf_load_segments, 146 .parse_fw = rcar_rproc_parse_fw, 147 .find_loaded_rsc_table = rproc_elf_find_loaded_rsc_table, 148 .sanity_check = rproc_elf_sanity_check, 149 .get_boot_addr = rproc_elf_get_boot_addr, 150 151 }; 152 153 static int rcar_rproc_probe(struct platform_device *pdev) 154 { 155 struct device *dev = &pdev->dev; 156 struct device_node *np = dev->of_node; 157 struct rcar_rproc *priv; 158 struct rproc *rproc; 159 int ret; 160 161 rproc = devm_rproc_alloc(dev, np->name, &rcar_rproc_ops, 162 NULL, sizeof(*priv)); 163 if (!rproc) 164 return -ENOMEM; 165 166 priv = rproc->priv; 167 168 priv->rst = devm_reset_control_get_exclusive(dev, NULL); 169 if (IS_ERR(priv->rst)) { 170 ret = PTR_ERR(priv->rst); 171 dev_err_probe(dev, ret, "fail to acquire rproc reset\n"); 172 return ret; 173 } 174 175 pm_runtime_enable(dev); 176 ret = pm_runtime_resume_and_get(dev); 177 if (ret) { 178 dev_err(dev, "failed to power up\n"); 179 return ret; 180 } 181 182 dev_set_drvdata(dev, rproc); 183 184 /* Manually start the rproc */ 185 rproc->auto_boot = false; 186 187 ret = devm_rproc_add(dev, rproc); 188 if (ret) { 189 dev_err(dev, "rproc_add failed\n"); 190 goto pm_disable; 191 } 192 193 return 0; 194 195 pm_disable: 196 pm_runtime_disable(dev); 197 198 return ret; 199 } 200 201 static void rcar_rproc_remove(struct platform_device *pdev) 202 { 203 struct device *dev = &pdev->dev; 204 205 pm_runtime_disable(dev); 206 } 207 208 static const struct of_device_id rcar_rproc_of_match[] = { 209 { .compatible = "renesas,rcar-cr7" }, 210 {}, 211 }; 212 213 MODULE_DEVICE_TABLE(of, rcar_rproc_of_match); 214 215 static struct platform_driver rcar_rproc_driver = { 216 .probe = rcar_rproc_probe, 217 .remove_new = rcar_rproc_remove, 218 .driver = { 219 .name = "rcar-rproc", 220 .of_match_table = rcar_rproc_of_match, 221 }, 222 }; 223 224 module_platform_driver(rcar_rproc_driver); 225 226 MODULE_LICENSE("GPL v2"); 227 MODULE_DESCRIPTION("Renesas R-Car Gen3 remote processor control driver"); 228 MODULE_AUTHOR("Julien Massot <julien.massot@iot.bzh>"); 229