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