Aren
/
NetBSD
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
NetBSD/sys/arch/arm32/ofw/ofw.c

2107 lines
57 KiB
C
Raw Blame History

/* $NetBSD: ofw.c,v 1.4 1998/05/22 17:43:10 cgd Exp $ */
/*
* Copyright 1997
* Digital Equipment Corporation. All rights reserved.
*
* This software is furnished under license and may be used and
* copied only in accordance with the following terms and conditions.
* Subject to these conditions, you may download, copy, install,
* use, modify and distribute this software in source and/or binary
* form. No title or ownership is transferred hereby.
*
* 1) Any source code used, modified or distributed must reproduce
* and retain this copyright notice and list of conditions as
* they appear in the source file.
*
* 2) No right is granted to use any trade name, trademark, or logo of
* Digital Equipment Corporation. Neither the "Digital Equipment
* Corporation" name nor any trademark or logo of Digital Equipment
* Corporation may be used to endorse or promote products derived
* from this software without the prior written permission of
* Digital Equipment Corporation.
*
* 3) This software is provided "AS-IS" and any express or implied
* warranties, including but not limited to, any implied warranties
* of merchantability, fitness for a particular purpose, or
* non-infringement are disclaimed. In no event shall DIGITAL be
* liable for any damages whatsoever, and in particular, DIGITAL
* shall not be liable for special, indirect, consequential, or
* incidental damages or damages for lost profits, loss of
* revenue or loss of use, whether such damages arise in contract,
* negligence, tort, under statute, in equity, at law or otherwise,
* even if advised of the possibility of such damage.
*/
/*
* Routines for interfacing between NetBSD and OFW.
*
* Parts of this could be moved to an MI file in time. -JJK
*
*/
#include <sys/types.h>
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/reboot.h>
#include <sys/callout.h>
#include <sys/proc.h>
#include <sys/user.h>
#include <sys/kernel.h>
#include <sys/mbuf.h>
#include <sys/msgbuf.h>
#include <sys/buf.h>
#include <sys/map.h>
#include <sys/exec.h>
#include <sys/mount.h>
#include <sys/vnode.h>
#include <sys/device.h>
#include <vm/vm.h>
#include <sys/sysctl.h>
#include <sys/syscallargs.h>
#ifdef SYSVMSG
#include <sys/msg.h>
#endif
#ifdef SYSVSEM
#include <sys/sem.h>
#endif
#ifdef SYSVSHM
#include <sys/shm.h>
#endif
#include <dev/cons.h>
#include <machine/db_machdep.h>
#include <ddb/db_sym.h>
#include <ddb/db_extern.h>
#include <vm/vm_kern.h>
#include <machine/signal.h>
#include <machine/frame.h>
#include <machine/bootconfig.h>
#include <machine/cpu.h>
#include <machine/irqhandler.h>
#include <machine/pte.h>
#include <machine/undefined.h>
#include <machine/rtc.h>
#include <dev/ofw/openfirm.h>
#include <machine/ofw.h>
#include <netinet/in.h>
#if BOOT_FW_DHCP
#include <nfs/bootdata.h>
#endif
#ifdef SHARK
#include "machine/pio.h"
#include "arm32/isa/isa_machdep.h"
#endif
#define IO_VIRT_BASE (OFW_VIRT_BASE + OFW_VIRT_SIZE)
#define IO_VIRT_SIZE 0x01000000
/*
* Imported constants
*/
/* Describe different actions to take when boot() is called */
#define ACTION_HALT 0x01 /* Halt and boot */
#define ACTION_REBOOT 0x02 /* Halt and request RiscBSD reboot */
#define ACTION_KSHELL 0x04 /* Call kshell */
#define ACTION_DUMP 0x08 /* Dump the system to the dump dev if requested */
#define HALT_ACTION ACTION_HALT | ACTION_KSHELL | ACTION_DUMP /* boot(RB_HALT) */
#define REBOOT_ACTION ACTION_REBOOT | ACTION_DUMP /* boot(0) */
#define PANIC_ACTION ACTION_HALT | ACTION_DUMP /* panic() */
/*
* Imported types
*/
typedef struct {
vm_offset_t physical;
vm_offset_t virtual;
} pv_addr_t;
/*
* Imported variables
*/
extern BootConfig bootconfig; /* temporary, I hope */
extern int cold;
extern int max_processes;
#ifdef DIAGNOSTIC
/* NOTE: These variables will be removed, well some of them */
extern u_int spl_mask;
extern u_int current_mask;
extern int userret_count0;
extern int userret_count1;
#endif
extern int ofw_handleticks;
/*
* Imported routines
*/
extern void map_section __P((vm_offset_t pt, vm_offset_t va, vm_offset_t pa, int cacheable));
extern void map_pagetable __P((vm_offset_t pt, vm_offset_t va, vm_offset_t pa));
extern void map_entry __P((vm_offset_t pt, vm_offset_t va, vm_offset_t pa));
extern void map_entry_nc __P((vm_offset_t pt, vm_offset_t va, vm_offset_t pa));
extern void map_entry_ro __P((vm_offset_t pt, vm_offset_t va, vm_offset_t pa));
extern void pmap_bootstrap __P((vm_offset_t kernel_l1pt, pt_entry_t kernel_ptpt));
extern void dump_spl_masks __P((void));
extern void dumpsys __P((void));
extern void dotickgrovelling __P((vm_offset_t));
#ifdef SHARK
extern void shark_screen_cleanup __P((int));
#endif
#define WriteWord(a, b) \
*((volatile unsigned int *)(a)) = (b)
#define ReadWord(a) \
(*((volatile unsigned int *)(a)))
/*
* Exported variables
*/
/* These should all be in a meminfo structure. */
vm_offset_t physical_start;
vm_offset_t physical_freestart;
vm_offset_t physical_freeend;
vm_offset_t physical_end;
int physical_memoryblock;
u_int free_pages;
int physmem;
pv_addr_t systempage;
#ifndef OFWGENCFG
pv_addr_t irqstack;
#endif
pv_addr_t undstack;
pv_addr_t abtstack;
pv_addr_t kernelstack;
vm_offset_t pagetables_start;
vm_offset_t msgbufphys;
/* for storage allocation, used to be local to ofw_construct_proc0_addrspace */
static vm_offset_t virt_freeptr;
int ofw_callbacks = 0; /* debugging counter */
/**************************************************************/
/*
* Declarations and definitions private to this module
*
*/
struct mem_region {
vm_offset_t start;
vm_size_t size;
};
struct mem_translation {
vm_offset_t virt;
vm_size_t size;
vm_offset_t phys;
unsigned int mode;
};
struct isa_range {
vm_offset_t isa_phys_hi;
vm_offset_t isa_phys_lo;
vm_offset_t parent_phys_start;
vm_size_t isa_size;
};
struct vl_range {
vm_offset_t vl_phys_hi;
vm_offset_t vl_phys_lo;
vm_offset_t parent_phys_start;
vm_size_t vl_size;
};
struct vl_isa_range {
vm_offset_t isa_phys_hi;
vm_offset_t isa_phys_lo;
vm_offset_t parent_phys_hi;
vm_offset_t parent_phys_lo;
vm_size_t isa_size;
};
struct dma_range {
vm_offset_t start;
vm_size_t size;
};
struct ofw_cbargs {
char *name;
int nargs;
int nreturns;
int args_n_results[12];
};
/* Memory info */
static int nOFphysmem;
static struct mem_region *OFphysmem;
static int nOFphysavail;
static struct mem_region *OFphysavail;
static int nOFtranslations;
static struct mem_translation *OFtranslations;
static int nOFdmaranges;
static struct dma_range *OFdmaranges;
/* The OFW client services handle. */
/* Initialized by ofw_init(). */
static ofw_handle_t ofw_client_services_handle;
static void ofw_callbackhandler(struct ofw_cbargs *);
static void ofw_construct_proc0_addrspace __P((vm_offset_t *, vm_offset_t *));
static void ofw_getphysmeminfo __P((void));
static void ofw_getvirttranslations __P((void));
static void *ofw_malloc(vm_size_t size);
static void ofw_claimpages __P((vm_offset_t *, pv_addr_t *, vm_size_t));
static void ofw_discardmappings __P ((vm_offset_t, vm_offset_t, vm_size_t));
static int ofw_mem_ihandle __P((void));
static int ofw_mmu_ihandle __P((void));
static vm_offset_t ofw_claimphys __P((vm_offset_t, vm_size_t, vm_offset_t));
#if 0
static vm_offset_t ofw_releasephys __P((vm_offset_t, vm_size_t));
#endif
static vm_offset_t ofw_claimvirt __P((vm_offset_t, vm_size_t, vm_offset_t));
static void ofw_settranslation __P ((vm_offset_t, vm_offset_t, vm_size_t, int));
static void ofw_initallocator(void);
static void ofw_configisaonly(vm_offset_t *, vm_offset_t *);
static void ofw_configvl(int, vm_offset_t *, vm_offset_t *);
static vm_offset_t ofw_valloc(vm_offset_t, vm_offset_t);
/*
* DHCP hooks. For a first cut, we look to see if there is a DHCP
* packet that was saved by the firmware. If not, we proceed as before,
* getting hand-configured data from NVRAM. If there is one, we get the
* packet, and extract the data from it. For now, we hand that data up
* in the boot_args string as before.
*/
/**************************************************************/
/*
*
* Support routines for xxx_machdep.c
*
* The intent is that all OFW-based configurations use the
* exported routines in this file to do their business. If
* they need to override some function they are free to do so.
*
* The exported routines are:
*
* openfirmware
* ofw_init
* ofw_boot
* ofw_getbootinfo
* ofw_configmem
* ofw_configisa
* ofw_configisadma
* ofw_gettranslation
* ofw_map
* ofw_getcleaninfo
*/
int
openfirmware(args)
void *args;
{
int ofw_result;
u_int saved_irq_state;
/* OFW is not re-entrant, so we wrap a mutex around the call. */
saved_irq_state = disable_interrupts(I32_bit);
ofw_result = ofw_client_services_handle(args);
(void)restore_interrupts(saved_irq_state);
return(ofw_result);
}
void
ofw_init(ofw_handle)
ofw_handle_t ofw_handle;
{
ofw_client_services_handle = ofw_handle;
/* Everything we allocate in the remainder of this block is
* constrained to be in the "kernel-static" portion of the
* virtual address space (i.e., 0xF0000000 - 0xF1000000).
* This is because all such objects are expected to be in
* that range by NetBSD, or the objects will be re-mapped
* after the page-table-switch to other specific locations.
* In the latter case, it's simplest if our pre-switch handles
* on those objects are in regions that are already "well-
* known." (Otherwise, the cloning of the OFW-managed address-
* space becomes more awkward.) To minimize the number of L2
* page tables that we use, we are further restricting the
* remaining allocations in this block to the bottom quarter of
* the legal range. OFW will have loaded the kernel text+data+bss
* starting at the bottom of the range, and we will allocate
* objects from the top, moving downwards. The two sub-regions
* will collide if their total sizes hit 4MB. The current total
* is <1.5MB, so we aren't in any real danger yet. The variable
* virt-freeptr represents the next free va (moving downwards).
*/
virt_freeptr = KERNEL_BASE + 0x00400000;
}
void
ofw_boot(howto, bootstr)
int howto;
char *bootstr;
{
int loop;
int action;
#ifdef DIAGNOSTIC
if (curproc == NULL)
printf("curproc = 0 - must have been in cpu_idle()\n");
/* if (curpcb)
printf("curpcb=%08x pcb_sp=%08x pcb_und_sp=%08x\n", curpcb, curpcb->pcb_sp, curpcb->pcb_und_sp);*/
printf("userret_count0=%d\n", userret_count0);
printf("userret_count1=%d\n", userret_count1);
printf("boot: howto=%08x %08x curproc=%08x\n", howto, spl_mask, (u_int)curproc);
printf("current_mask=%08x spl_mask=%08x\n", current_mask, spl_mask);
printf("ipl_bio=%08x ipl_net=%08x ipl_tty=%08x ipl_clock=%08x ipl_imp=%08x\n",
irqmasks[IPL_BIO], irqmasks[IPL_NET], irqmasks[IPL_TTY],
irqmasks[IPL_CLOCK], irqmasks[IPL_IMP]);
dump_spl_masks();
#endif
/* If we are still cold then hit the air brakes and crash to earth fast */
if (cold) {
doshutdownhooks();
printf("Halted while still in the ICE age.\n");
goto ofw_exit;
}
/*
* Depending on how we got here and with what intructions, choose
* the actions to take. (See the actions defined above)
*/
if (panicstr)
action = PANIC_ACTION;
else if (howto & RB_HALT)
action = HALT_ACTION;
else
action = REBOOT_ACTION;
/*
* If RB_NOSYNC was not specified sync the discs.
* Note: Unless cold is set to 1 here, syslogd will die during the unmount.
* It looks like syslogd is getting woken up only to find that it cannot
* page part of the binary in as the filesystem has been unmounted.
*/
if (!(howto & RB_NOSYNC))
bootsync();
/* Say NO to interrupts */
splhigh();
/* If we need to do a dump, do it */
if ((howto & RB_DUMP) && (action & ACTION_DUMP)) {
dumpsys();
}
/* Run any shutdown hooks */
printf("Running shutdown hooks ...\n");
doshutdownhooks();
/* Make sure IRQ's are disabled */
IRQdisable;
if (action & ACTION_HALT)
goto ofw_exit;
/* Tell the user we are booting */
printf("boot...");
/* Give the user time to read the last couple of lines of text. */
for (loop = 5; loop > 0; --loop) {
printf("%d..", loop);
delay(500000);
}
/* Jump into the OFW boot routine. */
{
static char str[256];
char *ap = str, *ap1 = ap;
if (bootstr && *bootstr) {
if (strlen(bootstr) > sizeof str - 5)
printf("boot string too large, ignored\n");
else {
strcpy(str, bootstr);
ap1 = ap = str + strlen(str);
*ap++ = ' ';
}
}
*ap++ = '-';
if (howto & RB_SINGLE)
*ap++ = 's';
if (howto & RB_KDB)
*ap++ = 'd';
*ap++ = 0;
if (ap[-2] == '-')
*ap1 = 0;
#ifdef SHARK
shark_screen_cleanup(0);
#endif
OF_boot(str);
/* Not reached. */
}
ofw_exit:
printf("Calling OF_exit...\n");
#ifdef SHARK
shark_screen_cleanup(1);
#endif
OF_exit();
/* Not reached. */
}
#if BOOT_FW_DHCP
extern char *ip2dotted __P((struct in_addr));
/*
* Get DHCP data from OFW
*/
void
get_fw_dhcp_data(struct bootdata *bdp) {
int chosen;
int dhcplen;
bzero((char *)bdp, sizeof(*bdp));
if ((chosen = OF_finddevice("/chosen")) == -1)
panic("no /chosen from OFW");
if ((dhcplen = OF_getproplen(chosen, "bootp-response")) > 0) {
u_char *cp;
int dhcp_type = 0;
char *ip;
/*
* OFW saved a DHCP (or BOOTP) packet for us.
*/
if(dhcplen > sizeof(bdp->dhcp_packet))
panic("DHCP packet too large");
OF_getprop(chosen, "bootp-response", &bdp->dhcp_packet,
sizeof(bdp->dhcp_packet));
SANITY(bdp->dhcp_packet.op == BOOTREPLY, "bogus DHCP packet");
/*
* Collect the interesting data from DHCP into
* the bootdata structure.
*/
bdp->ip_address = bdp->dhcp_packet.yiaddr;
ip = ip2dotted(bdp->ip_address);
if(bcmp(bdp->dhcp_packet.options, DHCP_OPTIONS_COOKIE, 4) == 0)
parse_dhcp_options(
&bdp->dhcp_packet,
bdp->dhcp_packet.options + 4,
&bdp->dhcp_packet.options[dhcplen - DHCP_FIXED_NON_UDP],
bdp,
ip
);
if (bdp->root_ip.s_addr == 0)
bdp->root_ip = bdp->dhcp_packet.siaddr;
if (bdp->swap_ip.s_addr == 0)
bdp->swap_ip = bdp->dhcp_packet.siaddr;
}
/*
* If the DHCP packet did not contain all the necessary data,
* look in NVRAM for the missing parts.
*/
{
int options;
int proplen;
# define BOOTJUNKV_SIZE 256
char bootjunkv[BOOTJUNKV_SIZE]; /* minimize stack usage */
if ((options = OF_finddevice("/options")) == -1)
panic("can't find /options");
if (bdp->ip_address.s_addr == 0 &&
(proplen = OF_getprop(options, "ipaddr",
bootjunkv, BOOTJUNKV_SIZE - 1)) > 0) {
bootjunkv[proplen] = '\0';
if (dotted2ip(bootjunkv, &bdp->ip_address.s_addr) == 0)
bdp->ip_address.s_addr = 0;
}
if (bdp->ip_mask.s_addr == 0 &&
(proplen = OF_getprop(options, "netmask",
bootjunkv, BOOTJUNKV_SIZE - 1)) > 0) {
bootjunkv[proplen] = '\0';
if (dotted2ip(bootjunkv, &bdp->ip_mask.s_addr) == 0)
bdp->ip_mask.s_addr = 0;
}
if (bdp->hostname[0] == '\0' &&
(proplen = OF_getprop(options, "hostname",
bdp->hostname, sizeof(bdp->hostname) - 1)) > 0) {
bdp->hostname[proplen] = '\0';
}
if (bdp->root[0] == '\0' &&
(proplen = OF_getprop(options, "rootfs",
bootjunkv, BOOTJUNKV_SIZE - 1)) > 0) {
bootjunkv[proplen] = '\0';
parse_server_path(bootjunkv, &bdp->root_ip, bdp->root);
}
if (bdp->swap[0] == '\0' &&
(proplen = OF_getprop(options, "swapfs",
bootjunkv, BOOTJUNKV_SIZE - 1)) > 0) {
bootjunkv[proplen] = '\0';
parse_server_path(bootjunkv, &bdp->swap_ip, bdp->swap);
}
}
}
#endif /* BOOT_FW_DHCP */
void
ofw_getbootinfo(bp_pp, ba_pp)
char **bp_pp;
char **ba_pp;
{
int chosen;
int bp_len;
int ba_len;
char *bootpathv;
char *bootargsv;
/* Read the bootpath and bootargs out of OFW. */
/* XXX is bootpath still interesting? --emg */
if ((chosen = OF_finddevice("/chosen")) == -1)
panic("no /chosen from OFW");
bp_len = OF_getproplen(chosen, "bootpath");
ba_len = OF_getproplen(chosen, "bootargs");
if (bp_len < 0 || ba_len < 0)
panic("can't get boot data from OFW");
bootpathv = (char *)ofw_malloc(bp_len);
bootargsv = (char *)ofw_malloc(ba_len);
if (bp_len)
OF_getprop(chosen, "bootpath", bootpathv, bp_len);
else
bootpathv[0] = '\0';
if (ba_len)
OF_getprop(chosen, "bootargs", bootargsv, ba_len);
else
bootargsv[0] = '\0';
*bp_pp = bootpathv;
*ba_pp = bootargsv;
}
vm_offset_t
ofw_getcleaninfo()
{
int cpu;
vm_offset_t vclean, pclean;
if ((cpu = OF_finddevice("/cpu")) == -1)
panic("no /cpu from OFW");
if ((OF_getprop(cpu, "d-cache-flush-address", &vclean,
sizeof(vclean))) != sizeof(vclean)) {
#ifdef DEBUG
printf("no OFW d-cache-flush-address property\n");
#endif
return -1;
}
if ((pclean = ofw_gettranslation(of_decode_int((unsigned char *)&vclean)))
== -1)
panic("OFW failed to translate cache flush address");
return pclean;
}
#ifdef DMA_BOUNCE /* XXX */
/* hack, hack, hack, your DMA,
gently into the kernel.
merrily, merrily, merrily, merrily,
life is just a gerbil.
Notes:
- Assumes that align is a power of 2.
- OFW integer properties stored in network order (thanks, Mitch).
*/
vm_offset_t ofw_getisadmamemory(size, align)
vm_size_t size;
vm_offset_t align;
{
int nphysavail;
struct mem_region *physavail;
int phandle;
int avail_len;
int region;
vm_offset_t physstart, physstartal;
vm_size_t physsize, physsizeal;
#ifdef DEBUG
printf("getisadmamemory: %08x, %08x\n", size, align);
#endif
/* the memory allocated by this ofw_malloc will be lost. sue me. */
if (((phandle = OF_finddevice("/memory")) == -1) ||
(avail_len = OF_getproplen(phandle, "available")) <= 0 ||
(physavail = ofw_malloc(avail_len)) == 0 ||
OF_getprop(phandle, "available", physavail, avail_len) != avail_len) {
panic("ofw_getisadmamemory: get available memory failed");
}
nphysavail = avail_len / sizeof(struct mem_region);
for (region = 0; region < nphysavail; ++region) {
physsize = of_decode_int((unsigned char *)&physavail[region].size);
physstart = of_decode_int((unsigned char *)&physavail[region].start);
#ifdef DEBUG
printf("avail: %08x %08x\n", physstart, physsize);
#endif
/* do alignment now */
physstartal = ((physstart + (align - 1)) & ~(align - 1));
if ((physstartal - physstart) > physsize)
physsizeal = 0;
else
physsizeal = physsize - (physstartal - physstart);
#ifdef DEBUG
printf("aligned: %08x %08x\n", physstartal, physsizeal);
#endif
if ((size <= physsizeal) &&
/* same function that's called by isadma.c: */
!isa_machdep_dmarangecheck(physstartal, size)) {
/* we have a winner */
#ifdef DEBUG
printf("we have a winner: %08x %08x\n", physstartal, size);
#endif
if (ofw_claimphys(physstartal, size, 0) == -1)
panic("ofw_getisadmamemory: get claim memory failed");
return physstartal;
}
}
return -1; /* uh, oh. */
}
#endif /* DMA_BOUNCE XXX */
void
ofw_configisa(vm_offset_t *pio, vm_offset_t *pmem)
{
int vl;
if ((vl = OF_finddevice("/vlbus")) == -1) /* old style OFW dev info tree */
ofw_configisaonly(pio, pmem);
else /* old style OFW dev info tree */
ofw_configvl(vl, pio, pmem);
}
static void
ofw_configisaonly(vm_offset_t *pio, vm_offset_t *pmem)
{
int isa;
int rangeidx;
int size;
vm_offset_t hi, start;
struct isa_range ranges[2];
if ((isa = OF_finddevice("/isa")) == -1)
panic("OFW has no /isa device node");
/* expect to find two isa ranges: IO/data and memory/data */
if ((size = OF_getprop(isa, "ranges", ranges, sizeof(ranges)))
!= sizeof(ranges))
panic("unexpected size of OFW /isa ranges property: %d", size);
*pio = *pmem = -1;
for (rangeidx = 0; rangeidx < 2; ++rangeidx) {
hi = of_decode_int((unsigned char *)&ranges[rangeidx].isa_phys_hi);
start = of_decode_int((unsigned char *)
&ranges[rangeidx].parent_phys_start);
if (hi & 1) { /* then I/O space */
*pio = start;
} else {
*pmem = start;
}
} /* END for */
if ((*pio == -1) || (*pmem == -1))
panic("bad OFW /isa ranges property");
}
static void
ofw_configvl(int vl, vm_offset_t *pio, vm_offset_t *pmem)
{
int isa;
int ir, vr;
int size;
vm_offset_t hi, start;
struct vl_isa_range isa_ranges[2];
struct vl_range vl_ranges[2];
if ((isa = OF_finddevice("/vlbus/isa")) == -1)
panic("OFW has no /vlbus/isa device node");
/* expect to find two isa ranges: IO/data and memory/data */
if ((size = OF_getprop(isa, "ranges", isa_ranges, sizeof(isa_ranges)))
!= sizeof(isa_ranges))
panic("unexpected size of OFW /vlbus/isa ranges property: %d", size);
/* expect to find two vl ranges: IO/data and memory/data */
if ((size = OF_getprop(vl, "ranges", vl_ranges, sizeof(vl_ranges)))
!= sizeof(vl_ranges))
panic("unexpected size of OFW /vlbus ranges property: %d", size);
*pio = -1;
*pmem = -1;
for (ir = 0; ir < 2; ++ir) {
for (vr = 0; vr < 2; ++vr) {
if ((isa_ranges[ir].parent_phys_hi == vl_ranges[vr].vl_phys_hi) &&
(isa_ranges[ir].parent_phys_lo == vl_ranges[vr].vl_phys_lo)) {
hi = of_decode_int((unsigned char *)&isa_ranges[ir].isa_phys_hi);
start = of_decode_int((unsigned char *)
&vl_ranges[vr].parent_phys_start);
if (hi & 1) { /* then I/O space */
*pio = start;
} else {
*pmem = start;
}
} /* END if */
} /* END for */
} /* END for */
if ((*pio == -1) || (*pmem == -1))
panic("bad OFW /isa ranges property");
}
void
ofw_configisadma(vm_offset_t *pdma)
{
int root;
int rangeidx;
int size;
struct dma_range *dr;
if ((root = OF_finddevice("/")) == -1 ||
(size = OF_getproplen(root, "dma-ranges")) <= 0 ||
(OFdmaranges = (struct dma_range *)ofw_malloc(size)) == 0 ||
OF_getprop(root, "dma-ranges", OFdmaranges, size) != size)
panic("bad / dma-ranges property");
nOFdmaranges = size / sizeof(struct dma_range);
for (rangeidx = 0, dr = OFdmaranges;
rangeidx < nOFdmaranges;
++rangeidx, ++dr) {
dr->start = of_decode_int((unsigned char *)&dr->start);
dr->size = of_decode_int((unsigned char *)&dr->size);
}
#ifdef DEBUG
printf("dma ranges size = %d\n", size);
for (rangeidx = 0; rangeidx < nOFdmaranges; ++rangeidx) {
printf("%08x %08x\n",
OFdmaranges[rangeidx].start,
OFdmaranges[rangeidx].size);
}
#endif
#ifdef DMA_BOUNCE /* XXX */
/* XXX - Snarf physical memory for DMA bounce buffers. */
if ((*pdma =
ofw_getisadmamemory(DMA_BOUNCE * NBPG, DMA_BOUNCE * NBPG)) == -1)
panic("no ISA DMA memory: is memory populated in the correct slot?");
#endif /* DMA_BOUNCE XXX */
}
int
ofw_isadmarangeintersect(vm_offset_t pa, vm_offset_t size,
vm_offset_t *ppa, vm_offset_t *psize)
{
int rangeidx;
struct dma_range *dr;
for (rangeidx = 0, dr = OFdmaranges;
rangeidx < nOFdmaranges;
++rangeidx, ++dr) {
if ((dr->start <= pa) && (pa < (dr->start + dr->size))) {
*ppa = pa;
*psize = min(pa + size, dr->start + dr->size) - pa;
return 1; /* intersection is not NULL */
} else if ((pa < dr->start) && (dr->start < (pa + size))) {
*ppa = dr->start;
*psize = min((pa + size) - dr->start, dr->size);
return 1; /* intersection is not NULL */
}
}
return 0; /* intersection is NULL */
}
/*
* Memory configuration:
*
* We start off running in the environment provided by OFW.
* This has the MMU turned on, the kernel code and data
* mapped-in at KERNEL_BASE (0xF0000000), OFW's text and
* data mapped-in at OFW_VIRT_BASE (0xF7000000), and (possibly)
* page0 mapped-in at 0x0.
*
* The strategy is to set-up the address space for proc0 --
* including the allocation of space for new page tables -- while
* memory is still managed by OFW. We then effectively create a
* copy of the address space by dumping all of OFW's translations
* and poking them into the new page tables. We then notify OFW
* that we are assuming control of memory-management by installing
* our callback-handler, and switch to the NetBSD-managed page
* tables with the setttb() call.
*
* This scheme may cause some amount of memory to be wasted within
* OFW as dead page tables, but it shouldn't be more than about
* 20-30KB. (It's also possible that OFW will re-use the space.)
*/
void
ofw_configmem(void)
{
vm_offset_t proc0_ttbbase;
vm_offset_t proc0_ptpt;
/* XXX - Snarf physical memory for max_processes L1 pagetables. */
/* I hate that these are statically-allocated; it needs to be */
/* fixed soon! -JJK */
pagetables_start = ofw_claimphys(0, PD_SIZE * max_processes, PD_SIZE);
if (pagetables_start == -1)
panic("unable to allocate L1 pagetables");
/* Set-up proc0 address space. */
ofw_construct_proc0_addrspace(&proc0_ttbbase, &proc0_ptpt);
/* Get a dump of OFW's picture of physical memory. */
/* This is used below to initialize a load of variables used by pmap. */
/* We get it now rather than later because we are about to */
/* tell OFW to stop managing memory. */
ofw_getphysmeminfo();
/* We are about to take control of memory-management from OFW. */
/* Establish callbacks for OFW to use for its future memory needs. */
/* This is required for us to keep using OFW services. */
{
/* First initialize our callback memory allocator. */
ofw_initallocator();
OF_set_callback((void(*)())ofw_callbackhandler);
}
/* Switch to the proc0 pagetables. */
setttb(proc0_ttbbase);
/* Aaaaaaaah, running in the proc0 address space! */
/* I feel good... */
/* Set-up the various globals which describe physical memory for pmap. */
{
struct mem_region *mp;
int totalcnt;
int availcnt;
int i;
/* physmem, physical_start, physical_end, physical_memoryblock */
physmem = 0;
for (totalcnt = 0, mp = OFphysmem;
totalcnt < nOFphysmem;
totalcnt++, mp++) {
#ifdef OLDPRINTFS
printf("physmem: %x, %x\n", mp->start, mp->size);
#endif
physmem += btoc(mp->size);
}
physical_start = OFphysmem[0].start;
mp--;
physical_end = mp->start + mp->size;
physical_memoryblock = 0;
/* free_pages, physical_freestart, physical_freeend */
free_pages = 0;
for (availcnt = 0, mp = OFphysavail;
availcnt < nOFphysavail;
availcnt++, mp++) {
#ifdef OLDPRINTFS
printf("physavail: %x, %x\n", mp->start, mp->size);
#endif
free_pages += btoc(mp->size);
}
physical_freestart = OFphysavail[0].start;
mp--;
physical_freeend = mp->start + mp->size;
#ifdef OLDPRINTFS
printf("pmap_bootstrap: physmem = %x, free_pages = %x\n", physmem, free_pages);
#endif
/*
* This is a hack to work with the existing pmap code.
* That code depends on a RiscPC BootConfig structure
* containing, among other things, an array describing
* the regions of physical memory. So, for now, we need
* to stuff our OFW-derived physical memory info into a
* "fake" BootConfig structure.
*
* An added twist is that we initialize the BootConfig
* structure with our "available" physical memory regions
* rather than the "total" physical memory regions. Why?
* Because:
*
* (a) the VM code requires that the "free" pages it is
* initialized with have consecutive indices. This
* allows it to use more efficient data structures
* (presumably).
* (b) the current pmap routines which report the initial
* set of free page indices (pmap_next_page) and
* which map addresses to indices (pmap_page_index)
* assume that the free pages are consecutive across
* memory region boundaries.
*
* This means that memory which is "stolen" at startup time
* (say, for page descriptors) MUST come from either the
* bottom of the first region or the top of the last.
*
* This requirement doesn't mesh well with OFW (or at least
* our use of it). We can get around it for the time being
* by pretending that our "available" region array describes
* all of our physical memory. This may cause some important
* information to be excluded from a dump file, but so far
* I haven't come across any other negative effects.
*
* In the long-run we should fix the index generation/translation
* code in the pmap module.
*/
if (DRAM_BLOCKS < (availcnt + 1))
panic("more ofw memory regions than bootconfig blocks");
for (i = 0, mp = OFphysavail; i < nOFphysavail; i++, mp++) {
bootconfig.dram[i].address = mp->start;
bootconfig.dram[i].pages = btoc(mp->size);
}
bootconfig.dramblocks = availcnt;
}
/* Initialize pmap module. */
pmap_bootstrap(PAGE_DIRS_BASE, proc0_ptpt);
cpu_cache_syncI(); /* XXX - Is this really needed */
}
/*
************************************************************
Routines private to this module
************************************************************
*/
/* N.B. Not supposed to call printf in callback-handler! Could deadlock! */
static void
ofw_callbackhandler(args)
struct ofw_cbargs *args;
{
char *name = args->name;
int nargs = args->nargs;
int nreturns = args->nreturns;
int *args_n_results = args->args_n_results;
ofw_callbacks++;
#if defined(OFWGENCFG)
/* Check this first, so that we don't waste IRQ time parsing. */
if (strcmp(name, "tick") == 0) {
vm_offset_t frame;
/* Check format. */
if (nargs != 1 || nreturns < 1) {
args_n_results[nargs] = -1;
args->nreturns = 1;
return;
}
args_n_results[nargs] = 0; /* properly formatted request */
/*
* Note that we are running in the IRQ frame, with interrupts disabled.
*
* We need to do two things here:
* - copy a few words out of the input frame into a global
* area, for later use by our real tick-handling code
* - patch a few words in the frame so that when OFW returns
* from the interrupt it will resume with our handler
* rather than the code that was actually interrupted.
* Our handler will resume when it finishes with the code that
* was actually interrupted.
*
* It's simplest to do this in assembler, since it requires
* switching frames and grovelling about with registers.
*/
frame = (vm_offset_t)args_n_results[0];
if (ofw_handleticks)
dotickgrovelling(frame);
args_n_results[nargs + 1] = frame;
args->nreturns = 1;
} else
#endif
if (strcmp(name, "map") == 0) {
vm_offset_t va;
vm_offset_t pa;
vm_size_t size;
int mode;
int ap_bits;
int dom_bits;
int cb_bits;
/* Check format. */
if (nargs != 4 || nreturns < 2) {
args_n_results[nargs] = -1;
args->nreturns = 1;
return;
}
args_n_results[nargs] = 0; /* properly formatted request */
pa = (vm_offset_t)args_n_results[0];
va = (vm_offset_t)args_n_results[1];
size = (vm_size_t)args_n_results[2];
mode = args_n_results[3];
ap_bits = (mode & 0x00000C00);
dom_bits = (mode & 0x000001E0);
cb_bits = (mode & 0x000000C0);
/* Sanity checks. */
if ((va & PGOFSET) != 0 ||
va < OFW_VIRT_BASE ||
(va + size) > (OFW_VIRT_BASE + OFW_VIRT_SIZE) ||
(pa & PGOFSET) != 0 ||
(size & PGOFSET) != 0 ||
size == 0 ||
(dom_bits >> 5) != 0) {
args_n_results[nargs + 1] = -1;
args->nreturns = 1;
return;
}
/* Write-back anything stuck in the cache. */
cache_clean();
/* Install new mappings. */
{
pt_entry_t *pte = vtopte(va);
int npages = size >> PGSHIFT;
ap_bits >>= 10;
for (; npages > 0; pte++, pa += NBPG, npages--)
*pte = (pa | PT_AP(ap_bits) | L2_SPAGE | cb_bits);
}
/* Clean out tlb. */
tlb_flush();
args_n_results[nargs + 1] = 0;
args->nreturns = 2;
} else if (strcmp(name, "unmap") == 0) {
vm_offset_t va;
vm_size_t size;
/* Check format. */
if (nargs != 2 || nreturns < 1) {
args_n_results[nargs] = -1;
args->nreturns = 1;
return;
}
args_n_results[nargs] = 0; /* properly formatted request */
va = (vm_offset_t)args_n_results[0];
size = (vm_size_t)args_n_results[1];
/* Sanity checks. */
if ((va & PGOFSET) != 0 ||
va < OFW_VIRT_BASE ||
(va + size) > (OFW_VIRT_BASE + OFW_VIRT_SIZE) ||
(size & PGOFSET) != 0 ||
size == 0) {
args_n_results[nargs + 1] = -1;
args->nreturns = 1;
return;
}
/* Write-back anything stuck in the cache. */
cache_clean();
/* Zero the mappings. */
{
pt_entry_t *pte = vtopte(va);
int npages = size >> PGSHIFT;
for (; npages > 0; pte++, npages--)
*pte = 0;
}
/* Clean out tlb. */
tlb_flush();
args->nreturns = 1;
} else if (strcmp(name, "translate") == 0) {
vm_offset_t va;
vm_offset_t pa;
int mode;
pt_entry_t pte;
/* Check format. */
if (nargs != 1 || nreturns < 4) {
args_n_results[nargs] = -1;
args->nreturns = 1;
return;
}
args_n_results[nargs] = 0; /* properly formatted request */
va = (vm_offset_t)args_n_results[0];
/* Sanity checks. */
/* For now, I am only willing to translate va's in the "ofw range." */
/* Eventually, I may be more generous. -JJK */
if ((va & PGOFSET) != 0 ||
va < OFW_VIRT_BASE ||
va >= (OFW_VIRT_BASE + OFW_VIRT_SIZE)) {
args_n_results[nargs + 1] = -1;
args->nreturns = 1;
return;
}
/* Lookup mapping. */
pte = *vtopte(va);
if (pte == 0) {
/* No mapping. */
args_n_results[nargs + 1] = -1;
args->nreturns = 2;
} else {
/* Existing mapping. */
pa = (pte & PG_FRAME) | (va & ~PG_FRAME);
mode = (pte & 0x0C00) | (0 << 5) | (pte & 0x000C); /* AP | DOM | CB */
args_n_results[nargs + 1] = 0;
args_n_results[nargs + 2] = pa;
args_n_results[nargs + 3] = mode;
args->nreturns = 4;
}
} else if (strcmp(name, "claim-phys") == 0) {
struct pglist alloclist = TAILQ_HEAD_INITIALIZER(alloclist);
vm_offset_t low, high;
vm_size_t align, size;
/*
* XXX
* XXX THIS IS A GROSS HACK AND NEEDS TO BE REWRITTEN. -- cgd
* XXX
*/
/* Check format. */
if (nargs != 4 || nreturns < 3) {
args_n_results[nargs] = -1;
args->nreturns = 1;
return;
}
args_n_results[nargs] = 0; /* properly formatted request */
low = args_n_results[0];
size = args_n_results[2];
align = args_n_results[3];
high = args_n_results[1] + size;
#if 0
printf("claim-phys: low = 0x%x, size = 0x%x, align = 0x%x, high = 0x%x\n",
low, size, align, high);
align = size;
printf("forcing align to be 0x%x\n", align);
#endif
args_n_results[nargs + 1] =
vm_page_alloc_memory(size, low, high, align, 0, &alloclist,
1, 0);
#if 0
printf(" -> 0x%lx", args_n_results[nargs + 1]);
#endif
if (args_n_results[nargs + 1] != 0) {
#if 0
printf("(failed)\n");
#endif
args_n_results[nargs + 1] = -1;
args->nreturns = 2;
return;
}
args_n_results[nargs + 2] = alloclist.tqh_first->phys_addr;
#if 0
printf("(succeeded: pa = 0x%lx)\n", args_n_results[nargs + 2]);
#endif
args->nreturns = 3;
} else if (strcmp(name, "release-phys") == 0) {
printf("unimplemented ofw callback - %s\n", name);
args_n_results[nargs] = -1;
args->nreturns = 1;
} else if (strcmp(name, "claim-virt") == 0) {
vm_offset_t va;
vm_size_t size;
vm_offset_t align;
/* XXX - notyet */
/* printf("unimplemented ofw callback - %s\n", name);*/
args_n_results[nargs] = -1;
args->nreturns = 1;
return;
/* Check format. */
if (nargs != 2 || nreturns < 3) {
args_n_results[nargs] = -1;
args->nreturns = 1;
return;
}
args_n_results[nargs] = 0; /* properly formatted request */
/* Allocate size bytes with specified alignment. */
size = (vm_size_t)args_n_results[0];
align = (vm_offset_t)args_n_results[1];
if (align % NBPG != 0) {
args_n_results[nargs + 1] = -1;
args->nreturns = 2;
return;
}
if (va == 0) {
/* Couldn't allocate. */
args_n_results[nargs + 1] = -1;
args->nreturns = 2;
} else {
/* Successful allocation. */
args_n_results[nargs + 1] = 0;
args_n_results[nargs + 2] = va;
args->nreturns = 3;
}
} else if (strcmp(name, "release-virt") == 0) {
vm_offset_t va;
vm_size_t size;
/* XXX - notyet */
printf("unimplemented ofw callback - %s\n", name);
args_n_results[nargs] = -1;
args->nreturns = 1;
return;
/* Check format. */
if (nargs != 2 || nreturns < 1) {
args_n_results[nargs] = -1;
args->nreturns = 1;
return;
}
args_n_results[nargs] = 0; /* properly formatted request */
/* Release bytes. */
va = (vm_offset_t)args_n_results[0];
size = (vm_size_t)args_n_results[1];
args->nreturns = 1;
} else {
args_n_results[nargs] = -1;
args->nreturns = 1;
}
}
static void
ofw_construct_proc0_addrspace(proc0_ttbbase, proc0_ptpt)
vm_offset_t *proc0_ttbbase;
vm_offset_t *proc0_ptpt;
{
int i, oft;
pv_addr_t proc0_pagedir;
pv_addr_t proc0_pt_pde;
pv_addr_t proc0_pt_pte;
pv_addr_t proc0_pt_sys;
pv_addr_t proc0_pt_kernel;
pv_addr_t proc0_pt_vmdata[8];
pv_addr_t proc0_pt_ofw[4];
pv_addr_t proc0_pt_io[4];
pv_addr_t msgbuf;
/* Set-up the system page. */
systempage.virtual = ofw_claimvirt(0, NBPG, 0);
if (systempage.virtual == -1) {
/* Something was already mapped to VA 0. */
systempage.virtual = 0;
systempage.physical = ofw_gettranslation(0);
if (systempage.physical == -1)
panic("bogus result from gettranslation(0)");
} else {
/* We were just allocated the page-length range at VA 0. */
if (systempage.virtual != 0)
panic("bogus result from claimvirt(0, NBPG, 0)");
/* Now allocate a physical page, and establish the mapping. */
systempage.physical = ofw_claimphys(0, NBPG, NBPG);
if (systempage.physical == -1)
panic("bogus result from claimphys(0, NBPG, NBPG)");
ofw_settranslation(systempage.virtual, systempage.physical, NBPG, -1); /* XXX - mode? -JJK */
/* Zero the memory. */
bzero((char *)systempage.virtual, NBPG);
}
/* Allocate/initialize space for the proc0, NetBSD-managed */
/* page tables that we will be switching to soon. */
ofw_claimpages(&virt_freeptr, &proc0_pagedir, PD_SIZE);
ofw_claimpages(&virt_freeptr, &proc0_pt_pde, PT_SIZE);
ofw_claimpages(&virt_freeptr, &proc0_pt_pte, PT_SIZE);
ofw_claimpages(&virt_freeptr, &proc0_pt_sys, PT_SIZE);
ofw_claimpages(&virt_freeptr, &proc0_pt_kernel, PT_SIZE);
for (i = 0; i < 8; i++)
ofw_claimpages(&virt_freeptr, &proc0_pt_vmdata[i], PT_SIZE);
for (i = 0; i < 4; i++)
ofw_claimpages(&virt_freeptr, &proc0_pt_ofw[i], PT_SIZE);
for (i = 0; i < 4; i++)
ofw_claimpages(&virt_freeptr, &proc0_pt_io[i], PT_SIZE);
/* Allocate/initialize space for stacks. */
#ifndef OFWGENCFG
ofw_claimpages(&virt_freeptr, &irqstack, NBPG);
#endif
ofw_claimpages(&virt_freeptr, &undstack, NBPG);
ofw_claimpages(&virt_freeptr, &abtstack, NBPG);
ofw_claimpages(&virt_freeptr, &kernelstack, UPAGES * NBPG);
/* Allocate/initialize space for msgbuf area. */
ofw_claimpages(&virt_freeptr, &msgbuf, MSGBUFSIZE);
msgbufphys = msgbuf.physical;
/* OK, we're done allocating. */
/* Get a dump of OFW's translations, and make the appropriate */
/* entries in the L2 pagetables that we just allocated. */
{
struct mem_translation *tp;
ofw_getvirttranslations();
for (oft = 0,
tp = OFtranslations;
oft < nOFtranslations; oft++, tp++) {
vm_offset_t va, pa;
int npages = tp->size / NBPG;
/* Size must be an integral number of pages. */
if (npages == 0 || tp->size % NBPG != 0)
panic("illegal ofw translation (size)");
/* Make an entry for each page in the appropriate table. */
for (va = tp->virt, pa = tp->phys; npages > 0;
va += NBPG, pa += NBPG, npages--) {
vm_offset_t L2pagetable;
/* Map the top bits to the appropriate L2 pagetable. */
/* The only allowable regions are page0, the kernel-static */
/* area, and the ofw area. */
switch(va >> (PDSHIFT + 2)) {
case 0:
/* page0 */
L2pagetable = proc0_pt_sys.virtual;
break;
case (KERNEL_BASE >> (PDSHIFT + 2)):
/* kernel static area */
L2pagetable = proc0_pt_kernel.virtual;
break;
case ( OFW_VIRT_BASE >> (PDSHIFT + 2)):
case ((OFW_VIRT_BASE + 0x00400000) >> (PDSHIFT + 2)):
case ((OFW_VIRT_BASE + 0x00800000) >> (PDSHIFT + 2)):
case ((OFW_VIRT_BASE + 0x00C00000) >> (PDSHIFT + 2)):
/* ofw area */
L2pagetable = proc0_pt_ofw[(va >> (PDSHIFT + 2)) & 0x3].virtual;
break;
case ( IO_VIRT_BASE >> (PDSHIFT + 2)):
case ((IO_VIRT_BASE + 0x00400000) >> (PDSHIFT + 2)):
case ((IO_VIRT_BASE + 0x00800000) >> (PDSHIFT + 2)):
case ((IO_VIRT_BASE + 0x00C00000) >> (PDSHIFT + 2)):
/* io area */
L2pagetable = proc0_pt_io[(va >> (PDSHIFT + 2)) & 0x3].virtual;
break;
default:
/* illegal */
panic("illegal ofw translation (addr) %#lx", va);
}
/* Sanity. The current entry should be null. */
{
pt_entry_t pte = ReadWord(L2pagetable + ((va >> 10) & 0x00000FFC));
if (pte != 0)
panic("illegal ofw translation (%#lx, %#lx, %#lx, %x)",
L2pagetable, va, pa, pte);
}
/* Make the entry. */
if ((tp->mode & 0xC) == 0xC)
map_entry(L2pagetable, va, pa);
else
map_entry_nc(L2pagetable, va, pa);
}
}
}
/* We don't actually want some of the mappings that we just */
/* set up to appear in proc0's address space. In particular, */
/* we don't want aliases to physical addresses that the kernel */
/* has-mapped/will-map elsewhere. */
{
ofw_discardmappings(proc0_pt_kernel.virtual,
proc0_pagedir.virtual, PD_SIZE);
ofw_discardmappings(proc0_pt_kernel.virtual,
proc0_pt_pde.virtual, PT_SIZE);
ofw_discardmappings(proc0_pt_kernel.virtual,
proc0_pt_pte.virtual, PT_SIZE);
ofw_discardmappings(proc0_pt_kernel.virtual,
proc0_pt_sys.virtual, PT_SIZE);
ofw_discardmappings(proc0_pt_kernel.virtual,
proc0_pt_kernel.virtual, PT_SIZE);
for (i = 0; i < 8; i++)
ofw_discardmappings(proc0_pt_kernel.virtual,
proc0_pt_vmdata[i].virtual, PT_SIZE);
for (i = 0; i < 4; i++)
ofw_discardmappings(proc0_pt_kernel.virtual,
proc0_pt_ofw[i].virtual, PT_SIZE);
for (i = 0; i < 4; i++)
ofw_discardmappings(proc0_pt_kernel.virtual,
proc0_pt_io[i].virtual, PT_SIZE);
ofw_discardmappings(proc0_pt_kernel.virtual,
msgbuf.virtual, MSGBUFSIZE);
}
/* Construct the proc0 L2 pagetables that map page tables. */
{
vm_offset_t L2pagetable;
/* Map entries in the L2pagetable used to map L1PTs. */
L2pagetable = proc0_pt_pde.virtual;
for (i = 0; i < 4; i++) {
u_int offset = i * NBPG;
map_entry_nc(L2pagetable, 0x00000000 + offset,
proc0_pagedir.physical + offset);
}
/* Map entries in the L2pagetable used to map L2PTs. */
L2pagetable = proc0_pt_pte.virtual;
map_entry_nc(L2pagetable, (0x00000000 >> (PGSHIFT-2)),
proc0_pt_sys.physical);
map_entry_nc(L2pagetable, (KERNEL_BASE >> (PGSHIFT-2)),
proc0_pt_kernel.physical);
map_entry_nc(L2pagetable, (PAGE_DIRS_BASE >> (PGSHIFT-2)),
proc0_pt_pde.physical);
map_entry_nc(L2pagetable, (PROCESS_PAGE_TBLS_BASE >> (PGSHIFT-2)),
proc0_pt_pte.physical);
for (i = 0; i < 8; i++)
map_entry_nc(L2pagetable, ((KERNEL_VM_BASE + i * 0x00400000) >> (PGSHIFT-2)),
proc0_pt_vmdata[i].physical);
for (i = 0; i < 4; i++)
map_entry_nc(L2pagetable, ((0xf5000000 + i * 0x00400000) >> (PGSHIFT-2)),
proc0_pagedir.physical + i * NBPG);
for (i = 0; i < 4; i++)
map_entry_nc(L2pagetable, ((OFW_VIRT_BASE + i * 0x00400000) >> (PGSHIFT-2)),
proc0_pt_ofw[i].physical);
for (i = 0; i < 4; i++)
map_entry_nc(L2pagetable, ((IO_VIRT_BASE + i * 0x00400000) >> (PGSHIFT-2)),
proc0_pt_io[i].physical);
}
/* Construct the proc0 L1 pagetable. */
{
vm_offset_t L1pagetable = proc0_pagedir.virtual;
struct mem_translation *tp;
map_pagetable(L1pagetable, 0x0,
proc0_pt_sys.physical);
map_pagetable(L1pagetable, KERNEL_BASE,
proc0_pt_kernel.physical);
map_pagetable(L1pagetable, PAGE_DIRS_BASE,
proc0_pt_pde.physical);
map_pagetable(L1pagetable, PROCESS_PAGE_TBLS_BASE,
proc0_pt_pte.physical);
for (i = 0; i < 8; i++)
map_pagetable(L1pagetable, KERNEL_VM_BASE + i * 0x00400000,
proc0_pt_vmdata[i].physical);
for (i = 0; i < 4; i++)
map_pagetable(L1pagetable, OFW_VIRT_BASE + i * 0x00400000,
proc0_pt_ofw[i].physical);
for (i = 0; i < 4; i++)
map_pagetable(L1pagetable, IO_VIRT_BASE + i * 0x00400000,
proc0_pt_io[i].physical);
/*
* gross hack for the sake of not thrashing the TLB and making
* cache flush more efficient: blast l1 ptes for sections.
*/
for (oft = 0,
tp = OFtranslations;
oft < nOFtranslations; oft++, tp++) {
vm_offset_t va = tp->virt;
vm_offset_t pa = tp->phys;
if (((va & (NBPD - 1)) == 0) && ((pa & (NBPD - 1)) == 0)) {
int nsections = tp->size / NBPD;
while (nsections--) {
map_section(L1pagetable, va, pa, 0);
/* even grosser hack: blast B & C bits if necessary */
if ((tp->mode & 0xC) == 0xC)
((u_int *)L1pagetable)[(va >> PDSHIFT)] |= PT_B | PT_C;
va += NBPD;
pa += NBPD;
} /* END while */
} /* END if */
} /* END for */
}
/* OUT parameters are the new ttbbase and the pt which maps pts. */
*proc0_ttbbase = proc0_pagedir.physical;
*proc0_ptpt = proc0_pt_pte.physical;
}
static void
ofw_getphysmeminfo()
{
int phandle;
int mem_len;
int avail_len;
int i;
if ((phandle = OF_finddevice("/memory")) == -1 ||
(mem_len = OF_getproplen(phandle, "reg")) <= 0 ||
(OFphysmem = (struct mem_region *)ofw_malloc(mem_len)) == 0 ||
OF_getprop(phandle, "reg", OFphysmem, mem_len) != mem_len ||
(avail_len = OF_getproplen(phandle, "available")) <= 0 ||
(OFphysavail = (struct mem_region *)ofw_malloc(avail_len)) == 0 ||
OF_getprop(phandle, "available", OFphysavail, avail_len) != avail_len)
panic("can't get physmeminfo from OFW");
nOFphysmem = mem_len / sizeof(struct mem_region);
nOFphysavail = avail_len / sizeof(struct mem_region);
/* Sort the blocks in each array into ascending address order. */
/* Also, page-align all blocks. */
for (i = 0; i < 2; i++) {
struct mem_region *tmp = (i == 0) ? OFphysmem : OFphysavail;
struct mem_region *mp;
int cnt = (i == 0) ? nOFphysmem : nOFphysavail;
int j;
#ifdef OLDPRINTFS
printf("ofw_getphysmeminfo: %d blocks\n", cnt);
#endif
/* XXX - Convert all the values to host order. -JJK */
for (j = 0, mp = tmp; j < cnt; j++, mp++) {
mp->start = of_decode_int((unsigned char *)&mp->start);
mp->size = of_decode_int((unsigned char *)&mp->size);
}
for (j = 0, mp = tmp; j < cnt; j++, mp++) {
u_int s, sz;
struct mem_region *mp1;
/* Page-align start of the block. */
s = mp->start % NBPG;
if (s != 0) {
s = (NBPG - s);
if (mp->size >= s) {
mp->start += s;
mp->size -= s;
}
}
/* Page-align the size. */
mp->size -= mp->size % NBPG;
/* Handle empty block. */
if (mp->size == 0) {
bcopy(mp + 1, mp, (cnt - (mp - tmp)) * sizeof(struct mem_region));
cnt--;
mp--;
continue;
}
/* Bubble sort. */
s = mp->start;
sz = mp->size;
for (mp1 = tmp; mp1 < mp; mp1++)
if (s < mp1->start)
break;
if (mp1 < mp) {
bcopy(mp1, mp1 + 1, (void *)mp - (void *)mp1);
mp1->start = s;
mp1->size = sz;
}
}
#ifdef OLDPRINTFS
for (mp = tmp; mp->size; mp++) {
printf("%x, %x\n", mp->start, mp->size);
}
#endif
}
}
static void
ofw_getvirttranslations()
{
int mmu_phandle;
int mmu_ihandle;
int trans_len;
int over, len;
int i;
struct mem_translation *tp;
mmu_ihandle = ofw_mmu_ihandle();
/* overallocate to avoid increases during allocation */
over = 4 * sizeof(struct mem_translation);
if ((mmu_phandle = OF_instance_to_package(mmu_ihandle)) == -1 ||
(len = OF_getproplen(mmu_phandle, "translations")) <= 0 ||
(OFtranslations = ofw_malloc(len + over)) == 0 ||
(trans_len = OF_getprop(mmu_phandle, "translations",
OFtranslations, len + over)) > (len + over))
panic("can't get virttranslations from OFW");
/* XXX - Convert all the values to host order. -JJK */
nOFtranslations = trans_len / sizeof(struct mem_translation);
#ifdef OLDPRINTFS
printf("ofw_getvirtmeminfo: %d blocks\n", nOFtranslations);
#endif
for (i = 0, tp = OFtranslations; i < nOFtranslations; i++, tp++) {
tp->virt = of_decode_int((unsigned char *)&tp->virt);
tp->size = of_decode_int((unsigned char *)&tp->size);
tp->phys = of_decode_int((unsigned char *)&tp->phys);
tp->mode = of_decode_int((unsigned char *)&tp->mode);
}
}
/*
* ofw_valloc: allocate blocks of VM for IO and other special purposes
*/
typedef struct _vfree {
struct _vfree *pNext;
vm_offset_t start;
vm_size_t size;
} VFREE, *PVFREE;
static VFREE vfinitial = {NULL, IO_VIRT_BASE, IO_VIRT_SIZE};
static PVFREE vflist = &vfinitial;
static vm_offset_t
ofw_valloc(vm_offset_t size, vm_offset_t align)
{
PVFREE *ppvf;
PVFREE pNew;
vm_offset_t new;
vm_offset_t lead;
for (ppvf = &vflist; *ppvf; ppvf = &((*ppvf)->pNext)) {
if (align == 0) {
new = (*ppvf)->start;
lead = 0;
} else {
new = ((*ppvf)->start + (align - 1)) & ~(align - 1);
lead = new - (*ppvf)->start;
}
if (((*ppvf)->size - lead) >= size) {
if (lead == 0) {
if (size == (*ppvf)->size) { /* using whole block */
(*ppvf) = (*ppvf)->pNext; /* splice out of list */
} else { /* tail of block is free */
(*ppvf)->start = new + size;
(*ppvf)->size -= size;
}
} else {
vm_size_t tail = ((*ppvf)->start + (*ppvf)->size) - (new + size);
(*ppvf)->size = lead; /* free space at beginning */
if (tail != 0) {
/* free space at tail */
pNew = ofw_malloc(sizeof(VFREE));
pNew->pNext = (*ppvf)->pNext;
(*ppvf)->pNext = pNew;
pNew->start = new + size;
pNew->size = tail;
}
}
return new;
} /* END if */
} /* END for */
return -1;
}
vm_offset_t
ofw_map(vm_offset_t pa, vm_size_t size, int cb_bits)
{
vm_offset_t va;
if ((va = ofw_valloc(size, size)) == -1)
panic("cannot alloc virtual memory for %#lx", pa);
ofw_claimvirt(va, size, 0); /* make sure OFW knows about the memory */
ofw_settranslation(va, pa, size, PT_AP(AP_KRW) | cb_bits);
return va;
}
static int
ofw_mem_ihandle(void)
{
static int mem_ihandle = 0;
int chosen;
if (mem_ihandle != 0)
return(mem_ihandle);
if ((chosen = OF_finddevice("/chosen")) == -1 ||
OF_getprop(chosen, "memory", &mem_ihandle, sizeof(int)) < 0)
panic("ofw_mem_ihandle");
mem_ihandle = of_decode_int((unsigned char *)&mem_ihandle);
return(mem_ihandle);
}
static int
ofw_mmu_ihandle(void)
{
static int mmu_ihandle = 0;
int chosen;
if (mmu_ihandle != 0)
return(mmu_ihandle);
if ((chosen = OF_finddevice("/chosen")) == -1 ||
OF_getprop(chosen, "mmu", &mmu_ihandle, sizeof(int)) < 0)
panic("ofw_mmu_ihandle");
mmu_ihandle = of_decode_int((unsigned char *)&mmu_ihandle);
return(mmu_ihandle);
}
/* Return -1 on failure. */
static vm_offset_t
ofw_claimphys(pa, size, align)
vm_offset_t pa;
vm_size_t size;
vm_offset_t align;
{
int mem_ihandle = ofw_mem_ihandle();
/*printf("ofw_claimphys (%x, %x, %x) --> ", pa, size, align);*/
if (align == 0) {
/* Allocate at specified base; alignment is ignored. */
pa = OF_call_method_1("claim", mem_ihandle, 3, pa, size, align);
} else {
/* Allocate anywhere, with specified alignment. */
pa = OF_call_method_1("claim", mem_ihandle, 2, size, align);
}
/*printf("%x\n", pa);*/
return(pa);
}
#if 0
/* Return -1 on failure. */
static vm_offset_t
ofw_releasephys(pa, size)
vm_offset_t pa;
vm_size_t size;
{
int mem_ihandle = ofw_mem_ihandle();
/*printf("ofw_releasephys (%x, %x)\n", pa, size);*/
return (OF_call_method_1("release", mem_ihandle, 2, pa, size));
}
#endif
/* Return -1 on failure. */
static vm_offset_t
ofw_claimvirt(va, size, align)
vm_offset_t va;
vm_size_t size;
vm_offset_t align;
{
int mmu_ihandle = ofw_mmu_ihandle();
/*printf("ofw_claimvirt (%x, %x, %x) --> ", va, size, align);*/
if (align == 0) {
/* Allocate at specified base; alignment is ignored. */
va = OF_call_method_1("claim", mmu_ihandle, 3, va, size, align);
} else {
/* Allocate anywhere, with specified alignment. */
va = OF_call_method_1("claim", mmu_ihandle, 2, size, align);
}
/*printf("%x\n", va);*/
return(va);
}
/* Return -1 if no mapping. */
vm_offset_t
ofw_gettranslation(va)
vm_offset_t va;
{
int mmu_ihandle = ofw_mmu_ihandle();
vm_offset_t pa;
int mode;
int exists;
/*printf("ofw_gettranslation (%x) --> ", va);*/
exists = 0; /* gets set to true if translation exists */
if (OF_call_method("translate", mmu_ihandle, 1, 3, va, &pa, &mode, &exists) != 0)
return(-1);
/*printf("%x\n", exists ? pa : -1);*/
return(exists ? pa : -1);
}
static void
ofw_settranslation(va, pa, size, mode)
vm_offset_t va;
vm_offset_t pa;
vm_size_t size;
int mode;
{
int mmu_ihandle = ofw_mmu_ihandle();
/*printf("ofw_settranslation (%x, %x, %x, %x) --> void", va, pa, size, mode);*/
if (OF_call_method("map", mmu_ihandle, 4, 0, pa, va, size, mode) != 0)
panic("ofw_settranslation failed");
}
/*
* Allocation routine used before the kernel takes over memory.
* Use this for efficient storage for things that aren't rounded to
* page size.
*
* The point here is not necessarily to be very efficient (even though
* that's sort of nice), but to do proper dynamic allocation to avoid
* size-limitation errors.
*
*/
typedef struct _leftover {
struct _leftover *pNext;
vm_size_t size;
} LEFTOVER, *PLEFTOVER;
/* leftover bits of pages. first word is pointer to next.
second word is size of leftover */
static PLEFTOVER leftovers = NULL;
static void *
ofw_malloc(vm_size_t size)
{
PLEFTOVER *ppLeftover;
PLEFTOVER pLeft;
pv_addr_t new;
vm_size_t newSize, claim_size;
/* round and set minimum size */
size = max(sizeof(LEFTOVER),
((size + (sizeof(LEFTOVER) - 1)) & ~(sizeof(LEFTOVER) - 1)));
for (ppLeftover = &leftovers;
*ppLeftover;
ppLeftover = &((*ppLeftover)->pNext))
if ((*ppLeftover)->size >= size)
break;
if (*ppLeftover) { /* have a leftover of the right size */
/* remember the leftover */
new.virtual = (vm_offset_t)*ppLeftover;
if ((*ppLeftover)->size < (size + sizeof(LEFTOVER))) {
*ppLeftover = (*ppLeftover)->pNext; /* splice out of chain */
} else {
pLeft = (*ppLeftover)->pNext; /* remember the next pointer */
newSize = (*ppLeftover)->size - size; /* reduce size */
/* move pointer */
*ppLeftover = (PLEFTOVER)(((vm_offset_t)*ppLeftover) + size);
(*ppLeftover)->pNext = pLeft;
(*ppLeftover)->size = newSize;
}
} else {
claim_size = (size + NBPG - 1) & ~(NBPG - 1);
ofw_claimpages(&virt_freeptr, &new, claim_size);
if ((size + sizeof(LEFTOVER)) <= claim_size) {
pLeft = (PLEFTOVER)(new.virtual + size);
pLeft->pNext = leftovers;
pLeft->size = claim_size - size;
leftovers = pLeft;
}
}
return (void *)(new.virtual);
}
/*
* Here is a really, really sleazy free. It's not used right now,
* because it's not worth the extra complexity for just a few bytes.
*
*/
#if 0
static void
ofw_free(vm_offset_t addr, vm_size_t size)
{
PLEFTOVER pLeftover = (PLEFTOVER)addr;
/* splice right into list without checks or compaction */
pLeftover->pNext = leftovers;
pLeftover->size = size;
leftovers = pLeftover;
}
#endif
/*
* Allocate and zero round(size)/NBPG pages of memory.
* We guarantee that the allocated memory will be
* aligned to a boundary equal to the smallest power of
* 2 greater than or equal to size.
* free_pp is an IN/OUT parameter which points to the
* last allocated virtual address in an allocate-downwards
* stack. pv_p is an OUT parameter which contains the
* virtual and physical base addresses of the allocated
* memory.
*/
static void
ofw_claimpages(free_pp, pv_p, size)
vm_offset_t *free_pp;
pv_addr_t *pv_p;
vm_size_t size;
{
vm_size_t alloc_size = (size + NBPG - 1) & ~(NBPG - 1); /* round-up to page boundary */
vm_size_t aligned_size;
vm_offset_t va, pa;
if (alloc_size == 0)
panic("ofw_claimpages zero");
for (aligned_size = 1; aligned_size < alloc_size; aligned_size <<= 1)
;
/* The only way to provide the alignment guarantees is to
* allocate the virtual and physical ranges separately,
* then do an explicit map call.
*/
va = (*free_pp & ~(aligned_size - 1)) - aligned_size;
if (ofw_claimvirt(va, alloc_size, 0) != va)
panic("ofw_claimpages va alloc");
pa = ofw_claimphys(0, alloc_size, aligned_size);
if (pa == -1)
panic("ofw_claimpages pa alloc");
ofw_settranslation(va, pa, alloc_size, -1); /* XXX - what mode? -JJK */
/* The memory's mapped-in now, so we can zero it. */
bzero((char *)va, alloc_size);
/* Set OUT parameters. */
*free_pp = va;
pv_p->virtual = va;
pv_p->physical = pa;
}
static void
ofw_discardmappings(L2pagetable, va, size)
vm_offset_t L2pagetable;
vm_offset_t va;
vm_size_t size;
{
vm_size_t alloc_size = (size + NBPG - 1) & ~(NBPG - 1); /* round-up to page boundary */
int npages = alloc_size / NBPG;
if (npages == 0)
panic("ofw_discardmappings zero");
/* Discard each mapping. */
for (; npages > 0; va += NBPG, npages--) {
/* Sanity. The current entry should be non-null. */
if (ReadWord(L2pagetable + ((va >> 10) & 0x00000FFC)) == 0)
panic("ofw_discardmappings zero entry");
/* Clear the entry. */
WriteWord(L2pagetable + ((va >> 10) & 0x00000FFC), 0);
}
}
static void
ofw_initallocator(void)
{
}
Reference in New Issue View Git Blame Copy Permalink