Commit | Line | Data |
---|---|---|
285892a7 JM |
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> | |
3440d8da | 8 | #include <linux/of.h> |
285892a7 | 9 | #include <linux/of_reserved_mem.h> |
3440d8da | 10 | #include <linux/platform_device.h> |
285892a7 JM |
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) { | |
f8bae637 | 66 | of_node_put(it.node); |
285892a7 JM |
67 | dev_err(&rproc->dev, |
68 | "unable to acquire memory-region\n"); | |
69 | return -EINVAL; | |
70 | } | |
71 | ||
f8bae637 MP |
72 | if (rmem->base > U32_MAX) { |
73 | of_node_put(it.node); | |
285892a7 | 74 | return -EINVAL; |
f8bae637 | 75 | } |
285892a7 JM |
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 | ||
f8bae637 MP |
86 | if (!mem) { |
87 | of_node_put(it.node); | |
285892a7 | 88 | return -ENOMEM; |
f8bae637 | 89 | } |
285892a7 JM |
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"); | |
ba635863 | 172 | return ret; |
285892a7 JM |
173 | } |
174 | ||
175 | pm_runtime_enable(dev); | |
b0229605 | 176 | ret = pm_runtime_resume_and_get(dev); |
285892a7 JM |
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 | ||
ed611874 | 201 | static void rcar_rproc_remove(struct platform_device *pdev) |
285892a7 JM |
202 | { |
203 | struct device *dev = &pdev->dev; | |
204 | ||
205 | pm_runtime_disable(dev); | |
285892a7 JM |
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, | |
ed611874 | 217 | .remove_new = rcar_rproc_remove, |
285892a7 JM |
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>"); |