1 /*
2  * (C) Copyright 2015
3  * Texas Instruments Incorporated - http://www.ti.com/
4  * SPDX-License-Identifier:	GPL-2.0+
5  */
6 #define pr_fmt(fmt) "%s: " fmt, __func__
7 #include <common.h>
8 #include <errno.h>
9 #include <fdtdec.h>
10 #include <malloc.h>
11 #include <remoteproc.h>
12 #include <asm/io.h>
13 #include <dm/device-internal.h>
14 #include <dm.h>
15 #include <dm/uclass.h>
16 #include <dm/uclass-internal.h>
17 
18 DECLARE_GLOBAL_DATA_PTR;
19 
20 /**
21  * for_each_remoteproc_device() - iterate through the list of rproc devices
22  * @fn: check function to call per match, if this function returns fail,
23  *	iteration is aborted with the resultant error value
24  * @skip_dev:	Device to skip calling the callback about.
25  * @data:	Data to pass to the callback function
26  *
27  * Return: 0 if none of the callback returned a non 0 result, else returns the
28  * result from the callback function
29  */
30 static int for_each_remoteproc_device(int (*fn) (struct udevice *dev,
31 					struct dm_rproc_uclass_pdata *uc_pdata,
32 					const void *data),
33 				      struct udevice *skip_dev,
34 				      const void *data)
35 {
36 	struct udevice *dev;
37 	struct dm_rproc_uclass_pdata *uc_pdata;
38 	int ret;
39 
40 	for (ret = uclass_find_first_device(UCLASS_REMOTEPROC, &dev); dev;
41 	     ret = uclass_find_next_device(&dev)) {
42 		if (ret || dev == skip_dev)
43 			continue;
44 		uc_pdata = dev_get_uclass_platdata(dev);
45 		ret = fn(dev, uc_pdata, data);
46 		if (ret)
47 			return ret;
48 	}
49 
50 	return 0;
51 }
52 
53 /**
54  * _rproc_name_is_unique() - iteration helper to check if rproc name is unique
55  * @dev:	device that we are checking name for
56  * @uc_pdata:	uclass platform data
57  * @data:	compare data (this is the name we want to ensure is unique)
58  *
59  * Return: 0 is there is no match(is unique); if there is a match(we dont
60  * have a unique name), return -EINVAL.
61  */
62 static int _rproc_name_is_unique(struct udevice *dev,
63 				 struct dm_rproc_uclass_pdata *uc_pdata,
64 				 const void *data)
65 {
66 	const char *check_name = data;
67 
68 	/* devices not yet populated with data - so skip them */
69 	if (!uc_pdata->name || !check_name)
70 		return 0;
71 
72 	/* Return 0 to search further if we dont match */
73 	if (strlen(uc_pdata->name) != strlen(check_name))
74 		return 0;
75 
76 	if (!strcmp(uc_pdata->name, check_name))
77 		return -EINVAL;
78 
79 	return 0;
80 }
81 
82 /**
83  * rproc_name_is_unique() - Check if the rproc name is unique
84  * @check_dev:	Device we are attempting to ensure is unique
85  * @check_name:	Name we are trying to ensure is unique.
86  *
87  * Return: true if we have a unique name, false if name is not unique.
88  */
89 static bool rproc_name_is_unique(struct udevice *check_dev,
90 				 const char *check_name)
91 {
92 	int ret;
93 
94 	ret = for_each_remoteproc_device(_rproc_name_is_unique,
95 					 check_dev, check_name);
96 	return ret ? false : true;
97 }
98 
99 /**
100  * rproc_pre_probe() - Pre probe accessor for the uclass
101  * @dev:	device for which we are preprobing
102  *
103  * Parses and fills up the uclass pdata for use as needed by core and
104  * remote proc drivers.
105  *
106  * Return: 0 if all wernt ok, else appropriate error value.
107  */
108 static int rproc_pre_probe(struct udevice *dev)
109 {
110 	struct dm_rproc_uclass_pdata *uc_pdata;
111 	const struct dm_rproc_ops *ops;
112 
113 	uc_pdata = dev_get_uclass_platdata(dev);
114 
115 	/* See if we need to populate via fdt */
116 
117 	if (!dev->platdata) {
118 #if CONFIG_IS_ENABLED(OF_CONTROL)
119 		int node = dev_of_offset(dev);
120 		const void *blob = gd->fdt_blob;
121 		bool tmp;
122 		if (!blob) {
123 			debug("'%s' no dt?\n", dev->name);
124 			return -EINVAL;
125 		}
126 		debug("'%s': using fdt\n", dev->name);
127 		uc_pdata->name = fdt_getprop(blob, node,
128 					     "remoteproc-name", NULL);
129 
130 		/* Default is internal memory mapped */
131 		uc_pdata->mem_type = RPROC_INTERNAL_MEMORY_MAPPED;
132 		tmp = fdtdec_get_bool(blob, node,
133 				      "remoteproc-internal-memory-mapped");
134 		if (tmp)
135 			uc_pdata->mem_type = RPROC_INTERNAL_MEMORY_MAPPED;
136 #else
137 		/* Nothing much we can do about this, can we? */
138 		return -EINVAL;
139 #endif
140 
141 	} else {
142 		struct dm_rproc_uclass_pdata *pdata = dev->platdata;
143 
144 		debug("'%s': using legacy data\n", dev->name);
145 		if (pdata->name)
146 			uc_pdata->name = pdata->name;
147 		uc_pdata->mem_type = pdata->mem_type;
148 		uc_pdata->driver_plat_data = pdata->driver_plat_data;
149 	}
150 
151 	/* Else try using device Name */
152 	if (!uc_pdata->name)
153 		uc_pdata->name = dev->name;
154 	if (!uc_pdata->name) {
155 		debug("Unnamed device!");
156 		return -EINVAL;
157 	}
158 
159 	if (!rproc_name_is_unique(dev, uc_pdata->name)) {
160 		debug("%s duplicate name '%s'\n", dev->name, uc_pdata->name);
161 		return -EINVAL;
162 	}
163 
164 	ops = rproc_get_ops(dev);
165 	if (!ops) {
166 		debug("%s driver has no ops?\n", dev->name);
167 		return -EINVAL;
168 	}
169 
170 	if (!ops->load || !ops->start) {
171 		debug("%s driver has missing mandatory ops?\n", dev->name);
172 		return -EINVAL;
173 	}
174 
175 	return 0;
176 }
177 
178 /**
179  * rproc_post_probe() - post probe accessor for the uclass
180  * @dev:	deivce we finished probing
181  *
182  * initiate init function after the probe is completed. This allows
183  * the remote processor drivers to split up the initializations between
184  * probe and init as needed.
185  *
186  * Return: if the remote proc driver has a init routine, invokes it and
187  * hands over the return value. overall, 0 if all went well, else appropriate
188  * error value.
189  */
190 static int rproc_post_probe(struct udevice *dev)
191 {
192 	const struct dm_rproc_ops *ops;
193 
194 	ops = rproc_get_ops(dev);
195 	if (!ops) {
196 		debug("%s driver has no ops?\n", dev->name);
197 		return -EINVAL;
198 	}
199 
200 	if (ops->init)
201 		return ops->init(dev);
202 
203 	return 0;
204 }
205 
206 UCLASS_DRIVER(rproc) = {
207 	.id = UCLASS_REMOTEPROC,
208 	.name = "remoteproc",
209 	.flags = DM_UC_FLAG_SEQ_ALIAS,
210 	.pre_probe = rproc_pre_probe,
211 	.post_probe = rproc_post_probe,
212 	.per_device_platdata_auto_alloc_size =
213 		sizeof(struct dm_rproc_uclass_pdata),
214 };
215 
216 /* Remoteproc subsystem access functions */
217 /**
218  * _rproc_probe_dev() - iteration helper to probe a rproc device
219  * @dev:	device to probe
220  * @uc_pdata:	uclass data allocated for the device
221  * @data:	unused
222  *
223  * Return: 0 if all ok, else appropriate error value.
224  */
225 static int _rproc_probe_dev(struct udevice *dev,
226 			    struct dm_rproc_uclass_pdata *uc_pdata,
227 			    const void *data)
228 {
229 	int ret;
230 
231 	ret = device_probe(dev);
232 
233 	if (ret)
234 		debug("%s: Failed to initialize - %d\n", dev->name, ret);
235 	return ret;
236 }
237 
238 /**
239  * _rproc_dev_is_probed() - check if the device has been probed
240  * @dev:	device to check
241  * @uc_pdata:	unused
242  * @data:	unused
243  *
244  * Return: -EAGAIN if not probed else return 0
245  */
246 static int _rproc_dev_is_probed(struct udevice *dev,
247 			    struct dm_rproc_uclass_pdata *uc_pdata,
248 			    const void *data)
249 {
250 	if (dev->flags & DM_FLAG_ACTIVATED)
251 		return 0;
252 
253 	return -EAGAIN;
254 }
255 
256 bool rproc_is_initialized(void)
257 {
258 	int ret = for_each_remoteproc_device(_rproc_dev_is_probed, NULL, NULL);
259 	return ret ? false : true;
260 }
261 
262 int rproc_init(void)
263 {
264 	int ret;
265 
266 	if (rproc_is_initialized()) {
267 		debug("Already initialized\n");
268 		return -EINVAL;
269 	}
270 
271 	ret = for_each_remoteproc_device(_rproc_probe_dev, NULL, NULL);
272 	return ret;
273 }
274 
275 int rproc_load(int id, ulong addr, ulong size)
276 {
277 	struct udevice *dev = NULL;
278 	struct dm_rproc_uclass_pdata *uc_pdata;
279 	const struct dm_rproc_ops *ops;
280 	int ret;
281 
282 	ret = uclass_get_device_by_seq(UCLASS_REMOTEPROC, id, &dev);
283 	if (ret) {
284 		debug("Unknown remote processor id '%d' requested(%d)\n",
285 		      id, ret);
286 		return ret;
287 	}
288 
289 	uc_pdata = dev_get_uclass_platdata(dev);
290 
291 	ops = rproc_get_ops(dev);
292 	if (!ops) {
293 		debug("%s driver has no ops?\n", dev->name);
294 		return -EINVAL;
295 	}
296 
297 	debug("Loading to '%s' from address 0x%08lX size of %lu bytes\n",
298 	      uc_pdata->name, addr, size);
299 	if (ops->load)
300 		return ops->load(dev, addr, size);
301 
302 	debug("%s: data corruption?? mandatory function is missing!\n",
303 	      dev->name);
304 
305 	return -EINVAL;
306 };
307 
308 /*
309  * Completely internal helper enums..
310  * Keeping this isolated helps this code evolve independent of other
311  * parts..
312  */
313 enum rproc_ops {
314 	RPROC_START,
315 	RPROC_STOP,
316 	RPROC_RESET,
317 	RPROC_PING,
318 	RPROC_RUNNING,
319 };
320 
321 /**
322  * _rproc_ops_wrapper() - wrapper for invoking remote proc driver callback
323  * @id:		id of the remote processor
324  * @op:		one of rproc_ops that indicate what operation to invoke
325  *
326  * Most of the checks and verification for remoteproc operations are more
327  * or less same for almost all operations. This allows us to put a wrapper
328  * and use the common checks to allow the driver to function appropriately.
329  *
330  * Return: 0 if all ok, else appropriate error value.
331  */
332 static int _rproc_ops_wrapper(int id, enum rproc_ops op)
333 {
334 	struct udevice *dev = NULL;
335 	struct dm_rproc_uclass_pdata *uc_pdata;
336 	const struct dm_rproc_ops *ops;
337 	int (*fn)(struct udevice *dev);
338 	bool mandatory = false;
339 	char *op_str;
340 	int ret;
341 
342 	ret = uclass_get_device_by_seq(UCLASS_REMOTEPROC, id, &dev);
343 	if (ret) {
344 		debug("Unknown remote processor id '%d' requested(%d)\n",
345 		      id, ret);
346 		return ret;
347 	}
348 
349 	uc_pdata = dev_get_uclass_platdata(dev);
350 
351 	ops = rproc_get_ops(dev);
352 	if (!ops) {
353 		debug("%s driver has no ops?\n", dev->name);
354 		return -EINVAL;
355 	}
356 	switch (op) {
357 	case RPROC_START:
358 		fn = ops->start;
359 		mandatory = true;
360 		op_str = "Starting";
361 		break;
362 	case RPROC_STOP:
363 		fn = ops->stop;
364 		op_str = "Stopping";
365 		break;
366 	case RPROC_RESET:
367 		fn = ops->reset;
368 		op_str = "Resetting";
369 		break;
370 	case RPROC_RUNNING:
371 		fn = ops->is_running;
372 		op_str = "Checking if running:";
373 		break;
374 	case RPROC_PING:
375 		fn = ops->ping;
376 		op_str = "Pinging";
377 		break;
378 	default:
379 		debug("what is '%d' operation??\n", op);
380 		return -EINVAL;
381 	}
382 
383 	debug("%s %s...\n", op_str, uc_pdata->name);
384 	if (fn)
385 		return fn(dev);
386 
387 	if (mandatory)
388 		debug("%s: data corruption?? mandatory function is missing!\n",
389 		      dev->name);
390 
391 	return -ENOSYS;
392 }
393 
394 int rproc_start(int id)
395 {
396 	return _rproc_ops_wrapper(id, RPROC_START);
397 };
398 
399 int rproc_stop(int id)
400 {
401 	return _rproc_ops_wrapper(id, RPROC_STOP);
402 };
403 
404 int rproc_reset(int id)
405 {
406 	return _rproc_ops_wrapper(id, RPROC_RESET);
407 };
408 
409 int rproc_ping(int id)
410 {
411 	return _rproc_ops_wrapper(id, RPROC_PING);
412 };
413 
414 int rproc_is_running(int id)
415 {
416 	return _rproc_ops_wrapper(id, RPROC_RUNNING);
417 };
418