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
rcar_rproc_mem_alloc(struct rproc * rproc,struct rproc_mem_entry * mem)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
rcar_rproc_mem_release(struct rproc * rproc,struct rproc_mem_entry * mem)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
rcar_rproc_prepare(struct rproc * rproc)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 rproc_mem_entry *mem;
56 int i = 0;
57 u32 da;
58
59 /* Register associated reserved memory regions */
60 while (1) {
61 struct resource res;
62 int ret;
63
64 ret = of_reserved_mem_region_to_resource(np, i++, &res);
65 if (ret)
66 return 0;
67
68 if (res.start > U32_MAX)
69 return -EINVAL;
70
71 /* No need to translate pa to da, R-Car use same map */
72 da = res.start;
73 mem = rproc_mem_entry_init(dev, NULL,
74 res.start,
75 resource_size(&res), da,
76 rcar_rproc_mem_alloc,
77 rcar_rproc_mem_release,
78 res.name);
79
80 if (!mem)
81 return -ENOMEM;
82
83 rproc_add_carveout(rproc, mem);
84 }
85 }
86
rcar_rproc_parse_fw(struct rproc * rproc,const struct firmware * fw)87 static int rcar_rproc_parse_fw(struct rproc *rproc, const struct firmware *fw)
88 {
89 int ret;
90
91 ret = rproc_elf_load_rsc_table(rproc, fw);
92 if (ret)
93 dev_info(&rproc->dev, "No resource table in elf\n");
94
95 return 0;
96 }
97
rcar_rproc_start(struct rproc * rproc)98 static int rcar_rproc_start(struct rproc *rproc)
99 {
100 struct rcar_rproc *priv = rproc->priv;
101 int err;
102
103 if (!rproc->bootaddr)
104 return -EINVAL;
105
106 err = rcar_rst_set_rproc_boot_addr(rproc->bootaddr);
107 if (err) {
108 dev_err(&rproc->dev, "failed to set rproc boot addr\n");
109 return err;
110 }
111
112 err = reset_control_deassert(priv->rst);
113 if (err)
114 dev_err(&rproc->dev, "failed to deassert reset\n");
115
116 return err;
117 }
118
rcar_rproc_stop(struct rproc * rproc)119 static int rcar_rproc_stop(struct rproc *rproc)
120 {
121 struct rcar_rproc *priv = rproc->priv;
122 int err;
123
124 err = reset_control_assert(priv->rst);
125 if (err)
126 dev_err(&rproc->dev, "failed to assert reset\n");
127
128 return err;
129 }
130
131 static struct rproc_ops rcar_rproc_ops = {
132 .prepare = rcar_rproc_prepare,
133 .start = rcar_rproc_start,
134 .stop = rcar_rproc_stop,
135 .load = rproc_elf_load_segments,
136 .parse_fw = rcar_rproc_parse_fw,
137 .find_loaded_rsc_table = rproc_elf_find_loaded_rsc_table,
138 .sanity_check = rproc_elf_sanity_check,
139 .get_boot_addr = rproc_elf_get_boot_addr,
140
141 };
142
rcar_rproc_probe(struct platform_device * pdev)143 static int rcar_rproc_probe(struct platform_device *pdev)
144 {
145 struct device *dev = &pdev->dev;
146 struct device_node *np = dev->of_node;
147 struct rcar_rproc *priv;
148 struct rproc *rproc;
149 int ret;
150
151 rproc = devm_rproc_alloc(dev, np->name, &rcar_rproc_ops,
152 NULL, sizeof(*priv));
153 if (!rproc)
154 return -ENOMEM;
155
156 priv = rproc->priv;
157
158 priv->rst = devm_reset_control_get_exclusive(dev, NULL);
159 if (IS_ERR(priv->rst)) {
160 ret = PTR_ERR(priv->rst);
161 dev_err_probe(dev, ret, "fail to acquire rproc reset\n");
162 return ret;
163 }
164
165 pm_runtime_enable(dev);
166 ret = pm_runtime_resume_and_get(dev);
167 if (ret) {
168 dev_err(dev, "failed to power up\n");
169 return ret;
170 }
171
172 dev_set_drvdata(dev, rproc);
173
174 /* Manually start the rproc */
175 rproc->auto_boot = false;
176
177 ret = devm_rproc_add(dev, rproc);
178 if (ret) {
179 dev_err(dev, "rproc_add failed\n");
180 goto pm_disable;
181 }
182
183 return 0;
184
185 pm_disable:
186 pm_runtime_disable(dev);
187
188 return ret;
189 }
190
rcar_rproc_remove(struct platform_device * pdev)191 static void rcar_rproc_remove(struct platform_device *pdev)
192 {
193 struct device *dev = &pdev->dev;
194
195 pm_runtime_disable(dev);
196 }
197
198 static const struct of_device_id rcar_rproc_of_match[] = {
199 { .compatible = "renesas,rcar-cr7" },
200 {},
201 };
202
203 MODULE_DEVICE_TABLE(of, rcar_rproc_of_match);
204
205 static struct platform_driver rcar_rproc_driver = {
206 .probe = rcar_rproc_probe,
207 .remove = rcar_rproc_remove,
208 .driver = {
209 .name = "rcar-rproc",
210 .of_match_table = rcar_rproc_of_match,
211 },
212 };
213
214 module_platform_driver(rcar_rproc_driver);
215
216 MODULE_LICENSE("GPL v2");
217 MODULE_DESCRIPTION("Renesas R-Car Gen3 remote processor control driver");
218 MODULE_AUTHOR("Julien Massot <julien.massot@iot.bzh>");
219