e60ab831db
OF loader on systems where address cells and size cells are both 2 (the Mambo simulator) and fix an error where cons_probe() was called before init_heap() but used malloc() to set environment variables. MFC after: 1 month
147 lines
3.8 KiB
C
147 lines
3.8 KiB
C
/*-
|
|
* Copyright (c) 2001 Benno Rice
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY Benno Rice ``AS IS'' AND
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
|
|
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
|
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
* SUCH DAMAGE.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__FBSDID("$FreeBSD$");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/types.h>
|
|
|
|
#include <stand.h>
|
|
|
|
#include "libofw.h"
|
|
#include "openfirm.h"
|
|
|
|
static void *heap_base = 0;
|
|
static unsigned int heap_size = 0;
|
|
|
|
struct ofw_mapping {
|
|
vm_offset_t va;
|
|
int len;
|
|
vm_offset_t pa;
|
|
int mode;
|
|
};
|
|
|
|
struct ofw_mapping2 {
|
|
vm_offset_t va;
|
|
int len;
|
|
vm_offset_t pa_hi;
|
|
vm_offset_t pa_lo;
|
|
int mode;
|
|
};
|
|
|
|
void
|
|
ofw_memmap(int acells)
|
|
{
|
|
struct ofw_mapping *mapptr;
|
|
struct ofw_mapping2 *mapptr2;
|
|
phandle_t mmup;
|
|
int nmapping, i;
|
|
u_char mappings[256 * sizeof(struct ofw_mapping2)];
|
|
char lbuf[80];
|
|
|
|
mmup = OF_instance_to_package(mmu);
|
|
|
|
bzero(mappings, sizeof(mappings));
|
|
|
|
nmapping = OF_getprop(mmup, "translations", mappings, sizeof(mappings));
|
|
if (nmapping == -1) {
|
|
printf("Could not get memory map (%d)\n",
|
|
nmapping);
|
|
return;
|
|
}
|
|
|
|
pager_open();
|
|
if (acells == 1) {
|
|
nmapping /= sizeof(struct ofw_mapping);
|
|
mapptr = (struct ofw_mapping *) mappings;
|
|
|
|
printf("%17s\t%17s\t%8s\t%6s\n", "Virtual Range",
|
|
"Physical Range", "#Pages", "Mode");
|
|
|
|
for (i = 0; i < nmapping; i++) {
|
|
sprintf(lbuf, "%08x-%08x\t%08x-%08x\t%8d\t%6x\n",
|
|
mapptr[i].va,
|
|
mapptr[i].va + mapptr[i].len,
|
|
mapptr[i].pa,
|
|
mapptr[i].pa + mapptr[i].len,
|
|
mapptr[i].len / 0x1000,
|
|
mapptr[i].mode);
|
|
if (pager_output(lbuf))
|
|
break;
|
|
}
|
|
} else {
|
|
nmapping /= sizeof(struct ofw_mapping2);
|
|
mapptr2 = (struct ofw_mapping2 *) mappings;
|
|
|
|
printf("%17s\t%17s\t%8s\t%6s\n", "Virtual Range",
|
|
"Physical Range", "#Pages", "Mode");
|
|
|
|
for (i = 0; i < nmapping; i++) {
|
|
sprintf(lbuf, "%08x-%08x\t%08x-%08x\t%8d\t%6x\n",
|
|
mapptr2[i].va,
|
|
mapptr2[i].va + mapptr2[i].len,
|
|
mapptr2[i].pa_lo,
|
|
mapptr2[i].pa_lo + mapptr2[i].len,
|
|
mapptr2[i].len / 0x1000,
|
|
mapptr2[i].mode);
|
|
if (pager_output(lbuf))
|
|
break;
|
|
}
|
|
}
|
|
pager_close();
|
|
}
|
|
|
|
void *
|
|
ofw_alloc_heap(unsigned int size)
|
|
{
|
|
phandle_t memoryp, root;
|
|
cell_t available[4];
|
|
cell_t acells;
|
|
|
|
root = OF_finddevice("/");
|
|
acells = 1;
|
|
OF_getprop(root, "#address-cells", &acells, sizeof(acells));
|
|
|
|
memoryp = OF_instance_to_package(memory);
|
|
OF_getprop(memoryp, "available", available, sizeof(available));
|
|
|
|
heap_base = OF_claim((void *)available[acells-1], size,
|
|
sizeof(register_t));
|
|
|
|
if (heap_base != (void *)-1) {
|
|
heap_size = size;
|
|
}
|
|
|
|
return (heap_base);
|
|
}
|
|
|
|
void
|
|
ofw_release_heap(void)
|
|
{
|
|
OF_release(heap_base, heap_size);
|
|
}
|