blob: 7c7bba088c999f96862b6bb76616e9d0c3e6b13a [file] [log] [blame]
Simon Glass201417d2022-04-24 23:31:07 -06001// 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
Simon Glass201417d2022-04-24 23:31:07 -06009#include <dm.h>
10#include <bootdev.h>
11#include <bootflow.h>
Simon Glassa8f5be12022-04-24 23:31:09 -060012#include <bootmeth.h>
Simon Glass201417d2022-04-24 23:31:07 -060013#include <bootstd.h>
Simon Glass201417d2022-04-24 23:31:07 -060014#include <fs.h>
15#include <log.h>
16#include <malloc.h>
17#include <part.h>
18#include <sort.h>
19#include <dm/device-internal.h>
20#include <dm/lists.h>
21#include <dm/uclass-internal.h>
22
23enum {
24 /*
25 * Set some sort of limit on the number of partitions a bootdev can
26 * have. Note that for disks this limits the partitions numbers that
27 * are scanned to 1..MAX_BOOTFLOWS_PER_BOOTDEV
28 */
29 MAX_PART_PER_BOOTDEV = 30,
30
31 /* Maximum supported length of the "boot_targets" env string */
32 BOOT_TARGETS_MAX_LEN = 100,
33};
34
35int bootdev_add_bootflow(struct bootflow *bflow)
36{
Simon Glass201417d2022-04-24 23:31:07 -060037 struct bootstd_priv *std;
38 struct bootflow *new;
39 int ret;
40
Simon Glass201417d2022-04-24 23:31:07 -060041 ret = bootstd_get_priv(&std);
42 if (ret)
43 return ret;
44
45 new = malloc(sizeof(*bflow));
46 if (!new)
47 return log_msg_ret("bflow", -ENOMEM);
48 memcpy(new, bflow, sizeof(*bflow));
49
50 list_add_tail(&new->glob_node, &std->glob_head);
Simon Glasseccb25c2022-07-30 15:52:23 -060051 if (bflow->dev) {
52 struct bootdev_uc_plat *ucp = dev_get_uclass_plat(bflow->dev);
53
54 list_add_tail(&new->bm_node, &ucp->bootflow_head);
55 }
Simon Glass201417d2022-04-24 23:31:07 -060056
57 return 0;
58}
59
60int bootdev_first_bootflow(struct udevice *dev, struct bootflow **bflowp)
61{
62 struct bootdev_uc_plat *ucp = dev_get_uclass_plat(dev);
63
64 if (list_empty(&ucp->bootflow_head))
65 return -ENOENT;
66
67 *bflowp = list_first_entry(&ucp->bootflow_head, struct bootflow,
68 bm_node);
69
70 return 0;
71}
72
73int bootdev_next_bootflow(struct bootflow **bflowp)
74{
75 struct bootflow *bflow = *bflowp;
76 struct bootdev_uc_plat *ucp = dev_get_uclass_plat(bflow->dev);
77
78 *bflowp = NULL;
79
80 if (list_is_last(&bflow->bm_node, &ucp->bootflow_head))
81 return -ENOENT;
82
83 *bflowp = list_entry(bflow->bm_node.next, struct bootflow, bm_node);
84
85 return 0;
86}
87
88int bootdev_bind(struct udevice *parent, const char *drv_name, const char *name,
89 struct udevice **devp)
90{
91 struct udevice *dev;
92 char dev_name[30];
93 char *str;
94 int ret;
95
96 snprintf(dev_name, sizeof(dev_name), "%s.%s", parent->name, name);
97 str = strdup(dev_name);
98 if (!str)
99 return -ENOMEM;
100 ret = device_bind_driver(parent, drv_name, str, &dev);
101 if (ret)
102 return ret;
103 device_set_name_alloced(dev);
104 *devp = dev;
105
106 return 0;
107}
108
109int bootdev_find_in_blk(struct udevice *dev, struct udevice *blk,
110 struct bootflow_iter *iter, struct bootflow *bflow)
111{
Simon Glass831405f2023-08-24 13:55:43 -0600112 struct bootmeth_uc_plat *plat = dev_get_uclass_plat(bflow->method);
113 bool allow_any_part = plat->flags & BOOTMETHF_ANY_PART;
Simon Glass201417d2022-04-24 23:31:07 -0600114 struct blk_desc *desc = dev_get_uclass_plat(blk);
115 struct disk_partition info;
116 char partstr[20];
117 char name[60];
118 int ret;
119
120 /* Sanity check */
121 if (iter->part >= MAX_PART_PER_BOOTDEV)
122 return log_msg_ret("max", -ESHUTDOWN);
123
124 bflow->blk = blk;
125 if (iter->part)
126 snprintf(partstr, sizeof(partstr), "part_%x", iter->part);
127 else
128 strcpy(partstr, "whole");
129 snprintf(name, sizeof(name), "%s.%s", dev->name, partstr);
130 bflow->name = strdup(name);
131 if (!bflow->name)
132 return log_msg_ret("name", -ENOMEM);
133
134 bflow->part = iter->part;
135
Simon Glassa8f5be12022-04-24 23:31:09 -0600136 ret = bootmeth_check(bflow->method, iter);
137 if (ret)
138 return log_msg_ret("check", ret);
139
Simon Glass201417d2022-04-24 23:31:07 -0600140 /*
141 * partition numbers start at 0 so this cannot succeed, but it can tell
142 * us whether there is valid media there
143 */
144 ret = part_get_info(desc, iter->part, &info);
Simon Glass831405f2023-08-24 13:55:43 -0600145 log_debug("part_get_info() returned %d\n", ret);
Simon Glass201417d2022-04-24 23:31:07 -0600146 if (!iter->part && ret == -ENOENT)
147 ret = 0;
148
149 /*
150 * This error indicates the media is not present. Otherwise we just
151 * blindly scan the next partition. We could be more intelligent here
152 * and check which partition numbers actually exist.
153 */
154 if (ret == -EOPNOTSUPP)
155 ret = -ESHUTDOWN;
156 else
157 bflow->state = BOOTFLOWST_MEDIA;
Simon Glass831405f2023-08-24 13:55:43 -0600158 if (ret && !allow_any_part) {
Simon Glass76afc842023-04-28 13:18:09 -0600159 /* allow partition 1 to be missing */
160 if (iter->part == 1) {
161 iter->max_part = 3;
162 ret = -ENOENT;
163 }
164
Simon Glass201417d2022-04-24 23:31:07 -0600165 return log_msg_ret("part", ret);
Simon Glass76afc842023-04-28 13:18:09 -0600166 }
Simon Glass201417d2022-04-24 23:31:07 -0600167
168 /*
169 * Currently we don't get the number of partitions, so just
170 * assume a large number
171 */
172 iter->max_part = MAX_PART_PER_BOOTDEV;
173
Nam Cao11324712024-02-21 13:41:44 +0100174 if (iter->flags & BOOTFLOWIF_SINGLE_PARTITION) {
175 /* a particular partition was specified, scan it without checking */
176 } else if (!iter->part) {
177 /* This is the whole disk, check if we have bootable partitions */
Simon Glassf0e358f2023-01-17 10:47:42 -0700178 iter->first_bootable = part_get_bootable(desc);
179 log_debug("checking bootable=%d\n", iter->first_bootable);
Simon Glass831405f2023-08-24 13:55:43 -0600180 } else if (allow_any_part) {
181 /*
182 * allow any partition to be scanned, by skipping any checks
183 * for filesystems or partition contents on this disk
184 */
Simon Glassf0e358f2023-01-17 10:47:42 -0700185
186 /* if there are bootable partitions, scan only those */
Simon Glass831405f2023-08-24 13:55:43 -0600187 } else if (iter->first_bootable >= 0 &&
188 (iter->first_bootable ? !info.bootable : iter->part != 1)) {
Simon Glassf0e358f2023-01-17 10:47:42 -0700189 return log_msg_ret("boot", -EINVAL);
190 } else {
Simon Glass201417d2022-04-24 23:31:07 -0600191 ret = fs_set_blk_dev_with_part(desc, bflow->part);
192 bflow->state = BOOTFLOWST_PART;
Simon Glass1aabe4e2023-04-24 13:49:49 +1200193 if (ret)
194 return log_msg_ret("fs", ret);
Simon Glass201417d2022-04-24 23:31:07 -0600195
Simon Glass201417d2022-04-24 23:31:07 -0600196 log_debug("%s: Found partition %x type %x fstype %d\n",
Simon Glassb2b7e6c2023-08-24 13:55:33 -0600197 blk->name, bflow->part,
198 IS_ENABLED(CONFIG_DOS_PARTITION) ?
199 disk_partition_sys_ind(&info) : 0,
Simon Glass201417d2022-04-24 23:31:07 -0600200 ret ? -1 : fs_get_type());
Simon Glass1aabe4e2023-04-24 13:49:49 +1200201 bflow->blk = blk;
Simon Glass201417d2022-04-24 23:31:07 -0600202 bflow->state = BOOTFLOWST_FS;
203 }
204
Simon Glass831405f2023-08-24 13:55:43 -0600205 log_debug("method %s\n", bflow->method->name);
Simon Glassa8f5be12022-04-24 23:31:09 -0600206 ret = bootmeth_read_bootflow(bflow->method, bflow);
207 if (ret)
208 return log_msg_ret("method", ret);
209
Simon Glass201417d2022-04-24 23:31:07 -0600210 return 0;
211}
212
213void bootdev_list(bool probe)
214{
215 struct udevice *dev;
216 int ret;
217 int i;
218
219 printf("Seq Probed Status Uclass Name\n");
220 printf("--- ------ ------ -------- ------------------\n");
221 if (probe)
Michal Suchanek28a22cd2022-10-12 21:57:53 +0200222 ret = uclass_first_device_check(UCLASS_BOOTDEV, &dev);
Simon Glass201417d2022-04-24 23:31:07 -0600223 else
224 ret = uclass_find_first_device(UCLASS_BOOTDEV, &dev);
225 for (i = 0; dev; i++) {
226 printf("%3x [ %c ] %6s %-9.9s %s\n", dev_seq(dev),
227 device_active(dev) ? '+' : ' ',
Heinrich Schuchardtca9d9262023-07-30 16:29:25 +0200228 ret ? simple_itoa(-ret) : "OK",
Simon Glass201417d2022-04-24 23:31:07 -0600229 dev_get_uclass_name(dev_get_parent(dev)), dev->name);
230 if (probe)
Michal Suchanek28a22cd2022-10-12 21:57:53 +0200231 ret = uclass_next_device_check(&dev);
Simon Glass201417d2022-04-24 23:31:07 -0600232 else
233 ret = uclass_find_next_device(&dev);
234 }
235 printf("--- ------ ------ -------- ------------------\n");
236 printf("(%d bootdev%s)\n", i, i != 1 ? "s" : "");
237}
238
239int bootdev_setup_for_dev(struct udevice *parent, const char *drv_name)
240{
241 struct udevice *bdev;
242 int ret;
243
244 ret = device_find_first_child_by_uclass(parent, UCLASS_BOOTDEV,
245 &bdev);
246 if (ret) {
247 if (ret != -ENODEV) {
248 log_debug("Cannot access bootdev device\n");
249 return ret;
250 }
251
252 ret = bootdev_bind(parent, drv_name, "bootdev", &bdev);
253 if (ret) {
254 log_debug("Cannot create bootdev device\n");
255 return ret;
256 }
257 }
258
259 return 0;
260}
261
Simon Glass3a2cb96e52023-01-17 10:47:25 -0700262static int bootdev_get_suffix_start(struct udevice *dev, const char *suffix)
263{
264 int len, slen;
265
266 len = strlen(dev->name);
267 slen = strlen(suffix);
268 if (len > slen && !strcmp(suffix, dev->name + len - slen))
269 return len - slen;
270
271 return len;
272}
273
Simon Glassd7d78572023-07-30 11:15:14 -0600274int bootdev_setup_for_sibling_blk(struct udevice *blk, const char *drv_name)
Simon Glass201417d2022-04-24 23:31:07 -0600275{
276 struct udevice *parent, *dev;
277 char dev_name[50];
Simon Glass3a2cb96e52023-01-17 10:47:25 -0700278 int ret, len;
Simon Glass201417d2022-04-24 23:31:07 -0600279
Simon Glass3a2cb96e52023-01-17 10:47:25 -0700280 len = bootdev_get_suffix_start(blk, ".blk");
281 snprintf(dev_name, sizeof(dev_name), "%.*s.%s", len, blk->name,
282 "bootdev");
Simon Glass201417d2022-04-24 23:31:07 -0600283
284 parent = dev_get_parent(blk);
285 ret = device_find_child_by_name(parent, dev_name, &dev);
286 if (ret) {
287 char *str;
288
289 if (ret != -ENODEV) {
290 log_debug("Cannot access bootdev device\n");
291 return ret;
292 }
293 str = strdup(dev_name);
294 if (!str)
295 return -ENOMEM;
296
297 ret = device_bind_driver(parent, drv_name, str, &dev);
298 if (ret) {
299 log_debug("Cannot create bootdev device\n");
300 return ret;
301 }
302 device_set_name_alloced(dev);
303 }
304
305 return 0;
306}
307
308int bootdev_get_sibling_blk(struct udevice *dev, struct udevice **blkp)
309{
310 struct udevice *parent = dev_get_parent(dev);
311 struct udevice *blk;
312 int ret, len;
Simon Glass201417d2022-04-24 23:31:07 -0600313
314 if (device_get_uclass_id(dev) != UCLASS_BOOTDEV)
315 return -EINVAL;
316
Simon Glassd7d78572023-07-30 11:15:14 -0600317 /*
318 * This should always work if bootdev_setup_for_sibling_blk() was used
319 */
Simon Glass3a2cb96e52023-01-17 10:47:25 -0700320 len = bootdev_get_suffix_start(dev, ".bootdev");
Simon Glass201417d2022-04-24 23:31:07 -0600321 ret = device_find_child_by_namelen(parent, dev->name, len, &blk);
Simon Glass3a2cb96e52023-01-17 10:47:25 -0700322 if (ret) {
323 char dev_name[50];
324
325 snprintf(dev_name, sizeof(dev_name), "%.*s.blk", len,
326 dev->name);
327 ret = device_find_child_by_name(parent, dev_name, &blk);
328 if (ret)
329 return log_msg_ret("find", ret);
330 }
Simon Glass965020c2023-01-28 15:00:19 -0700331 ret = device_probe(blk);
332 if (ret)
333 return log_msg_ret("act", ret);
Simon Glass201417d2022-04-24 23:31:07 -0600334 *blkp = blk;
335
336 return 0;
337}
338
339static int bootdev_get_from_blk(struct udevice *blk, struct udevice **bootdevp)
340{
341 struct udevice *parent = dev_get_parent(blk);
342 struct udevice *bootdev;
343 char dev_name[50];
Simon Glass3a2cb96e52023-01-17 10:47:25 -0700344 int ret, len;
Simon Glass201417d2022-04-24 23:31:07 -0600345
346 if (device_get_uclass_id(blk) != UCLASS_BLK)
347 return -EINVAL;
348
Simon Glassd7d78572023-07-30 11:15:14 -0600349 /* This should always work if bootdev_setup_for_sibling_blk() was used */
Simon Glass3a2cb96e52023-01-17 10:47:25 -0700350 len = bootdev_get_suffix_start(blk, ".blk");
351 snprintf(dev_name, sizeof(dev_name), "%.*s.%s", len, blk->name,
352 "bootdev");
Simon Glass201417d2022-04-24 23:31:07 -0600353 ret = device_find_child_by_name(parent, dev_name, &bootdev);
354 if (ret)
355 return log_msg_ret("find", ret);
356 *bootdevp = bootdev;
357
358 return 0;
359}
360
361int bootdev_unbind_dev(struct udevice *parent)
362{
363 struct udevice *dev;
364 int ret;
365
366 ret = device_find_first_child_by_uclass(parent, UCLASS_BOOTDEV, &dev);
367 if (!ret) {
368 ret = device_remove(dev, DM_REMOVE_NORMAL);
369 if (ret)
370 return log_msg_ret("rem", ret);
371 ret = device_unbind(dev);
372 if (ret)
373 return log_msg_ret("unb", ret);
374 }
375
376 return 0;
377}
378
379/**
Simon Glass74ebfb62023-01-17 10:48:00 -0700380 * label_to_uclass() - Convert a label to a uclass and sequence number
381 *
382 * @label: Label to look up (e.g. "mmc1" or "mmc0")
383 * @seqp: Returns the sequence number, or -1 if none
Simon Glassd9f48572023-01-17 10:48:05 -0700384 * @method_flagsp: If non-NULL, returns any flags implied by the label
385 * (enum bootflow_meth_flags_t), 0 if none
Simon Glass1736b4a2023-04-24 13:49:47 +1200386 * Returns: sequence number on success, -EPFNOSUPPORT is the uclass is not
387 * known, other -ve error code on other error
Simon Glass74ebfb62023-01-17 10:48:00 -0700388 */
Simon Glassd9f48572023-01-17 10:48:05 -0700389static int label_to_uclass(const char *label, int *seqp, int *method_flagsp)
Simon Glass74ebfb62023-01-17 10:48:00 -0700390{
Simon Glassd9f48572023-01-17 10:48:05 -0700391 int seq, len, method_flags;
Simon Glass74ebfb62023-01-17 10:48:00 -0700392 enum uclass_id id;
393 const char *end;
Simon Glass74ebfb62023-01-17 10:48:00 -0700394
Simon Glassd9f48572023-01-17 10:48:05 -0700395 method_flags = 0;
Simon Glass74ebfb62023-01-17 10:48:00 -0700396 seq = trailing_strtoln_end(label, NULL, &end);
397 len = end - label;
398 if (!len)
399 return -EINVAL;
400 id = uclass_get_by_namelen(label, len);
401 log_debug("find %s: seq=%d, id=%d/%s\n", label, seq, id,
402 uclass_get_name(id));
403 if (id == UCLASS_INVALID) {
Simon Glass0c1f4a92023-01-17 10:48:03 -0700404 /* try some special cases */
405 if (IS_ENABLED(CONFIG_BOOTDEV_SPI_FLASH) &&
406 !strncmp("spi", label, len)) {
407 id = UCLASS_SPI_FLASH;
Simon Glassd9f48572023-01-17 10:48:05 -0700408 } else if (IS_ENABLED(CONFIG_BOOTDEV_ETH) &&
409 !strncmp("pxe", label, len)) {
410 id = UCLASS_ETH;
411 method_flags |= BOOTFLOW_METHF_PXE_ONLY;
412 } else if (IS_ENABLED(CONFIG_BOOTDEV_ETH) &&
413 !strncmp("dhcp", label, len)) {
414 id = UCLASS_ETH;
415 method_flags |= BOOTFLOW_METHF_DHCP_ONLY;
Simon Glass0c1f4a92023-01-17 10:48:03 -0700416 } else {
Simon Glass1736b4a2023-04-24 13:49:47 +1200417 return -EPFNOSUPPORT;
Simon Glass0c1f4a92023-01-17 10:48:03 -0700418 }
Simon Glass74ebfb62023-01-17 10:48:00 -0700419 }
420 if (id == UCLASS_USB)
421 id = UCLASS_MASS_STORAGE;
422 *seqp = seq;
Simon Glassd9f48572023-01-17 10:48:05 -0700423 if (method_flagsp)
424 *method_flagsp = method_flags;
Simon Glass74ebfb62023-01-17 10:48:00 -0700425
426 return id;
427}
428
Simon Glassd9f48572023-01-17 10:48:05 -0700429int bootdev_find_by_label(const char *label, struct udevice **devp,
430 int *method_flagsp)
Simon Glass201417d2022-04-24 23:31:07 -0600431{
Simon Glassd9f48572023-01-17 10:48:05 -0700432 int seq, ret, method_flags = 0;
Simon Glass201417d2022-04-24 23:31:07 -0600433 struct udevice *media;
434 struct uclass *uc;
435 enum uclass_id id;
Simon Glass201417d2022-04-24 23:31:07 -0600436
Simon Glassd9f48572023-01-17 10:48:05 -0700437 ret = label_to_uclass(label, &seq, &method_flags);
Simon Glass74ebfb62023-01-17 10:48:00 -0700438 if (ret < 0)
439 return log_msg_ret("uc", ret);
440 id = ret;
Simon Glass201417d2022-04-24 23:31:07 -0600441
442 /* Iterate through devices in the media uclass (e.g. UCLASS_MMC) */
443 uclass_id_foreach_dev(id, media, uc) {
444 struct udevice *bdev, *blk;
445 int ret;
446
447 /* if there is no seq, match anything */
448 if (seq != -1 && dev_seq(media) != seq) {
449 log_debug("- skip, media seq=%d\n", dev_seq(media));
450 continue;
451 }
452
453 ret = device_find_first_child_by_uclass(media, UCLASS_BOOTDEV,
454 &bdev);
455 if (ret) {
456 log_debug("- looking via blk, seq=%d, id=%d\n", seq,
457 id);
458 ret = blk_find_device(id, seq, &blk);
459 if (!ret) {
460 log_debug("- get from blk %s\n", blk->name);
461 ret = bootdev_get_from_blk(blk, &bdev);
462 }
463 }
464 if (!ret) {
465 log_debug("- found %s\n", bdev->name);
466 *devp = bdev;
Simon Glass66e3dce2023-01-17 10:48:09 -0700467
468 /*
469 * if no sequence number was provided, we must scan all
470 * bootdevs for this media uclass
471 */
Simon Glasse824d0d2023-09-23 14:50:15 -0600472 if (seq == -1)
Simon Glass66e3dce2023-01-17 10:48:09 -0700473 method_flags |= BOOTFLOW_METHF_SINGLE_UCLASS;
Simon Glassd9f48572023-01-17 10:48:05 -0700474 if (method_flagsp)
475 *method_flagsp = method_flags;
Simon Glasse824d0d2023-09-23 14:50:15 -0600476 log_debug("method flags %x\n", method_flags);
Simon Glass201417d2022-04-24 23:31:07 -0600477 return 0;
478 }
479 log_debug("- no device in %s\n", media->name);
480 }
Simon Glass201417d2022-04-24 23:31:07 -0600481
482 return -ENOENT;
483}
484
Simon Glassd9f48572023-01-17 10:48:05 -0700485int bootdev_find_by_any(const char *name, struct udevice **devp,
486 int *method_flagsp)
Simon Glass201417d2022-04-24 23:31:07 -0600487{
488 struct udevice *dev;
Simon Glassd9f48572023-01-17 10:48:05 -0700489 int method_flags = 0;
Simon Glass66e3dce2023-01-17 10:48:09 -0700490 int ret = -ENODEV, seq;
Simon Glass201417d2022-04-24 23:31:07 -0600491 char *endp;
492
493 seq = simple_strtol(name, &endp, 16);
494
495 /* Select by name, label or number */
496 if (*endp) {
497 ret = uclass_get_device_by_name(UCLASS_BOOTDEV, name, &dev);
498 if (ret == -ENODEV) {
Simon Glassd9f48572023-01-17 10:48:05 -0700499 ret = bootdev_find_by_label(name, &dev, &method_flags);
Simon Glass201417d2022-04-24 23:31:07 -0600500 if (ret) {
501 printf("Cannot find bootdev '%s' (err=%d)\n",
502 name, ret);
Simon Glassd9f48572023-01-17 10:48:05 -0700503 return log_msg_ret("lab", ret);
Simon Glass201417d2022-04-24 23:31:07 -0600504 }
505 ret = device_probe(dev);
506 }
507 if (ret) {
508 printf("Cannot probe bootdev '%s' (err=%d)\n", name,
509 ret);
Simon Glassd9f48572023-01-17 10:48:05 -0700510 return log_msg_ret("pro", ret);
Simon Glass201417d2022-04-24 23:31:07 -0600511 }
Simon Glass66e3dce2023-01-17 10:48:09 -0700512 } else if (IS_ENABLED(CONFIG_BOOTSTD_FULL)) {
Simon Glass201417d2022-04-24 23:31:07 -0600513 ret = uclass_get_device_by_seq(UCLASS_BOOTDEV, seq, &dev);
Simon Glass66e3dce2023-01-17 10:48:09 -0700514 method_flags |= BOOTFLOW_METHF_SINGLE_DEV;
Simon Glass201417d2022-04-24 23:31:07 -0600515 }
516 if (ret) {
517 printf("Cannot find '%s' (err=%d)\n", name, ret);
518 return ret;
519 }
520
521 *devp = dev;
Simon Glassd9f48572023-01-17 10:48:05 -0700522 if (method_flagsp)
523 *method_flagsp = method_flags;
Simon Glass201417d2022-04-24 23:31:07 -0600524
525 return 0;
526}
527
Simon Glass66e3dce2023-01-17 10:48:09 -0700528int bootdev_hunt_and_find_by_label(const char *label, struct udevice **devp,
529 int *method_flagsp)
530{
531 int ret;
532
533 ret = bootdev_hunt(label, false);
534 if (ret)
535 return log_msg_ret("scn", ret);
536 ret = bootdev_find_by_label(label, devp, method_flagsp);
537 if (ret)
538 return log_msg_ret("fnd", ret);
539
540 return 0;
541}
542
Simon Glassb85fc8d2023-01-17 10:47:26 -0700543static int default_get_bootflow(struct udevice *dev, struct bootflow_iter *iter,
544 struct bootflow *bflow)
545{
546 struct udevice *blk;
547 int ret;
548
549 ret = bootdev_get_sibling_blk(dev, &blk);
Simon Glass3500ae12023-07-30 11:15:16 -0600550 log_debug("sibling_blk ret=%d, blk=%s\n", ret,
551 ret ? "(none)" : blk->name);
Simon Glassb85fc8d2023-01-17 10:47:26 -0700552 /*
553 * If there is no media, indicate that no more partitions should be
554 * checked
555 */
556 if (ret == -EOPNOTSUPP)
557 ret = -ESHUTDOWN;
558 if (ret)
559 return log_msg_ret("blk", ret);
560 assert(blk);
561 ret = bootdev_find_in_blk(dev, blk, iter, bflow);
562 if (ret)
563 return log_msg_ret("find", ret);
564
565 return 0;
566}
567
Simon Glass201417d2022-04-24 23:31:07 -0600568int bootdev_get_bootflow(struct udevice *dev, struct bootflow_iter *iter,
569 struct bootflow *bflow)
570{
571 const struct bootdev_ops *ops = bootdev_get_ops(dev);
572
Simon Glass831405f2023-08-24 13:55:43 -0600573 log_debug("->get_bootflow %s,%x=%p\n", dev->name, iter->part,
574 ops->get_bootflow);
Simon Glassb190deb2022-10-20 18:22:51 -0600575 bootflow_init(bflow, dev, iter->method);
Simon Glassb85fc8d2023-01-17 10:47:26 -0700576 if (!ops->get_bootflow)
577 return default_get_bootflow(dev, iter, bflow);
Simon Glass201417d2022-04-24 23:31:07 -0600578
579 return ops->get_bootflow(dev, iter, bflow);
580}
581
582void bootdev_clear_bootflows(struct udevice *dev)
583{
584 struct bootdev_uc_plat *ucp = dev_get_uclass_plat(dev);
585
586 while (!list_empty(&ucp->bootflow_head)) {
587 struct bootflow *bflow;
588
589 bflow = list_first_entry(&ucp->bootflow_head, struct bootflow,
590 bm_node);
Simon Glassa8f5be12022-04-24 23:31:09 -0600591 bootflow_remove(bflow);
Simon Glass201417d2022-04-24 23:31:07 -0600592 }
593}
594
Simon Glasse4b69482023-01-17 10:48:10 -0700595int bootdev_next_label(struct bootflow_iter *iter, struct udevice **devp,
596 int *method_flagsp)
597{
598 struct udevice *dev;
599
600 log_debug("next\n");
601 for (dev = NULL; !dev && iter->labels[++iter->cur_label];) {
Simon Glass1736b4a2023-04-24 13:49:47 +1200602 const char *label = iter->labels[iter->cur_label];
603 int ret;
604
605 log_debug("Scanning: %s\n", label);
606 ret = bootdev_hunt_and_find_by_label(label, &dev,
607 method_flagsp);
608 if (iter->flags & BOOTFLOWIF_SHOW) {
609 if (ret == -EPFNOSUPPORT) {
610 log_warning("Unknown uclass '%s' in label\n",
611 label);
612 } else if (ret == -ENOENT) {
613 /*
614 * looking for, e.g. 'scsi0' should find
615 * something if SCSI is present
616 */
617 if (!trailing_strtol(label)) {
618 log_warning("No bootdevs for '%s'\n",
619 label);
620 }
621 }
622 }
623
Simon Glasse4b69482023-01-17 10:48:10 -0700624 }
625
626 if (!dev)
627 return log_msg_ret("fin", -ENODEV);
628 *devp = dev;
629
630 return 0;
631}
632
Simon Glass43e89a32023-01-17 10:48:11 -0700633int bootdev_next_prio(struct bootflow_iter *iter, struct udevice **devp)
634{
Caleb Connolly9d92c412024-01-04 16:03:35 +0000635 struct udevice *dev = *devp, *last_dev = NULL;
Simon Glass43e89a32023-01-17 10:48:11 -0700636 bool found;
637 int ret;
638
639 /* find the next device with this priority */
640 *devp = NULL;
641 log_debug("next prio %d: dev=%p/%s\n", iter->cur_prio, dev,
642 dev ? dev->name : "none");
643 do {
644 /*
645 * Don't probe devices here since they may not be of the
646 * required priority
647 */
648 if (!dev)
649 uclass_find_first_device(UCLASS_BOOTDEV, &dev);
650 else
651 uclass_find_next_device(&dev);
652 found = false;
653
654 /* scan for the next device with the correct priority */
655 while (dev) {
656 struct bootdev_uc_plat *plat;
657
658 plat = dev_get_uclass_plat(dev);
659 log_debug("- %s: %d, want %d\n", dev->name, plat->prio,
660 iter->cur_prio);
661 if (plat->prio == iter->cur_prio)
662 break;
663 uclass_find_next_device(&dev);
664 }
665
666 /* none found for this priority, so move to the next */
667 if (!dev) {
668 log_debug("None found at prio %d, moving to %d\n",
669 iter->cur_prio, iter->cur_prio + 1);
670 if (++iter->cur_prio == BOOTDEVP_COUNT)
671 return log_msg_ret("fin", -ENODEV);
672
Simon Glass4f806f32023-02-22 12:17:03 -0700673 if (iter->flags & BOOTFLOWIF_HUNT) {
Simon Glass43e89a32023-01-17 10:48:11 -0700674 /* hunt to find new bootdevs */
675 ret = bootdev_hunt_prio(iter->cur_prio,
676 iter->flags &
Simon Glass4f806f32023-02-22 12:17:03 -0700677 BOOTFLOWIF_SHOW);
Simon Glass3500ae12023-07-30 11:15:16 -0600678 log_debug("- bootdev_hunt_prio() ret %d\n",
679 ret);
Simon Glass43e89a32023-01-17 10:48:11 -0700680 if (ret)
681 return log_msg_ret("hun", ret);
682 }
683 } else {
684 ret = device_probe(dev);
Caleb Connolly9d92c412024-01-04 16:03:35 +0000685 if (!ret)
686 last_dev = dev;
Simon Glass43e89a32023-01-17 10:48:11 -0700687 if (ret) {
Caleb Connolly9d92c412024-01-04 16:03:35 +0000688 log_warning("Device '%s' failed to probe\n",
Simon Glass43e89a32023-01-17 10:48:11 -0700689 dev->name);
Caleb Connolly9d92c412024-01-04 16:03:35 +0000690 if (last_dev == dev) {
691 /*
692 * We have already tried this device
693 * and it failed to probe. Give up.
694 */
695 return log_msg_ret("probe", ret);
696 }
697 last_dev = dev;
Simon Glass43e89a32023-01-17 10:48:11 -0700698 dev = NULL;
699 }
700 }
701 } while (!dev);
702
703 *devp = dev;
704
705 return 0;
706}
707
Simon Glass91943ff2023-01-17 10:48:15 -0700708int bootdev_setup_iter(struct bootflow_iter *iter, const char *label,
709 struct udevice **devp, int *method_flagsp)
Simon Glass201417d2022-04-24 23:31:07 -0600710{
Simon Glass91943ff2023-01-17 10:48:15 -0700711 struct udevice *bootstd, *dev = NULL;
Simon Glass4f806f32023-02-22 12:17:03 -0700712 bool show = iter->flags & BOOTFLOWIF_SHOW;
Simon Glass47aedc22023-01-17 10:48:14 -0700713 int method_flags;
Nam Cao11324712024-02-21 13:41:44 +0100714 char buf[32];
Simon Glass201417d2022-04-24 23:31:07 -0600715 int ret;
716
Nam Cao11324712024-02-21 13:41:44 +0100717 if (label) {
718 const char *end = strchr(label, ':');
719
720 if (end) {
721 size_t len = (size_t)(end - label);
722 const char *part = end + 1;
723
724 if (len + 1 > sizeof(buf)) {
725 log_err("label \"%s\" is way too long\n", label);
726 return -EINVAL;
727 }
728
729 memcpy(buf, label, len);
730 buf[len] = '\0';
731 label = buf;
732
733 unsigned long tmp;
734
735 if (strict_strtoul(part, 0, &tmp)) {
736 log_err("Invalid partition number: %s\n", part);
737 return -EINVAL;
738 }
739
740 iter->flags |= BOOTFLOWIF_SINGLE_PARTITION;
741 iter->part = tmp;
742 }
743 }
744
Simon Glass201417d2022-04-24 23:31:07 -0600745 ret = uclass_first_device_err(UCLASS_BOOTSTD, &bootstd);
746 if (ret) {
747 log_err("Missing bootstd device\n");
748 return log_msg_ret("std", ret);
749 }
750
Simon Glasseacc2612023-01-17 10:48:08 -0700751 /* hunt for any pre-scan devices */
Simon Glass4f806f32023-02-22 12:17:03 -0700752 if (iter->flags & BOOTFLOWIF_HUNT) {
Simon Glasseacc2612023-01-17 10:48:08 -0700753 ret = bootdev_hunt_prio(BOOTDEVP_1_PRE_SCAN, show);
Simon Glass3500ae12023-07-30 11:15:16 -0600754 log_debug("- bootdev_hunt_prio() ret %d\n", ret);
Simon Glasseacc2612023-01-17 10:48:08 -0700755 if (ret)
756 return log_msg_ret("pre", ret);
757 }
758
Simon Glass201417d2022-04-24 23:31:07 -0600759 /* Handle scanning a single device */
Simon Glass91943ff2023-01-17 10:48:15 -0700760 if (IS_ENABLED(CONFIG_BOOTSTD_FULL) && label) {
Simon Glass4f806f32023-02-22 12:17:03 -0700761 if (iter->flags & BOOTFLOWIF_HUNT) {
Simon Glass91943ff2023-01-17 10:48:15 -0700762 ret = bootdev_hunt(label, show);
763 if (ret)
764 return log_msg_ret("hun", ret);
765 }
766 ret = bootdev_find_by_any(label, &dev, &method_flags);
767 if (ret)
768 return log_msg_ret("lab", ret);
769
770 log_debug("method_flags: %x\n", method_flags);
771 if (method_flags & BOOTFLOW_METHF_SINGLE_UCLASS)
Simon Glass4f806f32023-02-22 12:17:03 -0700772 iter->flags |= BOOTFLOWIF_SINGLE_UCLASS;
Simon Glass91943ff2023-01-17 10:48:15 -0700773 else if (method_flags & BOOTFLOW_METHF_SINGLE_DEV)
Simon Glass4f806f32023-02-22 12:17:03 -0700774 iter->flags |= BOOTFLOWIF_SINGLE_DEV;
Simon Glass91943ff2023-01-17 10:48:15 -0700775 else
Simon Glass4f806f32023-02-22 12:17:03 -0700776 iter->flags |= BOOTFLOWIF_SINGLE_MEDIA;
Simon Glass91943ff2023-01-17 10:48:15 -0700777 log_debug("Selected label: %s, flags %x\n", label, iter->flags);
Simon Glass47aedc22023-01-17 10:48:14 -0700778 } else {
779 bool ok;
780
781 /* This either returns a non-empty list or NULL */
782 iter->labels = bootstd_get_bootdev_order(bootstd, &ok);
783 if (!ok)
784 return log_msg_ret("ord", -ENOMEM);
785 log_debug("setup labels %p\n", iter->labels);
786 if (iter->labels) {
787 iter->cur_label = -1;
788 ret = bootdev_next_label(iter, &dev, &method_flags);
789 } else {
790 ret = bootdev_next_prio(iter, &dev);
791 method_flags = 0;
792 }
793 if (!dev)
794 return log_msg_ret("fin", -ENOENT);
795 log_debug("Selected bootdev: %s\n", dev->name);
Simon Glass201417d2022-04-24 23:31:07 -0600796 }
797
Simon Glass201417d2022-04-24 23:31:07 -0600798 ret = device_probe(dev);
799 if (ret)
800 return log_msg_ret("probe", ret);
Simon Glass47aedc22023-01-17 10:48:14 -0700801 if (method_flagsp)
802 *method_flagsp = method_flags;
Simon Glass201417d2022-04-24 23:31:07 -0600803 *devp = dev;
804
805 return 0;
806}
807
Simon Glassc7b63d52023-01-17 10:47:34 -0700808static int bootdev_hunt_drv(struct bootdev_hunter *info, uint seq, bool show)
809{
810 const char *name = uclass_get_name(info->uclass);
811 struct bootstd_priv *std;
812 int ret;
813
814 ret = bootstd_get_priv(&std);
815 if (ret)
816 return log_msg_ret("std", ret);
817
818 if (!(std->hunters_used & BIT(seq))) {
819 if (show)
820 printf("Hunting with: %s\n",
821 uclass_get_name(info->uclass));
822 log_debug("Hunting with: %s\n", name);
823 if (info->hunt) {
824 ret = info->hunt(info, show);
Simon Glass3500ae12023-07-30 11:15:16 -0600825 log_debug(" - hunt result %d\n", ret);
Tony Dinhee2ce292023-11-02 11:51:15 -0700826 if (ret && ret != -ENOENT)
Simon Glassc7b63d52023-01-17 10:47:34 -0700827 return ret;
828 }
829 std->hunters_used |= BIT(seq);
830 }
831
832 return 0;
833}
834
835int bootdev_hunt(const char *spec, bool show)
836{
837 struct bootdev_hunter *start;
838 const char *end;
839 int n_ent, i;
840 int result;
841 size_t len;
842
843 start = ll_entry_start(struct bootdev_hunter, bootdev_hunter);
844 n_ent = ll_entry_count(struct bootdev_hunter, bootdev_hunter);
845 result = 0;
846
847 len = SIZE_MAX;
848 if (spec) {
849 trailing_strtoln_end(spec, NULL, &end);
850 len = end - spec;
851 }
852
853 for (i = 0; i < n_ent; i++) {
854 struct bootdev_hunter *info = start + i;
855 const char *name = uclass_get_name(info->uclass);
856 int ret;
857
858 log_debug("looking at %.*s for %s\n",
859 (int)max(strlen(name), len), spec, name);
Simon Glasse4b69482023-01-17 10:48:10 -0700860 if (spec && strncmp(spec, name, max(strlen(name), len))) {
861 if (info->uclass != UCLASS_ETH ||
862 (strcmp("dhcp", spec) && strcmp("pxe", spec)))
863 continue;
864 }
Simon Glassc7b63d52023-01-17 10:47:34 -0700865 ret = bootdev_hunt_drv(info, i, show);
866 if (ret)
867 result = ret;
868 }
869
870 return result;
871}
872
Simon Glass1b1d36e2023-09-20 07:29:49 -0600873int bootdev_unhunt(enum uclass_id id)
874{
875 struct bootdev_hunter *start;
876 int n_ent, i;
877
878 start = ll_entry_start(struct bootdev_hunter, bootdev_hunter);
879 n_ent = ll_entry_count(struct bootdev_hunter, bootdev_hunter);
880 for (i = 0; i < n_ent; i++) {
881 struct bootdev_hunter *info = start + i;
882
883 if (info->uclass == id) {
884 struct bootstd_priv *std;
885 int ret;
886
887 ret = bootstd_get_priv(&std);
888 if (ret)
889 return log_msg_ret("std", ret);
890 if (!(std->hunters_used & BIT(i)))
891 return -EALREADY;
892 std->hunters_used &= ~BIT(i);
893 return 0;
894 }
895 }
896
897 return -ENOENT;
898}
899
Simon Glass79a7d4a2023-01-17 10:48:07 -0700900int bootdev_hunt_prio(enum bootdev_prio_t prio, bool show)
901{
902 struct bootdev_hunter *start;
903 int n_ent, i;
904 int result;
905
906 start = ll_entry_start(struct bootdev_hunter, bootdev_hunter);
907 n_ent = ll_entry_count(struct bootdev_hunter, bootdev_hunter);
908 result = 0;
909
910 log_debug("Hunting for priority %d\n", prio);
911 for (i = 0; i < n_ent; i++) {
912 struct bootdev_hunter *info = start + i;
913 int ret;
914
915 if (prio != info->prio)
916 continue;
917 ret = bootdev_hunt_drv(info, i, show);
Simon Glass3500ae12023-07-30 11:15:16 -0600918 log_debug("bootdev_hunt_drv() return %d\n", ret);
Simon Glass79a7d4a2023-01-17 10:48:07 -0700919 if (ret && ret != -ENOENT)
920 result = ret;
921 }
Simon Glass3500ae12023-07-30 11:15:16 -0600922 log_debug("exit %d\n", result);
Simon Glass79a7d4a2023-01-17 10:48:07 -0700923
924 return result;
925}
926
Simon Glassbd90b092023-01-17 10:47:33 -0700927void bootdev_list_hunters(struct bootstd_priv *std)
928{
929 struct bootdev_hunter *orig, *start;
930 int n_ent, i;
931
932 orig = ll_entry_start(struct bootdev_hunter, bootdev_hunter);
933 n_ent = ll_entry_count(struct bootdev_hunter, bootdev_hunter);
934
935 /*
936 * workaround for strange bug in clang-12 which sees all the below data
937 * as zeroes. Any access of start seems to fix it, such as
938 *
939 * printf("%p", start);
940 *
941 * Use memcpy() to force the correct behaviour.
942 */
943 memcpy(&start, &orig, sizeof(orig));
944 printf("%4s %4s %-15s %s\n", "Prio", "Used", "Uclass", "Hunter");
945 printf("%4s %4s %-15s %s\n", "----", "----", "---------------", "---------------");
946 for (i = 0; i < n_ent; i++) {
947 struct bootdev_hunter *info = start + i;
948
949 printf("%4d %4s %-15s %s\n", info->prio,
950 std->hunters_used & BIT(i) ? "*" : "",
951 uclass_get_name(info->uclass),
952 info->drv ? info->drv->name : "(none)");
953 }
954
955 printf("(total hunters: %d)\n", n_ent);
956}
957
Simon Glass201417d2022-04-24 23:31:07 -0600958static int bootdev_post_bind(struct udevice *dev)
959{
960 struct bootdev_uc_plat *ucp = dev_get_uclass_plat(dev);
961
962 INIT_LIST_HEAD(&ucp->bootflow_head);
963
964 return 0;
965}
966
967static int bootdev_pre_unbind(struct udevice *dev)
968{
969 bootdev_clear_bootflows(dev);
970
971 return 0;
972}
973
974UCLASS_DRIVER(bootdev) = {
975 .id = UCLASS_BOOTDEV,
976 .name = "bootdev",
977 .flags = DM_UC_FLAG_SEQ_ALIAS,
978 .per_device_plat_auto = sizeof(struct bootdev_uc_plat),
979 .post_bind = bootdev_post_bind,
980 .pre_unbind = bootdev_pre_unbind,
981};