void stage_cache_add(int stage_id, const struct prog *stage) { struct imd *imd; const struct imd_entry *e; struct stage_cache *meta; void *c; imd = imd_get(); e = imd_entry_add(imd, CBMEM_ID_STAGEx_META + stage_id, sizeof(*meta)); if (e == NULL) { printk(BIOS_DEBUG, "Error: Can't add %x metadata to imd\n", CBMEM_ID_STAGEx_META + stage_id); return; } meta = imd_entry_at(imd, e); meta->load_addr = (uintptr_t)prog_start(stage); meta->entry_addr = (uintptr_t)prog_entry(stage); meta->arg = (uintptr_t)prog_entry_arg(stage); e = imd_entry_add(imd, CBMEM_ID_STAGEx_CACHE + stage_id, prog_size(stage)); if (e == NULL) { printk(BIOS_DEBUG, "Error: Can't add stage_cache %x to imd\n", CBMEM_ID_STAGEx_CACHE + stage_id); return; } c = imd_entry_at(imd, e); memcpy(c, prog_start(stage), prog_size(stage)); }
const struct imd_entry *imd_entry_find_or_add(const struct imd *imd, uint32_t id, size_t size) { const struct imd_entry *e; e = imd_entry_find(imd, id); if (e != NULL) return e; return imd_entry_add(imd, id, size); }
void stage_cache_add_raw(int stage_id, const void *base, const size_t size) { struct imd *imd; const struct imd_entry *e; void *c; imd = imd_get(); e = imd_entry_add(imd, CBMEM_ID_STAGEx_RAW + stage_id, size); if (e == NULL) { printk(BIOS_DEBUG, "Error: Can't add %x raw data to imd\n", CBMEM_ID_STAGEx_RAW + stage_id); return; } c = imd_entry_at(imd, e); if (c == NULL) { printk(BIOS_DEBUG, "Error: Can't get %x raw entry in imd\n", CBMEM_ID_STAGEx_RAW + stage_id); return; } memcpy(c, base, size); }