]> git.ipfire.org Git - people/ms/u-boot.git/blobdiff - common/bootstage.c
rockchip: rk3288: Fix wrong TPL_TEXT_BASE
[people/ms/u-boot.git] / common / bootstage.c
index c5c69961acc91dd8590968598deff5ba69def306..b866e66979e3d8577febda37141e8c5db8b1c22a 100644 (file)
@@ -1,31 +1,13 @@
 /*
  * Copyright (c) 2011, Google Inc. All rights reserved.
  *
- * See file CREDITS for list of people who contributed to this
- * project.
- *
- * This program is free software; you can redistribute it and/or
- * modify it under the terms of the GNU General Public License as
- * published by the Free Software Foundation; either version 2 of
- * the License, or (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, write to the Free Software
- * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
- * MA 02111-1307 USA
+ * SPDX-License-Identifier:    GPL-2.0+
  */
 
 
 /*
  * 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>
 
 DECLARE_GLOBAL_DATA_PTR;
 
+enum {
+       RECORD_COUNT = CONFIG_VAL(BOOTSTAGE_RECORD_COUNT),
+};
+
 struct bootstage_record {
        ulong time_us;
        uint32_t start_us;
@@ -43,12 +29,16 @@ struct bootstage_record {
        enum bootstage_id id;
 };
 
-static struct bootstage_record record[BOOTSTAGE_ID_COUNT] = { {1} };
-static int next_id = BOOTSTAGE_ID_USER;
+struct bootstage_data {
+       uint rec_count;
+       uint next_id;
+       struct bootstage_record record[RECORD_COUNT];
+};
 
 enum {
        BOOTSTAGE_VERSION       = 0,
        BOOTSTAGE_MAGIC         = 0xb00757a3,
+       BOOTSTAGE_DIGITS        = 9,
 };
 
 struct bootstage_hdr {
@@ -60,41 +50,72 @@ struct bootstage_hdr {
 
 int bootstage_relocate(void)
 {
+       struct bootstage_data *data = gd->bootstage;
        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);
+       debug("Relocating %d records\n", data->rec_count);
+       for (i = 0; i < data->rec_count; i++)
+               data->record[i].name = strdup(data->record[i].name);
 
        return 0;
 }
 
+struct bootstage_record *find_id(struct bootstage_data *data,
+                                enum bootstage_id id)
+{
+       struct bootstage_record *rec;
+       struct bootstage_record *end;
+
+       for (rec = data->record, end = rec + data->rec_count; rec < end;
+            rec++) {
+               if (rec->id == id)
+                       return rec;
+       }
+
+       return NULL;
+}
+
+struct bootstage_record *ensure_id(struct bootstage_data *data,
+                                  enum bootstage_id id)
+{
+       struct bootstage_record *rec;
+
+       rec = find_id(data, id);
+       if (!rec && data->rec_count < RECORD_COUNT) {
+               rec = &data->record[data->rec_count++];
+               rec->id = id;
+               return rec;
+       }
+
+       return rec;
+}
+
 ulong bootstage_add_record(enum bootstage_id id, const char *name,
                           int flags, ulong mark)
 {
+       struct bootstage_data *data = gd->bootstage;
        struct bootstage_record *rec;
 
        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;
-               }
+               id = data->next_id++;
+
+       /* Only record the first event for each */
+       rec = find_id(data, id);
+       if (!rec && data->rec_count < RECORD_COUNT) {
+               rec = &data->record[data->rec_count++];
+               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;
 }
 
@@ -116,6 +137,7 @@ ulong bootstage_mark_name(enum bootstage_id id, const char *name)
 
        if (id == BOOTSTAGE_ID_ALLOC)
                flags = BOOTSTAGEF_ALLOC;
+
        return bootstage_add_record(id, name, flags, timer_get_boot_us());
 }
 
