static void boot_find_cobjs(struct cobj_header *h, int n) { int i; vaddr_t start, end; start = (vaddr_t)h; hs[0] = h; for (i = 1 ; i < n ; i++) { int j = 0, size = 0, tot = 0; size = h->size; for (j = 0 ; j < (int)h->nsect ; j++) { tot += cobj_sect_size(h, j); } printc("cobj %d found at %p:%d, size %d -> %x\n", i, hs[i-1], size, tot, cobj_sect_get(hs[i-1], 0)->vaddr); end = start + round_up_to_cacheline(size); hs[i] = h = (struct cobj_header*)end; start = end; } hs[n] = NULL; printc("cobj found at %p ... -> %x\n", hs[n-1], cobj_sect_get(hs[n-1], 0)->vaddr); }
void make_spd_llboot(struct service_symbs *boot, struct service_symbs *all) { volatile int **heap_ptr; int *heap_ptr_val, n = 0; struct cobj_header *h; char *mem; u32_t obj_size; struct cos_component_information *ci; struct service_symbs *first = all; if (service_get_spdid(boot) != LLBOOT_COMPN) { printf("Low-Level Booter component must be component number %d, but is %d instead.\n" "\tSuggested fix: Your first four components should be e.g. " "c0.o, ;llboot.o, ;*fprr.o, ;mm.o, ;boot.o, ;\n", LLBOOT_COMPN, service_get_spdid(boot)); exit(-1); } /* Setup the capabilities for each of the booter-loaded * components */ all = first; for (all = first ; NULL != all ; all = all->next) { if (!is_booter_loaded(all)) continue; if (make_cobj_caps(all, all->cobj)) { printl(PRINT_HIGH, "Could not create capabilities in cobj for %s\n", all->obj); exit(-1); } } heap_ptr = (volatile int **)get_heap_ptr(boot); ci = (void *)get_symb_address(&boot->exported, COMP_INFO); ci->cos_poly[0] = (vaddr_t)*heap_ptr; for (all = first ; NULL != all ; all = all->next) { vaddr_t map_addr; int map_sz; if (!is_booter_loaded(all) || is_hl_booter_loaded(all)) continue; n++; heap_ptr_val = (int*)*heap_ptr; assert(is_booter_loaded(all)); h = all->cobj; assert(h); obj_size = round_up_to_cacheline(h->size); map_addr = round_up_to_page(heap_ptr_val); map_sz = (int)obj_size - (int)(map_addr-(vaddr_t)heap_ptr_val); if (map_sz > 0) { mem = mmap((void*)map_addr, map_sz, PROT_WRITE | PROT_READ, MAP_FIXED | MAP_PRIVATE | MAP_ANONYMOUS, 0, 0); if (MAP_FAILED == mem) { perror("Couldn't map test component into the boot component"); exit(-1); } } printl(PRINT_HIGH, "boot component: placing %s:%d @ %p, copied from %p:%d\n", all->obj, service_get_spdid(all), heap_ptr_val, h, obj_size); memcpy(heap_ptr_val, h, h->size); *heap_ptr = (void*)(((int)heap_ptr_val) + obj_size); } all = first; *heap_ptr = (int*)(round_up_to_page((int)*heap_ptr)); ci->cos_poly[1] = (vaddr_t)n; ci->cos_poly[2] = ((unsigned int)*heap_ptr); make_spd_mpd_mgr(boot, all); ci->cos_poly[3] = ((unsigned int)*heap_ptr); make_spd_config_comp(boot, all); llboot_mem = (unsigned int)*heap_ptr - boot->lower_addr; boot->heap_top = (unsigned int)*heap_ptr; /* ensure that we copy all of the meta-data as well */ }
void make_spd_boot(struct service_symbs *boot, struct service_symbs *all) { int n = 0, cnt = 0, tot_sz = 0; unsigned int off = 0, i; struct cobj_header *h, *new_h; char *new_end, *new_sect_start; u32_t new_vaddr_start; u32_t all_obj_sz; struct cos_component_information *ci; struct service_symbs *first = all; /* array to hold the order of initialization/schedule */ struct service_symbs **schedule; if (service_get_spdid(boot) != LLBOOT_BOOT) { printf("Booter component must be component number %d, is %d.\n" "\tSuggested fix: Your first four components should be e.g. " "c0.o, ;llboot.o, ;*fprr.o, ;mm.o, ;print.o, ;boot.o, ;\n", LLBOOT_BOOT, service_get_spdid(boot)); exit(-1); } /* should be loaded by llboot */ assert(is_booter_loaded(boot) && !is_hl_booter_loaded(boot)); assert(boot->cobj->nsect == MAXSEC_S); /* extra section for other components */ /* Assign ids to the booter-loaded components. */ for (all = first ; NULL != all ; all = all->next) { if (!is_hl_booter_loaded(all)) continue; h = all->cobj; assert(h); cnt++; tot_sz += h->size; } schedule = malloc(sizeof(struct service_symbs *) * cnt); assert(schedule); printl(PRINT_HIGH, "Loaded component's initialization scheduled in the following order:\n"); for (all = first ; NULL != all ; all = all->next) { make_spd_boot_schedule(all, schedule, &off); } /* Setup the capabilities for each of the booter-loaded * components */ all = first; for (all = first ; NULL != all ; all = all->next) { if (!is_hl_booter_loaded(all)) continue; if (make_cobj_caps(all, all->cobj)) { printl(PRINT_HIGH, "Could not create capabilities in cobj for %s\n", all->obj); exit(-1); } } all_obj_sz = 0; /* Find the cobj's size */ for (all = first ; NULL != all ; all = all->next) { struct cobj_header *h; if (!is_hl_booter_loaded(all)) continue; printl(PRINT_HIGH, "booter found %s:%d with len %d\n", all->obj, service_get_spdid(all), all->cobj->size) n++; assert(is_hl_booter_loaded(all)); h = all->cobj; assert(h); all_obj_sz += round_up_to_cacheline(h->size); } all_obj_sz = all_obj_sz; all_obj_sz += 3 * PAGE_SIZE; // schedule, config info, and edge info h = boot->cobj; assert(h->nsect == MAXSEC_S); new_h = malloc(h->size + all_obj_sz); assert(new_h); memcpy(new_h, h, h->size); /* Initialize the new section */ { struct cobj_sect *s_prev; new_h->size += all_obj_sz; s_prev = cobj_sect_get(new_h, INITFILE_S); cobj_sect_init(new_h, INITFILE_S, cos_sect_get(INITFILE_S)->cobj_flags, round_up_to_page(s_prev->vaddr + s_prev->bytes), all_obj_sz); } new_sect_start = new_end = cobj_sect_contents(new_h, INITFILE_S); new_vaddr_start = cobj_sect_get(new_h, INITFILE_S)->vaddr; ci = (void *)cobj_vaddr_get(new_h, (u32_t)get_symb_address(&boot->exported, COMP_INFO)); assert(ci); ci->cos_poly[0] = ADDR2VADDR(new_sect_start); /* copy the cobjs */ for (all = first ; NULL != all ; all = all->next) { struct cobj_header *h; if (!is_hl_booter_loaded(all)) continue; h = all->cobj; assert(h); memcpy(new_end, h, h->size); new_end += round_up_to_cacheline(h->size); } assert((u32_t)(new_end - new_sect_start) + 3*PAGE_SIZE == cobj_sect_get(new_h, INITFILE_S)->bytes); all = first; ci->cos_poly[1] = (vaddr_t)n; ci->cos_poly[2] = ADDR2VADDR(new_end); serialize_spd_graph((struct comp_graph*)new_end, PAGE_SIZE/sizeof(struct comp_graph), all); new_end += PAGE_SIZE; ci->cos_poly[3] = ADDR2VADDR(new_end); format_config_info(all, (struct component_init_str*)new_end); assert(off < PAGE_SIZE/sizeof(unsigned int)); /* schedule must fit into page. */ new_end += PAGE_SIZE; ci->cos_poly[4] = ADDR2VADDR(new_end); for (i = 0 ; i < off ; i++) { ((int *)new_end)[i] = service_get_spdid(schedule[i]); } ((int *)new_end)[off] = 0; new_end += PAGE_SIZE; ci->cos_heap_ptr = round_up_to_page(ADDR2VADDR(new_end)); boot->cobj = new_h; printl(PRINT_HIGH, "boot component %s:%d has new section @ %x:%x at address %x, \n\t" "with n %d, graph @ %x, config info @ %x, schedule %x, and heap %x\n", boot->obj, service_get_spdid(boot), (unsigned int)cobj_sect_get(new_h, 3)->vaddr, (int)cobj_sect_get(new_h, 3)->bytes, (unsigned int)ci->cos_poly[0], (unsigned int)ci->cos_poly[1], (unsigned int)ci->cos_poly[2], (unsigned int)ci->cos_poly[3], (unsigned int)ci->cos_poly[4], (unsigned int)ci->cos_heap_ptr); }