main.c revision 101287
184996Srobert/* 284996Srobert * Initial implementation: 384996Srobert * Copyright (c) 2001 Robert Drehmel 484996Srobert * All rights reserved. 584996Srobert * 684996Srobert * As long as the above copyright statement and this notice remain 784996Srobert * unchanged, you can do what ever you want with this file. 884996Srobert * 984996Srobert * $FreeBSD: head/sys/boot/sparc64/loader/main.c 101287 2002-08-04 01:30:26Z jake $ 1084996Srobert */ 1184996Srobert/* 1284996Srobert * FreeBSD/sparc64 kernel loader - machine dependent part 1384996Srobert * 1484996Srobert * - implements copyin and readin functions that map kernel 1584996Srobert * pages on demand. The machine independent code does not 1684996Srobert * know the size of the kernel early enough to pre-enter 1784996Srobert * TTEs and install just one 4MB mapping seemed to limiting 1884996Srobert * to me. 1984996Srobert */ 2091139Sjake 2184996Srobert#include <stand.h> 2284996Srobert#include <sys/exec.h> 2384996Srobert#include <sys/param.h> 2484996Srobert#include <sys/linker.h> 2591139Sjake#include <sys/pcpu.h> 2697510Sjake#include <sys/queue.h> 2784996Srobert 2884996Srobert#include <machine/asi.h> 2991139Sjake#include <machine/atomic.h> 3091139Sjake#include <machine/cpufunc.h> 3184996Srobert#include <machine/elf.h> 3291110Sjake#include <machine/lsu.h> 3391110Sjake#include <machine/metadata.h> 3484996Srobert#include <machine/tte.h> 3591139Sjake#include <machine/upa.h> 3684996Srobert 3784996Srobert#include "bootstrap.h" 3884996Srobert#include "libofw.h" 3985719Sjake#include "dev_net.h" 4084996Srobert 4184996Srobertenum { 4284996Srobert HEAPVA = 0x800000, 4384996Srobert HEAPSZ = 0x1000000, 4484996Srobert LOADSZ = 0x1000000 /* for kernel and modules */ 4584996Srobert}; 4684996Srobert 4784996Srobertstruct memory_slice { 4884996Srobert vm_offset_t pstart; 4984996Srobert vm_offset_t size; 5084996Srobert}; 5184996Srobert 5285719Sjaketypedef void kernel_entry_t(vm_offset_t mdp, u_long o1, u_long o2, u_long o3, 5385719Sjake void *openfirmware); 5485719Sjake 5593678Stmmextern void itlb_enter(u_long vpn, u_long data); 5693678Stmmextern void dtlb_enter(u_long vpn, u_long data); 5784996Srobertextern vm_offset_t itlb_va_to_pa(vm_offset_t); 5884996Srobertextern vm_offset_t dtlb_va_to_pa(vm_offset_t); 5985719Sjakeextern vm_offset_t md_load(char *, vm_offset_t *); 6084996Srobertstatic int elf_exec(struct preloaded_file *); 6184996Srobertstatic int sparc64_autoload(void); 6284996Srobertstatic int mmu_mapin(vm_offset_t, vm_size_t); 6384996Srobert 64101287Sjakeextern char bootprog_name[], bootprog_rev[], bootprog_date[], bootprog_maker[]; 6584996Srobert 6697445Sjakestruct tlb_entry *dtlb_store; 6797445Sjakestruct tlb_entry *itlb_store; 6891139Sjake 6991139Sjakeint dtlb_slot; 7091139Sjakeint itlb_slot; 7191139Sjakeint dtlb_slot_max; 7291139Sjakeint itlb_slot_max; 7391139Sjake 7484996Srobertvm_offset_t curkva = 0; 7584996Srobertvm_offset_t heapva; 7684996Srobertphandle_t pmemh; /* OFW memory handle */ 7784996Srobert 7884996Srobertstruct memory_slice memslices[18]; 7984996Srobertstruct ofw_devdesc bootdev; 8084996Srobert 8184996Srobert/* 8284996Srobert * Machine dependent structures that the machine independent 8384996Srobert * loader part uses. 8484996Srobert */ 8584996Srobertstruct devsw *devsw[] = { 8685719Sjake#ifdef LOADER_DISK_SUPPORT 8784996Srobert &ofwdisk, 8885719Sjake#endif 8985719Sjake#ifdef LOADER_NET_SUPPORT 9085719Sjake &netdev, 9185719Sjake#endif 9284996Srobert 0 9384996Srobert}; 9484996Srobertstruct arch_switch archsw; 9584996Srobert 9684996Srobertstruct file_format sparc64_elf = { 9784996Srobert elf_loadfile, 9884996Srobert elf_exec 9984996Srobert}; 10084996Srobertstruct file_format *file_formats[] = { 10184996Srobert &sparc64_elf, 10284996Srobert 0 10384996Srobert}; 10484996Srobertstruct fs_ops *file_system[] = { 10591110Sjake#ifdef LOADER_UFS_SUPPORT 10684996Srobert &ufs_fsops, 10785719Sjake#endif 10893606Stmm#ifdef LOADER_CD9660_SUPPORT 10993606Stmm &cd9660_fsops, 11093606Stmm#endif 11191139Sjake#ifdef LOADER_NET_SUPPORT 11285719Sjake &nfs_fsops, 11385719Sjake#endif 11491110Sjake#ifdef LOADER_TFTP_SUPPORT 11591110Sjake &tftp_fsops, 11691110Sjake#endif 11784996Srobert 0 11884996Srobert}; 11985719Sjakestruct netif_driver *netif_drivers[] = { 12085719Sjake#ifdef LOADER_NET_SUPPORT 12185719Sjake &ofwnet, 12285719Sjake#endif 12385719Sjake 0 12485719Sjake}; 12584996Srobert 12684996Srobertextern struct console ofwconsole; 12784996Srobertstruct console *consoles[] = { 12884996Srobert &ofwconsole, 12984996Srobert 0 13084996Srobert}; 13184996Srobert 13291110Sjake#ifdef LOADER_DEBUG 13391110Sjakestatic int 13491110Sjakewatch_phys_set_mask(vm_offset_t pa, u_long mask) 13591110Sjake{ 13691110Sjake u_long lsucr; 13791110Sjake 13891110Sjake stxa(AA_DMMU_PWPR, ASI_DMMU, pa & (((2UL << 38) - 1) << 3)); 13991110Sjake lsucr = ldxa(0, ASI_LSU_CTL_REG); 14091110Sjake lsucr = ((lsucr | LSU_PW) & ~LSU_PM_MASK) | 14191110Sjake (mask << LSU_PM_SHIFT); 14291110Sjake stxa(0, ASI_LSU_CTL_REG, lsucr); 14391110Sjake return (0); 14491110Sjake} 14591110Sjake 14691110Sjakestatic int 14791110Sjakewatch_phys_set(vm_offset_t pa, int sz) 14891110Sjake{ 14991110Sjake u_long off; 15091110Sjake 15191110Sjake off = (u_long)pa & 7; 15291110Sjake /* Test for misaligned watch points. */ 15391110Sjake if (off + sz > 8) 15491110Sjake return (-1); 15591110Sjake return (watch_phys_set_mask(pa, ((1 << sz) - 1) << off)); 15691110Sjake} 15791110Sjake 15891110Sjake 15991110Sjakestatic int 16091110Sjakewatch_virt_set_mask(vm_offset_t va, u_long mask) 16191110Sjake{ 16291110Sjake u_long lsucr; 16391110Sjake 16491110Sjake stxa(AA_DMMU_VWPR, ASI_DMMU, va & (((2UL << 41) - 1) << 3)); 16591110Sjake lsucr = ldxa(0, ASI_LSU_CTL_REG); 16691110Sjake lsucr = ((lsucr | LSU_VW) & ~LSU_VM_MASK) | 16791110Sjake (mask << LSU_VM_SHIFT); 16891110Sjake stxa(0, ASI_LSU_CTL_REG, lsucr); 16991110Sjake return (0); 17091110Sjake} 17191110Sjake 17291110Sjakestatic int 17391110Sjakewatch_virt_set(vm_offset_t va, int sz) 17491110Sjake{ 17591110Sjake u_long off; 17691110Sjake 17791110Sjake off = (u_long)va & 7; 17891110Sjake /* Test for misaligned watch points. */ 17991110Sjake if (off + sz > 8) 18091110Sjake return (-1); 18191110Sjake return (watch_virt_set_mask(va, ((1 << sz) - 1) << off)); 18291110Sjake} 18391110Sjake#endif 18491110Sjake 18584996Srobert/* 18684996Srobert * archsw functions 18784996Srobert */ 18884996Srobertstatic int 18984996Srobertsparc64_autoload(void) 19084996Srobert{ 19184996Srobert printf("nothing to autoload yet.\n"); 19284996Srobert return 0; 19384996Srobert} 19484996Srobert 19584996Srobertstatic ssize_t 19684996Srobertsparc64_readin(const int fd, vm_offset_t va, const size_t len) 19784996Srobert{ 19884996Srobert mmu_mapin(va, len); 19984996Srobert return read(fd, (void *)va, len); 20084996Srobert} 20184996Srobert 20284996Srobertstatic ssize_t 20384996Srobertsparc64_copyin(const void *src, vm_offset_t dest, size_t len) 20484996Srobert{ 20584996Srobert mmu_mapin(dest, len); 20684996Srobert memcpy((void *)dest, src, len); 20784996Srobert return len; 20884996Srobert} 20984996Srobert 21084996Srobert/* 21184996Srobert * other MD functions 21284996Srobert */ 21384996Srobertstatic int 21484996Srobertelf_exec(struct preloaded_file *fp) 21584996Srobert{ 21684996Srobert struct file_metadata *fmp; 21785719Sjake vm_offset_t mdp; 21891139Sjake Elf_Ehdr *e; 21985719Sjake int error; 22084996Srobert 22184996Srobert if ((fmp = file_findmetadata(fp, MODINFOMD_ELFHDR)) == 0) { 22284996Srobert return EFTYPE; 22384996Srobert } 22491139Sjake e = (Elf_Ehdr *)&fmp->md_data; 22584996Srobert 22685719Sjake if ((error = md_load(fp->f_args, &mdp)) != 0) 22785719Sjake return error; 22884996Srobert 22991139Sjake printf("jumping to kernel entry at %#lx.\n", e->e_entry); 23084996Srobert#if 0 23184996Srobert pmap_print_tlb('i'); 23284996Srobert pmap_print_tlb('d'); 23384996Srobert#endif 23491139Sjake ((kernel_entry_t *)e->e_entry)(mdp, 0, 0, 0, openfirmware); 23585719Sjake 23685719Sjake panic("exec returned"); 23784996Srobert} 23884996Srobert 23984996Srobertstatic int 24084996Srobertmmu_mapin(vm_offset_t va, vm_size_t len) 24184996Srobert{ 24291110Sjake vm_offset_t pa, mva; 24397445Sjake u_long data; 24484996Srobert 24584996Srobert if (va + len > curkva) 24684996Srobert curkva = va + len; 24784996Srobert 24891110Sjake pa = (vm_offset_t)-1; 24985719Sjake len += va & PAGE_MASK_4M; 25085719Sjake va &= ~PAGE_MASK_4M; 25184996Srobert while (len) { 25284996Srobert if (dtlb_va_to_pa(va) == (vm_offset_t)-1 || 25384996Srobert itlb_va_to_pa(va) == (vm_offset_t)-1) { 25491110Sjake /* Allocate a physical page, claim the virtual area */ 25591110Sjake if (pa == (vm_offset_t)-1) { 25691110Sjake pa = (vm_offset_t)OF_alloc_phys(PAGE_SIZE_4M, 25791110Sjake PAGE_SIZE_4M); 25891110Sjake if (pa == (vm_offset_t)-1) 25991110Sjake panic("out of memory"); 26091110Sjake mva = (vm_offset_t)OF_claim_virt(va, 26191110Sjake PAGE_SIZE_4M, 0); 26291110Sjake if (mva != va) { 26391110Sjake panic("can't claim virtual page " 26491110Sjake "(wanted %#lx, got %#lx)", 26591110Sjake va, mva); 26691110Sjake } 26791110Sjake /* The mappings may have changed, be paranoid. */ 26891110Sjake continue; 26991110Sjake } 27093678Stmm /* 27193678Stmm * Actually, we can only allocate two pages less at 27293678Stmm * most (depending on the kernel TSB size). 27393678Stmm */ 27493678Stmm if (dtlb_slot >= dtlb_slot_max) 27593678Stmm panic("mmu_mapin: out of dtlb_slots"); 27693678Stmm if (itlb_slot >= itlb_slot_max) 27793678Stmm panic("mmu_mapin: out of itlb_slots"); 27897445Sjake data = TD_V | TD_4M | TD_PA(pa) | TD_L | TD_CP | 27991139Sjake TD_CV | TD_P | TD_W; 28097445Sjake dtlb_store[dtlb_slot].te_pa = pa; 28197445Sjake dtlb_store[dtlb_slot].te_va = va; 28297445Sjake itlb_store[itlb_slot].te_pa = pa; 28397445Sjake itlb_store[itlb_slot].te_va = va; 28497445Sjake dtlb_slot++; 28597445Sjake itlb_slot++; 28697445Sjake dtlb_enter(va, data); 28797445Sjake itlb_enter(va, data); 28891110Sjake pa = (vm_offset_t)-1; 28984996Srobert } 29085719Sjake len -= len > PAGE_SIZE_4M ? PAGE_SIZE_4M : len; 29185719Sjake va += PAGE_SIZE_4M; 29284996Srobert } 29391110Sjake if (pa != (vm_offset_t)-1) 29491110Sjake OF_release_phys(pa, PAGE_SIZE_4M); 29584996Srobert return 0; 29684996Srobert} 29784996Srobert 29884996Srobertstatic vm_offset_t 29984996Srobertinit_heap(void) 30084996Srobert{ 30184996Srobert if ((pmemh = OF_finddevice("/memory")) == (phandle_t)-1) 30284996Srobert OF_exit(); 30385719Sjake if (OF_getprop(pmemh, "available", memslices, sizeof(memslices)) <= 0) 30484996Srobert OF_exit(); 30584996Srobert 30684996Srobert /* There is no need for continuous physical heap memory. */ 30784996Srobert heapva = (vm_offset_t)OF_claim((void *)HEAPVA, HEAPSZ, 32); 30884996Srobert return heapva; 30984996Srobert} 31084996Srobert 31191139Sjakestatic void 31291139Sjaketlb_init(void) 31391139Sjake{ 31491139Sjake phandle_t child; 31591139Sjake phandle_t root; 31691139Sjake char buf[128]; 31791139Sjake u_int bootcpu; 31891139Sjake u_int cpu; 31991139Sjake 32091139Sjake bootcpu = UPA_CR_GET_MID(ldxa(0, ASI_UPA_CONFIG_REG)); 32191139Sjake if ((root = OF_peer(0)) == -1) 32291139Sjake panic("main: OF_peer"); 32391139Sjake for (child = OF_child(root); child != 0; child = OF_peer(child)) { 32491139Sjake if (child == -1) 32591139Sjake panic("main: OF_child"); 32691139Sjake if (OF_getprop(child, "device_type", buf, sizeof(buf)) > 0 && 32791139Sjake strcmp(buf, "cpu") == 0) { 32891139Sjake if (OF_getprop(child, "upa-portid", &cpu, 32996428Sjake sizeof(cpu)) == -1 && OF_getprop(child, "portid", 33096428Sjake &cpu, sizeof(cpu)) == -1) 33191139Sjake panic("main: OF_getprop"); 33291139Sjake if (cpu == bootcpu) 33391139Sjake break; 33491139Sjake } 33591139Sjake } 33691139Sjake if (cpu != bootcpu) 33791139Sjake panic("init_tlb: no node for bootcpu?!?!"); 33891139Sjake if (OF_getprop(child, "#dtlb-entries", &dtlb_slot_max, 33991139Sjake sizeof(dtlb_slot_max)) == -1 || 34091139Sjake OF_getprop(child, "#itlb-entries", &itlb_slot_max, 34191139Sjake sizeof(itlb_slot_max)) == -1) 34291139Sjake panic("init_tlb: OF_getprop"); 34391139Sjake dtlb_store = malloc(dtlb_slot_max * sizeof(*dtlb_store)); 34491139Sjake itlb_store = malloc(itlb_slot_max * sizeof(*itlb_store)); 34591139Sjake if (dtlb_store == NULL || itlb_store == NULL) 34691139Sjake panic("init_tlb: malloc"); 34791139Sjake} 34891139Sjake 34985719Sjakeint 35085719Sjakemain(int (*openfirm)(void *)) 35184996Srobert{ 35284996Srobert char bootpath[64]; 35384996Srobert struct devsw **dp; 35484996Srobert phandle_t chosenh; 35584996Srobert 35684996Srobert /* 35784996Srobert * Tell the OpenFirmware functions where they find the ofw gate. 35884996Srobert */ 35985719Sjake OF_init(openfirm); 36084996Srobert 36184996Srobert archsw.arch_getdev = ofw_getdev; 36284996Srobert archsw.arch_copyin = sparc64_copyin; 36384996Srobert archsw.arch_copyout = ofw_copyout; 36484996Srobert archsw.arch_readin = sparc64_readin; 36584996Srobert archsw.arch_autoload = sparc64_autoload; 36691139Sjake#ifdef ELF_CRC32 36791139Sjake archsw.arch_crc32 = sparc64_crc32; 36891139Sjake#endif 36984996Srobert 37084996Srobert init_heap(); 37184996Srobert setheap((void *)heapva, (void *)(heapva + HEAPSZ)); 37284996Srobert 37384996Srobert /* 37484996Srobert * Probe for a console. 37584996Srobert */ 37684996Srobert cons_probe(); 37784996Srobert 37891139Sjake tlb_init(); 37991139Sjake 38084996Srobert bcache_init(32, 512); 38184996Srobert 38284996Srobert /* 38384996Srobert * Initialize devices. 38484996Srobert */ 38584996Srobert for (dp = devsw; *dp != 0; dp++) { 38684996Srobert if ((*dp)->dv_init != 0) 38784996Srobert (*dp)->dv_init(); 38884996Srobert } 38984996Srobert 39084996Srobert /* 39184996Srobert * Set up the current device. 39284996Srobert */ 39384996Srobert chosenh = OF_finddevice("/chosen"); 39484996Srobert OF_getprop(chosenh, "bootpath", bootpath, sizeof(bootpath)); 39584996Srobert 39684996Srobert bootdev.d_type = ofw_devicetype(bootpath); 39784996Srobert switch (bootdev.d_type) { 39884996Srobert case DEVT_DISK: 39984996Srobert bootdev.d_dev = &ofwdisk; 40093606Stmm /* 40193606Stmm * Sun compatible bootable CD-ROMs have a disk label placed 40296755Strhodes * before the cd9660 data, with the actual filesystem being 40393606Stmm * in the first partition, while the other partitions contain 40493606Stmm * pseudo disk labels with embedded boot blocks for different 40596755Strhodes * architectures, which may be followed by UFS filesystems. 40693606Stmm * The firmware will set the boot path to the partition it 40793606Stmm * boots from ('f' in the sun4u case), but we want the kernel 40893606Stmm * to be loaded from the cd9660 fs ('a'), so the boot path 40993606Stmm * needs to be altered. 41093606Stmm */ 41193606Stmm if (strstr(bootpath, "cdrom") != NULL && 41293606Stmm bootpath[strlen(bootpath) - 2] == ':') { 41393606Stmm bootpath[strlen(bootpath) - 1] = 'a'; 41493606Stmm printf("Boot path set to %s\n", bootpath); 41593606Stmm } 41684996Srobert strncpy(bootdev.d_kind.ofwdisk.path, bootpath, 64); 41784996Srobert ofw_parseofwdev(&bootdev, bootpath); 41884996Srobert break; 41984996Srobert case DEVT_NET: 42085719Sjake bootdev.d_dev = &netdev; 42184996Srobert strncpy(bootdev.d_kind.netif.path, bootpath, 64); 42284996Srobert bootdev.d_kind.netif.unit = 0; 42384996Srobert break; 42484996Srobert } 42584996Srobert 42684996Srobert env_setenv("currdev", EV_VOLATILE, ofw_fmtdev(&bootdev), 42784996Srobert ofw_setcurrdev, env_nounset); 42884996Srobert env_setenv("loaddev", EV_VOLATILE, ofw_fmtdev(&bootdev), 42984996Srobert env_noset, env_nounset); 43084996Srobert 431101287Sjake printf("\n"); 432101287Sjake printf("%s, Revision %s\n", bootprog_name, bootprog_rev); 433101287Sjake printf("(%s, %s)\n", bootprog_maker, bootprog_date); 43484996Srobert printf("bootpath=\"%s\"\n", bootpath); 43584996Srobert printf("loaddev=%s\n", getenv("loaddev")); 43684996Srobert 43784996Srobert /* Give control to the machine independent loader code. */ 43884996Srobert interact(); 43984996Srobert return 1; 44084996Srobert} 44184996Srobert 44291110SjakeCOMMAND_SET(reboot, "reboot", "reboot the system", command_reboot); 44391110Sjake 44491110Sjakestatic int 44591110Sjakecommand_reboot(int argc, char *argv[]) 44691110Sjake{ 44791110Sjake int i; 44891110Sjake 44991110Sjake for (i = 0; devsw[i] != NULL; ++i) 45091110Sjake if (devsw[i]->dv_cleanup != NULL) 45191110Sjake (devsw[i]->dv_cleanup)(); 45291110Sjake 45391110Sjake printf("Rebooting...\n"); 45491110Sjake OF_exit(); 45591110Sjake} 45691110Sjake 45791110Sjake/* provide this for panic, as it's not in the startup code */ 45891110Sjakevoid 45991110Sjakeexit(int code) 46091110Sjake{ 46191110Sjake OF_exit(); 46291110Sjake} 46391110Sjake 46491110Sjake#ifdef LOADER_DEBUG 46584996Sroberttypedef u_int64_t tte_t; 46684996Srobert 46784996Srobertconst char *page_sizes[] = { 46884996Srobert " 8k", " 64k", "512k", " 4m" 46984996Srobert}; 47084996Srobert 47184996Srobertstatic void 47284996Srobertpmap_print_tte(tte_t tag, tte_t tte) 47384996Srobert{ 47484996Srobert printf("%s %s ", 47584996Srobert page_sizes[(tte & TD_SIZE_MASK) >> TD_SIZE_SHIFT], 47684996Srobert tag & TD_G ? "G" : " "); 47784996Srobert printf(tte & TD_W ? "W " : " "); 47884996Srobert printf(tte & TD_P ? "\e[33mP\e[0m " : " "); 47984996Srobert printf(tte & TD_E ? "E " : " "); 48084996Srobert printf(tte & TD_CV ? "CV " : " "); 48184996Srobert printf(tte & TD_CP ? "CP " : " "); 48284996Srobert printf(tte & TD_L ? "\e[32mL\e[0m " : " "); 48384996Srobert printf(tte & TD_IE ? "IE " : " "); 48484996Srobert printf(tte & TD_NFO ? "NFO " : " "); 48584997Srobert printf("tag=0x%lx pa=0x%lx va=0x%lx ctx=%ld\n", tag, TD_PA(tte), 48684996Srobert TT_VA(tag), TT_CTX(tag)); 48784996Srobert} 48884996Srobertvoid 48984996Srobertpmap_print_tlb(char which) 49084996Srobert{ 49184996Srobert int i; 49284996Srobert tte_t tte, tag; 49384996Srobert 49484996Srobert for (i = 0; i < 64*8; i += 8) { 49584996Srobert if (which == 'i') { 49684996Srobert __asm__ __volatile__("ldxa [%1] %2, %0\n" : 49784996Srobert "=r" (tag) : "r" (i), 49884996Srobert "i" (ASI_ITLB_TAG_READ_REG)); 49984996Srobert __asm__ __volatile__("ldxa [%1] %2, %0\n" : 50084996Srobert "=r" (tte) : "r" (i), 50184996Srobert "i" (ASI_ITLB_DATA_ACCESS_REG)); 50284996Srobert } 50384996Srobert else { 50484996Srobert __asm__ __volatile__("ldxa [%1] %2, %0\n" : 50584996Srobert "=r" (tag) : "r" (i), 50684996Srobert "i" (ASI_DTLB_TAG_READ_REG)); 50784996Srobert __asm__ __volatile__("ldxa [%1] %2, %0\n" : 50884996Srobert "=r" (tte) : "r" (i), 50984996Srobert "i" (ASI_DTLB_DATA_ACCESS_REG)); 51084996Srobert } 51184996Srobert if (!(tte & TD_V)) 51284996Srobert continue; 51384996Srobert printf("%cTLB-%2u: ", which, i>>3); 51484996Srobert pmap_print_tte(tag, tte); 51584996Srobert } 51684996Srobert} 51791110Sjake#endif 518