@@ -148,36 +170,30 @@ ulong bootstage_mark_code(const char *file, const char *func, int linenum)
 
 uint32_t bootstage_start(enum bootstage_id id, const char *name)
 {
-       struct bootstage_record *rec = &record[id];
+       struct bootstage_data *data = gd->bootstage;
+       struct bootstage_record *rec = ensure_id(data, id);
+       ulong start_us = timer_get_boot_us();
 
-       rec->start_us = timer_get_boot_us();
-       rec->name = name;
-       return rec->start_us;
+       if (rec) {
+               rec->start_us = start_us;
+               rec->name = name;
+       }
+
+       return start_us;
 }
 
 uint32_t bootstage_accum(enum bootstage_id id)
 {
-       struct bootstage_record *rec = &record[id];
+       struct bootstage_data *data = gd->bootstage;
+       struct bootstage_record *rec = ensure_id(data, id);
        uint32_t duration;
 
+       if (!rec)
+               return 0;
        duration = (uint32_t)timer_get_boot_us() - rec->start_us;
        rec->time_us += duration;
-       return duration;
-}
 
-static void print_time(unsigned long us_time)
-{
-       char str[15], *s;
-       int grab = 3;
-
-       /* We don't seem to have %'d in U-Boot */
-       sprintf(str, "%12lu", us_time);
-       for (s = str + 3; *s; s += grab) {
-               if (s != str + 3)
-                       putc(s[-1] != ' ' ? ',' : ' ');
-               printf("%.*s", grab, s);
-               grab = 3;
-       }
+       return duration;
 }
 
 /**
@@ -189,7 +205,7 @@ static void print_time(unsigned long us_time)
  * @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)
+                                  const struct bootstage_record *rec)
 {
        if (rec->name)
                return rec->name;
@@ -201,17 +217,16 @@ static const char *get_record_name(char *buf, int len,
        return buf;
 }
 
-static uint32_t print_time_record(enum bootstage_id id,
-                       struct bootstage_record *rec, uint32_t prev)
+static uint32_t print_time_record(struct bootstage_record *rec, uint32_t prev)
 {
        char buf[20];
 
        if (prev == -1U) {
                printf("%11s", "");
-               print_time(rec->time_us);
+               print_grouped_ull(rec->time_us, BOOTSTAGE_DIGITS);
        } else {
-               print_time(rec->time_us);
-               print_time(rec->time_us - prev);
+               print_grouped_ull(rec->time_us, BOOTSTAGE_DIGITS);
+               print_grouped_ull(rec->time_us - prev, BOOTSTAGE_DIGITS);
        }
        printf("  %s\n", get_record_name(buf, sizeof(buf), rec));
 
@@ -234,9 +249,10 @@ static int h_compare_record(const void *r1, const void *r2)
  */
 static int add_bootstages_devicetree(struct fdt_header *blob)
 {
+       struct bootstage_data *data = gd->bootstage;
        int bootstage;
        char buf[20];
-       int id;
+       int recnum;
        int i;
 
        if (!blob)
@@ -248,17 +264,17 @@ static int add_bootstages_devicetree(struct fdt_header *blob)
         */
        bootstage = fdt_add_subnode(blob, 0, "bootstage");
        if (bootstage < 0)
-               return -1;
+               return -EINVAL;
 
        /*
         * 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];
+       for (recnum = data->rec_count - 1, i = 0; recnum >= 0; recnum--, i++) {
+               struct bootstage_record *rec = &data->record[recnum];
                int node;
 
-               if (id != BOOTSTAGE_ID_AWAKE && rec->time_us == 0)
+               if (rec->id != BOOTSTAGE_ID_AWAKE && rec->time_us == 0)
                        continue;
 
                node = fdt_add_subnode(blob, bootstage, simple_itoa(i));
@@ -267,14 +283,14 @@ static int add_bootstages_devicetree(struct fdt_header *blob)
 
                /* add properties to the node. */
                if (fdt_setprop_string(blob, node, "name",
-                               get_record_name(buf, sizeof(buf), rec)))
-                       return -1;
+                                      get_record_name(buf, sizeof(buf), rec)))
+                       return -EINVAL;
 
                /* 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 -EINVAL;
        }
 
        return 0;
@@ -291,54 +307,36 @@ int bootstage_fdt_add_report(void)
 
 void bootstage_report(void)
 {
-       struct bootstage_record *rec = record;
-       int id;
+       struct bootstage_data *data = gd->bootstage;
+       struct bootstage_record *rec = data->record;
        uint32_t prev;
+       int i;
 
-       puts("Timer summary in microseconds:\n");
+       printf("Timer summary in microseconds (%d records):\n",
+              data->rec_count);
        printf("%11s%11s  %s\n", "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);
+       prev = print_time_record(rec, 0);
 
        /* Sort records by increasing time */
