Rev 4338 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 4338 | Rev 4691 | ||
---|---|---|---|
Line 72... | Line 72... | ||
72 | static int segment_header(elf_ld_t *elf, elf_segment_header_t *entry); |
72 | static int segment_header(elf_ld_t *elf, elf_segment_header_t *entry); |
73 | static int section_header(elf_ld_t *elf, elf_section_header_t *entry); |
73 | static int section_header(elf_ld_t *elf, elf_section_header_t *entry); |
74 | static int load_segment(elf_ld_t *elf, elf_segment_header_t *entry); |
74 | static int load_segment(elf_ld_t *elf, elf_segment_header_t *entry); |
75 | 75 | ||
76 | /** Read until the buffer is read in its entirety. */ |
76 | /** Read until the buffer is read in its entirety. */ |
77 | static int my_read(int fd, char *buf, size_t len) |
77 | static int my_read(int fd, void *buf, size_t len) |
78 | { |
78 | { |
79 | int cnt = 0; |
79 | int cnt = 0; |
80 | do { |
80 | do { |
81 | buf += cnt; |
81 | buf += cnt; |
82 | len -= cnt; |
82 | len -= cnt; |
Line 327... | Line 327... | ||
327 | { |
327 | { |
328 | void *a; |
328 | void *a; |
329 | int flags = 0; |
329 | int flags = 0; |
330 | uintptr_t bias; |
330 | uintptr_t bias; |
331 | uintptr_t base; |
331 | uintptr_t base; |
- | 332 | void *seg_ptr; |
|
- | 333 | uintptr_t seg_addr; |
|
332 | size_t mem_sz; |
334 | size_t mem_sz; |
333 | int rc; |
335 | int rc; |
334 | 336 | ||
335 | DPRINTF("Load segment at addr 0x%x, size 0x%x\n", entry->p_vaddr, |
- | |
336 | entry->p_memsz); |
- | |
337 | - | ||
338 | bias = elf->bias; |
337 | bias = elf->bias; |
339 | 338 | ||
- | 339 | seg_addr = entry->p_vaddr + bias; |
|
- | 340 | seg_ptr = (void *) seg_addr; |
|
- | 341 | ||
- | 342 | DPRINTF("Load segment at addr 0x%x, size 0x%x\n", seg_addr, |
|
- | 343 | entry->p_memsz); |
|
- | 344 | ||
340 | if (entry->p_align > 1) { |
345 | if (entry->p_align > 1) { |
341 | if ((entry->p_offset % entry->p_align) != |
346 | if ((entry->p_offset % entry->p_align) != |
342 | (entry->p_vaddr % entry->p_align)) { |
347 | (seg_addr % entry->p_align)) { |
343 | DPRINTF("Align check 1 failed offset%%align=%d, " |
348 | DPRINTF("Align check 1 failed offset%%align=%d, " |
344 | "vaddr%%align=%d\n", |
349 | "vaddr%%align=%d\n", |
345 | entry->p_offset % entry->p_align, |
350 | entry->p_offset % entry->p_align, |
346 | entry->p_vaddr % entry->p_align |
351 | seg_addr % entry->p_align |
347 | ); |
352 | ); |
348 | return EE_INVALID; |
353 | return EE_INVALID; |
349 | } |
354 | } |
350 | } |
355 | } |
351 | 356 | ||
Line 360... | Line 365... | ||
360 | flags |= AS_AREA_CACHEABLE; |
365 | flags |= AS_AREA_CACHEABLE; |
361 | 366 | ||
362 | base = ALIGN_DOWN(entry->p_vaddr, PAGE_SIZE); |
367 | base = ALIGN_DOWN(entry->p_vaddr, PAGE_SIZE); |
363 | mem_sz = entry->p_memsz + (entry->p_vaddr - base); |
368 | mem_sz = entry->p_memsz + (entry->p_vaddr - base); |
364 | 369 | ||
365 | DPRINTF("Map to p_vaddr=0x%x-0x%x.\n", entry->p_vaddr + bias, |
370 | DPRINTF("Map to seg_addr=0x%x-0x%x.\n", seg_addr, |
366 | entry->p_vaddr + bias + ALIGN_UP(entry->p_memsz, PAGE_SIZE)); |
371 | entry->p_vaddr + bias + ALIGN_UP(entry->p_memsz, PAGE_SIZE)); |
367 | 372 | ||
368 | /* |
373 | /* |
369 | * For the course of loading, the area needs to be readable |
374 | * For the course of loading, the area needs to be readable |
370 | * and writeable. |
375 | * and writeable. |
Line 376... | Line 381... | ||
376 | base+bias, mem_sz); |
381 | base+bias, mem_sz); |
377 | return EE_MEMORY; |
382 | return EE_MEMORY; |
378 | } |
383 | } |
379 | 384 | ||
380 | DPRINTF("as_area_create(0x%lx, 0x%x, %d) -> 0x%lx\n", |
385 | DPRINTF("as_area_create(0x%lx, 0x%x, %d) -> 0x%lx\n", |
381 | entry->p_vaddr+bias, entry->p_memsz, flags, (uintptr_t)a); |
386 | base + bias, mem_sz, flags, (uintptr_t)a); |
382 | 387 | ||
383 | /* |
388 | /* |
384 | * Load segment data |
389 | * Load segment data |
385 | */ |
390 | */ |
386 | rc = lseek(elf->fd, entry->p_offset, SEEK_SET); |
391 | rc = lseek(elf->fd, entry->p_offset, SEEK_SET); |
Line 396... | Line 401... | ||
396 | 401 | ||
397 | unsigned left, now; |
402 | unsigned left, now; |
398 | uint8_t *dp; |
403 | uint8_t *dp; |
399 | 404 | ||
400 | left = entry->p_filesz; |
405 | left = entry->p_filesz; |
401 | dp = (uint8_t *)(entry->p_vaddr + bias); |
406 | dp = seg_ptr; |
402 | 407 | ||
403 | while (left > 0) { |
408 | while (left > 0) { |
404 | now = 16384; |
409 | now = 16384; |
405 | if (now > left) now = left; |
410 | if (now > left) now = left; |
406 | 411 | ||
Line 420... | Line 425... | ||
420 | * need to set the right access mode and ensure SMC coherence. |
425 | * need to set the right access mode and ensure SMC coherence. |
421 | */ |
426 | */ |
422 | if ((elf->flags & ELDF_RW) != 0) return EE_OK; |
427 | if ((elf->flags & ELDF_RW) != 0) return EE_OK; |
423 | 428 | ||
424 | // printf("set area flags to %d\n", flags); |
429 | // printf("set area flags to %d\n", flags); |
425 | rc = as_area_change_flags((uint8_t *)entry->p_vaddr + bias, flags); |
430 | rc = as_area_change_flags(seg_ptr, flags); |
426 | if (rc != 0) { |
431 | if (rc != 0) { |
427 | DPRINTF("Failed to set memory area flags.\n"); |
432 | DPRINTF("Failed to set memory area flags.\n"); |
428 | return EE_MEMORY; |
433 | return EE_MEMORY; |
429 | } |
434 | } |
430 | 435 | ||
431 | if (flags & AS_AREA_EXEC) { |
436 | if (flags & AS_AREA_EXEC) { |
432 | /* Enforce SMC coherence for the segment */ |
437 | /* Enforce SMC coherence for the segment */ |
433 | if (smc_coherence(entry->p_vaddr + bias, entry->p_filesz)) |
438 | if (smc_coherence(seg_ptr, entry->p_filesz)) |
434 | return EE_MEMORY; |
439 | return EE_MEMORY; |
435 | } |
440 | } |
436 | 441 | ||
437 | return EE_OK; |
442 | return EE_OK; |
438 | } |
443 | } |