2001-10-15 14:35:39 +00:00
|
|
|
/*
|
|
|
|
* Initial implementation:
|
|
|
|
* Copyright (c) 2001 Robert Drehmel
|
|
|
|
* All rights reserved.
|
|
|
|
*
|
|
|
|
* As long as the above copyright statement and this notice remain
|
|
|
|
* unchanged, you can do what ever you want with this file.
|
|
|
|
*
|
|
|
|
* $FreeBSD$
|
|
|
|
*/
|
|
|
|
/*
|
|
|
|
* FreeBSD/sparc64 kernel loader - machine dependent part
|
|
|
|
*
|
|
|
|
* - implements copyin and readin functions that map kernel
|
|
|
|
* pages on demand. The machine independent code does not
|
|
|
|
* know the size of the kernel early enough to pre-enter
|
|
|
|
* TTEs and install just one 4MB mapping seemed to limiting
|
|
|
|
* to me.
|
|
|
|
*/
|
|
|
|
#include <stand.h>
|
|
|
|
#include <sys/exec.h>
|
|
|
|
#include <sys/param.h>
|
|
|
|
#include <sys/linker.h>
|
|
|
|
|
|
|
|
#include <machine/asi.h>
|
|
|
|
#include <machine/elf.h>
|
2002-02-23 04:04:30 +00:00
|
|
|
#include <machine/lsu.h>
|
|
|
|
#include <machine/metadata.h>
|
2001-10-15 14:35:39 +00:00
|
|
|
#include <machine/tte.h>
|
|
|
|
|
|
|
|
#include "bootstrap.h"
|
|
|
|
#include "libofw.h"
|
2001-10-30 06:31:45 +00:00
|
|
|
#include "dev_net.h"
|
2001-10-15 14:35:39 +00:00
|
|
|
|
|
|
|
enum {
|
|
|
|
HEAPVA = 0x800000,
|
|
|
|
HEAPSZ = 0x1000000,
|
|
|
|
LOADSZ = 0x1000000 /* for kernel and modules */
|
|
|
|
};
|
|
|
|
|
|
|
|
struct memory_slice {
|
|
|
|
vm_offset_t pstart;
|
|
|
|
vm_offset_t size;
|
|
|
|
};
|
|
|
|
|
2001-10-30 06:31:45 +00:00
|
|
|
typedef void kernel_entry_t(vm_offset_t mdp, u_long o1, u_long o2, u_long o3,
|
|
|
|
void *openfirmware);
|
|
|
|
|
2001-10-15 14:35:39 +00:00
|
|
|
extern void itlb_enter(int, vm_offset_t, vm_offset_t, unsigned long);
|
|
|
|
extern void dtlb_enter(int, vm_offset_t, vm_offset_t, unsigned long);
|
|
|
|
extern vm_offset_t itlb_va_to_pa(vm_offset_t);
|
|
|
|
extern vm_offset_t dtlb_va_to_pa(vm_offset_t);
|
2001-10-30 06:31:45 +00:00
|
|
|
extern vm_offset_t md_load(char *, vm_offset_t *);
|
2001-10-15 14:35:39 +00:00
|
|
|
static int elf_exec(struct preloaded_file *);
|
|
|
|
static int sparc64_autoload(void);
|
|
|
|
static int mmu_mapin(vm_offset_t, vm_size_t);
|
|
|
|
|
|
|
|
char __progname[] = "FreeBSD/sparc64 loader";
|
|
|
|
|
|
|
|
vm_offset_t curkva = 0;
|
|
|
|
vm_offset_t heapva;
|
2001-10-30 06:31:45 +00:00
|
|
|
int tlbslot = 63; /* Insert first entry at this TLB slot. XXX */
|
2001-10-15 14:35:39 +00:00
|
|
|
phandle_t pmemh; /* OFW memory handle */
|
|
|
|
|
|
|
|
struct memory_slice memslices[18];
|
|
|
|
struct ofw_devdesc bootdev;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Machine dependent structures that the machine independent
|
|
|
|
* loader part uses.
|
|
|
|
*/
|
|
|
|
struct devsw *devsw[] = {
|
2001-10-30 06:31:45 +00:00
|
|
|
#ifdef LOADER_DISK_SUPPORT
|
2001-10-15 14:35:39 +00:00
|
|
|
&ofwdisk,
|
2001-10-30 06:31:45 +00:00
|
|
|
#endif
|
|
|
|
#ifdef LOADER_NET_SUPPORT
|
|
|
|
&netdev,
|
|
|
|
#endif
|
2001-10-15 14:35:39 +00:00
|
|
|
0
|
|
|
|
};
|
|
|
|
struct arch_switch archsw;
|
|
|
|
|
|
|
|
struct file_format sparc64_elf = {
|
|
|
|
elf_loadfile,
|
|
|
|
elf_exec
|
|
|
|
};
|
|
|
|
struct file_format *file_formats[] = {
|
|
|
|
&sparc64_elf,
|
|
|
|
0
|
|
|
|
};
|
|
|
|
struct fs_ops *file_system[] = {
|
2002-02-23 04:04:30 +00:00
|
|
|
#ifdef LOADER_UFS_SUPPORT
|
2001-10-15 14:35:39 +00:00
|
|
|
&ufs_fsops,
|
2001-10-30 06:31:45 +00:00
|
|
|
#endif
|
2002-02-23 04:04:30 +00:00
|
|
|
#ifdef LOADER_NFS_SUPPORT
|
2001-10-30 06:31:45 +00:00
|
|
|
&nfs_fsops,
|
2002-02-23 04:04:30 +00:00
|
|
|
#endif
|
|
|
|
#ifdef LOADER_TFTP_SUPPORT
|
|
|
|
&tftp_fsops,
|
2001-10-30 06:31:45 +00:00
|
|
|
#endif
|
|
|
|
0
|
|
|
|
};
|
|
|
|
struct netif_driver *netif_drivers[] = {
|
|
|
|
#ifdef LOADER_NET_SUPPORT
|
|
|
|
&ofwnet,
|
|
|
|
#endif
|
2001-10-15 14:35:39 +00:00
|
|
|
0
|
|
|
|
};
|
|
|
|
|
|
|
|
extern struct console ofwconsole;
|
|
|
|
struct console *consoles[] = {
|
|
|
|
&ofwconsole,
|
|
|
|
0
|
|
|
|
};
|
|
|
|
|
2002-02-23 04:04:30 +00:00
|
|
|
#ifdef LOADER_DEBUG
|
|
|
|
static int
|
|
|
|
watch_phys_set_mask(vm_offset_t pa, u_long mask)
|
|
|
|
{
|
|
|
|
u_long lsucr;
|
|
|
|
|
|
|
|
stxa(AA_DMMU_PWPR, ASI_DMMU, pa & (((2UL << 38) - 1) << 3));
|
|
|
|
lsucr = ldxa(0, ASI_LSU_CTL_REG);
|
|
|
|
lsucr = ((lsucr | LSU_PW) & ~LSU_PM_MASK) |
|
|
|
|
(mask << LSU_PM_SHIFT);
|
|
|
|
stxa(0, ASI_LSU_CTL_REG, lsucr);
|
|
|
|
return (0);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
watch_phys_set(vm_offset_t pa, int sz)
|
|
|
|
{
|
|
|
|
u_long off;
|
|
|
|
|
|
|
|
off = (u_long)pa & 7;
|
|
|
|
/* Test for misaligned watch points. */
|
|
|
|
if (off + sz > 8)
|
|
|
|
return (-1);
|
|
|
|
return (watch_phys_set_mask(pa, ((1 << sz) - 1) << off));
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static int
|
|
|
|
watch_virt_set_mask(vm_offset_t va, u_long mask)
|
|
|
|
{
|
|
|
|
u_long lsucr;
|
|
|
|
|
|
|
|
stxa(AA_DMMU_VWPR, ASI_DMMU, va & (((2UL << 41) - 1) << 3));
|
|
|
|
lsucr = ldxa(0, ASI_LSU_CTL_REG);
|
|
|
|
lsucr = ((lsucr | LSU_VW) & ~LSU_VM_MASK) |
|
|
|
|
(mask << LSU_VM_SHIFT);
|
|
|
|
stxa(0, ASI_LSU_CTL_REG, lsucr);
|
|
|
|
return (0);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
watch_virt_set(vm_offset_t va, int sz)
|
|
|
|
{
|
|
|
|
u_long off;
|
|
|
|
|
|
|
|
off = (u_long)va & 7;
|
|
|
|
/* Test for misaligned watch points. */
|
|
|
|
if (off + sz > 8)
|
|
|
|
return (-1);
|
|
|
|
return (watch_virt_set_mask(va, ((1 << sz) - 1) << off));
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2001-10-15 14:35:39 +00:00
|
|
|
/*
|
|
|
|
* archsw functions
|
|
|
|
*/
|
|
|
|
static int
|
|
|
|
sparc64_autoload(void)
|
|
|
|
{
|
|
|
|
printf("nothing to autoload yet.\n");
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t
|
|
|
|
sparc64_readin(const int fd, vm_offset_t va, const size_t len)
|
|
|
|
{
|
|
|
|
mmu_mapin(va, len);
|
|
|
|
return read(fd, (void *)va, len);
|
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t
|
|
|
|
sparc64_copyin(const void *src, vm_offset_t dest, size_t len)
|
|
|
|
{
|
|
|
|
mmu_mapin(dest, len);
|
|
|
|
memcpy((void *)dest, src, len);
|
|
|
|
return len;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* other MD functions
|
|
|
|
*/
|
|
|
|
static int
|
|
|
|
elf_exec(struct preloaded_file *fp)
|
|
|
|
{
|
|
|
|
struct file_metadata *fmp;
|
|
|
|
vm_offset_t entry;
|
2001-10-30 06:31:45 +00:00
|
|
|
vm_offset_t mdp;
|
|
|
|
Elf_Ehdr *Ehdr;
|
|
|
|
int error;
|
2001-10-15 14:35:39 +00:00
|
|
|
|
|
|
|
if ((fmp = file_findmetadata(fp, MODINFOMD_ELFHDR)) == 0) {
|
|
|
|
return EFTYPE;
|
|
|
|
}
|
|
|
|
Ehdr = (Elf_Ehdr *)&fmp->md_data;
|
|
|
|
entry = Ehdr->e_entry;
|
|
|
|
|
2001-10-30 06:31:45 +00:00
|
|
|
if ((error = md_load(fp->f_args, &mdp)) != 0)
|
|
|
|
return error;
|
2001-10-15 14:35:39 +00:00
|
|
|
|
|
|
|
printf("jumping to kernel entry at 0x%lx.\n", entry);
|
|
|
|
#if 0
|
|
|
|
pmap_print_tlb('i');
|
|
|
|
pmap_print_tlb('d');
|
|
|
|
#endif
|
2001-10-30 06:31:45 +00:00
|
|
|
((kernel_entry_t *)entry)(mdp, 0, 0, 0, openfirmware);
|
|
|
|
|
|
|
|
panic("exec returned");
|
2001-10-15 14:35:39 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
mmu_mapin(vm_offset_t va, vm_size_t len)
|
|
|
|
{
|
2002-02-23 04:04:30 +00:00
|
|
|
vm_offset_t pa, mva;
|
2001-10-15 14:35:39 +00:00
|
|
|
|
|
|
|
if (va + len > curkva)
|
|
|
|
curkva = va + len;
|
|
|
|
|
2002-02-23 04:04:30 +00:00
|
|
|
pa = (vm_offset_t)-1;
|
2001-10-30 06:31:45 +00:00
|
|
|
len += va & PAGE_MASK_4M;
|
|
|
|
va &= ~PAGE_MASK_4M;
|
2001-10-15 14:35:39 +00:00
|
|
|
while (len) {
|
|
|
|
if (dtlb_va_to_pa(va) == (vm_offset_t)-1 ||
|
|
|
|
itlb_va_to_pa(va) == (vm_offset_t)-1) {
|
2002-02-23 04:04:30 +00:00
|
|
|
/* Allocate a physical page, claim the virtual area */
|
|
|
|
if (pa == (vm_offset_t)-1) {
|
|
|
|
pa = (vm_offset_t)OF_alloc_phys(PAGE_SIZE_4M,
|
|
|
|
PAGE_SIZE_4M);
|
|
|
|
if (pa == (vm_offset_t)-1)
|
|
|
|
panic("out of memory");
|
|
|
|
mva = (vm_offset_t)OF_claim_virt(va,
|
|
|
|
PAGE_SIZE_4M, 0);
|
|
|
|
if (mva != va) {
|
|
|
|
panic("can't claim virtual page "
|
|
|
|
"(wanted %#lx, got %#lx)",
|
|
|
|
va, mva);
|
|
|
|
}
|
|
|
|
/* The mappings may have changed, be paranoid. */
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
dtlb_enter(tlbslot, pa, va,
|
2001-10-15 14:35:39 +00:00
|
|
|
TD_V | TD_4M | TD_L | TD_CP | TD_CV | TD_P | TD_W);
|
2002-02-23 04:04:30 +00:00
|
|
|
itlb_enter(tlbslot, pa, va,
|
2001-10-15 14:35:39 +00:00
|
|
|
TD_V | TD_4M | TD_L | TD_CP | TD_CV | TD_P | TD_W);
|
|
|
|
tlbslot--;
|
2002-02-23 04:04:30 +00:00
|
|
|
pa = (vm_offset_t)-1;
|
2001-10-15 14:35:39 +00:00
|
|
|
}
|
2001-10-30 06:31:45 +00:00
|
|
|
len -= len > PAGE_SIZE_4M ? PAGE_SIZE_4M : len;
|
|
|
|
va += PAGE_SIZE_4M;
|
2001-10-15 14:35:39 +00:00
|
|
|
}
|
2002-02-23 04:04:30 +00:00
|
|
|
if (pa != (vm_offset_t)-1)
|
|
|
|
OF_release_phys(pa, PAGE_SIZE_4M);
|
2001-10-15 14:35:39 +00:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static vm_offset_t
|
|
|
|
init_heap(void)
|
|
|
|
{
|
|
|
|
if ((pmemh = OF_finddevice("/memory")) == (phandle_t)-1)
|
|
|
|
OF_exit();
|
2001-10-30 06:31:45 +00:00
|
|
|
if (OF_getprop(pmemh, "available", memslices, sizeof(memslices)) <= 0)
|
2001-10-15 14:35:39 +00:00
|
|
|
OF_exit();
|
|
|
|
|
|
|
|
/* There is no need for continuous physical heap memory. */
|
|
|
|
heapva = (vm_offset_t)OF_claim((void *)HEAPVA, HEAPSZ, 32);
|
|
|
|
return heapva;
|
|
|
|
}
|
|
|
|
|
2001-10-30 06:31:45 +00:00
|
|
|
int
|
|
|
|
main(int (*openfirm)(void *))
|
2001-10-15 14:35:39 +00:00
|
|
|
{
|
|
|
|
char bootpath[64];
|
|
|
|
struct devsw **dp;
|
|
|
|
phandle_t chosenh;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Tell the OpenFirmware functions where they find the ofw gate.
|
|
|
|
*/
|
2001-10-30 06:31:45 +00:00
|
|
|
OF_init(openfirm);
|
2001-10-15 14:35:39 +00:00
|
|
|
|
|
|
|
archsw.arch_getdev = ofw_getdev;
|
|
|
|
archsw.arch_copyin = sparc64_copyin;
|
|
|
|
archsw.arch_copyout = ofw_copyout;
|
|
|
|
archsw.arch_readin = sparc64_readin;
|
|
|
|
archsw.arch_autoload = sparc64_autoload;
|
|
|
|
|
|
|
|
init_heap();
|
|
|
|
setheap((void *)heapva, (void *)(heapva + HEAPSZ));
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Probe for a console.
|
|
|
|
*/
|
|
|
|
cons_probe();
|
|
|
|
|
|
|
|
bcache_init(32, 512);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Initialize devices.
|
|
|
|
*/
|
|
|
|
for (dp = devsw; *dp != 0; dp++) {
|
|
|
|
if ((*dp)->dv_init != 0)
|
|
|
|
(*dp)->dv_init();
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Set up the current device.
|
|
|
|
*/
|
|
|
|
chosenh = OF_finddevice("/chosen");
|
|
|
|
OF_getprop(chosenh, "bootpath", bootpath, sizeof(bootpath));
|
|
|
|
|
|
|
|
bootdev.d_type = ofw_devicetype(bootpath);
|
|
|
|
switch (bootdev.d_type) {
|
|
|
|
case DEVT_DISK:
|
|
|
|
bootdev.d_dev = &ofwdisk;
|
|
|
|
strncpy(bootdev.d_kind.ofwdisk.path, bootpath, 64);
|
|
|
|
ofw_parseofwdev(&bootdev, bootpath);
|
|
|
|
break;
|
|
|
|
case DEVT_NET:
|
2001-10-30 06:31:45 +00:00
|
|
|
bootdev.d_dev = &netdev;
|
2001-10-15 14:35:39 +00:00
|
|
|
strncpy(bootdev.d_kind.netif.path, bootpath, 64);
|
|
|
|
bootdev.d_kind.netif.unit = 0;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
env_setenv("currdev", EV_VOLATILE, ofw_fmtdev(&bootdev),
|
|
|
|
ofw_setcurrdev, env_nounset);
|
|
|
|
env_setenv("loaddev", EV_VOLATILE, ofw_fmtdev(&bootdev),
|
|
|
|
env_noset, env_nounset);
|
|
|
|
|
|
|
|
printf("%s\n", __progname);
|
|
|
|
printf("bootpath=\"%s\"\n", bootpath);
|
|
|
|
printf("loaddev=%s\n", getenv("loaddev"));
|
|
|
|
|
|
|
|
/* Give control to the machine independent loader code. */
|
|
|
|
interact();
|
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
|
2002-02-23 04:04:30 +00:00
|
|
|
COMMAND_SET(reboot, "reboot", "reboot the system", command_reboot);
|
|
|
|
|
|
|
|
static int
|
|
|
|
command_reboot(int argc, char *argv[])
|
|
|
|
{
|
|
|
|
int i;
|
|
|
|
|
|
|
|
for (i = 0; devsw[i] != NULL; ++i)
|
|
|
|
if (devsw[i]->dv_cleanup != NULL)
|
|
|
|
(devsw[i]->dv_cleanup)();
|
|
|
|
|
|
|
|
printf("Rebooting...\n");
|
|
|
|
OF_exit();
|
|
|
|
}
|
|
|
|
|
|
|
|
/* provide this for panic, as it's not in the startup code */
|
|
|
|
void
|
|
|
|
exit(int code)
|
|
|
|
{
|
|
|
|
OF_exit();
|
|
|
|
}
|
|
|
|
|
|
|
|
#ifdef LOADER_DEBUG
|
2001-10-15 14:35:39 +00:00
|
|
|
typedef u_int64_t tte_t;
|
|
|
|
|
|
|
|
const char *page_sizes[] = {
|
|
|
|
" 8k", " 64k", "512k", " 4m"
|
|
|
|
};
|
|
|
|
|
|
|
|
static void
|
|
|
|
pmap_print_tte(tte_t tag, tte_t tte)
|
|
|
|
{
|
|
|
|
printf("%s %s ",
|
|
|
|
page_sizes[(tte & TD_SIZE_MASK) >> TD_SIZE_SHIFT],
|
|
|
|
tag & TD_G ? "G" : " ");
|
|
|
|
printf(tte & TD_W ? "W " : " ");
|
|
|
|
printf(tte & TD_P ? "\e[33mP\e[0m " : " ");
|
|
|
|
printf(tte & TD_E ? "E " : " ");
|
|
|
|
printf(tte & TD_CV ? "CV " : " ");
|
|
|
|
printf(tte & TD_CP ? "CP " : " ");
|
|
|
|
printf(tte & TD_L ? "\e[32mL\e[0m " : " ");
|
|
|
|
printf(tte & TD_IE ? "IE " : " ");
|
|
|
|
printf(tte & TD_NFO ? "NFO " : " ");
|
2001-10-15 14:40:36 +00:00
|
|
|
printf("tag=0x%lx pa=0x%lx va=0x%lx ctx=%ld\n", tag, TD_PA(tte),
|
2001-10-15 14:35:39 +00:00
|
|
|
TT_VA(tag), TT_CTX(tag));
|
|
|
|
}
|
|
|
|
void
|
|
|
|
pmap_print_tlb(char which)
|
|
|
|
{
|
|
|
|
int i;
|
|
|
|
tte_t tte, tag;
|
|
|
|
|
|
|
|
for (i = 0; i < 64*8; i += 8) {
|
|
|
|
if (which == 'i') {
|
|
|
|
__asm__ __volatile__("ldxa [%1] %2, %0\n" :
|
|
|
|
"=r" (tag) : "r" (i),
|
|
|
|
"i" (ASI_ITLB_TAG_READ_REG));
|
|
|
|
__asm__ __volatile__("ldxa [%1] %2, %0\n" :
|
|
|
|
"=r" (tte) : "r" (i),
|
|
|
|
"i" (ASI_ITLB_DATA_ACCESS_REG));
|
|
|
|
}
|
|
|
|
else {
|
|
|
|
__asm__ __volatile__("ldxa [%1] %2, %0\n" :
|
|
|
|
"=r" (tag) : "r" (i),
|
|
|
|
"i" (ASI_DTLB_TAG_READ_REG));
|
|
|
|
__asm__ __volatile__("ldxa [%1] %2, %0\n" :
|
|
|
|
"=r" (tte) : "r" (i),
|
|
|
|
"i" (ASI_DTLB_DATA_ACCESS_REG));
|
|
|
|
}
|
|
|
|
if (!(tte & TD_V))
|
|
|
|
continue;
|
|
|
|
printf("%cTLB-%2u: ", which, i>>3);
|
|
|
|
pmap_print_tte(tag, tte);
|
|
|
|
}
|
|
|
|
}
|
2002-02-23 04:04:30 +00:00
|
|
|
#endif
|