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(offset: mem->dma, size: 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(addr: 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: &it, np, list_name: "memory-region" , NULL, cell_count: 0); |
62 | while (of_phandle_iterator_next(it: &it) == 0) { |
63 | |
64 | rmem = of_reserved_mem_lookup(np: it.node); |
65 | if (!rmem) { |
66 | of_node_put(node: 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(node: 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 | dma: rmem->base, |
81 | len: rmem->size, da, |
82 | alloc: rcar_rproc_mem_alloc, |
83 | release: rcar_rproc_mem_release, |
84 | name: it.node->name); |
85 | |
86 | if (!mem) { |
87 | of_node_put(node: 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(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(rstc: 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(rstc: 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, name: np->name, ops: &rcar_rproc_ops, |
162 | NULL, len: 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(ptr: priv->rst)) { |
170 | ret = PTR_ERR(ptr: priv->rst); |
171 | dev_err_probe(dev, err: ret, fmt: "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, data: 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 | |