diff --git a/arch/sparc32/console.c b/arch/sparc32/console.c index ac2b931..590dc57 100644 --- a/arch/sparc32/console.c +++ b/arch/sparc32/console.c @@ -153,17 +153,7 @@ static void video_cls(void) void tcx_init(unsigned long base) { -#if 1 - unsigned int i; - - // Create 1:1 mapping for video memory - for (i = 0; i < VMEM_SIZE; i += 4096) { - map_page(base + VMEM_BASE + i, base + VMEM_BASE + i, 0); - } - vmem = (char *)base + VMEM_BASE; -#else vmem = map_io(base + VMEM_BASE, VMEM_SIZE); -#endif dac = map_io(base + DAC_BASE, DAC_SIZE); console_init(); diff --git a/arch/sparc32/entry.S b/arch/sparc32/entry.S index 89ac188..ef3e8fa 100644 --- a/arch/sparc32/entry.S +++ b/arch/sparc32/entry.S @@ -11,7 +11,8 @@ #include "asi.h" #include "asm/crs.h" -#define PHYS_JJ_EEPROM 0x71200000 +#define PHYS_JJ_EEPROM 0x71200000 /* [2000] MK48T08 */ +#define PHYS_JJ_INTR0 0x71E00000 /* CPU0 interrupt control registers */ #define WRITE_PAUSE nop; nop; nop; /* Have to do this after %wim/%psr chg */ @@ -35,6 +36,35 @@ entry: */ /* XXX no switching yet */ + ! Check if this not the first SMP CPU, if so, bypass PROM entirely + set PHYS_JJ_EEPROM + 0x2E, %g1 + lduba [%g1] ASI_M_BYPASS, %g2 + tst %g2 + bz first_cpu + nop + + set PHYS_JJ_INTR0 + 0x04, %g1 + sll %g2, 12, %g2 + add %g1, %g2, %g2 + set 0xffffffff, %g1 + sta %g1, [%g2] ASI_M_BYPASS ! clear softints + add %g2, 4, %g2 + sta %g0, [%g2] ASI_M_BYPASS ! clear softints + set PHYS_JJ_EEPROM + 0x3C, %g1 + lda [%g1] ASI_M_BYPASS, %g1 + set AC_M_CTPR, %g2 + sta %g1, [%g2] ASI_M_MMUREGS ! set ctx table ptr + set PHYS_JJ_EEPROM + 0x40, %g1 + lda [%g1] ASI_M_BYPASS, %g1 + set AC_M_CXR, %g2 + sta %g1, [%g2] ASI_M_MMUREGS ! set context + set PHYS_JJ_EEPROM + 0x38, %g1 + lda [%g1] ASI_M_BYPASS, %g2 + set 1, %g1 + jmp %g2 ! jump to kernel + sta %g1, [%g0] ASI_M_MMUREGS ! enable mmu + +first_cpu: set PHYS_JJ_EEPROM + 0x30, %g1 lda [%g1] ASI_M_BYPASS, %g1 ! map PROLDATA to PROLBASE+PROLSIZE to end of ram diff --git a/arch/sparc32/ldscript b/arch/sparc32/ldscript index 884ca07..4e79b5d 100644 --- a/arch/sparc32/ldscript +++ b/arch/sparc32/ldscript @@ -14,7 +14,7 @@ BASE_ADDR = 0xffd00000; HEAP_SIZE = 16384; STACK_SIZE = 16384; VMEM_SIZE = 128 * 1024; -IOMEM_SIZE = 256 * 1024; +IOMEM_SIZE = 256 * 1024 + 768 * 1024; SECTIONS { diff --git a/arch/sparc32/romvec.c b/arch/sparc32/romvec.c index be02065..e3d56c5 100644 --- a/arch/sparc32/romvec.c +++ b/arch/sparc32/romvec.c @@ -366,30 +366,27 @@ static int obp_inst2pkg(int dev_desc) return ret; } +extern int start_cpu(unsigned int pc, unsigned int context_ptr, + unsigned int context, int cpu); + static int obp_cpustart(__attribute__((unused))unsigned int whichcpu, __attribute__((unused))int ctxtbl_ptr, __attribute__((unused))int thiscontext, __attribute__((unused))char *prog_counter) { - //int cpu, found; -#ifdef CONFIG_DEBUG_OBP + int cpu, found; struct linux_prom_registers *smp_ctable = (void *)ctxtbl_ptr; -#endif DPRINTF("obp_cpustart: cpu %d, ctxptr 0x%x, ctx %d, pc 0x%x\n", whichcpu, smp_ctable->phys_addr, thiscontext, (unsigned int)prog_counter); -#if 0 + found = obp_getprop(whichcpu, "mid", (char *)&cpu); if (found == -1) return -1; - st_bypass(PHYS_JJ_EEPROM + 0x38, (unsigned int)prog_counter); - st_bypass(PHYS_JJ_EEPROM + 0x3C, ((unsigned int)smp_ctable->phys_addr) >> 4); - st_bypass(PHYS_JJ_EEPROM + 0x40, thiscontext); - DPRINTF("obp_cpustart: sending interrupt to CPU %d\n", cpu); - st_bypass(PHYS_JJ_INTR0 + 0x1000 * cpu + 8, 0x40000000); -#endif + DPRINTF("cpu found, id %d -> cpu %d\n", whichcpu, cpu); - return 0; + return start_cpu((unsigned int)prog_counter, ((unsigned int)smp_ctable->phys_addr) >> 4, + thiscontext, cpu); } static int obp_cpustop(__attribute__((unused)) unsigned int whichcpu) diff --git a/arch/sparc32/tree.fs b/arch/sparc32/tree.fs index 3f54699..7f872ba 100644 --- a/arch/sparc32/tree.fs +++ b/arch/sparc32/tree.fs @@ -28,35 +28,6 @@ new-device \ release ( phys size -- ) finish-device -new-device - " FMI,MB86904" device-name - " cpu" device-type - - \ 0 encode-int 0 encode-int encode+ 0 encode-int encode+ " context-table" property - 0 encode-int " implementation" property - d# 4 encode-int " version" property - - d# 32 encode-int " cache-line-size" property - d# 512 encode-int " cache-nlines" property - - d# 4096 encode-int " page-size" property - - d# 16 encode-int " dcache-line-size" property - d# 512 encode-int " dcache-nlines" property - d# 1 encode-int " dcache-associativity" property - - d# 16 encode-int " icache-line-size" property - d# 512 encode-int " icache-nlines" property - d# 1 encode-int " icache-associativity" property - - d# 2 encode-int " ncaches" property - d# 256 encode-int " mmu-nctx" property - d# 8 encode-int " sparc-version" property - d# 37 encode-int " mask_rev" property - - \ 1 encode-int " mid" property -finish-device - new-device " iommu" device-name 2 encode-int " #address-cells" property diff --git a/drivers/obio.c b/drivers/obio.c index e83b64d..de71919 100644 --- a/drivers/obio.c +++ b/drivers/obio.c @@ -148,6 +148,8 @@ ob_nvram_init(unsigned long base, unsigned long offset) extern uint32_t cmdline_size; extern char boot_device; + unsigned int i; + ob_new_obio_device("eeprom", NULL); nvram = (char *)ob_reg(base, offset, NVRAM_SIZE, 1); @@ -170,6 +172,7 @@ ob_nvram_init(unsigned long base, unsigned long offset) fword("finish-device"); + // Add /idprom push_str("/"); fword("find-device"); @@ -178,6 +181,103 @@ ob_nvram_init(unsigned long base, unsigned long offset) fword("encode-bytes"); push_str("idprom"); fword("property"); + + // Add cpus + printk("CPUs: %x\n", nv_info.smp_cpus); + for (i = 0; i < (unsigned int)nv_info.smp_cpus; i++) { + push_str("/"); + fword("find-device"); + + fword("new-device"); + + push_str("FMI,MB86904"); + fword("device-name"); + + push_str("cpu"); + fword("device-type"); + + PUSH(0); + fword("encode-int"); + push_str("implementation"); + fword("property"); + + PUSH(4); + fword("encode-int"); + push_str("version"); + fword("property"); + + PUSH(32); + fword("encode-int"); + push_str("cache-line-size"); + fword("property"); + + PUSH(512); + fword("encode-int"); + push_str("cache-nlines"); + fword("property"); + + PUSH(4096); + fword("encode-int"); + push_str("page-size"); + fword("property"); + + PUSH(16); + fword("encode-int"); + push_str("dcache-line-size"); + fword("property"); + + PUSH(512); + fword("encode-int"); + push_str("dcache-nlines"); + fword("property"); + + PUSH(1); + fword("encode-int"); + push_str("dcache-associativity"); + fword("property"); + + PUSH(16); + fword("encode-int"); + push_str("icache-line-size"); + fword("property"); + + PUSH(512); + fword("encode-int"); + push_str("icache-nlines"); + fword("property"); + + PUSH(1); + fword("encode-int"); + push_str("icache-associativity"); + fword("property"); + + PUSH(2); + fword("encode-int"); + push_str("ncaches"); + fword("property"); + + PUSH(256); + fword("encode-int"); + push_str("mmu-nctx"); + fword("property"); + + PUSH(8); + fword("encode-int"); + push_str("sparc-version"); + fword("property"); + + PUSH(37); + fword("encode-int"); + push_str("mask_rev"); + fword("property"); + + PUSH(i << 3); + fword("encode-int"); + push_str("mid"); + fword("property"); + + fword("finish-device"); + } } static void @@ -259,10 +359,11 @@ ob_counter_init(unsigned long base, unsigned long offset) regs->cpu_timers[0].l14_timer_limit = 0; } +static volatile struct sun4m_intregs *intregs; + static void ob_interrupt_init(unsigned long base, unsigned long offset) { - volatile struct sun4m_intregs *regs; ob_new_obio_device("interrupt", NULL); @@ -286,21 +387,35 @@ ob_interrupt_init(unsigned long base, unsigned long offset) push_str("reg"); fword("property"); - regs = map_io(base + offset, sizeof(*regs)); - regs->set = ~SUN4M_INT_MASKALL; - regs->cpu_intregs[0].clear = ~0x17fff; - - // is this really correct? - PUSH(regs); + intregs = map_io(base + offset, sizeof(*intregs)); + intregs->set = ~SUN4M_INT_MASKALL; + intregs->cpu_intregs[0].clear = ~0x17fff; + + PUSH(0); fword("encode-int"); - PUSH(regs); + PUSH((int)intregs); fword("encode-int"); fword("encode+"); push_str("address"); fword("property"); fword("finish-device"); +} +int +start_cpu(unsigned int pc, unsigned int context_ptr, unsigned int context, int cpu) +{ + if (!cpu) + return -1; + + nvram[0x38] = pc; + nvram[0x3c] = context_ptr; + nvram[0x40] = context; + nvram[0x2e] = cpu & 0xff; + + intregs->cpu_intregs[cpu].set = SUN4M_SOFT_INT(14); + + return 0; } diff --git a/drivers/obio.h b/drivers/obio.h index 0c2bdd8..85f33a1 100644 --- a/drivers/obio.h +++ b/drivers/obio.h @@ -37,6 +37,7 @@ struct qemu_nvram_v1 { uint32_t nvram_size; // not used in Sun4m char unused1[8]; char arch[12]; + char curr_cpu; char smp_cpus; char unused2; char nographic;