1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Copyright 2021 Google LLC
4  * Written by Simon Glass <sjg@chromium.org>
5  */
6 
7 #define LOG_CATEGORY UCLASS_BOOTSTD
8 
9 #include <common.h>
10 #include <bootdev.h>
11 #include <bootflow.h>
12 #include <bootmeth.h>
13 #include <bootstd.h>
14 #include <dm.h>
15 #include <malloc.h>
16 #include <dm/device-internal.h>
17 #include <dm/uclass-internal.h>
18 
19 /* error codes used to signal running out of things */
20 enum {
21 	BF_NO_MORE_PARTS	= -ESHUTDOWN,
22 	BF_NO_MORE_DEVICES	= -ENODEV,
23 };
24 
25 /**
26  * bootflow_state - name for each state
27  *
28  * See enum bootflow_state_t for what each of these means
29  */
30 static const char *const bootflow_state[BOOTFLOWST_COUNT] = {
31 	"base",
32 	"media",
33 	"part",
34 	"fs",
35 	"file",
36 	"ready",
37 };
38 
bootflow_state_get_name(enum bootflow_state_t state)39 const char *bootflow_state_get_name(enum bootflow_state_t state)
40 {
41 	/* This doesn't need to be a useful name, since it will never occur */
42 	if (state < 0 || state >= BOOTFLOWST_COUNT)
43 		return "?";
44 
45 	return bootflow_state[state];
46 }
47 
bootflow_first_glob(struct bootflow ** bflowp)48 int bootflow_first_glob(struct bootflow **bflowp)
49 {
50 	struct bootstd_priv *std;
51 	int ret;
52 
53 	ret = bootstd_get_priv(&std);
54 	if (ret)
55 		return ret;
56 
57 	if (list_empty(&std->glob_head))
58 		return -ENOENT;
59 
60 	*bflowp = list_first_entry(&std->glob_head, struct bootflow,
61 				   glob_node);
62 
63 	return 0;
64 }
65 
bootflow_next_glob(struct bootflow ** bflowp)66 int bootflow_next_glob(struct bootflow **bflowp)
67 {
68 	struct bootstd_priv *std;
69 	struct bootflow *bflow = *bflowp;
70 	int ret;
71 
72 	ret = bootstd_get_priv(&std);
73 	if (ret)
74 		return ret;
75 
76 	*bflowp = NULL;
77 
78 	if (list_is_last(&bflow->glob_node, &std->glob_head))
79 		return -ENOENT;
80 
81 	*bflowp = list_entry(bflow->glob_node.next, struct bootflow, glob_node);
82 
83 	return 0;
84 }
85 
bootflow_iter_init(struct bootflow_iter * iter,int flags)86 void bootflow_iter_init(struct bootflow_iter *iter, int flags)
87 {
88 	memset(iter, '\0', sizeof(*iter));
89 	iter->first_glob_method = -1;
90 	iter->flags = flags;
91 
92 	/* remember the first bootdevs we see */
93 	iter->max_devs = BOOTFLOW_MAX_USED_DEVS;
94 }
95 
bootflow_iter_uninit(struct bootflow_iter * iter)96 void bootflow_iter_uninit(struct bootflow_iter *iter)
97 {
98 	free(iter->method_order);
99 }
100 
bootflow_iter_drop_bootmeth(struct bootflow_iter * iter,const struct udevice * bmeth)101 int bootflow_iter_drop_bootmeth(struct bootflow_iter *iter,
102 				const struct udevice *bmeth)
103 {
104 	/* We only support disabling the current bootmeth */
105 	if (bmeth != iter->method || iter->cur_method >= iter->num_methods ||
106 	    iter->method_order[iter->cur_method] != bmeth)
107 		return -EINVAL;
108 
109 	memmove(&iter->method_order[iter->cur_method],
110 		&iter->method_order[iter->cur_method + 1],
111 		(iter->num_methods - iter->cur_method - 1) * sizeof(void *));
112 
113 	iter->num_methods--;
114 
115 	return 0;
116 }
117 
118 /**
119  * bootflow_iter_set_dev() - switch to the next bootdev when iterating
120  *
121  * This sets iter->dev, records the device in the dev_used[] list and shows a
122  * message if required
123  *
124  * @iter: Iterator to update
125  * @dev: Bootdev to use, or NULL if there are no more
126  */
bootflow_iter_set_dev(struct bootflow_iter * iter,struct udevice * dev,int method_flags)127 static void bootflow_iter_set_dev(struct bootflow_iter *iter,
128 				  struct udevice *dev, int method_flags)
129 {
130 	struct bootmeth_uc_plat *ucp = dev_get_uclass_plat(iter->method);
131 
132 	log_debug("iter: Setting dev to %s, flags %x\n",
133 		  dev ? dev->name : "(none)", method_flags);
134 	iter->dev = dev;
135 	iter->method_flags = method_flags;
136 
137 	if (IS_ENABLED(CONFIG_BOOTSTD_FULL)) {
138 		/* record the device for later */
139 		if (dev && iter->num_devs < iter->max_devs)
140 			iter->dev_used[iter->num_devs++] = dev;
141 
142 		if ((iter->flags & (BOOTFLOWIF_SHOW | BOOTFLOWIF_SINGLE_DEV)) ==
143 		    BOOTFLOWIF_SHOW) {
144 			if (dev)
145 				printf("Scanning bootdev '%s':\n", dev->name);
146 			else if (IS_ENABLED(CONFIG_BOOTMETH_GLOBAL) &&
147 				ucp->flags & BOOTMETHF_GLOBAL)
148 				printf("Scanning global bootmeth '%s':\n",
149 				iter->method->name);
150 			else
151 				printf("No more bootdevs\n");
152 		}
153 	}
154 }
155 
156 /**
157  * iter_incr() - Move to the next item (method, part, bootdev)
158  *
159  * Return: 0 if OK, BF_NO_MORE_DEVICES if there are no more bootdevs
160  */
iter_incr(struct bootflow_iter * iter)161 static int iter_incr(struct bootflow_iter *iter)
162 {
163 	struct udevice *dev;
164 	bool inc_dev = true;
165 	bool global;
166 	int ret;
167 
168 	log_debug("entry: err=%d\n", iter->err);
169 	global = iter->doing_global;
170 
171 	if (iter->err == BF_NO_MORE_DEVICES)
172 		return BF_NO_MORE_DEVICES;
173 
174 	if (iter->err != BF_NO_MORE_PARTS) {
175 		/* Get the next boothmethod */
176 		if (++iter->cur_method < iter->num_methods) {
177 			iter->method = iter->method_order[iter->cur_method];
178 			return 0;
179 		}
180 
181 		/*
182 		 * If we have finished scanning the global bootmeths, start the
183 		 * normal bootdev scan
184 		 */
185 		if (IS_ENABLED(CONFIG_BOOTMETH_GLOBAL) && global) {
186 			iter->num_methods = iter->first_glob_method;
187 			iter->doing_global = false;
188 
189 			/*
190 			 * Don't move to the next dev as we haven't tried this
191 			 * one yet!
192 			 */
193 			inc_dev = false;
194 		}
195 	}
196 
197 	/* No more bootmeths; start at the first one, and... */
198 	iter->cur_method = 0;
199 	iter->method = iter->method_order[iter->cur_method];
200 
201 	if (iter->err != BF_NO_MORE_PARTS) {
202 		/* ...select next partition  */
203 		if (++iter->part <= iter->max_part)
204 			return 0;
205 	}
206 
207 	/* No more partitions; start at the first one and... */
208 	iter->part = 0;
209 
210 	/*
211 	 * Note: as far as we know, there is no partition table on the next
212 	 * bootdev, so set max_part to 0 until we discover otherwise. See
213 	 * bootdev_find_in_blk() for where this is set.
214 	 */
215 	iter->max_part = 0;
216 
217 	/* ...select next bootdev */
218 	if (iter->flags & BOOTFLOWIF_SINGLE_DEV) {
219 		ret = -ENOENT;
220 	} else {
221 		int method_flags;
222 
223 		ret = 0;
224 		dev = iter->dev;
225 		log_debug("inc_dev=%d\n", inc_dev);
226 		if (!inc_dev) {
227 			ret = bootdev_setup_iter(iter, NULL, &dev,
228 						 &method_flags);
229 		} else if (IS_ENABLED(CONFIG_BOOTSTD_FULL) &&
230 			   (iter->flags & BOOTFLOWIF_SINGLE_UCLASS)) {
231 			/* Move to the next bootdev in this uclass */
232 			uclass_find_next_device(&dev);
233 			if (!dev) {
234 				log_debug("finished uclass %s\n",
235 					  dev_get_uclass_name(dev));
236 				ret = -ENODEV;
237 			}
238 		} else if (IS_ENABLED(CONFIG_BOOTSTD_FULL) &&
239 			   iter->flags & BOOTFLOWIF_SINGLE_MEDIA) {
240 			log_debug("next in single\n");
241 			method_flags = 0;
242 			do {
243 				/*
244 				 * Move to the next bootdev child of this media
245 				 * device. This ensures that we cover all the
246 				 * available SCSI IDs and LUNs.
247 				 */
248 				device_find_next_child(&dev);
249 				log_debug("- next %s\n",
250 					dev ? dev->name : "(none)");
251 			} while (dev && device_get_uclass_id(dev) !=
252 				UCLASS_BOOTDEV);
253 			if (!dev) {
254 				log_debug("finished uclass %s\n",
255 					  dev_get_uclass_name(dev));
256 				ret = -ENODEV;
257 			}
258 		} else {
259 			log_debug("labels %p\n", iter->labels);
260 			if (iter->labels) {
261 				ret = bootdev_next_label(iter, &dev,
262 							 &method_flags);
263 			} else {
264 				ret = bootdev_next_prio(iter, &dev);
265 				method_flags = 0;
266 			}
267 		}
268 		log_debug("ret=%d, dev=%p %s\n", ret, dev,
269 			  dev ? dev->name : "none");
270 		if (ret) {
271 			bootflow_iter_set_dev(iter, NULL, 0);
272 		} else {
273 			/*
274 			 * Probe the bootdev. This does not probe any attached
275 			 * block device, since they are siblings
276 			 */
277 			ret = device_probe(dev);
278 			log_debug("probe %s %d\n", dev->name, ret);
279 			if (!log_msg_ret("probe", ret))
280 				bootflow_iter_set_dev(iter, dev, method_flags);
281 		}
282 	}
283 
284 	/* if there are no more bootdevs, give up */
285 	if (ret)
286 		return log_msg_ret("incr", BF_NO_MORE_DEVICES);
287 
288 	return 0;
289 }
290 
291 /**
292  * bootflow_check() - Check if a bootflow can be obtained
293  *
294  * @iter: Provides part, bootmeth to use
295  * @bflow: Bootflow to update on success
296  * Return: 0 if OK, -ENOSYS if there is no bootflow support on this device,
297  *	BF_NO_MORE_PARTS if there are no more partitions on bootdev
298  */
bootflow_check(struct bootflow_iter * iter,struct bootflow * bflow)299 static int bootflow_check(struct bootflow_iter *iter, struct bootflow *bflow)
300 {
301 	struct udevice *dev;
302 	int ret;
303 
304 	if (IS_ENABLED(CONFIG_BOOTMETH_GLOBAL) && iter->doing_global) {
305 		bootflow_iter_set_dev(iter, NULL, 0);
306 		ret = bootmeth_get_bootflow(iter->method, bflow);
307 		if (ret)
308 			return log_msg_ret("glob", ret);
309 
310 		return 0;
311 	}
312 
313 	dev = iter->dev;
314 	ret = bootdev_get_bootflow(dev, iter, bflow);
315 
316 	/* If we got a valid bootflow, return it */
317 	if (!ret) {
318 		log_debug("Bootdevice '%s' part %d method '%s': Found bootflow\n",
319 			  dev->name, iter->part, iter->method->name);
320 		return 0;
321 	}
322 
323 	/* Unless there is nothing more to try, move to the next device */
324 	else if (ret != BF_NO_MORE_PARTS && ret != -ENOSYS) {
325 		log_debug("Bootdevice '%s' part %d method '%s': Error %d\n",
326 			  dev->name, iter->part, iter->method->name, ret);
327 		/*
328 		 * For 'all' we return all bootflows, even
329 		 * those with errors
330 		 */
331 		if (iter->flags & BOOTFLOWIF_ALL)
332 			return log_msg_ret("all", ret);
333 	}
334 	if (ret)
335 		return log_msg_ret("check", ret);
336 
337 	return 0;
338 }
339 
bootflow_scan_first(struct udevice * dev,const char * label,struct bootflow_iter * iter,int flags,struct bootflow * bflow)340 int bootflow_scan_first(struct udevice *dev, const char *label,
341 			struct bootflow_iter *iter, int flags,
342 			struct bootflow *bflow)
343 {
344 	int ret;
345 
346 	if (dev || label)
347 		flags |= BOOTFLOWIF_SKIP_GLOBAL;
348 	bootflow_iter_init(iter, flags);
349 
350 	/*
351 	 * Set up the ordering of bootmeths. This sets iter->doing_global and
352 	 * iter->first_glob_method if we are starting with the global bootmeths
353 	 */
354 	ret = bootmeth_setup_iter_order(iter, !(flags & BOOTFLOWIF_SKIP_GLOBAL));
355 	if (ret)
356 		return log_msg_ret("obmeth", -ENODEV);
357 
358 	/* Find the first bootmeth (there must be at least one!) */
359 	iter->method = iter->method_order[iter->cur_method];
360 
361 	if (!IS_ENABLED(CONFIG_BOOTMETH_GLOBAL) || !iter->doing_global) {
362 		struct udevice *dev = NULL;
363 		int method_flags;
364 
365 		ret = bootdev_setup_iter(iter, label, &dev, &method_flags);
366 		if (ret)
367 			return log_msg_ret("obdev", -ENODEV);
368 
369 		bootflow_iter_set_dev(iter, dev, method_flags);
370 	}
371 
372 	ret = bootflow_check(iter, bflow);
373 	if (ret) {
374 		log_debug("check - ret=%d\n", ret);
375 		if (ret != BF_NO_MORE_PARTS && ret != -ENOSYS) {
376 			if (iter->flags & BOOTFLOWIF_ALL)
377 				return log_msg_ret("all", ret);
378 		}
379 		iter->err = ret;
380 		ret = bootflow_scan_next(iter, bflow);
381 		if (ret)
382 			return log_msg_ret("get", ret);
383 	}
384 
385 	return 0;
386 }
387 
bootflow_scan_next(struct bootflow_iter * iter,struct bootflow * bflow)388 int bootflow_scan_next(struct bootflow_iter *iter, struct bootflow *bflow)
389 {
390 	int ret;
391 
392 	do {
393 		ret = iter_incr(iter);
394 		log_debug("iter_incr: ret=%d\n", ret);
395 		if (ret == BF_NO_MORE_DEVICES)
396 			return log_msg_ret("done", ret);
397 
398 		if (!ret) {
399 			ret = bootflow_check(iter, bflow);
400 			log_debug("check - ret=%d\n", ret);
401 			if (!ret)
402 				return 0;
403 			iter->err = ret;
404 			if (ret != BF_NO_MORE_PARTS && ret != -ENOSYS) {
405 				if (iter->flags & BOOTFLOWIF_ALL)
406 					return log_msg_ret("all", ret);
407 			}
408 		} else {
409 			log_debug("incr failed, err=%d\n", ret);
410 			iter->err = ret;
411 		}
412 
413 	} while (1);
414 }
415 
bootflow_init(struct bootflow * bflow,struct udevice * bootdev,struct udevice * meth)416 void bootflow_init(struct bootflow *bflow, struct udevice *bootdev,
417 		   struct udevice *meth)
418 {
419 	memset(bflow, '\0', sizeof(*bflow));
420 	bflow->dev = bootdev;
421 	bflow->method = meth;
422 	bflow->state = BOOTFLOWST_BASE;
423 }
424 
bootflow_free(struct bootflow * bflow)425 void bootflow_free(struct bootflow *bflow)
426 {
427 	free(bflow->name);
428 	free(bflow->subdir);
429 	free(bflow->fname);
430 	free(bflow->buf);
431 	free(bflow->os_name);
432 	free(bflow->fdt_fname);
433 }
434 
bootflow_remove(struct bootflow * bflow)435 void bootflow_remove(struct bootflow *bflow)
436 {
437 	if (bflow->dev)
438 		list_del(&bflow->bm_node);
439 	list_del(&bflow->glob_node);
440 
441 	bootflow_free(bflow);
442 	free(bflow);
443 }
444 
bootflow_boot(struct bootflow * bflow)445 int bootflow_boot(struct bootflow *bflow)
446 {
447 	int ret;
448 
449 	if (bflow->state != BOOTFLOWST_READY)
450 		return log_msg_ret("load", -EPROTO);
451 
452 	ret = bootmeth_boot(bflow->method, bflow);
453 	if (ret)
454 		return log_msg_ret("boot", ret);
455 
456 	/*
457 	 * internal error, should not get here since we should have booted
458 	 * something or returned an error
459 	 */
460 
461 	return log_msg_ret("end", -EFAULT);
462 }
463 
bootflow_run_boot(struct bootflow_iter * iter,struct bootflow * bflow)464 int bootflow_run_boot(struct bootflow_iter *iter, struct bootflow *bflow)
465 {
466 	int ret;
467 
468 	printf("** Booting bootflow '%s' with %s\n", bflow->name,
469 	       bflow->method->name);
470 	if (IS_ENABLED(CONFIG_OF_HAS_PRIOR_STAGE) &&
471 	    (bflow->flags & BOOTFLOWF_USE_PRIOR_FDT))
472 		printf("Using prior-stage device tree\n");
473 	ret = bootflow_boot(bflow);
474 	if (!IS_ENABLED(CONFIG_BOOTSTD_FULL)) {
475 		printf("Boot failed (err=%d)\n", ret);
476 		return ret;
477 	}
478 
479 	switch (ret) {
480 	case -EPROTO:
481 		printf("Bootflow not loaded (state '%s')\n",
482 		       bootflow_state_get_name(bflow->state));
483 		break;
484 	case -ENOSYS:
485 		printf("Boot method '%s' not supported\n", bflow->method->name);
486 		break;
487 	case -ENOTSUPP:
488 		/* Disable this bootflow for this iteration */
489 		if (iter) {
490 			int ret2;
491 
492 			ret2 = bootflow_iter_drop_bootmeth(iter, bflow->method);
493 			if (!ret2) {
494 				printf("Boot method '%s' failed and will not be retried\n",
495 				       bflow->method->name);
496 			}
497 		}
498 
499 		break;
500 	default:
501 		printf("Boot failed (err=%d)\n", ret);
502 		break;
503 	}
504 
505 	return ret;
506 }
507 
bootflow_iter_check_blk(const struct bootflow_iter * iter)508 int bootflow_iter_check_blk(const struct bootflow_iter *iter)
509 {
510 	const struct udevice *media = dev_get_parent(iter->dev);
511 	enum uclass_id id = device_get_uclass_id(media);
512 
513 	log_debug("uclass %d: %s\n", id, uclass_get_name(id));
514 	if (id != UCLASS_ETH && id != UCLASS_BOOTSTD && id != UCLASS_QFW)
515 		return 0;
516 
517 	return -ENOTSUPP;
518 }
519 
bootflow_iter_check_sf(const struct bootflow_iter * iter)520 int bootflow_iter_check_sf(const struct bootflow_iter *iter)
521 {
522 	const struct udevice *media = dev_get_parent(iter->dev);
523 	enum uclass_id id = device_get_uclass_id(media);
524 
525 	log_debug("uclass %d: %s\n", id, uclass_get_name(id));
526 	if (id == UCLASS_SPI_FLASH)
527 		return 0;
528 
529 	return -ENOTSUPP;
530 }
531 
bootflow_iter_check_net(const struct bootflow_iter * iter)532 int bootflow_iter_check_net(const struct bootflow_iter *iter)
533 {
534 	const struct udevice *media = dev_get_parent(iter->dev);
535 	enum uclass_id id = device_get_uclass_id(media);
536 
537 	log_debug("uclass %d: %s\n", id, uclass_get_name(id));
538 	if (id == UCLASS_ETH)
539 		return 0;
540 
541 	return -ENOTSUPP;
542 }
543 
bootflow_iter_check_system(const struct bootflow_iter * iter)544 int bootflow_iter_check_system(const struct bootflow_iter *iter)
545 {
546 	const struct udevice *media = dev_get_parent(iter->dev);
547 	enum uclass_id id = device_get_uclass_id(media);
548 
549 	log_debug("uclass %d: %s\n", id, uclass_get_name(id));
550 	if (id == UCLASS_BOOTSTD)
551 		return 0;
552 
553 	return -ENOTSUPP;
554 }
555