main/vaseboot
main
/
vaseboot
1
0
Fork 0
Code Issues Pull Requests 1 Packages Projects Releases Wiki Activity
vaseboot/VasEBoot-core/lib/relocator.c

1669 lines
45 KiB
C
Raw Blame History

/*
* VAS_EBOOT -- GRand Unified Bootloader
* Copyright (C) 2009, 2010 Free Software Foundation, Inc.
*
* VAS_EBOOT 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 3 of the License, or
* (at your option) any later version.
*
* VAS_EBOOT 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 VAS_EBOOT. If not, see <http://www.gnu.org/licenses/>.
*/
#include <VasEBoot/relocator.h>
#include <VasEBoot/relocator_private.h>
#include <VasEBoot/mm_private.h>
#include <VasEBoot/misc.h>
#include <VasEBoot/cache.h>
#include <VasEBoot/memory.h>
#include <VasEBoot/dl.h>
#include <VasEBoot/i18n.h>
VAS_EBOOT_MOD_LICENSE ("GPLv3+");
struct VasEBoot_relocator
{
struct VasEBoot_relocator_chunk *chunks;
VasEBoot_phys_addr_t postchunks;
VasEBoot_phys_addr_t highestaddr;
VasEBoot_phys_addr_t highestnonpostaddr;
VasEBoot_size_t relocators_size;
};
struct VasEBoot_relocator_subchunk
{
enum {CHUNK_TYPE_IN_REGION, CHUNK_TYPE_REGION_START,
#if VAS_EBOOT_RELOCATOR_HAVE_FIRMWARE_REQUESTS
CHUNK_TYPE_FIRMWARE, CHUNK_TYPE_LEFTOVER
#endif
} type;
VasEBoot_mm_region_t reg;
VasEBoot_phys_addr_t start;
VasEBoot_size_t size;
VasEBoot_size_t pre_size;
struct VasEBoot_relocator_extra_block *extra;
#if VAS_EBOOT_RELOCATOR_HAVE_LEFTOVERS
struct VasEBoot_relocator_fw_leftover *pre, *post;
#endif
};
struct VasEBoot_relocator_chunk
{
struct VasEBoot_relocator_chunk *next;
VasEBoot_phys_addr_t src;
void *srcv;
VasEBoot_phys_addr_t target;
VasEBoot_size_t size;
struct VasEBoot_relocator_subchunk *subchunks;
unsigned nsubchunks;
};
struct VasEBoot_relocator_extra_block
{
struct VasEBoot_relocator_extra_block *next;
struct VasEBoot_relocator_extra_block **prev;
VasEBoot_phys_addr_t start;
VasEBoot_phys_addr_t end;
};
#if VAS_EBOOT_RELOCATOR_HAVE_LEFTOVERS
struct VasEBoot_relocator_fw_leftover
{
struct VasEBoot_relocator_fw_leftover *next;
struct VasEBoot_relocator_fw_leftover **prev;
VasEBoot_phys_addr_t quantstart;
VasEBoot_uint8_t freebytes[VAS_EBOOT_RELOCATOR_FIRMWARE_REQUESTS_QUANT / 8];
};
static struct VasEBoot_relocator_fw_leftover *leftovers;
#endif
static struct VasEBoot_relocator_extra_block *extra_blocks;
void *
get_virtual_current_address (VasEBoot_relocator_chunk_t in)
{
return in->srcv;
}
VasEBoot_phys_addr_t
get_physical_target_address (VasEBoot_relocator_chunk_t in)
{
return in->target;
}
struct VasEBoot_relocator *
VasEBoot_relocator_new (void)
{
struct VasEBoot_relocator *ret;
VasEBoot_cpu_relocator_init ();
ret = VasEBoot_zalloc (sizeof (struct VasEBoot_relocator));
if (!ret)
return NULL;
ret->postchunks = ~(VasEBoot_phys_addr_t) 0;
ret->relocators_size = VasEBoot_relocator_jumper_size + VasEBoot_relocator_preamble_size;
VasEBoot_dprintf ("relocator", "relocators_size=%lu\n",
(unsigned long) ret->relocators_size);
return ret;
}
#define DIGITSORT_BITS 8
#define DIGITSORT_MASK ((1 << DIGITSORT_BITS) - 1)
#define BITS_IN_BYTE 8
#define max(a, b) (((a) > (b)) ? (a) : (b))
#define min(a, b) (((a) < (b)) ? (a) : (b))
static inline int
is_start (int type)
{
return !(type & 1) && (type != COLLISION_START);
}
static void
allocate_regstart (VasEBoot_phys_addr_t addr, VasEBoot_size_t size, VasEBoot_mm_region_t rb,
VasEBoot_mm_region_t *regancestor, VasEBoot_mm_header_t hancestor)
{
VasEBoot_addr_t newreg_start, newreg_raw_start
= (VasEBoot_addr_t) rb + (addr - VasEBoot_vtop (rb)) + size;
VasEBoot_addr_t newreg_size, newreg_presize;
VasEBoot_mm_header_t new_header;
VasEBoot_mm_header_t hb = (VasEBoot_mm_header_t) (rb + 1);
#ifdef DEBUG_RELOCATOR_NOMEM_DPRINTF
VasEBoot_dprintf ("relocator", "ra = %p, rb = %p\n", regancestor, rb);
#endif
newreg_start = ALIGN_UP (newreg_raw_start, VAS_EBOOT_MM_ALIGN);
newreg_presize = newreg_start - newreg_raw_start;
newreg_size = rb->size - (newreg_start - (VasEBoot_addr_t) rb);
if ((hb->size << VAS_EBOOT_MM_ALIGN_LOG2) >= newreg_start
- (VasEBoot_addr_t) rb)
{
VasEBoot_mm_header_t newhnext = hb->next;
VasEBoot_size_t newhsize = ((hb->size << VAS_EBOOT_MM_ALIGN_LOG2)
- (newreg_start
- (VasEBoot_addr_t) rb)) >> VAS_EBOOT_MM_ALIGN_LOG2;
new_header = (void *) (newreg_start + sizeof (*rb));
if (newhnext == hb)
newhnext = new_header;
new_header->next = newhnext;
new_header->size = newhsize;
new_header->magic = VAS_EBOOT_MM_FREE_MAGIC;
}
else
{
new_header = hb->next;
if (new_header == hb)
new_header = (void *) (newreg_start + sizeof (*rb));
}
{
struct VasEBoot_mm_header *newregfirst = rb->first;
struct VasEBoot_mm_region *newregnext = rb->next;
struct VasEBoot_mm_region *newreg = (void *) newreg_start;
hancestor->next = new_header;
if (newregfirst == hb)
newregfirst = new_header;
newreg->first = newregfirst;
newreg->next = newregnext;
newreg->pre_size = newreg_presize;
newreg->size = newreg_size;
*regancestor = newreg;
{
VasEBoot_mm_header_t h = newreg->first, hp = NULL;
do
{
if ((void *) h < (void *) (newreg + 1))
VasEBoot_fatal ("Failed to adjust memory region: %p, %p, %p, %p, %p",
newreg, newreg->first, h, hp, hb);
#ifdef DEBUG_RELOCATOR_NOMEM_DPRINTF
if ((void *) h == (void *) (newreg + 1))
VasEBoot_dprintf ("relocator",
"Free start memory region: %p, %p, %p, %p, %p",
newreg, newreg->first, h, hp, hb);
#endif
hp = h;
h = h->next;
}
while (h != newreg->first);
}
}
}
static void
allocate_inreg (VasEBoot_phys_addr_t paddr, VasEBoot_size_t size,
VasEBoot_mm_header_t hb, VasEBoot_mm_header_t hbp,
VasEBoot_mm_region_t rb)
{
struct VasEBoot_mm_header *foll = NULL;
VasEBoot_addr_t vaddr = (VasEBoot_addr_t) hb + (paddr - VasEBoot_vtop (hb));
#ifdef DEBUG_RELOCATOR_NOMEM_DPRINTF
VasEBoot_dprintf ("relocator", "inreg paddr = 0x%lx, size = %lu,"
" hb = %p, hbp = %p, rb = %p, vaddr = 0x%lx\n",
(unsigned long) paddr, (unsigned long) size, hb, hbp,
rb, (unsigned long) vaddr);
#endif
if (ALIGN_UP (vaddr + size, VAS_EBOOT_MM_ALIGN) + VAS_EBOOT_MM_ALIGN
<= (VasEBoot_addr_t) (hb + hb->size))
{
foll = (void *) ALIGN_UP (vaddr + size, VAS_EBOOT_MM_ALIGN);
foll->magic = VAS_EBOOT_MM_FREE_MAGIC;
foll->size = hb + hb->size - foll;
#ifdef DEBUG_RELOCATOR_NOMEM_DPRINTF
VasEBoot_dprintf ("relocator", "foll = %p, foll->size = %lu\n", foll,
(unsigned long) foll->size);
#endif
}
if (vaddr - (VasEBoot_addr_t) hb >= sizeof (*hb))
{
hb->size = ((vaddr - (VasEBoot_addr_t) hb) >> VAS_EBOOT_MM_ALIGN_LOG2);
if (foll)
{
foll->next = hb;
hbp->next = foll;
if (rb->first == hb)
{
rb->first = foll;
}
}
}
else
{
if (foll)
{
foll->next = hb->next;
}
else
foll = hb->next;
hbp->next = foll;
if (rb->first == hb)
{
rb->first = foll;
}
if (rb->first == hb)
{
rb->first = (void *) (rb + 1);
}
}
}
#if VAS_EBOOT_RELOCATOR_HAVE_LEFTOVERS
static void
check_leftover (struct VasEBoot_relocator_fw_leftover *lo)
{
unsigned i;
for (i = 0; i < sizeof (lo->freebytes); i++)
if (lo->freebytes[i] != 0xff)
return;
VasEBoot_relocator_firmware_free_region (lo->quantstart,
VAS_EBOOT_RELOCATOR_FIRMWARE_REQUESTS_QUANT);
*lo->prev = lo->next;
if (lo->next)
lo->next->prev = lo->prev;
}
#endif
static void
free_subchunk (const struct VasEBoot_relocator_subchunk *subchu)
{
switch (subchu->type)
{
case CHUNK_TYPE_REGION_START:
{
VasEBoot_mm_region_t r1, r2, *rp;
VasEBoot_mm_header_t h;
VasEBoot_size_t pre_size;
r1 = subchu->reg;
r2 = (VasEBoot_mm_region_t) ALIGN_UP ((VasEBoot_addr_t) subchu->reg
+ (VasEBoot_vtop (subchu->reg)
- subchu->start) + subchu->size,
VAS_EBOOT_MM_ALIGN);
for (rp = &VasEBoot_mm_base; *rp && *rp != r2; rp = &((*rp)->next));
pre_size = subchu->pre_size;
if (*rp)
{
VasEBoot_mm_header_t h2, *hp;
r1->first = r2->first;
r1->next = r2->next;
r1->pre_size = pre_size;
r1->size = r2->size + (r2 - r1) * sizeof (*r2);
*rp = r1;
h = (VasEBoot_mm_header_t) (r1 + 1);
h->next = r2->first;
h->magic = VAS_EBOOT_MM_FREE_MAGIC;
h->size = (r2 - r1 - 1);
for (hp = &r2->first, h2 = *hp; h2->next != r2->first;
hp = &(h2->next), h2 = *hp)
if (h2 == (VasEBoot_mm_header_t) (r2 + 1))
break;
if (h2 == (VasEBoot_mm_header_t) (r2 + 1))
{
h->size = h2->size + (h2 - h);
h->next = h2->next;
*hp = h;
if (hp == &r2->first)
{
for (h2 = r2->first; h2->next != r2->first; h2 = h2->next);
h2->next = h;
}
}
else
{
h2->next = h;
}
}
else
{
r1->pre_size = pre_size;
r1->size = (r2 - r1) * sizeof (*r2);
/* Find where to insert this region.
Put a smaller one before bigger ones,
to prevent fragmentation. */
for (rp = &VasEBoot_mm_base; *rp; rp = &((*rp)->next))
if ((*rp)->size > r1->size)
break;
r1->next = *rp;
*rp = r1->next;
h = (VasEBoot_mm_header_t) (r1 + 1);
r1->first = h;
h->next = h;
h->magic = VAS_EBOOT_MM_FREE_MAGIC;
h->size = (r2 - r1 - 1);
}
for (r2 = VasEBoot_mm_base; r2; r2 = r2->next)
if ((VasEBoot_addr_t) r2 + r2->size == (VasEBoot_addr_t) r1)
break;
if (r2)
{
VasEBoot_mm_header_t hl2, hl, g;
g = (VasEBoot_mm_header_t) ((VasEBoot_addr_t) r2 + r2->size);
g->size = (VasEBoot_mm_header_t) r1 - g;
r2->size += r1->size;
for (hl = r2->first; hl->next != r2->first; hl = hl->next);
for (hl2 = r1->first; hl2->next != r1->first; hl2 = hl2->next);
hl2->next = r2->first;
r2->first = r1->first;
hl->next = r2->first;
*rp = (*rp)->next;
VasEBoot_free (g + 1);
}
break;
}
case CHUNK_TYPE_IN_REGION:
{
VasEBoot_mm_header_t h = (VasEBoot_mm_header_t) ALIGN_DOWN ((VasEBoot_addr_t) subchu->start,
VAS_EBOOT_MM_ALIGN);
h->size
= ((subchu->start + subchu->size + VAS_EBOOT_MM_ALIGN - 1) / VAS_EBOOT_MM_ALIGN)
- (subchu->start / VAS_EBOOT_MM_ALIGN) - 1;
h->next = h;
h->magic = VAS_EBOOT_MM_ALLOC_MAGIC;
VasEBoot_free (h + 1);
break;
}
#if VAS_EBOOT_RELOCATOR_HAVE_FIRMWARE_REQUESTS
case CHUNK_TYPE_FIRMWARE:
case CHUNK_TYPE_LEFTOVER:
{
VasEBoot_addr_t fstart, fend;
fstart = ALIGN_UP (subchu->start,
VAS_EBOOT_RELOCATOR_FIRMWARE_REQUESTS_QUANT);
fend = ALIGN_DOWN (subchu->start + subchu->size,
VAS_EBOOT_RELOCATOR_FIRMWARE_REQUESTS_QUANT);
if (fstart < fend)
VasEBoot_relocator_firmware_free_region (fstart, fend - fstart);
#if VAS_EBOOT_RELOCATOR_HAVE_LEFTOVERS
if (subchu->pre)
{
int off = subchu->start - fstart
- VAS_EBOOT_RELOCATOR_FIRMWARE_REQUESTS_QUANT;
VasEBoot_memset (subchu->pre->freebytes + off / 8 + 1,
0xff, sizeof (subchu->pre->freebytes) - off / 8 - 1);
subchu->pre->freebytes[off / 8] |= ~((1 << (off % 8)) - 1);
check_leftover (subchu->pre);
}
if (subchu->post)
{
int off = subchu->start + subchu->size - fend;
VasEBoot_memset (subchu->post->freebytes,
0xff, sizeof (subchu->post->freebytes) - off / 8 - 1);
subchu->post->freebytes[sizeof (subchu->post->freebytes) - off / 8 - 1] |= ((1 << (8 - (off % 8))) - 1);
check_leftover (subchu->post);
}
#endif
*subchu->extra->prev = subchu->extra->next;
VasEBoot_free (subchu->extra);
}
break;
#endif
}
}
static int
malloc_in_range (struct VasEBoot_relocator *rel,
VasEBoot_addr_t start, VasEBoot_addr_t end, VasEBoot_addr_t align,
VasEBoot_size_t size, struct VasEBoot_relocator_chunk *res,
int from_low_priv, int collisioncheck)
{
VasEBoot_mm_region_t r, *ra, base_saved;
struct VasEBoot_relocator_mmap_event *events = NULL, *eventt = NULL, *t;
/* 128 is just in case of additional malloc (shouldn't happen). */
unsigned maxevents = 2 + 128;
VasEBoot_mm_header_t p, pa;
unsigned *counter;
int nallocs = 0;
unsigned j, N = 0;
VasEBoot_addr_t target = 0;
VasEBoot_dprintf ("relocator",
"trying to allocate in 0x%lx-0x%lx aligned 0x%lx size 0x%lx\n",
(unsigned long) start, (unsigned long) end,
(unsigned long) align, (unsigned long) size);
start = ALIGN_UP (start, align);
end = ALIGN_DOWN (end - size, align) + size;
if (end < start + size)
return 0;
/* We have to avoid any allocations when filling scanline events.
Hence 2-stages.
*/
for (r = VasEBoot_mm_base; r; r = r->next)
{
p = r->first;
do
{
if ((VasEBoot_addr_t) p < (VasEBoot_addr_t) (r + 1)
|| (VasEBoot_addr_t) p >= (VasEBoot_addr_t) (r + 1) + r->size)
VasEBoot_fatal ("%d: out of range pointer: %p\n", __LINE__, p);
maxevents += 2;
p = p->next;
}
while (p != r->first);
maxevents += 4;
}
if (collisioncheck && rel)
{
struct VasEBoot_relocator_chunk *chunk;
for (chunk = rel->chunks; chunk; chunk = chunk->next)
maxevents += 2;
}
#if VAS_EBOOT_RELOCATOR_HAVE_FIRMWARE_REQUESTS
{
struct VasEBoot_relocator_extra_block *cur;
for (cur = extra_blocks; cur; cur = cur->next)
maxevents += 2;
}
for (r = VasEBoot_mm_base; r; r = r->next)
maxevents += 2;
maxevents += VasEBoot_relocator_firmware_get_max_events ();
#endif
#if VAS_EBOOT_RELOCATOR_HAVE_LEFTOVERS
{
COMPILE_TIME_ASSERT (VAS_EBOOT_RELOCATOR_FIRMWARE_REQUESTS_QUANT % 8 == 0);
struct VasEBoot_relocator_fw_leftover *cur;
for (cur = leftovers; cur; cur = cur->next)
{
int l = 0;
unsigned i;
for (i = 0; i < VAS_EBOOT_RELOCATOR_FIRMWARE_REQUESTS_QUANT; i++)
{
if (l != ((cur->freebytes[i / 8] >> (i % 8)) & 1))
maxevents++;
l = ((cur->freebytes[i / 8] >> (i % 8)) & 1);
}
if (l)
maxevents++;
}
}
#endif
eventt = VasEBoot_calloc (maxevents, sizeof (events[0]));
counter = VasEBoot_malloc ((DIGITSORT_MASK + 2) * sizeof (counter[0]));
events = VasEBoot_calloc (maxevents, sizeof (events[0]));
if (!events || !eventt || !counter)
{
VasEBoot_dprintf ("relocator", "events or counter allocation failed %d\n",
maxevents);
VasEBoot_free (events);
VasEBoot_free (eventt);
VasEBoot_free (counter);
return 0;
}
if (collisioncheck && rel)
{
struct VasEBoot_relocator_chunk *chunk;
for (chunk = rel->chunks; chunk; chunk = chunk->next)
{
events[N].type = COLLISION_START;
events[N].pos = chunk->target;
N++;
events[N].type = COLLISION_END;
events[N].pos = chunk->target + chunk->size;
N++;
}
}
#if VAS_EBOOT_RELOCATOR_HAVE_FIRMWARE_REQUESTS
for (r = VasEBoot_mm_base; r; r = r->next)
{
#ifdef DEBUG_RELOCATOR_NOMEM_DPRINTF
VasEBoot_dprintf ("relocator", "Blocking at 0x%lx-0x%lx\n",
(unsigned long) r - r->pre_size,
(unsigned long) (r + 1) + r->size);
#endif
events[N].type = FIRMWARE_BLOCK_START;
events[N].pos = (VasEBoot_addr_t) r - r->pre_size;
N++;
events[N].type = FIRMWARE_BLOCK_END;
events[N].pos = (VasEBoot_addr_t) (r + 1) + r->size;
N++;
}
{
struct VasEBoot_relocator_extra_block *cur;
for (cur = extra_blocks; cur; cur = cur->next)
{
#ifdef DEBUG_RELOCATOR_NOMEM_DPRINTF
VasEBoot_dprintf ("relocator", "Blocking at 0x%lx-0x%lx\n",
(unsigned long) cur->start, (unsigned long) cur->end);
#endif
events[N].type = FIRMWARE_BLOCK_START;
events[N].pos = cur->start;
N++;
events[N].type = FIRMWARE_BLOCK_END;
events[N].pos = cur->end;
N++;
}
}
N += VasEBoot_relocator_firmware_fill_events (events + N);
#if VAS_EBOOT_RELOCATOR_HAVE_LEFTOVERS
{
struct VasEBoot_relocator_fw_leftover *cur;
for (cur = leftovers; cur; cur = cur->next)
{
unsigned i;
int l = 0;
for (i = 0; i < VAS_EBOOT_RELOCATOR_FIRMWARE_REQUESTS_QUANT; i++)
{
if (l != ((cur->freebytes[i / 8] >> (i % 8)) & 1))
{
events[N].type = l ? REG_LEFTOVER_END : REG_LEFTOVER_START;
events[N].pos = cur->quantstart + i;
events[N].leftover = cur;
N++;
}
l = ((cur->freebytes[i / 8] >> (i % 8)) & 1);
}
if (l)
{
events[N].type = REG_LEFTOVER_END;
events[N].pos = cur->quantstart + i;
events[N].leftover = cur;
N++;
}
}
}
#endif
#endif
/* No malloc from this point. */
base_saved = VasEBoot_mm_base;
VasEBoot_mm_base = NULL;
for (ra = &base_saved, r = *ra; r; ra = &(r->next), r = *ra)
{
pa = r->first;
p = pa->next;
if (p->magic == VAS_EBOOT_MM_ALLOC_MAGIC)
continue;
do
{
if (p->magic != VAS_EBOOT_MM_FREE_MAGIC)
VasEBoot_fatal ("%s:%d free magic broken at %p (0x%x)\n",
__FILE__,
__LINE__, p, p->magic);
if (p == (VasEBoot_mm_header_t) (r + 1))
{
events[N].type = REG_BEG_START;
events[N].pos = VasEBoot_vtop (r) - r->pre_size;
events[N].reg = r;
events[N].regancestor = ra;
events[N].head = p;
events[N].hancestor = pa;
N++;
events[N].type = REG_BEG_END;
events[N].pos = VasEBoot_vtop (p + p->size) - sizeof (*r)
- sizeof (struct VasEBoot_mm_header);
N++;
}
else
{
events[N].type = IN_REG_START;
events[N].pos = VasEBoot_vtop (p);
events[N].head = p;
events[N].hancestor = pa;
events[N].reg = r;
N++;
events[N].type = IN_REG_END;
events[N].pos = VasEBoot_vtop (p + p->size);
N++;
}
pa = p;
p = pa->next;
}
while (pa != r->first);
}
/* Put ending events after starting events. */
{
int st = 0, e = N / 2;
for (j = 0; j < N; j++)
if (is_start (events[j].type) || events[j].type == COLLISION_START)
eventt[st++] = events[j];
else
eventt[e++] = events[j];
t = eventt;
eventt = events;
events = t;
}
{
unsigned i;
for (i = 0; i < (BITS_IN_BYTE * sizeof (VasEBoot_addr_t) / DIGITSORT_BITS);
i++)
{
VasEBoot_memset (counter, 0, (1 + (1 << DIGITSORT_BITS)) * sizeof (counter[0]));
for (j = 0; j < N; j++)
counter[((events[j].pos >> (DIGITSORT_BITS * i))
& DIGITSORT_MASK) + 1]++;
for (j = 0; j <= DIGITSORT_MASK; j++)
counter[j+1] += counter[j];
for (j = 0; j < N; j++)
eventt[counter[((events[j].pos >> (DIGITSORT_BITS * i))
& DIGITSORT_MASK)]++] = events[j];
t = eventt;
eventt = events;
events = t;
}
}
#if VAS_EBOOT_RELOCATOR_HAVE_FIRMWARE_REQUESTS
retry:
#endif
/* Now events are nicely sorted. */
{
int nstarted = 0, ncollisions = 0, nstartedfw = 0, nblockfw = 0;
#if VAS_EBOOT_RELOCATOR_HAVE_LEFTOVERS
int nlefto = 0;
#else
const int nlefto = 0;
#endif
VasEBoot_addr_t starta = 0;
for (j = from_low_priv ? 0 : N - 1; from_low_priv ? j < N : (j + 1);
from_low_priv ? j++ : j--)
{
int isinsidebefore, isinsideafter;
isinsidebefore = (!ncollisions && (nstarted || (((nlefto || nstartedfw)
&& !nblockfw))));
switch (events[j].type)
{
#if VAS_EBOOT_RELOCATOR_HAVE_FIRMWARE_REQUESTS
case REG_FIRMWARE_START:
nstartedfw++;
break;
case REG_FIRMWARE_END:
nstartedfw--;
break;
case FIRMWARE_BLOCK_START:
nblockfw++;
break;
case FIRMWARE_BLOCK_END:
nblockfw--;
break;
#endif
#if VAS_EBOOT_RELOCATOR_HAVE_LEFTOVERS
case REG_LEFTOVER_START:
nlefto++;
break;
case REG_LEFTOVER_END:
nlefto--;
break;
#endif
case COLLISION_START:
ncollisions++;
break;
case COLLISION_END:
ncollisions--;
break;
case IN_REG_START:
case REG_BEG_START:
nstarted++;
break;
case IN_REG_END:
case REG_BEG_END:
nstarted--;
break;
}
isinsideafter = (!ncollisions && (nstarted || ((nlefto || nstartedfw)
&& !nblockfw)));
if (from_low_priv) {
if (!isinsidebefore && isinsideafter)
starta = ALIGN_UP (events[j].pos, align);
if (isinsidebefore && !isinsideafter)
{
target = starta;
if (target < start)
target = ALIGN_UP (start, align);
if (target + size <= end && target + size <= events[j].pos)
/* Found an usable address. */
goto found;
}
} else {
if (!isinsidebefore && isinsideafter)
{
if (events[j].pos >= size)
starta = ALIGN_DOWN (events[j].pos - size, align) + size;
else
starta = 0;
}
if (isinsidebefore && !isinsideafter && starta >= size)
{
target = starta - size;
if (target > end - size)
target = ALIGN_DOWN (end - size, align);
if (target >= start && target >= events[j].pos)
goto found;
}
}
}
}
VasEBoot_mm_base = base_saved;
VasEBoot_free (events);
VasEBoot_free (eventt);
VasEBoot_free (counter);
return 0;
found:
{
int inreg = 0, regbeg = 0, ncol = 0;
#if VAS_EBOOT_RELOCATOR_HAVE_FIRMWARE_REQUESTS
int fwin = 0, fwb = 0, fwlefto = 0;
#endif
#if VAS_EBOOT_RELOCATOR_HAVE_LEFTOVERS
int last_lo = 0;
#endif
int last_start = 0;
for (j = 0; j < N; j++)
{
int typepre;
if (ncol)
typepre = -1;
else if (regbeg)
typepre = CHUNK_TYPE_REGION_START;
else if (inreg)
typepre = CHUNK_TYPE_IN_REGION;
#if VAS_EBOOT_RELOCATOR_HAVE_FIRMWARE_REQUESTS
else if (fwin && !fwb)
typepre = CHUNK_TYPE_FIRMWARE;
else if (fwlefto && !fwb)
typepre = CHUNK_TYPE_LEFTOVER;
#endif
else
typepre = -1;
if (j != 0 && events[j - 1].pos != events[j].pos)
{
VasEBoot_addr_t alloc_start, alloc_end;
alloc_start = max (events[j - 1].pos, target);
alloc_end = min (events[j].pos, target + size);
if (alloc_end > alloc_start)
{
switch (typepre)
{
case CHUNK_TYPE_REGION_START:
allocate_regstart (alloc_start, alloc_end - alloc_start,
events[last_start].reg,
events[last_start].regancestor,
events[last_start].hancestor);
/* TODO: maintain a reverse lookup tree for hancestor. */
{
unsigned k;
for (k = 0; k < N; k++)
if (events[k].hancestor == events[last_start].head)
events[k].hancestor = events[last_start].hancestor;
}
break;
case CHUNK_TYPE_IN_REGION:
allocate_inreg (alloc_start, alloc_end - alloc_start,
events[last_start].head,
events[last_start].hancestor,
events[last_start].reg);
{
unsigned k;
for (k = 0; k < N; k++)
if (events[k].hancestor == events[last_start].head)
events[k].hancestor = events[last_start].hancestor;
}
break;
#if VAS_EBOOT_RELOCATOR_HAVE_FIRMWARE_REQUESTS
case CHUNK_TYPE_FIRMWARE:
{
VasEBoot_addr_t fstart, fend;
fstart
= ALIGN_DOWN (alloc_start,
VAS_EBOOT_RELOCATOR_FIRMWARE_REQUESTS_QUANT);
fend
= ALIGN_UP (alloc_end,
VAS_EBOOT_RELOCATOR_FIRMWARE_REQUESTS_QUANT);
#ifdef DEBUG_RELOCATOR_NOMEM_DPRINTF
VasEBoot_dprintf ("relocator", "requesting %lx-%lx\n",
(unsigned long) fstart,
(unsigned long) fend);
#endif
/* The failure here can be very expensive. */
if (!VasEBoot_relocator_firmware_alloc_region (fstart,
fend - fstart))
{
if (from_low_priv)
start = fend;
else
end = fstart;
goto retry;
}
break;
}
#endif
#if VAS_EBOOT_RELOCATOR_HAVE_LEFTOVERS
case CHUNK_TYPE_LEFTOVER:
{
unsigned offstart = alloc_start
% VAS_EBOOT_RELOCATOR_FIRMWARE_REQUESTS_QUANT;
unsigned offend = alloc_end
% VAS_EBOOT_RELOCATOR_FIRMWARE_REQUESTS_QUANT;
struct VasEBoot_relocator_fw_leftover *lo
= events[last_lo].leftover;
if (offend == 0 && alloc_end != alloc_start)
offend = VAS_EBOOT_RELOCATOR_FIRMWARE_REQUESTS_QUANT;
lo->freebytes[offstart / 8]
&= ((1 << (8 - (start % 8))) - 1);
if (offend / 8 > (offstart + 7) / 8)
VasEBoot_memset (lo->freebytes + (offstart + 7) / 8, 0,
offend / 8 - (offstart + 7) / 8);
if (offend < VAS_EBOOT_RELOCATOR_FIRMWARE_REQUESTS_QUANT)
lo->freebytes[offend / 8] &= ~((1 << (offend % 8)) - 1);
}
break;
#endif
}
nallocs++;
}
}
switch (events[j].type)
{
case REG_BEG_START:
case IN_REG_START:
if (events[j].type == REG_BEG_START &&
(VasEBoot_addr_t) (events[j].reg + 1) > target)
regbeg++;
else
inreg++;
last_start = j;
break;
case REG_BEG_END:
case IN_REG_END:
if (regbeg)
regbeg--;
else
inreg--;
break;
#if VAS_EBOOT_RELOCATOR_HAVE_FIRMWARE_REQUESTS
case REG_FIRMWARE_START:
fwin++;
break;
case REG_FIRMWARE_END:
fwin--;
break;
case FIRMWARE_BLOCK_START:
fwb++;
break;
case FIRMWARE_BLOCK_END:
fwb--;
break;
#endif
#if VAS_EBOOT_RELOCATOR_HAVE_LEFTOVERS
case REG_LEFTOVER_START:
fwlefto++;
last_lo = j;
break;
case REG_LEFTOVER_END:
fwlefto--;
break;
#endif
case COLLISION_START:
ncol++;
break;
case COLLISION_END:
ncol--;
break;
}
}
}
/* Malloc is available again. */
VasEBoot_mm_base = base_saved;
VasEBoot_free (eventt);
VasEBoot_free (counter);
{
int last_start = 0;
int inreg = 0, regbeg = 0, ncol = 0;
#if VAS_EBOOT_RELOCATOR_HAVE_FIRMWARE_REQUESTS
int fwin = 0, fwlefto = 0, fwb = 0;
#endif
unsigned cural = 0;
int oom = 0;
res->subchunks = VasEBoot_calloc (nallocs, sizeof (res->subchunks[0]));
if (!res->subchunks)
oom = 1;
res->nsubchunks = nallocs;
for (j = 0; j < N; j++)
{
int typepre;
if (ncol)
typepre = -1;
else if (regbeg)
typepre = CHUNK_TYPE_REGION_START;
else if (inreg)
typepre = CHUNK_TYPE_IN_REGION;
#if VAS_EBOOT_RELOCATOR_HAVE_FIRMWARE_REQUESTS
else if (fwin && !fwb)
typepre = CHUNK_TYPE_FIRMWARE;
else if (fwlefto && !fwb)
typepre = CHUNK_TYPE_LEFTOVER;
#endif
else
typepre = -1;
if (j != 0 && events[j - 1].pos != events[j].pos)
{
VasEBoot_addr_t alloc_start, alloc_end;
struct VasEBoot_relocator_subchunk tofree = {0};
struct VasEBoot_relocator_subchunk *curschu = &tofree;
if (!oom)
curschu = &res->subchunks[cural];
alloc_start = max (events[j - 1].pos, target);
alloc_end = min (events[j].pos, target + size);
if (alloc_end > alloc_start)
{
#ifdef DEBUG_RELOCATOR_NOMEM_DPRINTF
VasEBoot_dprintf ("relocator", "subchunk 0x%lx-0x%lx, %d\n",
(unsigned long) alloc_start,
(unsigned long) alloc_end, typepre);
#endif
curschu->type = typepre;
curschu->start = alloc_start;
curschu->size = alloc_end - alloc_start;
if (typepre == CHUNK_TYPE_REGION_START
|| typepre == CHUNK_TYPE_IN_REGION)
{
curschu->reg = events[last_start].reg;
curschu->pre_size = alloc_start - events[j - 1].pos;
}
if (!oom && (typepre == CHUNK_TYPE_REGION_START
#if VAS_EBOOT_RELOCATOR_HAVE_FIRMWARE_REQUESTS
|| typepre == CHUNK_TYPE_FIRMWARE
#endif
))
{
struct VasEBoot_relocator_extra_block *ne;
ne = VasEBoot_malloc (sizeof (*ne));
if (!ne)
{
oom = 1;
VasEBoot_memcpy (&tofree, curschu, sizeof (tofree));
}
else
{
ne->start = alloc_start;
ne->end = alloc_end;
ne->next = extra_blocks;
ne->prev = &extra_blocks;
if (extra_blocks)
extra_blocks->prev = &(ne->next);
extra_blocks = ne;
curschu->extra = ne;
}
}
#if VAS_EBOOT_RELOCATOR_HAVE_LEFTOVERS
if (!oom && typepre == CHUNK_TYPE_FIRMWARE)
{
VasEBoot_addr_t fstart, fend;
fstart
= ALIGN_DOWN (alloc_start,
VAS_EBOOT_RELOCATOR_FIRMWARE_REQUESTS_QUANT);
fend
= ALIGN_UP (alloc_end,
VAS_EBOOT_RELOCATOR_FIRMWARE_REQUESTS_QUANT);
{
struct VasEBoot_relocator_fw_leftover *lo1 = NULL;
struct VasEBoot_relocator_fw_leftover *lo2 = NULL;
if (fstart != alloc_start)
lo1 = VasEBoot_malloc (sizeof (*lo1));
if (fend != alloc_end)
lo2 = VasEBoot_malloc (sizeof (*lo2));
if ((!lo1 && fstart != alloc_start)
|| (!lo2 && fend != alloc_end))
{
struct VasEBoot_relocator_extra_block *ne;
VasEBoot_free (lo1);
VasEBoot_free (lo2);
lo1 = NULL;
lo2 = NULL;
oom = 1;
VasEBoot_memcpy (&tofree, curschu, sizeof (tofree));
ne = extra_blocks;
extra_blocks = extra_blocks->next;
VasEBoot_free (ne);
}
if (lo1)
{
lo1->quantstart = fstart;
VasEBoot_memset (lo1->freebytes, 0xff,
(alloc_start - fstart) / 8);
lo1->freebytes[(alloc_start - fstart) / 8]
= (1 << ((alloc_start - fstart) % 8)) - 1;
VasEBoot_memset (lo1->freebytes
+ ((alloc_start - fstart) / 8) + 1, 0,
sizeof (lo1->freebytes)
- (alloc_start - fstart) / 8 - 1);
lo1->next = leftovers;
lo1->prev = &leftovers;
if (leftovers)
leftovers->prev = &lo1->next;
leftovers = lo1;
}
if (lo2)
{
lo2->quantstart
= fend - VAS_EBOOT_RELOCATOR_FIRMWARE_REQUESTS_QUANT;
VasEBoot_memset (lo2->freebytes, 0,
(alloc_end - lo2->quantstart) / 8);
lo2->freebytes[(alloc_end - lo2->quantstart) / 8]
= ~((1 << ((alloc_end - lo2->quantstart) % 8)) - 1);
VasEBoot_memset (lo2->freebytes
+ ((alloc_end - lo2->quantstart) / 8)
+ 1, 0, sizeof (lo2->freebytes)
- (alloc_end - lo2->quantstart) / 8 - 1);
lo2->prev = &leftovers;
if (leftovers)
leftovers->prev = &lo2->next;
lo2->next = leftovers;
leftovers = lo2;
}
curschu->pre = lo1;
curschu->post = lo2;
}
}
if (typepre == CHUNK_TYPE_LEFTOVER)
{
curschu->pre = events[last_start].leftover;
curschu->post = events[last_start].leftover;
}
#endif
if (!oom)
cural++;
else
free_subchunk (&tofree);
}
}
switch (events[j].type)
{
case REG_BEG_START:
case IN_REG_START:
if (events[j].type == REG_BEG_START &&
(VasEBoot_addr_t) (events[j].reg + 1) > target)
regbeg++;
else
inreg++;
last_start = j;
break;
case REG_BEG_END:
case IN_REG_END:
inreg = regbeg = 0;
break;
#if VAS_EBOOT_RELOCATOR_HAVE_FIRMWARE_REQUESTS
case REG_FIRMWARE_START:
fwin++;
break;
case REG_FIRMWARE_END:
fwin--;
break;
case FIRMWARE_BLOCK_START:
fwb++;
break;
case FIRMWARE_BLOCK_END:
fwb--;
break;
#endif
#if VAS_EBOOT_RELOCATOR_HAVE_LEFTOVERS
case REG_LEFTOVER_START:
fwlefto++;
break;
case REG_LEFTOVER_END:
fwlefto--;
break;
#endif
case COLLISION_START:
ncol++;
break;
case COLLISION_END:
ncol--;
break;
}
}
if (oom)
{
unsigned i;
for (i = 0; i < cural; i++)
free_subchunk (&res->subchunks[i]);
VasEBoot_free (res->subchunks);
VasEBoot_dprintf ("relocator", "allocation failed with out-of-memory\n");
VasEBoot_free (events);
return 0;
}
}
res->src = target;
res->size = size;
VasEBoot_free (events);
VasEBoot_dprintf ("relocator", "allocated: 0x%lx+0x%lx\n", (unsigned long) target,
(unsigned long) size);
return 1;
}
static void
adjust_limits (struct VasEBoot_relocator *rel,
VasEBoot_phys_addr_t *min_addr, VasEBoot_phys_addr_t *max_addr,
VasEBoot_phys_addr_t in_min, VasEBoot_phys_addr_t in_max)
{
struct VasEBoot_relocator_chunk *chunk;
*min_addr = 0;
*max_addr = rel->postchunks;
/* Keep chunks in memory in the same order as they'll be after relocation. */
for (chunk = rel->chunks; chunk; chunk = chunk->next)
{
if (chunk->target > in_max && chunk->src < *max_addr
&& chunk->src < rel->postchunks)
*max_addr = chunk->src;
if (chunk->target + chunk->size <= in_min
&& chunk->src + chunk->size > *min_addr
&& chunk->src < rel->postchunks)
*min_addr = chunk->src + chunk->size;
}
}
VasEBoot_err_t
VasEBoot_relocator_alloc_chunk_addr (struct VasEBoot_relocator *rel,
VasEBoot_relocator_chunk_t *out,
VasEBoot_phys_addr_t target, VasEBoot_size_t size)
{
struct VasEBoot_relocator_chunk *chunk;
VasEBoot_phys_addr_t min_addr = 0, max_addr;
if (target > ~size)
return VasEBoot_error (VAS_EBOOT_ERR_BUG, "address is out of range");
adjust_limits (rel, &min_addr, &max_addr, target, target);
for (chunk = rel->chunks; chunk; chunk = chunk->next)
if ((chunk->target <= target && target < chunk->target + chunk->size)
|| (target <= chunk->target && chunk->target < target + size))
return VasEBoot_error (VAS_EBOOT_ERR_BUG, "overlap detected");
chunk = VasEBoot_malloc (sizeof (struct VasEBoot_relocator_chunk));
if (!chunk)
return VasEBoot_errno;
VasEBoot_dprintf ("relocator",
"min_addr = 0x%llx, max_addr = 0x%llx, target = 0x%llx\n",
(unsigned long long) min_addr, (unsigned long long) max_addr,
(unsigned long long) target);
do
{
/* A trick to improve Linux allocation. */
#if defined (__i386__) || defined (__x86_64__)
if (target < 0x100000)
if (malloc_in_range (rel, rel->highestnonpostaddr, ~(VasEBoot_addr_t)0, 1,
size, chunk, 0, 1))
{
if (rel->postchunks > chunk->src)
rel->postchunks = chunk->src;
break;
}
#endif
if (malloc_in_range (rel, target, max_addr, 1, size, chunk, 1, 0))
break;
if (malloc_in_range (rel, min_addr, target, 1, size, chunk, 0, 0))
break;
if (malloc_in_range (rel, rel->highestnonpostaddr, ~(VasEBoot_addr_t)0, 1,
size, chunk, 0, 1))
{
if (rel->postchunks > chunk->src)
rel->postchunks = chunk->src;
break;
}
VasEBoot_dprintf ("relocator", "not allocated\n");
VasEBoot_free (chunk);
return VasEBoot_error (VAS_EBOOT_ERR_OUT_OF_MEMORY, N_("out of memory"));
}
while (0);
VasEBoot_dprintf ("relocator", "allocated 0x%llx/0x%llx\n",
(unsigned long long) chunk->src, (unsigned long long) target);
if (rel->highestaddr < target + size)
rel->highestaddr = target + size;
if (rel->highestaddr < chunk->src + size)
rel->highestaddr = chunk->src + size;
if (chunk->src < rel->postchunks)
{
if (rel->highestnonpostaddr < target + size)
rel->highestnonpostaddr = target + size;
if (rel->highestnonpostaddr < chunk->src + size)
rel->highestnonpostaddr = chunk->src + size;
}
VasEBoot_dprintf ("relocator", "relocators_size=%ld\n",
(unsigned long) rel->relocators_size);
if (chunk->src < target)
rel->relocators_size += VasEBoot_relocator_backward_size;
if (chunk->src > target)
rel->relocators_size += VasEBoot_relocator_forward_size;
VasEBoot_dprintf ("relocator", "relocators_size=%ld\n",
(unsigned long) rel->relocators_size);
chunk->target = target;
chunk->size = size;
chunk->next = rel->chunks;
rel->chunks = chunk;
VasEBoot_dprintf ("relocator", "cur = %p, next = %p\n", rel->chunks,
rel->chunks->next);
chunk->srcv = VasEBoot_map_memory (chunk->src, chunk->size);
*out = chunk;
#ifdef DEBUG_RELOCATOR
VasEBoot_memset (chunk->srcv, 0xfa, chunk->size);
VasEBoot_mm_check ();
#endif
return VAS_EBOOT_ERR_NONE;
}
/* Context for VasEBoot_relocator_alloc_chunk_align. */
struct VasEBoot_relocator_alloc_chunk_align_ctx
{
VasEBoot_phys_addr_t min_addr, max_addr;
VasEBoot_size_t size, align;
int preference;
struct VasEBoot_relocator_chunk *chunk;
int found;
};
/* Helper for VasEBoot_relocator_alloc_chunk_align. */
static int
VasEBoot_relocator_alloc_chunk_align_iter (VasEBoot_uint64_t addr, VasEBoot_uint64_t sz,
VasEBoot_memory_type_t type, void *data)
{
struct VasEBoot_relocator_alloc_chunk_align_ctx *ctx = data;
VasEBoot_uint64_t candidate;
if (type != VAS_EBOOT_MEMORY_AVAILABLE)
return 0;
candidate = ALIGN_UP (addr, ctx->align);
if (candidate < ctx->min_addr)
candidate = ALIGN_UP (ctx->min_addr, ctx->align);
if (candidate + ctx->size > addr + sz
|| candidate > ALIGN_DOWN (ctx->max_addr, ctx->align))
return 0;
if (ctx->preference == VAS_EBOOT_RELOCATOR_PREFERENCE_HIGH)
candidate = ALIGN_DOWN (min (addr + sz - ctx->size, ctx->max_addr),
ctx->align);
if (!ctx->found || (ctx->preference == VAS_EBOOT_RELOCATOR_PREFERENCE_HIGH
&& candidate > ctx->chunk->target))
ctx->chunk->target = candidate;
if (!ctx->found || (ctx->preference == VAS_EBOOT_RELOCATOR_PREFERENCE_LOW
&& candidate < ctx->chunk->target))
ctx->chunk->target = candidate;
ctx->found = 1;
return 0;
}
VasEBoot_err_t
VasEBoot_relocator_alloc_chunk_align (struct VasEBoot_relocator *rel,
VasEBoot_relocator_chunk_t *out,
VasEBoot_phys_addr_t min_addr,
VasEBoot_phys_addr_t max_addr,
VasEBoot_size_t size, VasEBoot_size_t align,
int preference,
int avoid_efi_boot_services)
{
struct VasEBoot_relocator_alloc_chunk_align_ctx ctx = {
.min_addr = min_addr,
.max_addr = max_addr,
.size = size,
.align = align,
.preference = preference,
.found = 0
};
VasEBoot_addr_t min_addr2 = 0, max_addr2;
if (size && (max_addr > ~size))
max_addr = ~size + 1;
#ifdef VAS_EBOOT_MACHINE_PCBIOS
if (min_addr < 0x1000)
min_addr = 0x1000;
#endif
VasEBoot_dprintf ("relocator", "chunks = %p\n", rel->chunks);
ctx.chunk = VasEBoot_malloc (sizeof (struct VasEBoot_relocator_chunk));
if (!ctx.chunk)
return VasEBoot_errno;
if (malloc_in_range (rel, min_addr, max_addr, align,
size, ctx.chunk,
preference != VAS_EBOOT_RELOCATOR_PREFERENCE_HIGH, 1))
{
VasEBoot_dprintf ("relocator", "allocated 0x%llx/0x%llx\n",
(unsigned long long) ctx.chunk->src,
(unsigned long long) ctx.chunk->src);
VasEBoot_dprintf ("relocator", "chunks = %p\n", rel->chunks);
ctx.chunk->target = ctx.chunk->src;
ctx.chunk->size = size;
ctx.chunk->next = rel->chunks;
rel->chunks = ctx.chunk;
ctx.chunk->srcv = VasEBoot_map_memory (ctx.chunk->src, ctx.chunk->size);
*out = ctx.chunk;
return VAS_EBOOT_ERR_NONE;
}
adjust_limits (rel, &min_addr2, &max_addr2, min_addr, max_addr);
VasEBoot_dprintf ("relocator", "Adjusted limits from %lx-%lx to %lx-%lx\n",
(unsigned long) min_addr, (unsigned long) max_addr,
(unsigned long) min_addr2, (unsigned long) max_addr2);
do
{
if (malloc_in_range (rel, min_addr2, max_addr2, align,
size, ctx.chunk, 1, 1))
break;
if (malloc_in_range (rel, rel->highestnonpostaddr, ~(VasEBoot_addr_t)0, 1,
size, ctx.chunk, 0, 1))
{
if (rel->postchunks > ctx.chunk->src)
rel->postchunks = ctx.chunk->src;
break;
}
VasEBoot_free (ctx.chunk);
return VasEBoot_error (VAS_EBOOT_ERR_OUT_OF_MEMORY, N_("out of memory"));
}
while (0);
{
#ifdef VAS_EBOOT_MACHINE_EFI
VasEBoot_efi_mmap_iterate (VasEBoot_relocator_alloc_chunk_align_iter, &ctx,
avoid_efi_boot_services);
#elif defined (__powerpc__) || defined (VAS_EBOOT_MACHINE_XEN)
(void) avoid_efi_boot_services;
VasEBoot_machine_mmap_iterate (VasEBoot_relocator_alloc_chunk_align_iter, &ctx);
#else
(void) avoid_efi_boot_services;
VasEBoot_mmap_iterate (VasEBoot_relocator_alloc_chunk_align_iter, &ctx);
#endif
if (!ctx.found)
{
VasEBoot_free (ctx.chunk);
return VasEBoot_error (VAS_EBOOT_ERR_BAD_OS, "couldn't find suitable memory target");
}
}
while (1)
{
struct VasEBoot_relocator_chunk *chunk2;
for (chunk2 = rel->chunks; chunk2; chunk2 = chunk2->next)
if ((chunk2->target <= ctx.chunk->target
&& ctx.chunk->target < chunk2->target + chunk2->size)
|| (ctx.chunk->target <= chunk2->target && chunk2->target
< ctx.chunk->target + size))
{
if (preference == VAS_EBOOT_RELOCATOR_PREFERENCE_HIGH)
ctx.chunk->target = ALIGN_DOWN (chunk2->target, align);
else
ctx.chunk->target = ALIGN_UP (chunk2->target + chunk2->size,
align);
break;
}
if (!chunk2)
break;
}
VasEBoot_dprintf ("relocator", "relocators_size=%ld\n",
(unsigned long) rel->relocators_size);
if (ctx.chunk->src < ctx.chunk->target)
rel->relocators_size += VasEBoot_relocator_backward_size;
if (ctx.chunk->src > ctx.chunk->target)
rel->relocators_size += VasEBoot_relocator_forward_size;
VasEBoot_dprintf ("relocator", "relocators_size=%ld\n",
(unsigned long) rel->relocators_size);
ctx.chunk->size = size;
ctx.chunk->next = rel->chunks;
rel->chunks = ctx.chunk;
VasEBoot_dprintf ("relocator", "cur = %p, next = %p\n", rel->chunks,
rel->chunks->next);
ctx.chunk->srcv = VasEBoot_map_memory (ctx.chunk->src, ctx.chunk->size);
*out = ctx.chunk;
#ifdef DEBUG_RELOCATOR
VasEBoot_memset (ctx.chunk->srcv, 0xfa, ctx.chunk->size);
VasEBoot_mm_check ();
#endif
return VAS_EBOOT_ERR_NONE;
}
void
VasEBoot_relocator_unload (struct VasEBoot_relocator *rel)
{
struct VasEBoot_relocator_chunk *chunk, *next;
if (!rel)
return;
for (chunk = rel->chunks; chunk; chunk = next)
{
unsigned i;
for (i = 0; i < chunk->nsubchunks; i++)
free_subchunk (&chunk->subchunks[i]);
VasEBoot_unmap_memory (chunk->srcv, chunk->size);
next = chunk->next;
VasEBoot_free (chunk->subchunks);
VasEBoot_free (chunk);
}
VasEBoot_free (rel);
}
VasEBoot_err_t
VasEBoot_relocator_prepare_relocs (struct VasEBoot_relocator *rel, VasEBoot_addr_t addr,
void **relstart, VasEBoot_size_t *relsize)
{
VasEBoot_uint8_t *rels;
VasEBoot_uint8_t *rels0;
struct VasEBoot_relocator_chunk *sorted;
VasEBoot_size_t nchunks = 0;
unsigned j;
struct VasEBoot_relocator_chunk movers_chunk;
VasEBoot_dprintf ("relocator", "Preparing relocs (size=%ld)\n",
(unsigned long) rel->relocators_size);
if (!malloc_in_range (rel, 0, ~(VasEBoot_addr_t)0 - rel->relocators_size + 1,
VasEBoot_relocator_align,
rel->relocators_size, &movers_chunk, 1, 1))
return VasEBoot_error (VAS_EBOOT_ERR_OUT_OF_MEMORY, N_("out of memory"));
movers_chunk.srcv = rels = rels0
= VasEBoot_map_memory (movers_chunk.src, movers_chunk.size);
if (relsize)
*relsize = rel->relocators_size;
VasEBoot_dprintf ("relocator", "Relocs allocated at %p\n", movers_chunk.srcv);
{
unsigned i;
VasEBoot_size_t count[257];
struct VasEBoot_relocator_chunk *from, *to, *tmp;
VasEBoot_memset (count, 0, sizeof (count));
{
struct VasEBoot_relocator_chunk *chunk;
for (chunk = rel->chunks; chunk; chunk = chunk->next)
{
VasEBoot_dprintf ("relocator", "chunk %p->%p, 0x%lx\n",
(void *) chunk->src, (void *) chunk->target,
(unsigned long) chunk->size);
nchunks++;
count[(chunk->src & 0xff) + 1]++;
}
}
from = VasEBoot_calloc (nchunks, sizeof (sorted[0]));
to = VasEBoot_calloc (nchunks, sizeof (sorted[0]));
if (!from || !to)
{
VasEBoot_free (from);
VasEBoot_free (to);
return VasEBoot_errno;
}
for (j = 0; j < 256; j++)
count[j+1] += count[j];
{
struct VasEBoot_relocator_chunk *chunk;
for (chunk = rel->chunks; chunk; chunk = chunk->next)
from[count[chunk->src & 0xff]++] = *chunk;
}
for (i = 1; i < VAS_EBOOT_CPU_SIZEOF_VOID_P; i++)
{
VasEBoot_memset (count, 0, sizeof (count));
for (j = 0; j < nchunks; j++)
count[((from[j].src >> (8 * i)) & 0xff) + 1]++;
for (j = 0; j < 256; j++)
count[j+1] += count[j];
for (j = 0; j < nchunks; j++)
to[count[(from[j].src >> (8 * i)) & 0xff]++] = from[j];
tmp = to;
to = from;
from = tmp;
}
sorted = from;
VasEBoot_free (to);
}
VasEBoot_cpu_relocator_preamble (rels);
rels += VasEBoot_relocator_preamble_size;
for (j = 0; j < nchunks; j++)
{
VasEBoot_dprintf ("relocator", "sorted chunk %p->%p, 0x%lx\n",
(void *) sorted[j].src, (void *) sorted[j].target,
(unsigned long) sorted[j].size);
if (sorted[j].src < sorted[j].target)
{
VasEBoot_cpu_relocator_backward ((void *) rels,
sorted[j].srcv,
VasEBoot_map_memory (sorted[j].target,
sorted[j].size),
sorted[j].size);
rels += VasEBoot_relocator_backward_size;
}
if (sorted[j].src > sorted[j].target)
{
VasEBoot_cpu_relocator_forward ((void *) rels,
sorted[j].srcv,
VasEBoot_map_memory (sorted[j].target,
sorted[j].size),
sorted[j].size);
rels += VasEBoot_relocator_forward_size;
}
if (sorted[j].src == sorted[j].target)
VasEBoot_arch_sync_caches (sorted[j].srcv, sorted[j].size);
}
VasEBoot_cpu_relocator_jumper ((void *) rels, (VasEBoot_addr_t) addr);
*relstart = rels0;
VasEBoot_free (sorted);
return VAS_EBOOT_ERR_NONE;
}
void
VasEBoot_mm_check_real (const char *file, int line)
{
VasEBoot_mm_region_t r;
VasEBoot_mm_header_t p, pa;
for (r = VasEBoot_mm_base; r; r = r->next)
{
pa = r->first;
p = pa->next;
if (p->magic == VAS_EBOOT_MM_ALLOC_MAGIC)
continue;
do
{
if ((VasEBoot_addr_t) p < (VasEBoot_addr_t) (r + 1)
|| (VasEBoot_addr_t) p >= (VasEBoot_addr_t) (r + 1) + r->size)
VasEBoot_fatal ("%s:%d: out of range pointer: %p\n", file, line, p);
if (p->magic != VAS_EBOOT_MM_FREE_MAGIC)
VasEBoot_fatal ("%s:%d free magic broken at %p (0x%x)\n", file,
line, p, p->magic);
pa = p;
p = pa->next;
}
while (pa != r->first);
}
}
Reference in New Issue View Git Blame Copy Permalink