blob: 1ea2966ae9a5b8c56d92a81a399c78b4d0b5e19d [file] [log] [blame]
Simon Glass03fcbf92022-04-24 23:31:09 -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
9#include <common.h>
10#include <bootdev.h>
11#include <bootflow.h>
12#include <bootmeth.h>
13#include <bootstd.h>
14#include <dm.h>
Simon Glassb35513a2023-07-12 09:04:35 -060015#include <env_internal.h>
Simon Glass03fcbf92022-04-24 23:31:09 -060016#include <malloc.h>
Simon Glasscd91e992023-07-12 09:04:42 -060017#include <serial.h>
Simon Glass03fcbf92022-04-24 23:31:09 -060018#include <dm/device-internal.h>
19#include <dm/uclass-internal.h>
20
21/* error codes used to signal running out of things */
22enum {
23 BF_NO_MORE_PARTS = -ESHUTDOWN,
24 BF_NO_MORE_DEVICES = -ENODEV,
25};
26
27/**
28 * bootflow_state - name for each state
29 *
30 * See enum bootflow_state_t for what each of these means
31 */
32static const char *const bootflow_state[BOOTFLOWST_COUNT] = {
33 "base",
34 "media",
35 "part",
36 "fs",
37 "file",
38 "ready",
39};
40
41const char *bootflow_state_get_name(enum bootflow_state_t state)
42{
43 /* This doesn't need to be a useful name, since it will never occur */
44 if (state < 0 || state >= BOOTFLOWST_COUNT)
45 return "?";
46
47 return bootflow_state[state];
48}
49
50int bootflow_first_glob(struct bootflow **bflowp)
51{
52 struct bootstd_priv *std;
53 int ret;
54
55 ret = bootstd_get_priv(&std);
56 if (ret)
57 return ret;
58
59 if (list_empty(&std->glob_head))
60 return -ENOENT;
61
62 *bflowp = list_first_entry(&std->glob_head, struct bootflow,
63 glob_node);
64
65 return 0;
66}
67
68int bootflow_next_glob(struct bootflow **bflowp)
69{
70 struct bootstd_priv *std;
71 struct bootflow *bflow = *bflowp;
72 int ret;
73
74 ret = bootstd_get_priv(&std);
75 if (ret)
76 return ret;
77
78 *bflowp = NULL;
79
80 if (list_is_last(&bflow->glob_node, &std->glob_head))
81 return -ENOENT;
82
83 *bflowp = list_entry(bflow->glob_node.next, struct bootflow, glob_node);
84
85 return 0;
86}
87
88void bootflow_iter_init(struct bootflow_iter *iter, int flags)
89{
90 memset(iter, '\0', sizeof(*iter));
Simon Glass73fcf512022-07-30 15:52:25 -060091 iter->first_glob_method = -1;
Simon Glass03fcbf92022-04-24 23:31:09 -060092 iter->flags = flags;
Simon Glasscb2a5cd2023-01-17 10:48:17 -070093
94 /* remember the first bootdevs we see */
95 iter->max_devs = BOOTFLOW_MAX_USED_DEVS;
Simon Glass03fcbf92022-04-24 23:31:09 -060096}
97
98void bootflow_iter_uninit(struct bootflow_iter *iter)
99{
Simon Glass03fcbf92022-04-24 23:31:09 -0600100 free(iter->method_order);
101}
102
103int bootflow_iter_drop_bootmeth(struct bootflow_iter *iter,
104 const struct udevice *bmeth)
105{
106 /* We only support disabling the current bootmeth */
107 if (bmeth != iter->method || iter->cur_method >= iter->num_methods ||
108 iter->method_order[iter->cur_method] != bmeth)
109 return -EINVAL;
110
111 memmove(&iter->method_order[iter->cur_method],
112 &iter->method_order[iter->cur_method + 1],
113 (iter->num_methods - iter->cur_method - 1) * sizeof(void *));
114
115 iter->num_methods--;
116
117 return 0;
118}
119
Simon Glass484e4072023-01-17 10:48:14 -0700120/**
121 * bootflow_iter_set_dev() - switch to the next bootdev when iterating
122 *
123 * This sets iter->dev, records the device in the dev_used[] list and shows a
124 * message if required
125 *
126 * @iter: Iterator to update
127 * @dev: Bootdev to use, or NULL if there are no more
128 */
Simon Glass03fcbf92022-04-24 23:31:09 -0600129static void bootflow_iter_set_dev(struct bootflow_iter *iter,
Simon Glass484e4072023-01-17 10:48:14 -0700130 struct udevice *dev, int method_flags)
Simon Glass03fcbf92022-04-24 23:31:09 -0600131{
Simon Glass73fcf512022-07-30 15:52:25 -0600132 struct bootmeth_uc_plat *ucp = dev_get_uclass_plat(iter->method);
133
Simon Glass484e4072023-01-17 10:48:14 -0700134 log_debug("iter: Setting dev to %s, flags %x\n",
135 dev ? dev->name : "(none)", method_flags);
Simon Glass03fcbf92022-04-24 23:31:09 -0600136 iter->dev = dev;
Simon Glass484e4072023-01-17 10:48:14 -0700137 iter->method_flags = method_flags;
138
Simon Glasscb2a5cd2023-01-17 10:48:17 -0700139 if (IS_ENABLED(CONFIG_BOOTSTD_FULL)) {
140 /* record the device for later */
141 if (dev && iter->num_devs < iter->max_devs)
142 iter->dev_used[iter->num_devs++] = dev;
143
Simon Glass99e68182023-02-22 12:17:03 -0700144 if ((iter->flags & (BOOTFLOWIF_SHOW | BOOTFLOWIF_SINGLE_DEV)) ==
145 BOOTFLOWIF_SHOW) {
Simon Glasscb2a5cd2023-01-17 10:48:17 -0700146 if (dev)
147 printf("Scanning bootdev '%s':\n", dev->name);
148 else if (IS_ENABLED(CONFIG_BOOTMETH_GLOBAL) &&
149 ucp->flags & BOOTMETHF_GLOBAL)
150 printf("Scanning global bootmeth '%s':\n",
151 iter->method->name);
152 else
153 printf("No more bootdevs\n");
154 }
Simon Glass03fcbf92022-04-24 23:31:09 -0600155 }
156}
157
158/**
Simon Glass33795a92023-10-23 00:02:12 -0700159 * scan_next_in_uclass() - Scan for the next bootdev in the same media uclass
160 *
161 * Move through the following bootdevs until we find another in this media
162 * uclass, or run out
163 *
164 * @devp: On entry, the device to check, on exit the new device, or NULL if
165 * there is none
166 */
167static void scan_next_in_uclass(struct udevice **devp)
168{
169 struct udevice *dev = *devp;
170 enum uclass_id cur_id = device_get_uclass_id(dev->parent);
171
172 do {
173 uclass_find_next_device(&dev);
174 } while (dev && cur_id != device_get_uclass_id(dev->parent));
175
176 *devp = dev;
177}
178
179/**
Simon Glass03fcbf92022-04-24 23:31:09 -0600180 * iter_incr() - Move to the next item (method, part, bootdev)
181 *
182 * Return: 0 if OK, BF_NO_MORE_DEVICES if there are no more bootdevs
183 */
184static int iter_incr(struct bootflow_iter *iter)
185{
186 struct udevice *dev;
Simon Glass73fcf512022-07-30 15:52:25 -0600187 bool inc_dev = true;
188 bool global;
Simon Glass03fcbf92022-04-24 23:31:09 -0600189 int ret;
190
Simon Glass484e4072023-01-17 10:48:14 -0700191 log_debug("entry: err=%d\n", iter->err);
Simon Glass73fcf512022-07-30 15:52:25 -0600192 global = iter->doing_global;
193
Simon Glass03fcbf92022-04-24 23:31:09 -0600194 if (iter->err == BF_NO_MORE_DEVICES)
195 return BF_NO_MORE_DEVICES;
196
197 if (iter->err != BF_NO_MORE_PARTS) {
198 /* Get the next boothmethod */
199 if (++iter->cur_method < iter->num_methods) {
200 iter->method = iter->method_order[iter->cur_method];
201 return 0;
202 }
Simon Glass73fcf512022-07-30 15:52:25 -0600203
204 /*
205 * If we have finished scanning the global bootmeths, start the
206 * normal bootdev scan
207 */
208 if (IS_ENABLED(CONFIG_BOOTMETH_GLOBAL) && global) {
209 iter->num_methods = iter->first_glob_method;
210 iter->doing_global = false;
211
212 /*
213 * Don't move to the next dev as we haven't tried this
214 * one yet!
215 */
216 inc_dev = false;
217 }
Simon Glass03fcbf92022-04-24 23:31:09 -0600218 }
219
220 /* No more bootmeths; start at the first one, and... */
221 iter->cur_method = 0;
222 iter->method = iter->method_order[iter->cur_method];
223
224 if (iter->err != BF_NO_MORE_PARTS) {
225 /* ...select next partition */
226 if (++iter->part <= iter->max_part)
227 return 0;
228 }
229
Simon Glass484e4072023-01-17 10:48:14 -0700230 /* No more partitions; start at the first one and... */
Simon Glass03fcbf92022-04-24 23:31:09 -0600231 iter->part = 0;
232
233 /*
234 * Note: as far as we know, there is no partition table on the next
235 * bootdev, so set max_part to 0 until we discover otherwise. See
236 * bootdev_find_in_blk() for where this is set.
237 */
238 iter->max_part = 0;
239
240 /* ...select next bootdev */
Simon Glass99e68182023-02-22 12:17:03 -0700241 if (iter->flags & BOOTFLOWIF_SINGLE_DEV) {
Simon Glass03fcbf92022-04-24 23:31:09 -0600242 ret = -ENOENT;
Simon Glass03fcbf92022-04-24 23:31:09 -0600243 } else {
Simon Glass484e4072023-01-17 10:48:14 -0700244 int method_flags;
245
246 ret = 0;
247 dev = iter->dev;
248 log_debug("inc_dev=%d\n", inc_dev);
249 if (!inc_dev) {
Simon Glassba3d5372023-01-17 10:48:15 -0700250 ret = bootdev_setup_iter(iter, NULL, &dev,
251 &method_flags);
252 } else if (IS_ENABLED(CONFIG_BOOTSTD_FULL) &&
Simon Glass99e68182023-02-22 12:17:03 -0700253 (iter->flags & BOOTFLOWIF_SINGLE_UCLASS)) {
Simon Glass33795a92023-10-23 00:02:12 -0700254 scan_next_in_uclass(&dev);
Simon Glassba3d5372023-01-17 10:48:15 -0700255 if (!dev) {
256 log_debug("finished uclass %s\n",
257 dev_get_uclass_name(dev));
258 ret = -ENODEV;
259 }
260 } else if (IS_ENABLED(CONFIG_BOOTSTD_FULL) &&
Simon Glass99e68182023-02-22 12:17:03 -0700261 iter->flags & BOOTFLOWIF_SINGLE_MEDIA) {
Simon Glassba3d5372023-01-17 10:48:15 -0700262 log_debug("next in single\n");
263 method_flags = 0;
264 do {
265 /*
266 * Move to the next bootdev child of this media
267 * device. This ensures that we cover all the
268 * available SCSI IDs and LUNs.
269 */
270 device_find_next_child(&dev);
271 log_debug("- next %s\n",
272 dev ? dev->name : "(none)");
273 } while (dev && device_get_uclass_id(dev) !=
274 UCLASS_BOOTDEV);
275 if (!dev) {
276 log_debug("finished uclass %s\n",
277 dev_get_uclass_name(dev));
278 ret = -ENODEV;
279 }
Simon Glass484e4072023-01-17 10:48:14 -0700280 } else {
281 log_debug("labels %p\n", iter->labels);
282 if (iter->labels) {
Simon Glassb51f01d2023-10-23 00:02:13 -0700283 /*
284 * when the label is "mmc" we want to scan all
285 * mmc bootdevs, not just the first. See
286 * bootdev_find_by_label() where this flag is
287 * set up
288 */
289 if (iter->method_flags &
290 BOOTFLOW_METHF_SINGLE_UCLASS) {
291 scan_next_in_uclass(&dev);
292 log_debug("looking for next device %s: %s\n",
293 iter->dev->name,
294 dev ? dev->name : "<none>");
295 } else {
296 dev = NULL;
297 }
298 if (!dev) {
299 log_debug("looking at next label\n");
300 ret = bootdev_next_label(iter, &dev,
301 &method_flags);
302 }
Simon Glass484e4072023-01-17 10:48:14 -0700303 } else {
304 ret = bootdev_next_prio(iter, &dev);
305 method_flags = 0;
306 }
307 }
308 log_debug("ret=%d, dev=%p %s\n", ret, dev,
309 dev ? dev->name : "none");
310 if (ret) {
311 bootflow_iter_set_dev(iter, NULL, 0);
Simon Glass73fcf512022-07-30 15:52:25 -0600312 } else {
Simon Glassb73a8292023-01-28 15:00:19 -0700313 /*
314 * Probe the bootdev. This does not probe any attached
315 * block device, since they are siblings
316 */
Simon Glass73fcf512022-07-30 15:52:25 -0600317 ret = device_probe(dev);
Simon Glass484e4072023-01-17 10:48:14 -0700318 log_debug("probe %s %d\n", dev->name, ret);
Simon Glass73fcf512022-07-30 15:52:25 -0600319 if (!log_msg_ret("probe", ret))
Simon Glass484e4072023-01-17 10:48:14 -0700320 bootflow_iter_set_dev(iter, dev, method_flags);
Simon Glass73fcf512022-07-30 15:52:25 -0600321 }
Simon Glass03fcbf92022-04-24 23:31:09 -0600322 }
323
324 /* if there are no more bootdevs, give up */
325 if (ret)
326 return log_msg_ret("incr", BF_NO_MORE_DEVICES);
327
328 return 0;
329}
330
331/**
332 * bootflow_check() - Check if a bootflow can be obtained
333 *
334 * @iter: Provides part, bootmeth to use
335 * @bflow: Bootflow to update on success
336 * Return: 0 if OK, -ENOSYS if there is no bootflow support on this device,
337 * BF_NO_MORE_PARTS if there are no more partitions on bootdev
338 */
339static int bootflow_check(struct bootflow_iter *iter, struct bootflow *bflow)
340{
341 struct udevice *dev;
342 int ret;
343
Simon Glass73fcf512022-07-30 15:52:25 -0600344 if (IS_ENABLED(CONFIG_BOOTMETH_GLOBAL) && iter->doing_global) {
Simon Glass484e4072023-01-17 10:48:14 -0700345 bootflow_iter_set_dev(iter, NULL, 0);
Simon Glass73fcf512022-07-30 15:52:25 -0600346 ret = bootmeth_get_bootflow(iter->method, bflow);
347 if (ret)
348 return log_msg_ret("glob", ret);
349
350 return 0;
351 }
352
Simon Glass03fcbf92022-04-24 23:31:09 -0600353 dev = iter->dev;
354 ret = bootdev_get_bootflow(dev, iter, bflow);
355
356 /* If we got a valid bootflow, return it */
357 if (!ret) {
Simon Glass41571582023-07-12 09:04:32 -0600358 log_debug("Bootdev '%s' part %d method '%s': Found bootflow\n",
Simon Glass03fcbf92022-04-24 23:31:09 -0600359 dev->name, iter->part, iter->method->name);
360 return 0;
361 }
362
363 /* Unless there is nothing more to try, move to the next device */
364 else if (ret != BF_NO_MORE_PARTS && ret != -ENOSYS) {
Simon Glass41571582023-07-12 09:04:32 -0600365 log_debug("Bootdev '%s' part %d method '%s': Error %d\n",
Simon Glass03fcbf92022-04-24 23:31:09 -0600366 dev->name, iter->part, iter->method->name, ret);
367 /*
368 * For 'all' we return all bootflows, even
369 * those with errors
370 */
Simon Glass99e68182023-02-22 12:17:03 -0700371 if (iter->flags & BOOTFLOWIF_ALL)
Simon Glass03fcbf92022-04-24 23:31:09 -0600372 return log_msg_ret("all", ret);
373 }
374 if (ret)
375 return log_msg_ret("check", ret);
376
377 return 0;
378}
379
Simon Glass5d3d44f2023-01-17 10:48:16 -0700380int bootflow_scan_first(struct udevice *dev, const char *label,
381 struct bootflow_iter *iter, int flags,
382 struct bootflow *bflow)
Simon Glass03fcbf92022-04-24 23:31:09 -0600383{
384 int ret;
385
Simon Glassba3d5372023-01-17 10:48:15 -0700386 if (dev || label)
Simon Glass99e68182023-02-22 12:17:03 -0700387 flags |= BOOTFLOWIF_SKIP_GLOBAL;
Simon Glass03fcbf92022-04-24 23:31:09 -0600388 bootflow_iter_init(iter, flags);
389
Simon Glass484e4072023-01-17 10:48:14 -0700390 /*
391 * Set up the ordering of bootmeths. This sets iter->doing_global and
392 * iter->first_glob_method if we are starting with the global bootmeths
393 */
Simon Glass99e68182023-02-22 12:17:03 -0700394 ret = bootmeth_setup_iter_order(iter, !(flags & BOOTFLOWIF_SKIP_GLOBAL));
Simon Glass03fcbf92022-04-24 23:31:09 -0600395 if (ret)
396 return log_msg_ret("obmeth", -ENODEV);
397
398 /* Find the first bootmeth (there must be at least one!) */
399 iter->method = iter->method_order[iter->cur_method];
Simon Glass484e4072023-01-17 10:48:14 -0700400
401 if (!IS_ENABLED(CONFIG_BOOTMETH_GLOBAL) || !iter->doing_global) {
402 struct udevice *dev = NULL;
403 int method_flags;
404
Simon Glassba3d5372023-01-17 10:48:15 -0700405 ret = bootdev_setup_iter(iter, label, &dev, &method_flags);
Simon Glass484e4072023-01-17 10:48:14 -0700406 if (ret)
407 return log_msg_ret("obdev", -ENODEV);
408
409 bootflow_iter_set_dev(iter, dev, method_flags);
410 }
Simon Glass03fcbf92022-04-24 23:31:09 -0600411
412 ret = bootflow_check(iter, bflow);
413 if (ret) {
Simon Glass33063462023-01-17 10:48:18 -0700414 log_debug("check - ret=%d\n", ret);
Simon Glass03fcbf92022-04-24 23:31:09 -0600415 if (ret != BF_NO_MORE_PARTS && ret != -ENOSYS) {
Simon Glass99e68182023-02-22 12:17:03 -0700416 if (iter->flags & BOOTFLOWIF_ALL)
Simon Glass03fcbf92022-04-24 23:31:09 -0600417 return log_msg_ret("all", ret);
418 }
419 iter->err = ret;
420 ret = bootflow_scan_next(iter, bflow);
421 if (ret)
422 return log_msg_ret("get", ret);
423 }
424
425 return 0;
426}
427
Simon Glass03fcbf92022-04-24 23:31:09 -0600428int bootflow_scan_next(struct bootflow_iter *iter, struct bootflow *bflow)
429{
430 int ret;
431
432 do {
433 ret = iter_incr(iter);
Simon Glass33063462023-01-17 10:48:18 -0700434 log_debug("iter_incr: ret=%d\n", ret);
Simon Glass03fcbf92022-04-24 23:31:09 -0600435 if (ret == BF_NO_MORE_DEVICES)
436 return log_msg_ret("done", ret);
437
438 if (!ret) {
439 ret = bootflow_check(iter, bflow);
Simon Glass33063462023-01-17 10:48:18 -0700440 log_debug("check - ret=%d\n", ret);
Simon Glass03fcbf92022-04-24 23:31:09 -0600441 if (!ret)
442 return 0;
443 iter->err = ret;
444 if (ret != BF_NO_MORE_PARTS && ret != -ENOSYS) {
Simon Glass99e68182023-02-22 12:17:03 -0700445 if (iter->flags & BOOTFLOWIF_ALL)
Simon Glass03fcbf92022-04-24 23:31:09 -0600446 return log_msg_ret("all", ret);
447 }
448 } else {
Simon Glass33063462023-01-17 10:48:18 -0700449 log_debug("incr failed, err=%d\n", ret);
Simon Glass03fcbf92022-04-24 23:31:09 -0600450 iter->err = ret;
451 }
452
453 } while (1);
454}
455
Simon Glass00501fc2022-10-20 18:22:51 -0600456void bootflow_init(struct bootflow *bflow, struct udevice *bootdev,
457 struct udevice *meth)
458{
459 memset(bflow, '\0', sizeof(*bflow));
460 bflow->dev = bootdev;
461 bflow->method = meth;
462 bflow->state = BOOTFLOWST_BASE;
463}
464
Simon Glass03fcbf92022-04-24 23:31:09 -0600465void bootflow_free(struct bootflow *bflow)
466{
467 free(bflow->name);
468 free(bflow->subdir);
469 free(bflow->fname);
Simon Glass254c9342023-11-15 18:35:23 -0700470 if (!(bflow->flags & BOOTFLOWF_STATIC_BUF))
471 free(bflow->buf);
Simon Glass72b7b192023-01-06 08:52:33 -0600472 free(bflow->os_name);
Simon Glass7b8c6342023-01-17 10:47:56 -0700473 free(bflow->fdt_fname);
Simon Glass7f75f232023-07-30 11:16:56 -0600474 free(bflow->bootmeth_priv);
Simon Glass03fcbf92022-04-24 23:31:09 -0600475}
476
477void bootflow_remove(struct bootflow *bflow)
478{
Simon Glassdee4d642022-07-30 15:52:23 -0600479 if (bflow->dev)
480 list_del(&bflow->bm_node);
Simon Glass03fcbf92022-04-24 23:31:09 -0600481 list_del(&bflow->glob_node);
482
483 bootflow_free(bflow);
484 free(bflow);
485}
486
Simon Glass6d8f95b2023-08-10 19:33:18 -0600487#if CONFIG_IS_ENABLED(BOOTSTD_FULL)
488int bootflow_read_all(struct bootflow *bflow)
489{
490 int ret;
491
492 if (bflow->state != BOOTFLOWST_READY)
493 return log_msg_ret("rd", -EPROTO);
494
495 ret = bootmeth_read_all(bflow->method, bflow);
496 if (ret)
497 return log_msg_ret("rd2", ret);
498
499 return 0;
500}
501#endif /* BOOTSTD_FULL */
502
Simon Glass03fcbf92022-04-24 23:31:09 -0600503int bootflow_boot(struct bootflow *bflow)
504{
505 int ret;
506
507 if (bflow->state != BOOTFLOWST_READY)
508 return log_msg_ret("load", -EPROTO);
509
510 ret = bootmeth_boot(bflow->method, bflow);
511 if (ret)
512 return log_msg_ret("boot", ret);
513
514 /*
515 * internal error, should not get here since we should have booted
516 * something or returned an error
517 */
518
519 return log_msg_ret("end", -EFAULT);
520}
521
522int bootflow_run_boot(struct bootflow_iter *iter, struct bootflow *bflow)
523{
524 int ret;
525
526 printf("** Booting bootflow '%s' with %s\n", bflow->name,
527 bflow->method->name);
Simon Glassca84dc82023-02-22 12:17:04 -0700528 if (IS_ENABLED(CONFIG_OF_HAS_PRIOR_STAGE) &&
529 (bflow->flags & BOOTFLOWF_USE_PRIOR_FDT))
530 printf("Using prior-stage device tree\n");
Simon Glass03fcbf92022-04-24 23:31:09 -0600531 ret = bootflow_boot(bflow);
532 if (!IS_ENABLED(CONFIG_BOOTSTD_FULL)) {
533 printf("Boot failed (err=%d)\n", ret);
534 return ret;
535 }
536
537 switch (ret) {
538 case -EPROTO:
539 printf("Bootflow not loaded (state '%s')\n",
540 bootflow_state_get_name(bflow->state));
541 break;
542 case -ENOSYS:
543 printf("Boot method '%s' not supported\n", bflow->method->name);
544 break;
545 case -ENOTSUPP:
546 /* Disable this bootflow for this iteration */
547 if (iter) {
548 int ret2;
549
550 ret2 = bootflow_iter_drop_bootmeth(iter, bflow->method);
551 if (!ret2) {
552 printf("Boot method '%s' failed and will not be retried\n",
553 bflow->method->name);
554 }
555 }
556
557 break;
558 default:
559 printf("Boot failed (err=%d)\n", ret);
560 break;
561 }
562
563 return ret;
564}
565
Simon Glass18c50402023-01-17 10:47:54 -0700566int bootflow_iter_check_blk(const struct bootflow_iter *iter)
Simon Glass03fcbf92022-04-24 23:31:09 -0600567{
568 const struct udevice *media = dev_get_parent(iter->dev);
569 enum uclass_id id = device_get_uclass_id(media);
570
571 log_debug("uclass %d: %s\n", id, uclass_get_name(id));
Simon Glass5820c2f2023-01-28 15:00:25 -0700572 if (id != UCLASS_ETH && id != UCLASS_BOOTSTD && id != UCLASS_QFW)
Simon Glass03fcbf92022-04-24 23:31:09 -0600573 return 0;
574
575 return -ENOTSUPP;
576}
577
Simon Glass215be682023-01-17 10:48:03 -0700578int bootflow_iter_check_sf(const struct bootflow_iter *iter)
579{
580 const struct udevice *media = dev_get_parent(iter->dev);
581 enum uclass_id id = device_get_uclass_id(media);
582
583 log_debug("uclass %d: %s\n", id, uclass_get_name(id));
584 if (id == UCLASS_SPI_FLASH)
585 return 0;
586
587 return -ENOTSUPP;
588}
589
Simon Glass18c50402023-01-17 10:47:54 -0700590int bootflow_iter_check_net(const struct bootflow_iter *iter)
Simon Glass03fcbf92022-04-24 23:31:09 -0600591{
592 const struct udevice *media = dev_get_parent(iter->dev);
593 enum uclass_id id = device_get_uclass_id(media);
594
595 log_debug("uclass %d: %s\n", id, uclass_get_name(id));
596 if (id == UCLASS_ETH)
597 return 0;
598
599 return -ENOTSUPP;
600}
601
Simon Glass18c50402023-01-17 10:47:54 -0700602int bootflow_iter_check_system(const struct bootflow_iter *iter)
Simon Glass03fcbf92022-04-24 23:31:09 -0600603{
604 const struct udevice *media = dev_get_parent(iter->dev);
605 enum uclass_id id = device_get_uclass_id(media);
606
607 log_debug("uclass %d: %s\n", id, uclass_get_name(id));
608 if (id == UCLASS_BOOTSTD)
609 return 0;
610
611 return -ENOTSUPP;
612}
Simon Glassb35513a2023-07-12 09:04:35 -0600613
614/**
615 * bootflow_cmdline_set() - Set the command line for a bootflow
616 *
617 * @value: New command-line string
618 * Returns 0 if OK, -ENOENT if no current bootflow, -ENOMEM if out of memory
619 */
620int bootflow_cmdline_set(struct bootflow *bflow, const char *value)
621{
622 char *cmdline = NULL;
623
624 if (value) {
625 cmdline = strdup(value);
626 if (!cmdline)
627 return -ENOMEM;
628 }
629
630 free(bflow->cmdline);
631 bflow->cmdline = cmdline;
632
633 return 0;
634}
635
636#ifdef CONFIG_BOOTSTD_FULL
637/**
638 * on_bootargs() - Update the cmdline of a bootflow
639 */
640static int on_bootargs(const char *name, const char *value, enum env_op op,
641 int flags)
642{
643 struct bootstd_priv *std;
644 struct bootflow *bflow;
645 int ret;
646
647 ret = bootstd_get_priv(&std);
648 if (ret)
649 return 0;
650 bflow = std->cur_bootflow;
651 if (!bflow)
652 return 0;
653
654 switch (op) {
655 case env_op_create:
656 case env_op_overwrite:
657 ret = bootflow_cmdline_set(bflow, value);
658 if (ret && ret != ENOENT)
659 return 1;
660 return 0;
661 case env_op_delete:
662 bootflow_cmdline_set(bflow, NULL);
663 fallthrough;
664 default:
665 return 0;
666 }
667}
668U_BOOT_ENV_CALLBACK(bootargs, on_bootargs);
669#endif
Simon Glassa08adca2023-07-12 09:04:38 -0600670
671/**
672 * copy_in() - Copy a string into a cmdline buffer
673 *
674 * @buf: Buffer to copy into
675 * @end: End of buffer (pointer to char after the end)
676 * @arg: String to copy from
677 * @len: Number of chars to copy from @arg (note that this is not usually the
678 * sane as strlen(arg) since the string may contain following arguments)
679 * @new_val: Value to put after arg, or BOOTFLOWCL_EMPTY to use an empty value
680 * with no '=' sign
681 * Returns: Number of chars written to @buf
682 */
683static int copy_in(char *buf, char *end, const char *arg, int len,
684 const char *new_val)
685{
686 char *to = buf;
687
688 /* copy the arg name */
689 if (to + len >= end)
690 return -E2BIG;
691 memcpy(to, arg, len);
692 to += len;
693
694 if (new_val == BOOTFLOWCL_EMPTY) {
695 /* no value */
696 } else {
697 bool need_quote = strchr(new_val, ' ');
698 len = strlen(new_val);
699
700 /* need space for value, equals sign and maybe two quotes */
701 if (to + 1 + (need_quote ? 2 : 0) + len >= end)
702 return -E2BIG;
703 *to++ = '=';
704 if (need_quote)
705 *to++ = '"';
706 memcpy(to, new_val, len);
707 to += len;
708 if (need_quote)
709 *to++ = '"';
710 }
711
712 return to - buf;
713}
714
715int cmdline_set_arg(char *buf, int maxlen, const char *cmdline,
716 const char *set_arg, const char *new_val, int *posp)
717{
718 bool found_arg = false;
719 const char *from;
720 char *to, *end;
721 int set_arg_len;
722 char empty = '\0';
723 int ret;
724
725 from = cmdline ?: &empty;
726
727 /* check if the value has quotes inside */
728 if (new_val && new_val != BOOTFLOWCL_EMPTY && strchr(new_val, '"'))
729 return -EBADF;
730
731 set_arg_len = strlen(set_arg);
732 for (to = buf, end = buf + maxlen; *from;) {
733 const char *val, *arg_end, *val_end, *p;
734 bool in_quote;
735
736 if (to >= end)
737 return -E2BIG;
738 while (*from == ' ')
739 from++;
740 if (!*from)
741 break;
742
743 /* find the end of this arg */
744 val = NULL;
745 arg_end = NULL;
746 val_end = NULL;
747 in_quote = false;
748 for (p = from;; p++) {
749 if (in_quote) {
750 if (!*p)
751 return -EINVAL;
752 if (*p == '"')
753 in_quote = false;
754 continue;
755 }
Simon Glassa61057f2023-10-25 07:17:36 +1300756 if (*p == '=' && !arg_end) {
Simon Glassa08adca2023-07-12 09:04:38 -0600757 arg_end = p;
758 val = p + 1;
759 } else if (*p == '"') {
760 in_quote = true;
761 } else if (!*p || *p == ' ') {
762 val_end = p;
763 if (!arg_end)
764 arg_end = p;
765 break;
766 }
767 }
768 /*
769 * At this point val_end points to the end of the value, or the
770 * last char after the arg name, if there is no label.
771 * arg_end is the char after the arg name
772 * val points to the value, or NULL if there is none
773 * char after the value.
774 *
775 * fred=1234
776 * ^ ^^ ^
777 * from || |
778 * / \ \
779 * arg_end val val_end
780 */
781 log_debug("from %s arg_end %ld val %ld val_end %ld\n", from,
782 (long)(arg_end - from), (long)(val - from),
783 (long)(val_end - from));
784
785 if (to != buf) {
786 if (to >= end)
787 return -E2BIG;
788 *to++ = ' ';
789 }
790
791 /* if this is the target arg, update it */
Simon Glassa61057f2023-10-25 07:17:36 +1300792 if (arg_end - from == set_arg_len &&
793 !strncmp(from, set_arg, set_arg_len)) {
Simon Glassa08adca2023-07-12 09:04:38 -0600794 if (!buf) {
795 bool has_quote = val_end[-1] == '"';
796
797 /*
798 * exclude any start/end quotes from
799 * calculations
800 */
801 if (!val)
802 val = val_end;
803 *posp = val - cmdline + has_quote;
804 return val_end - val - 2 * has_quote;
805 }
806 found_arg = true;
807 if (!new_val) {
808 /* delete this arg */
809 from = val_end + (*val_end == ' ');
810 log_debug("delete from: %s\n", from);
811 if (to != buf)
812 to--; /* drop the space we added */
813 continue;
814 }
815
816 ret = copy_in(to, end, from, arg_end - from, new_val);
817 if (ret < 0)
818 return ret;
819 to += ret;
820
821 /* if not the target arg, copy it unchanged */
822 } else if (to) {
823 int len;
824
825 len = val_end - from;
826 if (to + len >= end)
827 return -E2BIG;
828 memcpy(to, from, len);
829 to += len;
830 }
831 from = val_end;
832 }
833
834 /* If we didn't find the arg, add it */
835 if (!found_arg) {
836 /* trying to delete something that is not there */
837 if (!new_val || !buf)
838 return -ENOENT;
839 if (to >= end)
840 return -E2BIG;
841
842 /* add a space to separate it from the previous arg */
843 if (to != buf && to[-1] != ' ')
844 *to++ = ' ';
845 ret = copy_in(to, end, set_arg, set_arg_len, new_val);
846 log_debug("ret=%d, to: %s buf: %s\n", ret, to, buf);
847 if (ret < 0)
848 return ret;
849 to += ret;
850 }
851
852 /* delete any trailing space */
853 if (to > buf && to[-1] == ' ')
854 to--;
855
856 if (to >= end)
857 return -E2BIG;
858 *to++ = '\0';
859
860 return to - buf;
861}
Simon Glass55a2da32023-07-12 09:04:39 -0600862
863int bootflow_cmdline_set_arg(struct bootflow *bflow, const char *set_arg,
864 const char *new_val, bool set_env)
865{
866 char buf[2048];
867 char *cmd = NULL;
868 int ret;
869
870 ret = cmdline_set_arg(buf, sizeof(buf), bflow->cmdline, set_arg,
871 new_val, NULL);
872 if (ret < 0)
873 return ret;
874
875 ret = bootflow_cmdline_set(bflow, buf);
876 if (*buf) {
877 cmd = strdup(buf);
878 if (!cmd)
879 return -ENOMEM;
880 }
881 free(bflow->cmdline);
882 bflow->cmdline = cmd;
883
884 if (set_env) {
885 ret = env_set("bootargs", bflow->cmdline);
886 if (ret)
887 return ret;
888 }
889
890 return 0;
891}
892
893int cmdline_get_arg(const char *cmdline, const char *arg, int *posp)
894{
895 int ret;
896
897 ret = cmdline_set_arg(NULL, 1, cmdline, arg, NULL, posp);
898
899 return ret;
900}
901
902int bootflow_cmdline_get_arg(struct bootflow *bflow, const char *arg,
903 const char **val)
904{
905 int ret;
906 int pos;
907
908 ret = cmdline_get_arg(bflow->cmdline, arg, &pos);
909 if (ret < 0)
910 return ret;
911 *val = bflow->cmdline + pos;
912
913 return ret;
914}
Simon Glasscd91e992023-07-12 09:04:42 -0600915
916int bootflow_cmdline_auto(struct bootflow *bflow, const char *arg)
917{
918 struct serial_device_info info;
919 char buf[50];
920 int ret;
921
922 ret = serial_getinfo(gd->cur_serial_dev, &info);
923 if (ret)
924 return ret;
925
926 *buf = '\0';
927 if (!strcmp("earlycon", arg)) {
928 snprintf(buf, sizeof(buf),
929 "uart8250,mmio32,%#lx,%dn8", info.addr,
930 info.baudrate);
931 } else if (!strcmp("console", arg)) {
932 snprintf(buf, sizeof(buf),
933 "ttyS0,%dn8", info.baudrate);
934 }
935
936 if (!*buf) {
937 printf("Unknown param '%s\n", arg);
938 return -ENOENT;
939 }
940
941 ret = bootflow_cmdline_set_arg(bflow, arg, buf, true);
942 if (ret)
943 return ret;
944
945 return 0;
946}