openbios.patch-22.bz2 from blueswirl

git-svn-id: svn://coreboot.org/openbios/openbios-devel@49 f158a5a8-5612-0410-a976-696ce0be7e32

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();

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

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
 {

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)

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

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;
+    intregs = map_io(base + offset, sizeof(*intregs));
+    intregs->set = ~SUN4M_INT_MASKALL;
+    intregs->cpu_intregs[0].clear = ~0x17fff;
 
-    // is this really correct?
-    PUSH(regs);
+    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;
 }
 
 

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;