123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428 |
- // SPDX-License-Identifier: GPL-2.0+
- /*
- * Copyright 2018 Google, Inc
- * Written by Simon Glass <sjg@chromium.org>
- */
- #include <common.h>
- #include <bloblist.h>
- #include <log.h>
- #include <mapmem.h>
- #include <spl.h>
- #include <asm/global_data.h>
- #include <u-boot/crc.h>
- /*
- * A bloblist is a single contiguous chunk of memory with a header
- * (struct bloblist_hdr) and a number of blobs in it.
- *
- * Each blob starts on a BLOBLIST_ALIGN boundary relative to the start of the
- * bloblist and consists of a struct bloblist_rec, some padding to the required
- * alignment for the blog and then the actual data. The padding ensures that the
- * start address of the data in each blob is aligned as required. Note that
- * each blob's *data* is aligned to BLOBLIST_ALIGN regardless of the alignment
- * of the bloblist itself or the blob header.
- *
- * So far, only BLOBLIST_ALIGN alignment is supported.
- */
- DECLARE_GLOBAL_DATA_PTR;
- static const char *const tag_name[] = {
- [BLOBLISTT_NONE] = "(none)",
- [BLOBLISTT_EC_HOSTEVENT] = "EC host event",
- [BLOBLISTT_SPL_HANDOFF] = "SPL hand-off",
- [BLOBLISTT_VBOOT_CTX] = "Chrome OS vboot context",
- [BLOBLISTT_VBOOT_HANDOFF] = "Chrome OS vboot hand-off",
- [BLOBLISTT_ACPI_GNVS] = "ACPI GNVS",
- [BLOBLISTT_INTEL_VBT] = "Intel Video-BIOS table",
- [BLOBLISTT_TPM2_TCG_LOG] = "TPM v2 log space",
- [BLOBLISTT_TCPA_LOG] = "TPM log space",
- [BLOBLISTT_ACPI_TABLES] = "ACPI tables for x86",
- [BLOBLISTT_SMBIOS_TABLES] = "SMBIOS tables for x86",
- };
- const char *bloblist_tag_name(enum bloblist_tag_t tag)
- {
- if (tag < 0 || tag >= BLOBLISTT_COUNT)
- return "invalid";
- return tag_name[tag];
- }
- static struct bloblist_rec *bloblist_first_blob(struct bloblist_hdr *hdr)
- {
- if (hdr->alloced <= hdr->hdr_size)
- return NULL;
- return (struct bloblist_rec *)((void *)hdr + hdr->hdr_size);
- }
- static ulong bloblist_blob_end_ofs(struct bloblist_hdr *hdr,
- struct bloblist_rec *rec)
- {
- ulong offset;
- offset = (void *)rec - (void *)hdr;
- offset += rec->hdr_size + ALIGN(rec->size, BLOBLIST_ALIGN);
- return offset;
- }
- static struct bloblist_rec *bloblist_next_blob(struct bloblist_hdr *hdr,
- struct bloblist_rec *rec)
- {
- ulong offset = bloblist_blob_end_ofs(hdr, rec);
- if (offset >= hdr->alloced)
- return NULL;
- return (struct bloblist_rec *)((void *)hdr + offset);
- }
- #define foreach_rec(_rec, _hdr) \
- for (_rec = bloblist_first_blob(_hdr); \
- _rec; \
- _rec = bloblist_next_blob(_hdr, _rec))
- static struct bloblist_rec *bloblist_findrec(uint tag)
- {
- struct bloblist_hdr *hdr = gd->bloblist;
- struct bloblist_rec *rec;
- if (!hdr)
- return NULL;
- foreach_rec(rec, hdr) {
- if (rec->tag == tag)
- return rec;
- }
- return NULL;
- }
- static int bloblist_addrec(uint tag, int size, int align,
- struct bloblist_rec **recp)
- {
- struct bloblist_hdr *hdr = gd->bloblist;
- struct bloblist_rec *rec;
- int data_start, new_alloced;
- if (!align)
- align = BLOBLIST_ALIGN;
- /* Figure out where the new data will start */
- data_start = map_to_sysmem(hdr) + hdr->alloced + sizeof(*rec);
- /* Align the address and then calculate the offset from ->alloced */
- data_start = ALIGN(data_start, align) - map_to_sysmem(hdr);
- /* Calculate the new allocated total */
- new_alloced = data_start + ALIGN(size, align);
- if (new_alloced > hdr->size) {
- log(LOGC_BLOBLIST, LOGL_ERR,
- "Failed to allocate %x bytes size=%x, need size=%x\n",
- size, hdr->size, new_alloced);
- return log_msg_ret("bloblist add", -ENOSPC);
- }
- rec = (void *)hdr + hdr->alloced;
- rec->tag = tag;
- rec->hdr_size = data_start - hdr->alloced;
- rec->size = size;
- rec->spare = 0;
- /* Zero the record data */
- memset((void *)rec + rec->hdr_size, '\0', rec->size);
- hdr->alloced = new_alloced;
- *recp = rec;
- return 0;
- }
- static int bloblist_ensurerec(uint tag, struct bloblist_rec **recp, int size,
- int align)
- {
- struct bloblist_rec *rec;
- rec = bloblist_findrec(tag);
- if (rec) {
- if (size && size != rec->size) {
- *recp = rec;
- return -ESPIPE;
- }
- } else {
- int ret;
- ret = bloblist_addrec(tag, size, align, &rec);
- if (ret)
- return ret;
- }
- *recp = rec;
- return 0;
- }
- void *bloblist_find(uint tag, int size)
- {
- struct bloblist_rec *rec;
- rec = bloblist_findrec(tag);
- if (!rec)
- return NULL;
- if (size && size != rec->size)
- return NULL;
- return (void *)rec + rec->hdr_size;
- }
- void *bloblist_add(uint tag, int size, int align)
- {
- struct bloblist_rec *rec;
- if (bloblist_addrec(tag, size, align, &rec))
- return NULL;
- return (void *)rec + rec->hdr_size;
- }
- int bloblist_ensure_size(uint tag, int size, int align, void **blobp)
- {
- struct bloblist_rec *rec;
- int ret;
- ret = bloblist_ensurerec(tag, &rec, size, align);
- if (ret)
- return ret;
- *blobp = (void *)rec + rec->hdr_size;
- return 0;
- }
- void *bloblist_ensure(uint tag, int size)
- {
- struct bloblist_rec *rec;
- if (bloblist_ensurerec(tag, &rec, size, 0))
- return NULL;
- return (void *)rec + rec->hdr_size;
- }
- int bloblist_ensure_size_ret(uint tag, int *sizep, void **blobp)
- {
- struct bloblist_rec *rec;
- int ret;
- ret = bloblist_ensurerec(tag, &rec, *sizep, 0);
- if (ret == -ESPIPE)
- *sizep = rec->size;
- else if (ret)
- return ret;
- *blobp = (void *)rec + rec->hdr_size;
- return 0;
- }
- static int bloblist_resize_rec(struct bloblist_hdr *hdr,
- struct bloblist_rec *rec,
- int new_size)
- {
- int expand_by; /* Number of bytes to expand by (-ve to contract) */
- int new_alloced; /* New value for @hdr->alloced */
- ulong next_ofs; /* Offset of the record after @rec */
- expand_by = ALIGN(new_size - rec->size, BLOBLIST_ALIGN);
- new_alloced = ALIGN(hdr->alloced + expand_by, BLOBLIST_ALIGN);
- if (new_size < 0) {
- log(LOGC_BLOBLIST, LOGL_DEBUG,
- "Attempt to shrink blob size below 0 (%x)\n", new_size);
- return log_msg_ret("size", -EINVAL);
- }
- if (new_alloced > hdr->size) {
- log(LOGC_BLOBLIST, LOGL_ERR,
- "Failed to allocate %x bytes size=%x, need size=%x\n",
- new_size, hdr->size, new_alloced);
- return log_msg_ret("alloc", -ENOSPC);
- }
- /* Move the following blobs up or down, if this is not the last */
- next_ofs = bloblist_blob_end_ofs(hdr, rec);
- if (next_ofs != hdr->alloced) {
- memmove((void *)hdr + next_ofs + expand_by,
- (void *)hdr + next_ofs, new_alloced - next_ofs);
- }
- hdr->alloced = new_alloced;
- /* Zero the new part of the blob */
- if (expand_by > 0) {
- memset((void *)rec + rec->hdr_size + rec->size, '\0',
- new_size - rec->size);
- }
- /* Update the size of this blob */
- rec->size = new_size;
- return 0;
- }
- int bloblist_resize(uint tag, int new_size)
- {
- struct bloblist_hdr *hdr = gd->bloblist;
- struct bloblist_rec *rec;
- int ret;
- rec = bloblist_findrec(tag);
- if (!rec)
- return log_msg_ret("find", -ENOENT);
- ret = bloblist_resize_rec(hdr, rec, new_size);
- if (ret)
- return log_msg_ret("resize", ret);
- return 0;
- }
- static u32 bloblist_calc_chksum(struct bloblist_hdr *hdr)
- {
- struct bloblist_rec *rec;
- u32 chksum;
- chksum = crc32(0, (unsigned char *)hdr,
- offsetof(struct bloblist_hdr, chksum));
- foreach_rec(rec, hdr) {
- chksum = crc32(chksum, (void *)rec, rec->hdr_size);
- chksum = crc32(chksum, (void *)rec + rec->hdr_size, rec->size);
- }
- return chksum;
- }
- int bloblist_new(ulong addr, uint size, uint flags)
- {
- struct bloblist_hdr *hdr;
- if (size < sizeof(*hdr))
- return log_ret(-ENOSPC);
- if (addr & (BLOBLIST_ALIGN - 1))
- return log_ret(-EFAULT);
- hdr = map_sysmem(addr, size);
- memset(hdr, '\0', sizeof(*hdr));
- hdr->version = BLOBLIST_VERSION;
- hdr->hdr_size = sizeof(*hdr);
- hdr->flags = flags;
- hdr->magic = BLOBLIST_MAGIC;
- hdr->size = size;
- hdr->alloced = hdr->hdr_size;
- hdr->chksum = 0;
- gd->bloblist = hdr;
- return 0;
- }
- int bloblist_check(ulong addr, uint size)
- {
- struct bloblist_hdr *hdr;
- u32 chksum;
- hdr = map_sysmem(addr, sizeof(*hdr));
- if (hdr->magic != BLOBLIST_MAGIC)
- return log_msg_ret("Bad magic", -ENOENT);
- if (hdr->version != BLOBLIST_VERSION)
- return log_msg_ret("Bad version", -EPROTONOSUPPORT);
- if (size && hdr->size != size)
- return log_msg_ret("Bad size", -EFBIG);
- chksum = bloblist_calc_chksum(hdr);
- if (hdr->chksum != chksum) {
- log(LOGC_BLOBLIST, LOGL_ERR, "Checksum %x != %x\n", hdr->chksum,
- chksum);
- return log_msg_ret("Bad checksum", -EIO);
- }
- gd->bloblist = hdr;
- return 0;
- }
- int bloblist_finish(void)
- {
- struct bloblist_hdr *hdr = gd->bloblist;
- hdr->chksum = bloblist_calc_chksum(hdr);
- return 0;
- }
- void bloblist_get_stats(ulong *basep, ulong *sizep, ulong *allocedp)
- {
- struct bloblist_hdr *hdr = gd->bloblist;
- *basep = map_to_sysmem(gd->bloblist);
- *sizep = hdr->size;
- *allocedp = hdr->alloced;
- }
- static void show_value(const char *prompt, ulong value)
- {
- printf("%s:%*s %-5lx ", prompt, 8 - (int)strlen(prompt), "", value);
- print_size(value, "\n");
- }
- void bloblist_show_stats(void)
- {
- ulong base, size, alloced;
- bloblist_get_stats(&base, &size, &alloced);
- printf("base: %lx\n", base);
- show_value("size", size);
- show_value("alloced", alloced);
- show_value("free", size - alloced);
- }
- void bloblist_show_list(void)
- {
- struct bloblist_hdr *hdr = gd->bloblist;
- struct bloblist_rec *rec;
- printf("%-8s %8s Tag Name\n", "Address", "Size");
- for (rec = bloblist_first_blob(hdr); rec;
- rec = bloblist_next_blob(hdr, rec)) {
- printf("%08lx %8x %3d %s\n",
- (ulong)map_to_sysmem((void *)rec + rec->hdr_size),
- rec->size, rec->tag, bloblist_tag_name(rec->tag));
- }
- }
- void bloblist_reloc(void *to, uint to_size, void *from, uint from_size)
- {
- struct bloblist_hdr *hdr;
- memcpy(to, from, from_size);
- hdr = to;
- hdr->size = to_size;
- }
- int bloblist_init(void)
- {
- bool expected;
- int ret = -ENOENT;
- /**
- * Wed expect to find an existing bloblist in the first phase of U-Boot
- * that runs
- */
- expected = !u_boot_first_phase();
- if (spl_prev_phase() == PHASE_TPL && !IS_ENABLED(CONFIG_TPL_BLOBLIST))
- expected = false;
- if (expected)
- ret = bloblist_check(CONFIG_BLOBLIST_ADDR,
- CONFIG_BLOBLIST_SIZE);
- if (ret) {
- log(LOGC_BLOBLIST, expected ? LOGL_WARNING : LOGL_DEBUG,
- "Existing bloblist not found: creating new bloblist\n");
- ret = bloblist_new(CONFIG_BLOBLIST_ADDR, CONFIG_BLOBLIST_SIZE,
- 0);
- } else {
- log(LOGC_BLOBLIST, LOGL_DEBUG, "Found existing bloblist\n");
- }
- return ret;
- }
|