| /* |
| * Copyright (C) 1999, 2000, 2004, 2005 MIPS Technologies, Inc. |
| * All rights reserved. |
| * Authors: Carsten Langgaard <carstenl@mips.com> |
| * Maciej W. Rozycki <macro@mips.com> |
| * |
| * This program is free software; you can distribute it and/or modify it |
| * under the terms of the GNU General Public License (Version 2) as |
| * published by the Free Software Foundation. |
| * |
| * This program is distributed in the hope it will be useful, but WITHOUT |
| * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or |
| * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License |
| * for more details. |
| * |
| * You should have received a copy of the GNU General Public License along |
| * with this program; if not, write to the Free Software Foundation, Inc., |
| * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. |
| * |
| * PROM library initialisation code. |
| */ |
| #include <linux/init.h> |
| #include <linux/string.h> |
| #include <linux/kernel.h> |
| |
| #include <asm/bootinfo.h> |
| #include <asm/gt64120.h> |
| #include <asm/io.h> |
| #include <asm/system.h> |
| #include <asm/cacheflush.h> |
| #include <asm/traps.h> |
| |
| #include <asm/gcmpregs.h> |
| #include <asm/mips-boards/prom.h> |
| #include <asm/mips-boards/generic.h> |
| #include <asm/mips-boards/bonito64.h> |
| #include <asm/mips-boards/msc01_pci.h> |
| |
| #include <asm/mips-boards/malta.h> |
| |
| int prom_argc; |
| int *_prom_argv, *_prom_envp; |
| |
| /* |
| * YAMON (32-bit PROM) pass arguments and environment as 32-bit pointer. |
| * This macro take care of sign extension, if running in 64-bit mode. |
| */ |
| #define prom_envp(index) ((char *)(long)_prom_envp[(index)]) |
| |
| int init_debug; |
| |
| static int mips_revision_corid; |
| int mips_revision_sconid; |
| |
| /* Bonito64 system controller register base. */ |
| unsigned long _pcictrl_bonito; |
| unsigned long _pcictrl_bonito_pcicfg; |
| |
| /* GT64120 system controller register base */ |
| unsigned long _pcictrl_gt64120; |
| |
| /* MIPS System controller register base */ |
| unsigned long _pcictrl_msc; |
| |
| char *prom_getenv(char *envname) |
| { |
| /* |
| * Return a pointer to the given environment variable. |
| * In 64-bit mode: we're using 64-bit pointers, but all pointers |
| * in the PROM structures are only 32-bit, so we need some |
| * workarounds, if we are running in 64-bit mode. |
| */ |
| int i, index=0; |
| |
| i = strlen(envname); |
| |
| while (prom_envp(index)) { |
| if(strncmp(envname, prom_envp(index), i) == 0) { |
| return(prom_envp(index+1)); |
| } |
| index += 2; |
| } |
| |
| return NULL; |
| } |
| |
| static inline unsigned char str2hexnum(unsigned char c) |
| { |
| if (c >= '0' && c <= '9') |
| return c - '0'; |
| if (c >= 'a' && c <= 'f') |
| return c - 'a' + 10; |
| return 0; /* foo */ |
| } |
| |
| static inline void str2eaddr(unsigned char *ea, unsigned char *str) |
| { |
| int i; |
| |
| for (i = 0; i < 6; i++) { |
| unsigned char num; |
| |
| if((*str == '.') || (*str == ':')) |
| str++; |
| num = str2hexnum(*str++) << 4; |
| num |= (str2hexnum(*str++)); |
| ea[i] = num; |
| } |
| } |
| |
| int get_ethernet_addr(char *ethernet_addr) |
| { |
| char *ethaddr_str; |
| |
| ethaddr_str = prom_getenv("ethaddr"); |
| if (!ethaddr_str) { |
| printk("ethaddr not set in boot prom\n"); |
| return -1; |
| } |
| str2eaddr(ethernet_addr, ethaddr_str); |
| |
| if (init_debug > 1) { |
| int i; |
| printk("get_ethernet_addr: "); |
| for (i=0; i<5; i++) |
| printk("%02x:", (unsigned char)*(ethernet_addr+i)); |
| printk("%02x\n", *(ethernet_addr+i)); |
| } |
| |
| return 0; |
| } |
| |
| #ifdef CONFIG_SERIAL_8250_CONSOLE |
| static void __init console_config(void) |
| { |
| char console_string[40]; |
| int baud = 0; |
| char parity = '\0', bits = '\0', flow = '\0'; |
| char *s; |
| |
| if ((strstr(prom_getcmdline(), "console=")) == NULL) { |
| s = prom_getenv("modetty0"); |
| if (s) { |
| while (*s >= '0' && *s <= '9') |
| baud = baud*10 + *s++ - '0'; |
| if (*s == ',') s++; |
| if (*s) parity = *s++; |
| if (*s == ',') s++; |
| if (*s) bits = *s++; |
| if (*s == ',') s++; |
| if (*s == 'h') flow = 'r'; |
| } |
| if (baud == 0) |
| baud = 38400; |
| if (parity != 'n' && parity != 'o' && parity != 'e') |
| parity = 'n'; |
| if (bits != '7' && bits != '8') |
| bits = '8'; |
| if (flow == '\0') |
| flow = 'r'; |
| sprintf(console_string, " console=ttyS0,%d%c%c%c", baud, parity, bits, flow); |
| strcat(prom_getcmdline(), console_string); |
| pr_info("Config serial console:%s\n", console_string); |
| } |
| } |
| #endif |
| |
| static void __init mips_nmi_setup(void) |
| { |
| void *base; |
| extern char except_vec_nmi; |
| |
| base = cpu_has_veic ? |
| (void *)(CAC_BASE + 0xa80) : |
| (void *)(CAC_BASE + 0x380); |
| memcpy(base, &except_vec_nmi, 0x80); |
| flush_icache_range((unsigned long)base, (unsigned long)base + 0x80); |
| } |
| |
| static void __init mips_ejtag_setup(void) |
| { |
| void *base; |
| extern char except_vec_ejtag_debug; |
| |
| base = cpu_has_veic ? |
| (void *)(CAC_BASE + 0xa00) : |
| (void *)(CAC_BASE + 0x300); |
| memcpy(base, &except_vec_ejtag_debug, 0x80); |
| flush_icache_range((unsigned long)base, (unsigned long)base + 0x80); |
| } |
| |
| extern struct plat_smp_ops msmtc_smp_ops; |
| |
| void __init prom_init(void) |
| { |
| int result; |
| |
| prom_argc = fw_arg0; |
| _prom_argv = (int *) fw_arg1; |
| _prom_envp = (int *) fw_arg2; |
| |
| mips_display_message("LINUX"); |
| |
| /* |
| * early setup of _pcictrl_bonito so that we can determine |
| * the system controller on a CORE_EMUL board |
| */ |
| _pcictrl_bonito = (unsigned long)ioremap(BONITO_REG_BASE, BONITO_REG_SIZE); |
| |
| mips_revision_corid = MIPS_REVISION_CORID; |
| |
| if (mips_revision_corid == MIPS_REVISION_CORID_CORE_EMUL) { |
| if (BONITO_PCIDID == 0x0001df53 || |
| BONITO_PCIDID == 0x0003df53) |
| mips_revision_corid = MIPS_REVISION_CORID_CORE_EMUL_BON; |
| else |
| mips_revision_corid = MIPS_REVISION_CORID_CORE_EMUL_MSC; |
| } |
| |
| mips_revision_sconid = MIPS_REVISION_SCONID; |
| if (mips_revision_sconid == MIPS_REVISION_SCON_OTHER) { |
| switch (mips_revision_corid) { |
| case MIPS_REVISION_CORID_QED_RM5261: |
| case MIPS_REVISION_CORID_CORE_LV: |
| case MIPS_REVISION_CORID_CORE_FPGA: |
| case MIPS_REVISION_CORID_CORE_FPGAR2: |
| mips_revision_sconid = MIPS_REVISION_SCON_GT64120; |
| break; |
| case MIPS_REVISION_CORID_CORE_EMUL_BON: |
| case MIPS_REVISION_CORID_BONITO64: |
| case MIPS_REVISION_CORID_CORE_20K: |
| mips_revision_sconid = MIPS_REVISION_SCON_BONITO; |
| break; |
| case MIPS_REVISION_CORID_CORE_MSC: |
| case MIPS_REVISION_CORID_CORE_FPGA2: |
| case MIPS_REVISION_CORID_CORE_24K: |
| /* |
| * SOCit/ROCit support is essentially identical |
| * but make an attempt to distinguish them |
| */ |
| mips_revision_sconid = MIPS_REVISION_SCON_SOCIT; |
| break; |
| case MIPS_REVISION_CORID_CORE_FPGA3: |
| case MIPS_REVISION_CORID_CORE_FPGA4: |
| case MIPS_REVISION_CORID_CORE_FPGA5: |
| case MIPS_REVISION_CORID_CORE_EMUL_MSC: |
| default: |
| /* See above */ |
| mips_revision_sconid = MIPS_REVISION_SCON_ROCIT; |
| break; |
| } |
| } |
| |
| switch (mips_revision_sconid) { |
| u32 start, map, mask, data; |
| |
| case MIPS_REVISION_SCON_GT64120: |
| /* |
| * Setup the North bridge to do Master byte-lane swapping |
| * when running in bigendian. |
| */ |
| _pcictrl_gt64120 = (unsigned long)ioremap(MIPS_GT_BASE, 0x2000); |
| |
| #ifdef CONFIG_CPU_LITTLE_ENDIAN |
| GT_WRITE(GT_PCI0_CMD_OFS, GT_PCI0_CMD_MBYTESWAP_BIT | |
| GT_PCI0_CMD_SBYTESWAP_BIT); |
| #else |
| GT_WRITE(GT_PCI0_CMD_OFS, 0); |
| #endif |
| /* Fix up PCI I/O mapping if necessary (for Atlas). */ |
| start = GT_READ(GT_PCI0IOLD_OFS); |
| map = GT_READ(GT_PCI0IOREMAP_OFS); |
| if ((start & map) != 0) { |
| map &= ~start; |
| GT_WRITE(GT_PCI0IOREMAP_OFS, map); |
| } |
| |
| set_io_port_base(MALTA_GT_PORT_BASE); |
| break; |
| |
| case MIPS_REVISION_SCON_BONITO: |
| _pcictrl_bonito_pcicfg = (unsigned long)ioremap(BONITO_PCICFG_BASE, BONITO_PCICFG_SIZE); |
| |
| /* |
| * Disable Bonito IOBC. |
| */ |
| BONITO_PCIMEMBASECFG = BONITO_PCIMEMBASECFG & |
| ~(BONITO_PCIMEMBASECFG_MEMBASE0_CACHED | |
| BONITO_PCIMEMBASECFG_MEMBASE1_CACHED); |
| |
| /* |
| * Setup the North bridge to do Master byte-lane swapping |
| * when running in bigendian. |
| */ |
| #ifdef CONFIG_CPU_LITTLE_ENDIAN |
| BONITO_BONGENCFG = BONITO_BONGENCFG & |
| ~(BONITO_BONGENCFG_MSTRBYTESWAP | |
| BONITO_BONGENCFG_BYTESWAP); |
| #else |
| BONITO_BONGENCFG = BONITO_BONGENCFG | |
| BONITO_BONGENCFG_MSTRBYTESWAP | |
| BONITO_BONGENCFG_BYTESWAP; |
| #endif |
| |
| set_io_port_base(MALTA_BONITO_PORT_BASE); |
| break; |
| |
| case MIPS_REVISION_SCON_SOCIT: |
| case MIPS_REVISION_SCON_ROCIT: |
| _pcictrl_msc = (unsigned long)ioremap(MIPS_MSC01_PCI_REG_BASE, 0x2000); |
| mips_pci_controller: |
| mb(); |
| MSC_READ(MSC01_PCI_CFG, data); |
| MSC_WRITE(MSC01_PCI_CFG, data & ~MSC01_PCI_CFG_EN_BIT); |
| wmb(); |
| |
| /* Fix up lane swapping. */ |
| #ifdef CONFIG_CPU_LITTLE_ENDIAN |
| MSC_WRITE(MSC01_PCI_SWAP, MSC01_PCI_SWAP_NOSWAP); |
| #else |
| MSC_WRITE(MSC01_PCI_SWAP, |
| MSC01_PCI_SWAP_BYTESWAP << MSC01_PCI_SWAP_IO_SHF | |
| MSC01_PCI_SWAP_BYTESWAP << MSC01_PCI_SWAP_MEM_SHF | |
| MSC01_PCI_SWAP_BYTESWAP << MSC01_PCI_SWAP_BAR0_SHF); |
| #endif |
| /* Fix up target memory mapping. */ |
| MSC_READ(MSC01_PCI_BAR0, mask); |
| MSC_WRITE(MSC01_PCI_P2SCMSKL, mask & MSC01_PCI_BAR0_SIZE_MSK); |
| |
| /* Don't handle target retries indefinitely. */ |
| if ((data & MSC01_PCI_CFG_MAXRTRY_MSK) == |
| MSC01_PCI_CFG_MAXRTRY_MSK) |
| data = (data & ~(MSC01_PCI_CFG_MAXRTRY_MSK << |
| MSC01_PCI_CFG_MAXRTRY_SHF)) | |
| ((MSC01_PCI_CFG_MAXRTRY_MSK - 1) << |
| MSC01_PCI_CFG_MAXRTRY_SHF); |
| |
| wmb(); |
| MSC_WRITE(MSC01_PCI_CFG, data); |
| mb(); |
| |
| set_io_port_base(MALTA_MSC_PORT_BASE); |
| break; |
| |
| case MIPS_REVISION_SCON_SOCITSC: |
| case MIPS_REVISION_SCON_SOCITSCP: |
| _pcictrl_msc = (unsigned long)ioremap(MIPS_SOCITSC_PCI_REG_BASE, 0x2000); |
| goto mips_pci_controller; |
| |
| default: |
| /* Unknown system controller */ |
| mips_display_message("SC Error"); |
| while (1); /* We die here... */ |
| } |
| board_nmi_handler_setup = mips_nmi_setup; |
| board_ejtag_handler_setup = mips_ejtag_setup; |
| |
| prom_init_cmdline(); |
| prom_meminit(); |
| #ifdef CONFIG_SERIAL_8250_CONSOLE |
| console_config(); |
| #endif |
| /* Early detection of CMP support */ |
| result = gcmp_probe(GCMP_BASE_ADDR, GCMP_ADDRSPACE_SZ); |
| |
| #ifdef CONFIG_MIPS_CMP |
| if (result) |
| register_smp_ops(&cmp_smp_ops); |
| #endif |
| #ifdef CONFIG_MIPS_MT_SMP |
| #ifdef CONFIG_MIPS_CMP |
| if (!result) |
| register_smp_ops(&vsmp_smp_ops); |
| #else |
| register_smp_ops(&vsmp_smp_ops); |
| #endif |
| #endif |
| #ifdef CONFIG_MIPS_MT_SMTC |
| register_smp_ops(&msmtc_smp_ops); |
| #endif |
| } |