-       qsort(record, ARRAY_SIZE(record), sizeof(*rec), h_compare_record);
+       qsort(data->record, data->rec_count, sizeof(*rec), h_compare_record);
 
-       for (id = 0; id < BOOTSTAGE_ID_COUNT; id++, rec++) {
-               if (rec->time_us != 0 && !rec->start_us)
-                       prev = print_time_record(rec->id, rec, prev);
+       for (i = 1, rec++; i < data->rec_count; i++, rec++) {
+               if (rec->id && !rec->start_us)
+                       prev = print_time_record(rec, prev);
        }
-       if (next_id > BOOTSTAGE_ID_COUNT)
-               printf("(Overflowed internal boot id table by %d entries\n"
-                       "- please increase CONFIG_BOOTSTAGE_USER_COUNT\n",
-                      next_id - BOOTSTAGE_ID_COUNT);
+       if (data->rec_count > RECORD_COUNT)
+               printf("Overflowed internal boot id table by %d entries\n"
+                      "Please increase CONFIG_(SPL_)BOOTSTAGE_RECORD_COUNT\n",
+                      data->rec_count - RECORD_COUNT);
 
        puts("\nAccumulated time:\n");
-       for (id = 0, rec = record; id < BOOTSTAGE_ID_COUNT; id++, rec++) {
+       for (i = 0, rec = data->record; i < data->rec_count; i++, rec++) {
                if (rec->start_us)
-                       prev = print_time_record(id, rec, -1);
+                       prev = print_time_record(rec, -1);
        }
 }
 
-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")));
-
 /**
  * Append data to a memory buffer
  *
@@ -363,25 +361,26 @@ static void append_data(char **ptrp, char *end, const void *data, int size)
 
 int bootstage_stash(void *base, int size)
 {
+       const struct bootstage_data *data = gd->bootstage;
        struct bootstage_hdr *hdr = (struct bootstage_hdr *)base;
-       struct bootstage_record *rec;
+       const struct bootstage_record *rec;
        char buf[20];
        char *ptr = base, *end = ptr + size;
        uint32_t count;
-       int id;
+       int i;
 
        if (hdr + 1 > (struct bootstage_hdr *)end) {
                debug("%s: Not enough space for bootstage hdr\n", __func__);
-               return -1;
+               return -ENOSPC;
        }
 
        /* 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)
+       for (rec = data->record, i = count = 0; i < data->rec_count;
+            i++, rec++) {
+               if (rec->id != 0)
                        count++;
        }
        hdr->count = count;
@@ -390,89 +389,88 @@ int bootstage_stash(void *base, int size)
        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));
+       for (rec = data->record, i = 0; i < data->rec_count; i++, rec++) {
+               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;
+       for (rec = data->record, i = 0; i < data->rec_count; i++, rec++) {
+               const char *name;
 
-                       name = get_record_name(buf, sizeof(buf), rec);
-                       append_data(&ptr, end, name, strlen(name) + 1);
-               }
+               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\n", __func__);
-               return -1;
+               return -ENOSPC;
        }
 
        /* Update total data size */
        hdr->size = ptr - (char *)base;
-       printf("Stashed %d records\n", hdr->count);
+       debug("Stashed %d records\n", hdr->count);
 
        return 0;
 }
 
