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