/* $Id: startz.S,v 1.1.1.1 2006/09/14 01:59:08 root Exp $ */ /* * Copyright (c) 2001 Opsycon AB (www.opsycon.se) * * 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 Opsycon AB, Sweden. * 4. The name of the author may not be used to endorse or promote products * derived from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 AUTHOR 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. * */ #ifndef _KERNEL #define _KERNEL #endif #include #include #include #include #include "pmon/dev/ns16550.h" #include "target/i82371eb.h" #include "target/prid.h" #include "target/sbd.h" #include "target/bonito.h" #include "target/i8254.h" #include "target/pc97307.h" #include "target/isapnpreg.h" #define DEBUG_LOCORE #undef DEBUG_DIMM_SPD #ifdef DEBUG_LOCORE #define TTYDBG(x) \ .rdata;98: .asciz x; .text; la a0, 98b; bal stringserial; nop #else #define TTYDBG(x) #endif #define PRINTSTR(x) \ .rdata;98: .asciz x; .text; la a0, 98b; bal stringserial; nop #define CONFIG_CACHE_64K_4WAY 1 #define tmpsize s1 #define msize s2 #define sdShape s3 #define bonito s4 #define dbg s5 #define sdCfg s6 #define CFG_IB 0x00000020 #define CFG_DB 0x00000010 #define CFG_C_WBACK 3 #define CFG_BE 0x00008000 #define CFG_EPMASK 0x0f000000 #define CFG_EPD 0x00000000 #define CFG_EM_R4K 0x00000000 #define CFG_EMMASK 0x00c00000 #define CFG_AD 0x00800000 #define CP0_CONFIG $16 #define CP0_TAGLO $28 #define CP0_TAGHI $29 #define DDR100 0x1d441091 /* #define DDR100 0x0c011091*/ #define DDR266 0x0410435e #define DDR300 0x041453df /* * Register usage: * * s0 link versus load offset, used to relocate absolute adresses. * s1 free * s2 memory size. * s3 sdShape. * s4 Bonito base address. * s5 dbg. * s6 sdCfg. * s7 rasave. * s8 L3 Cache size. */ .set noreorder .globl _start .globl start .globl __main _start: start: .globl stack stack = start - 0x4000 /* Place PMON stack below PMON start in RAM */ /* NOTE!! Not more that 16 instructions here!!! Right now it's FULL! */ mtc0 zero, COP_0_STATUS_REG mtc0 zero, COP_0_CAUSE_REG li t0, SR_BOOT_EXC_VEC /* Exception to Boostrap Location */ mtc0 t0, COP_0_STATUS_REG la sp, stack la gp, _gp bal uncached /* Switch to uncached address space */ nop bal locate /* Get current execute address */ nop uncached: or ra, UNCACHED_MEMORY_ADDR j ra nop /* * Exception vectors here for rom, before we are up and running. Catch * whatever comes up before we have a fully fledged exception handler. */ .align 8 nop .align 8 .word read .word write .word open .word close .word nullfunction .word printf .word vsprintf .word nullfunction .word nullfunction .word getenv .word nullfunction .word nullfunction .word nullfunction .word nullfunction /* * We get here from executing a bal to get the PC value of the current execute * location into ra. Check to see if we run from ROM or if this is ramloaded. */ locate: la s0,start subu s0,ra,s0 and s0,0xffff0000 li t0,SR_BOOT_EXC_VEC mtc0 t0,COP_0_STATUS_REG mtc0 zero,COP_0_CAUSE_REG .set noreorder li bonito,PHYS_TO_UNCACHED(BONITO_REG_BASE) #define MOD_MASK 0x00000003 #define MOD_B 0x00000000 /* byte "modifier" */ #define MOD_H 0x00000001 /* halfword "modifier" */ #define MOD_W 0x00000002 /* word "modifier" */ #if __mips64 # define MOD_D 0x00000003 /* doubleword "modifier" */ #endif #define OP_MASK 0x000000fc #define OP_EXIT 0x00000000 /* exit (status) */ #define OP_DELAY 0x00000008 /* delay (cycles) */ #define OP_RD 0x00000010 /* read (addr) */ #define OP_WR 0x00000014 /* write (addr, val) */ #define OP_RMW 0x00000018 /* read-modify-write (addr, and, or) */ #define OP_WAIT 0x00000020 /* wait (addr, mask, value) */ #define WR_INIT(mod,addr,val) \ .word OP_WR|mod,PHYS_TO_UNCACHED(addr);\ .word (val),0 #define RD_INIT(mod,addr) \ .word OP_RD|mod,PHYS_TO_UNCACHED(addr);\ .word 0,0 #define RMW_INIT(mod,addr,and,or) \ .word OP_RMW|mod,PHYS_TO_UNCACHED(addr);\ .word (and),(or) #define WAIT_INIT(mod,addr,and,or) \ .word OP_WAIT|mod,PHYS_TO_UNCACHED(addr);\ .word (mask),(val) #define DELAY_INIT(cycles) \ .word OP_DELAY,(cycles);\ .word 0,0 #define EXIT_INIT(status) \ .word OP_EXIT,(status);\ .word 0,0 #define BONITO_INIT(r,v) WR_INIT(MOD_W,BONITO_BASE+/**/r,v) #define BONITO_BIS(r,b) RMW_INIT(MOD_W,BONITO_BASE+(r),~0,b) #define BONITO_BIC(r,b) RMW_INIT(MOD_W,BONITO_BASE+(r),~(b),0) #define BONITO_RMW(r,c,s) RMW_INIT(MOD_W,BONITO_BASE+(r),~(c),s) #define CFGADDR(idsel,function,reg) ((1<<(11+(idsel)))+((function)<<8)+(reg)) #define _ISABWR_INIT(mod,function,isabreg,val) \ WR_INIT(MOD_W,BONITO_BASE+BONITO_PCIMAP_CFG,CFGADDR(PCI_IDSEL_VIA686B,function,isabreg)>>16) ; \ RD_INIT(MOD_W,BONITO_BASE+BONITO_PCIMAP_CFG) ; \ WR_INIT(mod,PCI_CFG_SPACE+(CFGADDR(PCI_IDSEL_VIA686B,function,isabreg)&0xffff),val) #define _ISABRD_INIT(mod,function,isabreg) \ WR_INIT(MOD_W,BONITO_BASE+BONITO_PCIMAP_CFG,CFGADDR(PCI_IDSEL_VIA686B,function,isabreg)>>16) ; \ RD_INIT(MOD_W,BONITO_BASE+BONITO_PCIMAP_CFG) ; \ RD_INIT(mod,PCI_CFG_SPACE+(CFGADDR(PCI_IDSEL_VIA686B,function,isabreg)&0xffff)) #define _ISAWR_INIT(isareg,val) \ WR_INIT(MOD_B,PCI_IO_SPACE+(isareg),val) #define _ISARD_INIT(isareg) \ RD_INIT(MOD_B,PCI_IO_SPACE+(isareg)) #define ISABBWR_INIT(function,isabreg,val) \ _ISABWR_INIT(MOD_B,function,(isabreg),val) #define ISABHWR_INIT(function,isabreg,val) \ _ISABWR_INIT(MOD_H,function,(isabreg),val) #define ISABWWR_INIT(function,isabreg,val) \ _ISABWR_INIT(MOD_W,function,isabreg,val) #define ISAWR_INIT(isareg,val) \ _ISAWR_INIT(isareg,val) #define ISARD_INIT(isareg) \ _ISARD_INIT(isareg) bal 1f nop /* * In certain situations it is possible for the Bonito ASIC * to come up with the PCI registers uninitialised, so do them here */ #define PCI_CLASS_BRIDGE 0x06 #define PCI_CLASS_SHIFT 24 #define PCI_SUBCLASS_BRIDGE_HOST 0x00 #define PCI_SUBCLASS_SHIFT 16 #define PCI_COMMAND_IO_ENABLE 0x00000001 #define PCI_COMMAND_MEM_ENABLE 0x00000002 #define PCI_COMMAND_MASTER_ENABLE 0x00000004 #define PCI_COMMAND_STATUS_REG 0x04 #define PCI_MAP_IO 0X00000001 #define PCI_DEV_VIA686B 17 #define PCI_CFG_SPACE BONITO_PCICFG_BASE #define Init_Op 0 #define Init_A0 4 #define Init_A1 8 #define Init_A2 12 #define Init_Size 16 1: move a0,ra .done: /* plj. initialize southbridge */ li a0,CFGADDR(PCI_DEV_VIA686B,3,PCI_COMMAND_STATUS_REG) li a1,PHYS_TO_UNCACHED(PCI_CFG_SPACE) and a2,a0,0xffff or a1,a2 srl a0,16 li a2,BONITO_BASE+BONITO_PCIMAP_CFG sw a0,BONITO_PCIMAP_CFG(bonito) lw zero,BONITO_PCIMAP_CFG(bonito) lw t0,(a1) ori t0, 0x02|0x04 sw a0,BONITO_PCIMAP_CFG(bonito) lw zero,BONITO_PCIMAP_CFG(bonito) sw t0,(a1) /* Initialise other low-level I/O devices */ bal superio_init nop bal initserial nop PRINTSTR("\r\nPMON2000 MIPS Initializing. Standby...\r\n") PRINTSTR("ERRORPC=") mfc0 a0, COP_0_ERROR_PC bal hexserial nop PRINTSTR(" CONFIG=") mfc0 a0, COP_0_CONFIG bal hexserial nop PRINTSTR("\r\n") PRINTSTR(" PRID=") mfc0 a0, COP_0_PRID bal hexserial nop PRINTSTR("\r\n") #if 0 /* zhb cpu*/ li msize,0x10000000 #li sdCfg,0x0544e091 #li sdCfg,0x1d44e091 li sdCfg,0x3d500081 #~133MHz # li sdCfg,0x3d540081 #~166MHz li t0, 0xbff00008 sd sdCfg, 0(t0) #### gx 2006-03-17: mode #### #li t1,0x20 li t1,0x28 li t0, 0xbff00000 sw t1,0(t0) nop li t1,0x0 li t0, 0xbff00000 sw t1,0x30(t0) nop /* lui t0, 0xbff0 lui t1, 0x2000 dsll t1, t1, 8 sd t1, 0x20(t0) lui t1, 0x1000 sd t1, 0x28(t0) */ #endif #if 1//def DBGSBD PRINTSTR("sdcfg="); move a0,sdCfg bal hexserial nop PRINTSTR("\r\n"); PRINTSTR("msize="); move a0,msize bal hexserial nop PRINTSTR("\r\n") #endif skipdimm: li t1,0 # accumulate pcimembasecfg settings /* set bar0 mask and translation to point to SDRAM */ sub t0,msize,1 not t0 srl t0,BONITO_PCIMEMBASECFG_ASHIFT-BONITO_PCIMEMBASECFG_MEMBASE0_MASK_SHIFT and t0,BONITO_PCIMEMBASECFG_MEMBASE0_MASK or t1,t0 li t0,0x00000000 srl t0,BONITO_PCIMEMBASECFG_ASHIFT-BONITO_PCIMEMBASECFG_MEMBASE0_TRANS_SHIFT and t0,BONITO_PCIMEMBASECFG_MEMBASE0_TRANS or t1,t0 or t1,BONITO_PCIMEMBASECFG_MEMBASE0_CACHED /* set bar1 to minimum size to conserve PCI space */ li t0, ~0 srl t0,BONITO_PCIMEMBASECFG_ASHIFT-BONITO_PCIMEMBASECFG_MEMBASE1_MASK_SHIFT and t0,BONITO_PCIMEMBASECFG_MEMBASE1_MASK or t1,t0 li t0,0x00000000 srl t0,BONITO_PCIMEMBASECFG_ASHIFT-BONITO_PCIMEMBASECFG_MEMBASE1_TRANS_SHIFT and t0,BONITO_PCIMEMBASECFG_MEMBASE1_TRANS or t1,t0 or t1,BONITO_PCIMEMBASECFG_MEMBASE1_CACHED sw t1,BONITO_PCIMEMBASECFG(bonito) /* enable configuration cycles now */ lw t0,BONITO_BONPONCFG(bonito) and t0,~BONITO_BONPONCFG_CONFIG_DIS sw t0,BONITO_BONPONCFG(bonito) PRINTSTR("Init SDRAM Done!\r\n"); /* * Reset and initialize caches to a known state. */ #define IndexStoreTagI 0x08 #define IndexStoreTagD 0x09 #define IndexStoreTagS 0x0b #define IndexStoreTagT 0x0a #define FillI 0x14 /* * RM7000 config register bits. */ #define CF_7_SE (1 << 3) /* Secondary cache enable */ #define CF_7_SC (1 << 31) /* Secondary cache not present */ #define CF_7_TE (1 << 12) /* Tertiary cache enable */ #define CF_7_TC (1 << 17) /* Tertiary cache not present */ #define CF_7_TS (3 << 20) /* Tertiary cache size */ #define CF_7_TS_AL 20 /* Shift to align */ #define NOP8 nop;nop;nop;nop;nop;nop;nop;nop do_caches: TTYDBG("Sizing caches...\r\n"); mfc0 t3, COP_0_CONFIG /* t3 = original config */ and t3, 0xffffeff0 /* Make sure coherency is OK */ and t3, ~(CF_7_TE|CF_7_SE|CF_7_TC|CF_7_SC) /* disable L2/L3 cache */ mtc0 t3, COP_0_CONFIG li t2, 4096 srl t1, t3, 9 and t1, 3 sllv s3, t2, t1 /* s3 = I cache size */ #ifdef CONFIG_CACHE_64K_4WAY sll s3,2 #endif and t1, t3, 0x20 srl t1, t1, 1 addu s4, t1, 16 /* s4 = I cache line size */ srl t1, t3, 6 and t1, 3 sllv s5, t2, t1 /* s5 = D cache size */ #ifdef CONFIG_CACHE_64K_4WAY sll s5,2 #endif and t1, t3, 0x10 addu s6, t1, 16 /* s6 = D cache line size */ TTYDBG("Init caches...\r\n") li s7, 0 /* no L2 cache */ li s8, 0 /* no L3 cache */ #if 0 mfc0 a0, COP_0_PRID li a1, 0x6301 bne a0,a1,1f nop #endif TTYDBG("godson2 caches found\r\n") bal godson2_cache_init nop #ifdef DEBUG_LOCORE TTYDBG("Init caches done, cfg = ") mfc0 a0, COP_0_CONFIG bal hexserial nop TTYDBG("\r\n\r\n") #endif /* zhb */ #if 0 /* li t0, 0 */ /* li t1, 0x90000 */ /*1: addiu t0, 1 */ /* bne t0, t1, 1b */ nop TTYDBG("Testing memory...\r\n") li t7, 10 tmem: li t0, 0xa0000000+1*1024*1024 li t1, 0xa0000000 li t2, 0xffffffff 1: sw t2, 0(t1) lw t3, 0(t1) bne t3, t2, 1f nop not t2 sw t2, 0(t1) lw t3, 0(t1) bne t3, t2, 1f nop not t2 subu t2, 1 addu t1, 4 beq t1, t0, 2f nop and t4, t1, 0x000fffff bnez t4, skipdot li a0, '.' bal tgt_putchar nop skipdot: b 1b nop 1: TTYDBG("Memory test failed at "); move a0, t1 bal hexserial nop TTYDBG("\r\nWrite="); move a0, t2 bal hexserial nop TTYDBG("\r\nRead="); move a0, t3 bal hexserial nop 1: b 1b nop 2: TTYDBG("Testing ok...\r\n"); sub t7,1 beqz t7, 1f nop b tmem nop 1: b 1b nop #endif /* Clear BSS */ la a0, _edata la a2, _end 2: sw zero, 0(a0) bne a2, a0, 2b addu a0, 4 TTYDBG("Clear PMON BBS done.\r\n") /* zhb */ #if 0 zhb: TTYDBG("Testing...\r\n") la a0, start li a1, 0xbfc00000 la a2, _edata or a0, 0xa0000000 or a2, 0xa0000000 /* subu s6, a2, a0*/ /* srl s6, s6, 2*/ move t0, a0 move t1, a1 move t2, a2 /* copy text section */ 1: lw t4, 0(t1) nop lw t5, 0(t0) addu t0, 4 addu t1, 4 beq t4, t5, 2f nop move a0, t0 subu a0, 4 bal hexserial nop TTYDBG (" ") move a0, t4 bal hexserial nop TTYDBG (" ") move a0, t5 bal hexserial nop TTYDBG ("\r\n") 2: bne t2, t0, 1b nop TTYDBG ("test ok!\r\n") /* 3: beqz zero, 3b nop */ #endif #if 0 mfc0 a0,COP_0_CONFIG and a0,a0,0xfffffff8 or a0,a0,0x3 mtc0 a0,COP_0_CONFIG #endif li a0, 4096*1024 sw a0, CpuTertiaryCacheSize /* Set L3 cache size */ move a0,msize srl a0,20 #if 1 li a0,256 #endif la v0, initmips jalr v0 nop stuck: #ifdef DEBUG_LOCORE TTYDBG("Dumping GT64240 setup.\r\n") TTYDBG("offset----data------------------------.\r\n") li s3, 0 1: move a0, s3 bal hexserial nop TTYDBG(": ") 2: add a0, s3, bonito lw a0, 0(a0) bal hexserial addiu s3, 4 TTYDBG(" ") li a0, 0xfff and a0, s3 beqz a0, 3f li a0, 0x01f and a0, s3 bnez a0, 2b TTYDBG("\r\n") b 1b nop 3: b 3b nop #else b stuck nop #endif /* * Clear the TLB. Normally called from start.S. */ #if __mips64 #define MTC0 dmtc0 #else #define MTC0 mtc0 #endif LEAF(CPU_TLBClear) li a3, 0 # First TLB index. li a2, PG_SIZE_4K MTC0 a2, COP_0_TLB_PG_MASK # Whatever... 1: MTC0 zero, COP_0_TLB_HI # Clear entry high. MTC0 zero, COP_0_TLB_LO0 # Clear entry low0. MTC0 zero, COP_0_TLB_LO1 # Clear entry low1. mtc0 a3, COP_0_TLB_INDEX # Set the index. addiu a3, 1 li a2, 64 nop nop tlbwi # Write the TLB bne a3, a2, 1b nop jr ra nop END(CPU_TLBClear) /* * Set up the TLB. Normally called from start.S. */ LEAF(CPU_TLBInit) li a3, 0 # First TLB index. li a2, PG_SIZE_16M MTC0 a2, COP_0_TLB_PG_MASK # All pages are 16Mb. 1: and a2, a0, PG_SVPN MTC0 a2, COP_0_TLB_HI # Set up entry high. move a2, a0 srl a2, a0, PG_SHIFT and a2, a2, PG_FRAME ori a2, PG_IOPAGE MTC0 a2, COP_0_TLB_LO0 # Set up entry low0. addu a2, (0x01000000 >> PG_SHIFT) MTC0 a2, COP_0_TLB_LO1 # Set up entry low1. mtc0 a3, COP_0_TLB_INDEX # Set the index. addiu a3, 1 li a2, 0x02000000 subu a1, a2 nop tlbwi # Write the TLB bgtz a1, 1b addu a0, a2 # Step address 32Mb. jr ra nop END(CPU_TLBInit) /* * Simple character printing routine used before full initialization */ #if 0 #define TXWAIT 0x100000 LEAF(tgt_putchar) /* blocking transmit, with timeout */ li t0,TXWAIT # timeout 1: lbu t1,PHYS_TO_UNCACHED(0x1fd002fd) # get LSR and t1,0x20 # tx ready? bnez t1,1f # yup - go and write nop subu t0,1 # continue until timeout bnez t0,1b nop 1: sb a0,PHYS_TO_UNCACHED(0x1fd002f8) # write data li t0,TXWAIT # timeout 1: lbu t1,PHYS_TO_UNCACHED(0x1fd003fd) # get LSR and t1,0x20 # tx ready? bnez t1,1f # yup - go and write nop subu t0,1 # continue until timeout bnez t0,1b nop 1: sb a0,PHYS_TO_UNCACHED(0x1fd003f8) # write data j ra nop END(tgt_putchar) #endif LEAF(stringserial) move a2, ra addu a1, a0, s0 lbu a0, 0(a1) 1: beqz a0, 2f nop bal tgt_putchar addiu a1, 1 b 1b lbu a0, 0(a1) 2: j a2 nop END(stringserial) LEAF(outstring) move a2, ra move a1, a0 lbu a0, 0(a1) 1: beqz a0, 2f nop bal tgt_putchar addiu a1, 1 b 1b lbu a0, 0(a1) 2: j a2 nop END(outstring) LEAF(hexserial) move a2, ra move a1, a0 li a3, 7 1: rol a0, a1, 4 move a1, a0 and a0, 0xf la v0, hexchar addu v0, s0 addu v0, a0 bal tgt_putchar lbu a0, 0(v0) bnez a3, 1b addu a3, -1 j a2 nop END(hexserial) LEAF(tgt_putchar) # la v0, COM1_BASE_ADDR la v0, COM3_BASE_ADDR 1: lbu v1, NSREG(NS16550_LSR)(v0) and v1, LSR_TXRDY beqz v1, 1b nop sb a0, NSREG(NS16550_DATA)(v0) move v1, v0 la v0, COM3_BASE_ADDR bne v0, v1, 1b nop j ra nop END(tgt_putchar) /* baud rate definitions, matching include/termios.h */ #define B0 0 #define B50 50 #define B75 75 #define B110 110 #define B134 134 #define B150 150 #define B200 200 #define B300 300 #define B600 600 #define B1200 1200 #define B1800 1800 #define B2400 2400 #define B4800 4800 #define B9600 9600 #define B19200 19200 #define B38400 38400 #define B57600 57600 #define B115200 115200 LEAF(initserial) # la v0, COM1_BASE_ADDR la v0, COM3_BASE_ADDR 1: li v1, FIFO_ENABLE|FIFO_RCV_RST|FIFO_XMT_RST|FIFO_TRIGGER_4 sb v1, NSREG(NS16550_FIFO)(v0) li v1, CFCR_DLAB sb v1, NSREG(NS16550_CFCR)(v0) li v1, NS16550HZ/(16*CONS_BAUD) sb v1, NSREG(NS16550_DATA)(v0) srl v1, 8 sb v1, NSREG(NS16550_IER)(v0) li v1, CFCR_8BITS sb v1, NSREG(NS16550_CFCR)(v0) li v1, MCR_DTR|MCR_RTS sb v1, NSREG(NS16550_MCR)(v0) li v1, 0x0 sb v1, NSREG(NS16550_IER)(v0) move v1, v0 la v0, COM3_BASE_ADDR bne v0, v1, 1b nop j ra nop END(initserial) LEAF(i2cdump) jr t4 nop END(i2cdump) LEAF(i2cread) li v0,-1 j ra nop END(i2cread) __main: j ra nop .rdata hexchar: .ascii "0123456789abcdef" .text .align 2 /* * I2C Functions used in early startup code to get SPD info from * SDRAM modules. This code must be entirely PIC and RAM independent. */ /* Delay macro */ #define DELAY(count) \ li v0, count; \ 99: \ bnz vo, 99b;\ addiu v0, -1 #define I2C_INT_ENABLE 0x80 #define I2C_ENABLE 0x40 #define I2C_ACK 0x04 #define I2C_INT_FLAG 0x08 #define I2C_STOP_BIT 0x10 #define I2C_START_BIT 0x20 #define I2C_AMOD_RD 0x01 #define BUS_ERROR 0x00 #define START_CONDITION_TRA 0x08 #define RSTART_CONDITION_TRA 0x10 #define ADDR_AND_WRITE_BIT_TRA_ACK_REC 0x18 #define ADDR_AND_READ_BIT_TRA_ACK_REC 0x40 #define SLAVE_REC_WRITE_DATA_ACK_TRA 0x28 #define MAS_REC_READ_DATA_ACK_NOT_TRA 0x58 #define Index_Store_Tag_D 0x05 #define Index_Invalidate_I 0x00 #define Index_Writeback_Inv_D 0x01 #define Index_Store_Tag_S 0x0b #define Index_Writeback_Inv_S 0x03 LEAF(nullfunction) jr ra nop END(nullfunction) LEAF(godson2_cache_init) ####part 2#### cache_detect_2way: mfc0 t4, CP0_CONFIG andi t5, t4, 0x0e00 srl t5, t5, 9 andi t6, t4, 0x01c0 srl t6, t6, 6 addiu t6, t6, 11 addiu t5, t5, 11 addiu t4, $0, 1 sllv t6, t4, t6 srl t6,1 sllv t5, t4, t5 srl t5,1 addiu t7, $0, 2 ####part 3#### lui a0, 0x8000 addu a1, $0, t5 addu a2, $0, t6 cache_init_d2way: #a0=0x80000000, a1=icache_size, a2=dcache_size #a3, v0 and v1 used as local registers mtc0 $0, CP0_TAGHI addu v0, $0, a0 addu v1, a0, a2 1: slt a3, v0, v1 beq a3, $0, 1f nop mtc0 $0, CP0_TAGLO cache Index_Store_Tag_D, 0x0(v0) mtc0 $0, CP0_TAGLO cache Index_Store_Tag_D, 0x1(v0) mtc0 $0, CP0_TAGLO cache Index_Store_Tag_D, 0x2(v0) mtc0 $0, CP0_TAGLO cache Index_Store_Tag_D, 0x3(v0) beq $0, $0, 1b addiu v0, v0, 0x20 #if 1 1: cache_init_l24way: mtc0 $0, CP0_TAGHI addu v0, $0, a0 addu v1, a0, 128*1024 1: slt a3, v0, v1 beq a3, $0, 1f nop mtc0 $0, CP0_TAGLO cache Index_Store_Tag_S, 0x0(v0) mtc0 $0, CP0_TAGLO cache Index_Store_Tag_S, 0x1(v0) mtc0 $0, CP0_TAGLO cache Index_Store_Tag_S, 0x2(v0) mtc0 $0, CP0_TAGLO cache Index_Store_Tag_S, 0x3(v0) beq $0, $0, 1b addiu v0, v0, 0x20 1: cache_flush_4way: addu v0, $0, a0 addu v1, a0, 128*1024 1: slt a3, v0, v1 beq a3, $0, 1f nop cache Index_Writeback_Inv_S, 0x0(v0) cache Index_Writeback_Inv_S, 0x1(v0) cache Index_Writeback_Inv_S, 0x2(v0) cache Index_Writeback_Inv_S, 0x3(v0) beq $0, $0, 1b addiu v0, v0, 0x20 # endif 1: cache_flush_i2way: addu v0, $0, a0 addu v1, a0, a1 1: slt a3, v0, v1 beq a3, $0, 1f nop cache Index_Invalidate_I, 0x0(v0) # cache Index_Invalidate_I, 0x1(v0) # cache Index_Invalidate_I, 0x2(v0) # cache Index_Invalidate_I, 0x3(v0) beq $0, $0, 1b addiu v0, v0, 0x20 1: cache_flush_d2way: addu v0, $0, a0 addu v1, a0, a2 1: slt a3, v0, v1 beq a3, $0, 1f nop cache Index_Writeback_Inv_D, 0x0(v0) cache Index_Writeback_Inv_D, 0x1(v0) cache Index_Writeback_Inv_D, 0x2(v0) cache Index_Writeback_Inv_D, 0x3(v0) beq $0, $0, 1b addiu v0, v0, 0x20 1: cache_init_finish: nop jr ra nop cache_init_panic: TTYDBG("cache init panic\r\n"); 1: b 1b nop .end godson2_cache_init #define PCICONF_WRITEB(dev,func,reg,data) \ li a0,CFGADDR(dev,func,reg); \ li a1,PHYS_TO_UNCACHED(PCI_CFG_SPACE); \ and a2,a0,0xffff; \ or a1,a2; \ srl a0,16; \ li a2,BONITO_BASE+BONITO_PCIMAP_CFG; \ sw a0,BONITO_PCIMAP_CFG(bonito); \ lw zero,BONITO_PCIMAP_CFG(bonito); \ or a0,zero,data; \ sb a0,(a1); #define PCICONF_WRITEW(dev,func,reg,data) \ li a0,CFGADDR(dev,func,reg); \ li a1,PHYS_TO_UNCACHED(PCI_CFG_SPACE); \ and a2,t0,0xffff; \ or a1,a2; \ srl a0,16; \ li a2,BONITO_BASE+BONITO_PCIMAP_CFG; \ sw a0,BONITO_PCIMAP_CFG(bonito); \ lw zero,BONITO_PCIMAP_CFG(bonito); \ or a0,zero,data; \ sw a0,(a1); #define PCICONF_ORB(dev,func,reg,data) \ li a0,CFGADDR(dev,func,reg); \ li a1,PHYS_TO_UNCACHED(PCI_CFG_SPACE); \ and a2,a0,0xffff; \ or a1,a2; \ srl a0,16; \ li a2,BONITO_BASE+BONITO_PCIMAP_CFG; \ sw a0,BONITO_PCIMAP_CFG(bonito); \ lw zero,BONITO_PCIMAP_CFG(bonito); \ lbu a2,(a1); \ ori a2,data; \ sw a0,BONITO_PCIMAP_CFG(bonito); \ lw zero,BONITO_PCIMAP_CFG(bonito); \ sb a2,(a1); #define SUPERIO_WR(idx,data) \ li v0,BONITO_PCIIO_BASE_VA+0x3f0; \ or v1,zero,idx; \ sb v1,(v0); \ or v1,zero,data; \ sb v1,1(v0); #define E2_EPP 2 #define E2_S1 (1<<2) #define E2_S2 (1<<3) #define E2_FLOPPY (1<<4) LEAF(superio_init) PCICONF_WRITEW(PCI_IDSEL_VIA686B,0,4,7); /*positive decode*/ PCICONF_ORB(PCI_IDSEL_VIA686B,0,0x81,0x80); PCICONF_WRITEB(PCI_IDSEL_VIA686B,0,0x83,0x80|0x1| 0x8); PCICONF_WRITEB(PCI_IDSEL_VIA686B,0,0x85,3); /* enable RTC/PS2/KBC */ PCICONF_WRITEB(PCI_IDSEL_VIA686B,0,0x5A,7); SUPERIO_WR(0xe2,E2_S2|E2_S1|E2_EPP|E2_FLOPPY) /*enable serial and floppy */ SUPERIO_WR(0xe3,0x3f0>>2) /*floppy base address*/ SUPERIO_WR(0xe6,0x378>>2) /*parallel port*/ SUPERIO_WR(0xe7,0x3f8>>2) /*set serial port1 base addr 0x3f8*/ SUPERIO_WR(0xe8,0x2f8>>2) /*set serial port2 base addr 0x2f8*/ SUPERIO_WR(0xee,0xc0) /* both ports on high speed*/ PCICONF_WRITEB(PCI_IDSEL_VIA686B,0,0x85,1) jr ra nop END(superio_init)