-int bootstage_unstash(void *base, int size)
+int bootstage_unstash(const void *base, int size)
 {
-       struct bootstage_hdr *hdr = (struct bootstage_hdr *)base;
+       const struct bootstage_hdr *hdr = (struct bootstage_hdr *)base;
+       struct bootstage_data *data = gd->bootstage;
+       const char *ptr = base, *end = ptr + size;
        struct bootstage_record *rec;
-       char *ptr = base, *end = ptr + size;
        uint rec_size;
-       int id;
+       int i;
 
        if (size == -1)
                end = (char *)(~(uintptr_t)0);
 
        if (hdr + 1 > (struct bootstage_hdr *)end) {
                debug("%s: Not enough space for bootstage hdr\n", __func__);
-               return -1;
+               return -EPERM;
        }
 
        if (hdr->magic != BOOTSTAGE_MAGIC) {
                debug("%s: Invalid bootstage magic\n", __func__);
-               return -1;
+               return -ENOENT;
        }
 
        if (ptr + hdr->size > end) {
                debug("%s: Bootstage data runs past buffer end\n", __func__);
-               return -1;
+               return -ENOSPC;
        }
 
        if (hdr->count * sizeof(*rec) > hdr->size) {
-               debug("%s: Bootstage has %d records needing %d bytes, but "
+               debug("%s: Bootstage has %d records needing %lu bytes, but "
                        "only %d bytes is available\n", __func__, hdr->count,
-                     hdr->count * sizeof(*rec), hdr->size);
-               return -1;
+                     (ulong)hdr->count * sizeof(*rec), hdr->size);
+               return -ENOSPC;
        }
 
        if (hdr->version != BOOTSTAGE_VERSION) {
                debug("%s: Bootstage data version %#0x unrecognised\n",
                      __func__, hdr->version);
-               return -1;
+               return -EINVAL;
        }
 
-       if (next_id + hdr->count > BOOTSTAGE_ID_COUNT) {
+       if (data->rec_count + hdr->count > RECORD_COUNT) {
                debug("%s: Bootstage has %d records, we have space for %d\n"
-                       "- please increase CONFIG_BOOTSTAGE_USER_COUNT\n",
-                     __func__, hdr->count, BOOTSTAGE_ID_COUNT - next_id);
-               return -1;
+                       "Please increase CONFIG_(SPL_)BOOTSTAGE_RECORD_COUNT\n",
+                     __func__, hdr->count, RECORD_COUNT - data->rec_count);
+               return -ENOSPC;
        }
 
        ptr += sizeof(*hdr);
 
        /* Read the records */
-       rec_size = hdr->count * sizeof(*record);
-       memcpy(record + next_id, ptr, rec_size);
+       rec_size = hdr->count * sizeof(*data->record);
+       memcpy(data->record + data->rec_count, ptr, rec_size);
 
        /* Read the name strings */
        ptr += rec_size;
-       for (rec = record + next_id, id = 0; id < hdr->count; id++, rec++) {
+       for (rec = data->record + data->next_id, i = 0; i < hdr->count;
+            i++, rec++) {
                rec->name = ptr;
 
                /* Assume no data corruption here */
@@ -480,8 +478,31 @@ int bootstage_unstash(void *base, int size)
        }
 
        /* Mark the records as read */
-       next_id += hdr->count;
-       printf("Unstashed %d records\n", hdr->count);
+       data->rec_count += hdr->count;
+       debug("Unstashed %d records\n", hdr->count);
+
+       return 0;
+}
+
+int bootstage_get_size(void)
+{
+       return sizeof(struct bootstage_data);
+}
+
+int bootstage_init(bool first)
+{
+       struct bootstage_data *data;
+       int size = sizeof(struct bootstage_data);
+
+       gd->bootstage = (struct bootstage_data *)malloc(size);
+       if (!gd->bootstage)
+               return -ENOMEM;
+       data = gd->bootstage;
+       memset(data, '\0', size);
+       if (first) {
+               data->next_id = BOOTSTAGE_ID_USER;
+               bootstage_add_record(BOOTSTAGE_ID_AWAKE, "reset", 0, 0);
+       }
 
        return 0;
 }