Blame view
common/bootstage.c
10.4 KB
3a608ca01 bootstage: Implem... |
1 2 3 |
/* * Copyright (c) 2011, Google Inc. All rights reserved. * |
1a4596601 Add GPL-2.0+ SPDX... |
4 |
* SPDX-License-Identifier: GPL-2.0+ |
3a608ca01 bootstage: Implem... |
5 6 7 8 9 10 11 12 13 14 15 16 |
*/ /* * This module records the progress of boot and arbitrary commands, and * permits accurate timestamping of each. * * TBD: Pass timings to kernel in the FDT */ #include <common.h> #include <libfdt.h> |
fb7db41cd bootstage: Allow ... |
17 18 |
#include <malloc.h> #include <linux/compiler.h> |
3a608ca01 bootstage: Implem... |
19 20 |
DECLARE_GLOBAL_DATA_PTR; |
3a608ca01 bootstage: Implem... |
21 22 |
struct bootstage_record { ulong time_us; |
094e06a52 bootstage: Export... |
23 |
uint32_t start_us; |
3a608ca01 bootstage: Implem... |
24 25 26 27 28 29 30 |
const char *name; int flags; /* see enum bootstage_flags */ enum bootstage_id id; }; static struct bootstage_record record[BOOTSTAGE_ID_COUNT] = { {1} }; static int next_id = BOOTSTAGE_ID_USER; |
fcf509b80 bootstage: Add fe... |
31 32 33 |
enum { BOOTSTAGE_VERSION = 0, BOOTSTAGE_MAGIC = 0xb00757a3, |
b8bcaa3ad Add function to p... |
34 |
BOOTSTAGE_DIGITS = 9, |
fcf509b80 bootstage: Add fe... |
35 36 37 38 39 40 41 42 |
}; struct bootstage_hdr { uint32_t version; /* BOOTSTAGE_VERSION */ uint32_t count; /* Number of records */ uint32_t size; /* Total data size (non-zero if valid) */ uint32_t magic; /* Unused */ }; |
150678a58 bootstage: Copy b... |
43 44 45 46 47 48 49 50 51 52 53 54 55 56 |
int bootstage_relocate(void) { int i; /* * Duplicate all strings. They may point to an old location in the * program .text section that can eventually get trashed. */ for (i = 0; i < BOOTSTAGE_ID_COUNT; i++) if (record[i].name) record[i].name = strdup(record[i].name); return 0; } |
3a608ca01 bootstage: Implem... |
57 |
ulong bootstage_add_record(enum bootstage_id id, const char *name, |
094e06a52 bootstage: Export... |
58 |
int flags, ulong mark) |
3a608ca01 bootstage: Implem... |
59 60 |
{ struct bootstage_record *rec; |
3a608ca01 bootstage: Implem... |
61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 |
if (flags & BOOTSTAGEF_ALLOC) id = next_id++; if (id < BOOTSTAGE_ID_COUNT) { rec = &record[id]; /* Only record the first event for each */ if (!rec->time_us) { rec->time_us = mark; rec->name = name; rec->flags = flags; rec->id = id; } } /* Tell the board about this progress */ show_boot_progress(flags & BOOTSTAGEF_ERROR ? -id : id); return mark; } ulong bootstage_mark(enum bootstage_id id) { |
094e06a52 bootstage: Export... |
85 |
return bootstage_add_record(id, NULL, 0, timer_get_boot_us()); |
3a608ca01 bootstage: Implem... |
86 87 88 89 |
} ulong bootstage_error(enum bootstage_id id) { |
094e06a52 bootstage: Export... |
90 91 |
return bootstage_add_record(id, NULL, BOOTSTAGEF_ERROR, timer_get_boot_us()); |
3a608ca01 bootstage: Implem... |
92 93 94 95 96 97 98 99 |
} ulong bootstage_mark_name(enum bootstage_id id, const char *name) { int flags = 0; if (id == BOOTSTAGE_ID_ALLOC) flags = BOOTSTAGEF_ALLOC; |
094e06a52 bootstage: Export... |
100 |
return bootstage_add_record(id, name, flags, timer_get_boot_us()); |
3a608ca01 bootstage: Implem... |
101 |
} |
fb7db41cd bootstage: Allow ... |
102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 |
ulong bootstage_mark_code(const char *file, const char *func, int linenum) { char *str, *p; __maybe_unused char *end; int len = 0; /* First work out the length we need to allocate */ if (linenum != -1) len = 11; if (func) len += strlen(func); if (file) len += strlen(file); str = malloc(len + 1); p = str; end = p + len; if (file) p += snprintf(p, end - p, "%s,", file); if (linenum != -1) p += snprintf(p, end - p, "%d", linenum); if (func) p += snprintf(p, end - p, ": %s", func); return bootstage_mark_name(BOOTSTAGE_ID_ALLOC, str); } |
0e9967735 bootstage: Add ti... |
128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 |
uint32_t bootstage_start(enum bootstage_id id, const char *name) { struct bootstage_record *rec = &record[id]; rec->start_us = timer_get_boot_us(); rec->name = name; return rec->start_us; } uint32_t bootstage_accum(enum bootstage_id id) { struct bootstage_record *rec = &record[id]; uint32_t duration; duration = (uint32_t)timer_get_boot_us() - rec->start_us; rec->time_us += duration; return duration; } |
94fd1316b bootstage: Store ... |
146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 |
/** * Get a record name as a printable string * * @param buf Buffer to put name if needed * @param len Length of buffer * @param rec Boot stage record to get the name from * @return pointer to name, either from the record or pointing to buf. */ static const char *get_record_name(char *buf, int len, struct bootstage_record *rec) { if (rec->name) return rec->name; else if (rec->id >= BOOTSTAGE_ID_USER) snprintf(buf, len, "user_%d", rec->id - BOOTSTAGE_ID_USER); else snprintf(buf, len, "id=%d", rec->id); return buf; } |
3a608ca01 bootstage: Implem... |
166 167 168 |
static uint32_t print_time_record(enum bootstage_id id, struct bootstage_record *rec, uint32_t prev) { |
94fd1316b bootstage: Store ... |
169 |
char buf[20]; |
0e9967735 bootstage: Add ti... |
170 171 |
if (prev == -1U) { printf("%11s", ""); |
b8bcaa3ad Add function to p... |
172 |
print_grouped_ull(rec->time_us, BOOTSTAGE_DIGITS); |
0e9967735 bootstage: Add ti... |
173 |
} else { |
b8bcaa3ad Add function to p... |
174 175 |
print_grouped_ull(rec->time_us, BOOTSTAGE_DIGITS); print_grouped_ull(rec->time_us - prev, BOOTSTAGE_DIGITS); |
0e9967735 bootstage: Add ti... |
176 |
} |
94fd1316b bootstage: Store ... |
177 178 |
printf(" %s ", get_record_name(buf, sizeof(buf), rec)); |
3a608ca01 bootstage: Implem... |
179 180 181 182 183 184 185 186 187 |
return rec->time_us; } static int h_compare_record(const void *r1, const void *r2) { const struct bootstage_record *rec1 = r1, *rec2 = r2; return rec1->time_us > rec2->time_us ? 1 : -1; } |
94fd1316b bootstage: Store ... |
188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 |
#ifdef CONFIG_OF_LIBFDT /** * Add all bootstage timings to a device tree. * * @param blob Device tree blob * @return 0 on success, != 0 on failure. */ static int add_bootstages_devicetree(struct fdt_header *blob) { int bootstage; char buf[20]; int id; int i; if (!blob) return 0; /* * Create the node for bootstage. * The address of flat device tree is set up by the command bootm. */ bootstage = fdt_add_subnode(blob, 0, "bootstage"); if (bootstage < 0) return -1; /* * Insert the timings to the device tree in the reverse order so * that they can be printed in the Linux kernel in the right order. */ for (id = BOOTSTAGE_ID_COUNT - 1, i = 0; id >= 0; id--, i++) { struct bootstage_record *rec = &record[id]; int node; if (id != BOOTSTAGE_ID_AWAKE && rec->time_us == 0) continue; node = fdt_add_subnode(blob, bootstage, simple_itoa(i)); if (node < 0) break; /* add properties to the node. */ if (fdt_setprop_string(blob, node, "name", get_record_name(buf, sizeof(buf), rec))) return -1; /* Check if this is a 'mark' or 'accum' record */ if (fdt_setprop_cell(blob, node, rec->start_us ? "accum" : "mark", rec->time_us)) return -1; } return 0; } int bootstage_fdt_add_report(void) { if (add_bootstages_devicetree(working_fdt)) puts("bootstage: Failed to add to device tree "); return 0; } #endif |
3a608ca01 bootstage: Implem... |
252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 |
void bootstage_report(void) { struct bootstage_record *rec = record; int id; uint32_t prev; puts("Timer summary in microseconds: "); printf("%11s%11s %s ", "Mark", "Elapsed", "Stage"); /* Fake the first record - we could get it from early boot */ rec->name = "reset"; rec->time_us = 0; prev = print_time_record(BOOTSTAGE_ID_AWAKE, rec, 0); /* Sort records by increasing time */ qsort(record, ARRAY_SIZE(record), sizeof(*rec), h_compare_record); for (id = 0; id < BOOTSTAGE_ID_COUNT; id++, rec++) { |
0e9967735 bootstage: Add ti... |
272 |
if (rec->time_us != 0 && !rec->start_us) |
3a608ca01 bootstage: Implem... |
273 274 275 276 277 278 279 280 |
prev = print_time_record(rec->id, rec, prev); } if (next_id > BOOTSTAGE_ID_COUNT) printf("(Overflowed internal boot id table by %d entries " "- please increase CONFIG_BOOTSTAGE_USER_COUNT ", next_id - BOOTSTAGE_ID_COUNT); |
0e9967735 bootstage: Add ti... |
281 282 283 284 285 286 287 288 |
puts(" Accumulated time: "); for (id = 0, rec = record; id < BOOTSTAGE_ID_COUNT; id++, rec++) { if (rec->start_us) prev = print_time_record(id, rec, -1); } |
3a608ca01 bootstage: Implem... |
289 |
} |
3786980dd Move bootstage ti... |
290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 |
ulong __timer_get_boot_us(void) { static ulong base_time; /* * We can't implement this properly. Return 0 on the first call and * larger values after that. */ if (base_time) return get_timer(base_time) * 1000; base_time = get_timer(0); return 0; } ulong timer_get_boot_us(void) __attribute__((weak, alias("__timer_get_boot_us"))); |
fcf509b80 bootstage: Add fe... |
307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 |
/** * Append data to a memory buffer * * Write data to the buffer if there is space. Whether there is space or not, * the buffer pointer is incremented. * * @param ptrp Pointer to buffer, updated by this function * @param end Pointer to end of buffer * @param data Data to write to buffer * @param size Size of data */ static void append_data(char **ptrp, char *end, const void *data, int size) { char *ptr = *ptrp; *ptrp += size; if (*ptrp > end) return; memcpy(ptr, data, size); } int bootstage_stash(void *base, int size) { struct bootstage_hdr *hdr = (struct bootstage_hdr *)base; struct bootstage_record *rec; char buf[20]; char *ptr = base, *end = ptr + size; uint32_t count; int id; if (hdr + 1 > (struct bootstage_hdr *)end) { debug("%s: Not enough space for bootstage hdr ", __func__); return -1; } /* Write an arbitrary version number */ hdr->version = BOOTSTAGE_VERSION; /* Count the number of records, and write that value first */ for (rec = record, id = count = 0; id < BOOTSTAGE_ID_COUNT; id++, rec++) { if (rec->time_us != 0) count++; } hdr->count = count; hdr->size = 0; hdr->magic = BOOTSTAGE_MAGIC; ptr += sizeof(*hdr); /* Write the records, silently stopping when we run out of space */ for (rec = record, id = 0; id < BOOTSTAGE_ID_COUNT; id++, rec++) { if (rec->time_us != 0) append_data(&ptr, end, rec, sizeof(*rec)); } /* Write the name strings */ for (rec = record, id = 0; id < BOOTSTAGE_ID_COUNT; id++, rec++) { if (rec->time_us != 0) { const char *name; name = get_record_name(buf, sizeof(buf), rec); append_data(&ptr, end, name, strlen(name) + 1); } } /* Check for buffer overflow */ if (ptr > end) { debug("%s: Not enough space for bootstage stash ", __func__); return -1; } /* Update total data size */ hdr->size = ptr - (char *)base; printf("Stashed %d records ", hdr->count); return 0; } int bootstage_unstash(void *base, int size) { struct bootstage_hdr *hdr = (struct bootstage_hdr *)base; struct bootstage_record *rec; char *ptr = base, *end = ptr + size; uint rec_size; int id; if (size == -1) end = (char *)(~(uintptr_t)0); if (hdr + 1 > (struct bootstage_hdr *)end) { debug("%s: Not enough space for bootstage hdr ", __func__); return -1; } if (hdr->magic != BOOTSTAGE_MAGIC) { debug("%s: Invalid bootstage magic ", __func__); return -1; } if (ptr + hdr->size > end) { debug("%s: Bootstage data runs past buffer end ", __func__); return -1; } if (hdr->count * sizeof(*rec) > hdr->size) { |
5d3bd3454 bootstage: Correc... |
420 |
debug("%s: Bootstage has %d records needing %lu bytes, but " |
fcf509b80 bootstage: Add fe... |
421 422 |
"only %d bytes is available ", __func__, hdr->count, |
5d3bd3454 bootstage: Correc... |
423 |
(ulong)hdr->count * sizeof(*rec), hdr->size); |
fcf509b80 bootstage: Add fe... |
424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 |
return -1; } if (hdr->version != BOOTSTAGE_VERSION) { debug("%s: Bootstage data version %#0x unrecognised ", __func__, hdr->version); return -1; } if (next_id + hdr->count > BOOTSTAGE_ID_COUNT) { debug("%s: Bootstage has %d records, we have space for %d " "- please increase CONFIG_BOOTSTAGE_USER_COUNT ", __func__, hdr->count, BOOTSTAGE_ID_COUNT - next_id); return -1; } ptr += sizeof(*hdr); /* Read the records */ rec_size = hdr->count * sizeof(*record); memcpy(record + next_id, ptr, rec_size); /* Read the name strings */ ptr += rec_size; for (rec = record + next_id, id = 0; id < hdr->count; id++, rec++) { rec->name = ptr; /* Assume no data corruption here */ ptr += strlen(ptr) + 1; } /* Mark the records as read */ next_id += hdr->count; printf("Unstashed %d records ", hdr->count); return 0; } |