/* $NetBSD: vr.c,v 1.64 2011/03/18 15:31:38 tsutsui Exp $ */ /*- * Copyright (c) 1999-2002 * Shin Takemura and PocketBSD Project. 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. * 3. All advertising materials mentioning features or use of this software * must display the following acknowledgement: * This product includes software developed by the PocketBSD project * and its contributors. * 4. Neither the name of the project nor the names of its contributors * may be used to endorse or promote products derived from this software * without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``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 __KERNEL_RCSID(0, "$NetBSD: vr.c,v 1.64 2011/03/18 15:31:38 tsutsui Exp $"); #include "opt_vr41xx.h" #include "opt_tx39xx.h" #include "opt_kgdb.h" #define __INTR_PRIVATE #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "vrip_common.h" #if NVRIP_COMMON > 0 #include #endif #include "vrbcu.h" #if NVRBCU > 0 #include #endif #include "vrdsu.h" #if NVRDSU > 0 #include #endif #include "com.h" #include "com_vrip.h" #include "com_hpcio.h" #if NCOM > 0 #include #include #include #include #if NCOM_VRIP > 0 #include #include #endif #if NCOM_HPCIO > 0 #include #endif #ifndef CONSPEED #define CONSPEED TTYDEF_SPEED #endif #endif #include "hpcfb.h" #include "vrkiu.h" #if (NVRKIU > 0) || (NHPCFB > 0) #include #include #endif #if NHPCFB > 0 #include #endif #if NVRKIU > 0 #include #include #endif #ifdef DEBUG #define STATIC #else #define STATIC static #endif /* * This is a mask of bits to clear in the SR when we go to a * given interrupt priority level. */ const struct ipl_sr_map __ipl_sr_map_vr = { .sr_bits = { [IPL_NONE] = 0, [IPL_SOFTCLOCK] = MIPS_SOFT_INT_MASK_0, [IPL_SOFTNET] = MIPS_SOFT_INT_MASK, [IPL_VM] = MIPS_SOFT_INT_MASK | MIPS_INT_MASK_0, [IPL_SCHED] = MIPS_SOFT_INT_MASK | MIPS_INT_MASK_0 | MIPS_INT_MASK_1, [IPL_DDB] = MIPS_INT_MASK, [IPL_HIGH] = MIPS_INT_MASK, }, }; #if defined(VR41XX) && defined(TX39XX) #define VR_INTR vr_intr #else #define VR_INTR cpu_intr /* locore_mips3 directly call this */ #endif void vr_init(void); void VR_INTR(int, vaddr_t, uint32_t); extern void vr_idle(void); STATIC void vr_cons_init(void); STATIC void vr_fb_init(void **); STATIC void vr_mem_init(paddr_t); STATIC void vr_find_dram(paddr_t, paddr_t); STATIC void vr_reboot(int, char *); /* * CPU interrupt dispatch table (HwInt[0:3]) */ STATIC int vr_null_handler(void *, uint32_t, uint32_t); STATIC int (*vr_intr_handler[4])(void *, vaddr_t, uint32_t) = { vr_null_handler, vr_null_handler, vr_null_handler, vr_null_handler }; STATIC void *vr_intr_arg[4]; #if NCOM > 0 /* * machine dependent serial console info */ static struct vr_com_platdep { platid_mask_t *platidmask; int (*attach)(bus_space_tag_t, int, int, int, tcflag_t, int); int addr; int freq; } platdep_com_table[] = { #if NCOM_HPCIO > 0 { &platid_mask_MACH_NEC_MCR_SIGMARION2, com_hpcio_cndb_attach, /* attach proc */ 0x0b600000, /* base address */ COM_FREQ, /* frequency */ }, #endif #if NCOM_VRIP > 0 #ifdef VR4102 { &platid_mask_CPU_MIPS_VR_4102, com_vrip_cndb_attach, /* attach proc */ VR4102_SIU_ADDR, /* base address */ VRCOM_FREQ, /* frequency */ }, #endif /* VR4102 */ #ifdef VR4111 { &platid_mask_CPU_MIPS_VR_4111, com_vrip_cndb_attach, /* attach proc */ VR4102_SIU_ADDR, /* base address */ VRCOM_FREQ, /* frequency */ }, #endif /* VR4111 */ #ifdef VR4121 { &platid_mask_CPU_MIPS_VR_4121, com_vrip_cndb_attach, /* attach proc */ VR4102_SIU_ADDR, /* base address */ VRCOM_FREQ, /* frequency */ }, #endif /* VR4121 */ #ifdef VR4122 { &platid_mask_CPU_MIPS_VR_4122, com_vrip_cndb_attach, /* attach proc */ VR4122_SIU_ADDR, /* base address */ VRCOM_FREQ, /* frequency */ }, #endif /* VR4122 */ #ifdef VR4131 { &platid_mask_CPU_MIPS_VR_4122, com_vrip_cndb_attach, /* attach proc */ VR4122_SIU_ADDR, /* base address */ VRCOM_FREQ, /* frequency */ }, #endif /* VR4131 */ #ifdef SINGLE_VRIP_BASE { &platid_wild, com_vrip_cndb_attach, /* attach proc */ VRIP_SIU_ADDR, /* base address */ VRCOM_FREQ, /* frequency */ }, #endif /* SINGLE_VRIP_BASE */ #else /* NCOM_VRIP > 0 */ /* dummy */ { &platid_wild, NULL, /* attach proc */ 0, /* base address */ 0, /* frequency */ }, #endif /* NCOM_VRIP > 0 */ }; #endif /* NCOM > 0 */ #if NVRKIU > 0 /* * machine dependent keyboard info */ static struct vr_kiu_platdep { platid_mask_t *platidmask; int addr; } platdep_kiu_table[] = { #ifdef VR4102 { &platid_mask_CPU_MIPS_VR_4102, VR4102_KIU_ADDR, /* base address */ }, #endif /* VR4102 */ #ifdef VR4111 { &platid_mask_CPU_MIPS_VR_4111, VR4102_KIU_ADDR, /* base address */ }, #endif /* VR4111 */ #ifdef VR4121 { &platid_mask_CPU_MIPS_VR_4121, VR4102_KIU_ADDR, /* base address */ }, #endif /* VR4121 */ { &platid_wild, #ifdef SINGLE_VRIP_BASE VRIP_KIU_ADDR, /* base address */ #else VRIP_NO_ADDR, /* base address */ #endif /* SINGLE_VRIP_BASE */ }, }; #endif /* NVRKIU > 0 */ void vr_init(void) { /* * Platform Specific Function Hooks */ platform.cpu_idle = vr_idle; platform.cpu_intr = VR_INTR; platform.cons_init = vr_cons_init; platform.fb_init = vr_fb_init; platform.mem_init = vr_mem_init; platform.reboot = vr_reboot; #if NVRBCU > 0 sprintf(hpcmips_cpuname, "NEC %s rev%d.%d %d.%03dMHz", vrbcu_vrip_getcpuname(), vrbcu_vrip_getcpumajor(), vrbcu_vrip_getcpuminor(), vrbcu_vrip_getcpuclock() / 1000000, (vrbcu_vrip_getcpuclock() % 1000000) / 1000); #else sprintf(hpcmips_cpuname, "NEC VR41xx"); #endif } void vr_mem_init(paddr_t kernend) { mem_clusters[0].start = 0; mem_clusters[0].size = kernend; mem_cluster_cnt = 1; vr_find_dram(kernend, 0x02000000); vr_find_dram(0x02000000, 0x04000000); vr_find_dram(0x04000000, 0x06000000); vr_find_dram(0x06000000, 0x08000000); } void vr_find_dram(paddr_t addr, paddr_t end) { int n; char *page; #ifdef NARLY_MEMORY_PROBE int x, i; #endif #ifdef VR_FIND_DRAMLIM if (VR_FIND_DRAMLIM < end) end = VR_FIND_DRAMLIM; #endif /* VR_FIND_DRAMLIM */ n = mem_cluster_cnt; for (; addr < end; addr += PAGE_SIZE) { page = (char *)MIPS_PHYS_TO_KSEG1(addr); /* XXX see port-hpcmips/42934 if (badaddr(page, 4)) goto bad; */ /* stop memory probing at first memory image */ if (memcmp(page, (void *)MIPS_PHYS_TO_KSEG0(0), 128) == 0) return; *(volatile int *)(page+0) = 0xa5a5a5a5; *(volatile int *)(page+4) = 0x5a5a5a5a; wbflush(); if (*(volatile int *)(page+0) != 0xa5a5a5a5) goto bad; *(volatile int *)(page+0) = 0x5a5a5a5a; *(volatile int *)(page+4) = 0xa5a5a5a5; wbflush(); if (*(volatile int *)(page+0) != 0x5a5a5a5a) goto bad; #ifdef NARLY_MEMORY_PROBE x = random(); for (i = 0; i < PAGE_SIZE; i += 4) *(volatile int *)(page+i) = (x ^ i); wbflush(); for (i = 0; i < PAGE_SIZE; i += 4) if (*(volatile int *)(page+i) != (x ^ i)) goto bad; x = random(); for (i = 0; i < PAGE_SIZE; i += 4) *(volatile int *)(page+i) = (x ^ i); wbflush(); for (i = 0; i < PAGE_SIZE; i += 4) if (*(volatile int *)(page+i) != (x ^ i)) goto bad; #endif /* NARLY_MEMORY_PROBE */ if (!mem_clusters[n].size) mem_clusters[n].start = addr; mem_clusters[n].size += PAGE_SIZE; continue; bad: if (mem_clusters[n].size) ++n; continue; } if (mem_clusters[n].size) ++n; mem_cluster_cnt = n; } void vr_fb_init(void **kernend) { /* Nothing to do */ } void vr_cons_init(void) { #if NCOM > 0 || NHPCFB > 0 || NVRKIU > 0 bus_space_tag_t iot = hpcmips_system_bus_space(); #endif #if NCOM > 0 static struct vr_com_platdep *com_info; #endif #if NVRKIU > 0 static struct vr_kiu_platdep *kiu_info; #endif #if NCOM > 0 com_info = platid_search(&platid, platdep_com_table, sizeof(platdep_com_table)/sizeof(*platdep_com_table), sizeof(*platdep_com_table)); #ifdef KGDB if (com_info->attach != NULL) { /* if KGDB is defined, always use the serial port for KGDB */ if ((*com_info->attach)(iot, com_info->addr, 9600, com_info->freq, (TTYDEF_CFLAG & ~(CSIZE | PARENB)) | CS8, 1)) { printf("%s(%d): can't init kgdb's serial port", __FILE__, __LINE__); } } #else /* KGDB */ if (com_info->attach != NULL && (bootinfo->bi_cnuse&BI_CNUSE_SERIAL)) { /* Serial console */ if ((*com_info->attach)(iot, com_info->addr, CONSPEED, com_info->freq, (TTYDEF_CFLAG & ~(CSIZE | PARENB)) | CS8, 0)) { printf("%s(%d): can't init serial console", __FILE__, __LINE__); } else { return; } } #endif /* KGDB */ #endif /* NCOM > 0 */ #if NHPCFB > 0 if (hpcfb_cnattach(NULL)) { printf("%s(%d): can't init fb console", __FILE__, __LINE__); } else { goto find_keyboard; } find_keyboard: #endif /* NHPCFB > 0 */ #if NVRKIU > 0 kiu_info = platid_search(&platid, platdep_kiu_table, sizeof(platdep_kiu_table)/sizeof(*platdep_kiu_table), sizeof(*platdep_kiu_table)); if (kiu_info->addr != VRIP_NO_ADDR) { if (vrkiu_cnattach(iot, kiu_info->addr)) { printf("%s(%d): can't init vrkiu as console", __FILE__, __LINE__); } else { return; } } #endif /* NVRKIU > 0 */ } extern char vr_hibernate[]; extern char evr_hibernate[]; void vr_reboot(int howto, char *bootstr) { /* * power down */ if ((howto & RB_POWERDOWN) == RB_POWERDOWN) { printf("fake powerdown\n"); /* * copy vr_hibernate() to top of physical memory. */ memcpy((void *)MIPS_KSEG0_START, vr_hibernate, evr_hibernate - (char *)vr_hibernate); /* sync I&D cache */ mips_dcache_wbinv_all(); mips_icache_sync_all(); /* * call vr_hibernate() at MIPS_KSEG0_START. */ ((void (*)(void *,int))MIPS_KSEG0_START)( (void *)MIPS_KSEG0_START, ptoa(physmem)); /* not reach */ vr_reboot(howto&~RB_HALT, bootstr); } /* * halt */ if (howto & RB_HALT) { #if NVRIP_COMMON > 0 vrip_splpiu(); vrip_intr_suspend(); #else splhigh(); #endif __asm(".set noreorder"); __asm(".word " ___STRING(VR_OPCODE_SUSPEND)); __asm("nop"); __asm("nop"); __asm("nop"); __asm("nop"); __asm("nop"); __asm(".set reorder"); #if NVRIP_COMMON > 0 vrip_intr_resume(); #endif } /* * reset */ #if NVRDSU vrdsu_reset(); #else printf("%s(%d): There is no DSU.", __FILE__, __LINE__); #endif } /* * Handle interrupts. */ void VR_INTR(int ppl, vaddr_t pc, uint32_t status) { uint32_t ipending; int ipl; while (ppl < (ipl = splintr(&ipending))) { /* Deal with unneded compare interrupts occasionally so that * we can keep spllowersoftclock. */ if (ipending & MIPS_INT_MASK_5) { mips3_cp0_compare_write(0); } if (ipending & MIPS_INT_MASK_1) { (*vr_intr_handler[1])(vr_intr_arg[1], pc, status); } if (ipending & MIPS_INT_MASK_0) { (*vr_intr_handler[0])(vr_intr_arg[0], pc, status); } } } void * vr_intr_establish(int line, int (*ih_fun)(void *, vaddr_t, uint32_t), void *ih_arg) { KDASSERT(vr_intr_handler[line] == vr_null_handler); vr_intr_handler[line] = ih_fun; vr_intr_arg[line] = ih_arg; return ((void *)line); } void vr_intr_disestablish(void *ih) { int line = (int)ih; vr_intr_handler[line] = vr_null_handler; vr_intr_arg[line] = NULL; } int vr_null_handler(void *arg, vaddr_t pc, uint32_t status) { printf("vr_null_handler\n"); return (0); } /* int x4181 = VR4181; int x4101 = VR4101; int x4102 = VR4102; int x4111 = VR4111; int x4121 = VR4121; int x4122 = VR4122; int xo4181 = ONLY_VR4181; int xo4101 = ONLY_VR4101; int xo4102 = ONLY_VR4102; int xo4111_4121 = ONLY_VR4111_4121; int g4101=VRGROUP_4101; int g4102=VRGROUP_4102; int g4181=VRGROUP_4181; int g4102_4121=VRGROUP_4102_4121; int g4111_4121=VRGROUP_4111_4121; int g4102_4122=VRGROUP_4102_4122; int g4111_4122=VRGROUP_4111_4122; int single_vrip_base=SINGLE_VRIP_BASE; int vrip_base_addr=VRIP_BASE_ADDR; */