| /* | |
| * Board setup routines for the Motorola SPS Sandpoint Test Platform. | |
| * | |
| * Author: Mark A. Greer | |
| * mgreer@mvista.com | |
| * | |
| * 2000-2003 (c) MontaVista Software, Inc. This file is licensed under | |
| * the terms of the GNU General Public License version 2. This program | |
| * is licensed "as is" without any warranty of any kind, whether express | |
| * or implied. | |
| */ | |
| /* | |
| * This file adds support for the Motorola SPS Sandpoint Test Platform. | |
| * These boards have a PPMC slot for the processor so any combination | |
| * of cpu and host bridge can be attached. This port is for an 8240 PPMC | |
| * module from Motorola SPS and other closely related cpu/host bridge | |
| * combinations (e.g., 750/755/7400 with MPC107 host bridge). | |
| * The sandpoint itself has a Windbond 83c553 (PCI-ISA bridge, 2 DMA ctlrs, 2 | |
| * cascaded 8259 interrupt ctlrs, 8254 Timer/Counter, and an IDE ctlr), a | |
| * National 87308 (RTC, 2 UARTs, Keyboard & mouse ctlrs, and a floppy ctlr), | |
| * and 4 PCI slots (only 2 of which are usable; the other 2 are keyed for 3.3V | |
| * but are really 5V). | |
| * | |
| * The firmware on the sandpoint is called DINK (not my acronym :). This port | |
| * depends on DINK to do some basic initialization (e.g., initialize the memory | |
| * ctlr) and to ensure that the processor is using MAP B (CHRP map). | |
| * | |
| * The switch settings for the Sandpoint board MUST be as follows: | |
| * S3: down | |
| * S4: up | |
| * S5: up | |
| * S6: down | |
| * | |
| * 'down' is in the direction from the PCI slots towards the PPMC slot; | |
| * 'up' is in the direction from the PPMC slot towards the PCI slots. | |
| * Be careful, the way the sandpoint board is installed in XT chasses will | |
| * make the directions reversed. | |
| * | |
| * Since Motorola listened to our suggestions for improvement, we now have | |
| * the Sandpoint X3 board. All of the PCI slots are available, it uses | |
| * the serial interrupt interface (just a hardware thing we need to | |
| * configure properly). | |
| * | |
| * Use the default X3 switch settings. The interrupts are then: | |
| * EPIC Source | |
| * 0 SIOINT (8259, active low) | |
| * 1 PCI #1 | |
| * 2 PCI #2 | |
| * 3 PCI #3 | |
| * 4 PCI #4 | |
| * 7 Winbond INTC (IDE interrupt) | |
| * 8 Winbond INTD (IDE interrupt) | |
| * | |
| * | |
| * Motorola has finally released a version of DINK32 that correctly | |
| * (seemingly) initalizes the memory controller correctly, regardless | |
| * of the amount of memory in the system. Once a method of determining | |
| * what version of DINK initializes the system for us, if applicable, is | |
| * found, we can hopefully stop hardcoding 32MB of RAM. | |
| */ | |
| #include <linux/stddef.h> | |
| #include <linux/kernel.h> | |
| #include <linux/init.h> | |
| #include <linux/errno.h> | |
| #include <linux/reboot.h> | |
| #include <linux/pci.h> | |
| #include <linux/kdev_t.h> | |
| #include <linux/major.h> | |
| #include <linux/initrd.h> | |
| #include <linux/console.h> | |
| #include <linux/delay.h> | |
| #include <linux/ide.h> | |
| #include <linux/seq_file.h> | |
| #include <linux/root_dev.h> | |
| #include <linux/serial.h> | |
| #include <linux/tty.h> /* for linux/serial_core.h */ | |
| #include <linux/serial_core.h> | |
| #include <linux/serial_8250.h> | |
| #include <asm/system.h> | |
| #include <asm/pgtable.h> | |
| #include <asm/page.h> | |
| #include <asm/time.h> | |
| #include <asm/dma.h> | |
| #include <asm/io.h> | |
| #include <asm/machdep.h> | |
| #include <asm/prom.h> | |
| #include <asm/smp.h> | |
| #include <asm/vga.h> | |
| #include <asm/open_pic.h> | |
| #include <asm/i8259.h> | |
| #include <asm/todc.h> | |
| #include <asm/bootinfo.h> | |
| #include <asm/mpc10x.h> | |
| #include <asm/pci-bridge.h> | |
| #include <asm/kgdb.h> | |
| #include <asm/ppc_sys.h> | |
| #include "sandpoint.h" | |
| /* Set non-zero if an X2 Sandpoint detected. */ | |
| static int sandpoint_is_x2; | |
| unsigned char __res[sizeof(bd_t)]; | |
| static void sandpoint_halt(void); | |
| static void sandpoint_probe_type(void); | |
| /* | |
| * Define all of the IRQ senses and polarities. Taken from the | |
| * Sandpoint X3 User's manual. | |
| */ | |
| static u_char sandpoint_openpic_initsenses[] __initdata = { | |
| (IRQ_SENSE_LEVEL | IRQ_POLARITY_NEGATIVE), /* 0: SIOINT */ | |
| (IRQ_SENSE_LEVEL | IRQ_POLARITY_NEGATIVE), /* 2: PCI Slot 1 */ | |
| (IRQ_SENSE_LEVEL | IRQ_POLARITY_NEGATIVE), /* 3: PCI Slot 2 */ | |
| (IRQ_SENSE_LEVEL | IRQ_POLARITY_NEGATIVE), /* 4: PCI Slot 3 */ | |
| (IRQ_SENSE_LEVEL | IRQ_POLARITY_NEGATIVE), /* 5: PCI Slot 4 */ | |
| (IRQ_SENSE_LEVEL | IRQ_POLARITY_NEGATIVE), /* 8: IDE (INT C) */ | |
| (IRQ_SENSE_LEVEL | IRQ_POLARITY_NEGATIVE) /* 9: IDE (INT D) */ | |
| }; | |
| /* | |
| * Motorola SPS Sandpoint interrupt routing. | |
| */ | |
| static inline int | |
| x3_map_irq(struct pci_dev *dev, unsigned char idsel, unsigned char pin) | |
| { | |
| static char pci_irq_table[][4] = | |
| /* | |
| * PCI IDSEL/INTPIN->INTLINE | |
| * A B C D | |
| */ | |
| { | |
| { 16, 0, 0, 0 }, /* IDSEL 11 - i8259 on Winbond */ | |
| { 0, 0, 0, 0 }, /* IDSEL 12 - unused */ | |
| { 18, 21, 20, 19 }, /* IDSEL 13 - PCI slot 1 */ | |
| { 19, 18, 21, 20 }, /* IDSEL 14 - PCI slot 2 */ | |
| { 20, 19, 18, 21 }, /* IDSEL 15 - PCI slot 3 */ | |
| { 21, 20, 19, 18 }, /* IDSEL 16 - PCI slot 4 */ | |
| }; | |
| const long min_idsel = 11, max_idsel = 16, irqs_per_slot = 4; | |
| return PCI_IRQ_TABLE_LOOKUP; | |
| } | |
| static inline int | |
| x2_map_irq(struct pci_dev *dev, unsigned char idsel, unsigned char pin) | |
| { | |
| static char pci_irq_table[][4] = | |
| /* | |
| * PCI IDSEL/INTPIN->INTLINE | |
| * A B C D | |
| */ | |
| { | |
| { 18, 0, 0, 0 }, /* IDSEL 11 - i8259 on Windbond */ | |
| { 0, 0, 0, 0 }, /* IDSEL 12 - unused */ | |
| { 16, 17, 18, 19 }, /* IDSEL 13 - PCI slot 1 */ | |
| { 17, 18, 19, 16 }, /* IDSEL 14 - PCI slot 2 */ | |
| { 18, 19, 16, 17 }, /* IDSEL 15 - PCI slot 3 */ | |
| { 19, 16, 17, 18 }, /* IDSEL 16 - PCI slot 4 */ | |
| }; | |
| const long min_idsel = 11, max_idsel = 16, irqs_per_slot = 4; | |
| return PCI_IRQ_TABLE_LOOKUP; | |
| } | |
| static void __init | |
| sandpoint_setup_winbond_83553(struct pci_controller *hose) | |
| { | |
| int devfn; | |
| /* | |
| * Route IDE interrupts directly to the 8259's IRQ 14 & 15. | |
| * We can't route the IDE interrupt to PCI INTC# or INTD# because those | |
| * woule interfere with the PMC's INTC# and INTD# lines. | |
| */ | |
| /* | |
| * Winbond Fcn 0 | |
| */ | |
| devfn = PCI_DEVFN(11,0); | |
| early_write_config_byte(hose, | |
| 0, | |
| devfn, | |
| 0x43, /* IDE Interrupt Routing Control */ | |
| 0xef); | |
| early_write_config_word(hose, | |
| 0, | |
| devfn, | |
| 0x44, /* PCI Interrupt Routing Control */ | |
| 0x0000); | |
| /* Want ISA memory cycles to be forwarded to PCI bus */ | |
| early_write_config_byte(hose, | |
| 0, | |
| devfn, | |
| 0x48, /* ISA-to-PCI Addr Decoder Control */ | |
| 0xf0); | |
| /* Enable Port 92. */ | |
| early_write_config_byte(hose, | |
| 0, | |
| devfn, | |
| 0x4e, /* AT System Control Register */ | |
| 0x06); | |
| /* | |
| * Winbond Fcn 1 | |
| */ | |
| devfn = PCI_DEVFN(11,1); | |
| /* Put IDE controller into native mode. */ | |
| early_write_config_byte(hose, | |
| 0, | |
| devfn, | |
| 0x09, /* Programming interface Register */ | |
| 0x8f); | |
| /* Init IRQ routing, enable both ports, disable fast 16 */ | |
| early_write_config_dword(hose, | |
| 0, | |
| devfn, | |
| 0x40, /* IDE Control/Status Register */ | |
| 0x00ff0011); | |
| return; | |
| } | |
| /* On the sandpoint X2, we must avoid sending configuration cycles to | |
| * device #12 (IDSEL addr = AD12). | |
| */ | |
| static int | |
| x2_exclude_device(u_char bus, u_char devfn) | |
| { | |
| if ((bus == 0) && (PCI_SLOT(devfn) == SANDPOINT_HOST_BRIDGE_IDSEL)) | |
| return PCIBIOS_DEVICE_NOT_FOUND; | |
| else | |
| return PCIBIOS_SUCCESSFUL; | |
| } | |
| static void __init | |
| sandpoint_find_bridges(void) | |
| { | |
| struct pci_controller *hose; | |
| hose = pcibios_alloc_controller(); | |
| if (!hose) | |
| return; | |
| hose->first_busno = 0; | |
| hose->last_busno = 0xff; | |
| if (mpc10x_bridge_init(hose, | |
| MPC10X_MEM_MAP_B, | |
| MPC10X_MEM_MAP_B, | |
| MPC10X_MAPB_EUMB_BASE) == 0) { | |
| /* Do early winbond init, then scan PCI bus */ | |
| sandpoint_setup_winbond_83553(hose); | |
| hose->last_busno = pciauto_bus_scan(hose, hose->first_busno); | |
| ppc_md.pcibios_fixup = NULL; | |
| ppc_md.pcibios_fixup_bus = NULL; | |
| ppc_md.pci_swizzle = common_swizzle; | |
| if (sandpoint_is_x2) { | |
| ppc_md.pci_map_irq = x2_map_irq; | |
| ppc_md.pci_exclude_device = x2_exclude_device; | |
| } else | |
| ppc_md.pci_map_irq = x3_map_irq; | |
| } | |
| else { | |
| if (ppc_md.progress) | |
| ppc_md.progress("Bridge init failed", 0x100); | |
| printk("Host bridge init failed\n"); | |
| } | |
| return; | |
| } | |
| static void __init | |
| sandpoint_setup_arch(void) | |
| { | |
| /* Probe for Sandpoint model */ | |
| sandpoint_probe_type(); | |
| if (sandpoint_is_x2) | |
| epic_serial_mode = 0; | |
| loops_per_jiffy = 100000000 / HZ; | |
| #ifdef CONFIG_BLK_DEV_INITRD | |
| if (initrd_start) | |
| ROOT_DEV = Root_RAM0; | |
| else | |
| #endif | |
| #ifdef CONFIG_ROOT_NFS | |
| ROOT_DEV = Root_NFS; | |
| #else | |
| ROOT_DEV = Root_HDA1; | |
| #endif | |
| /* Lookup PCI host bridges */ | |
| sandpoint_find_bridges(); | |
| if (strncmp (cur_ppc_sys_spec->ppc_sys_name, "8245", 4) == 0) | |
| { | |
| bd_t *bp = (bd_t *)__res; | |
| struct plat_serial8250_port *pdata; | |
| pdata = (struct plat_serial8250_port *) ppc_sys_get_pdata(MPC10X_UART0); | |
| if (pdata) | |
| { | |
| pdata[0].uartclk = bp->bi_busfreq; | |
| } | |
| #ifdef CONFIG_SANDPOINT_ENABLE_UART1 | |
| pdata = (struct plat_serial8250_port *) ppc_sys_get_pdata(MPC10X_UART1); | |
| if (pdata) | |
| { | |
| pdata[0].uartclk = bp->bi_busfreq; | |
| } | |
| #else | |
| ppc_sys_device_remove(MPC10X_UART1); | |
| #endif | |
| } | |
| printk(KERN_INFO "Motorola SPS Sandpoint Test Platform\n"); | |
| printk(KERN_INFO "Port by MontaVista Software, Inc. (source@mvista.com)\n"); | |
| /* DINK32 12.3 and below do not correctly enable any caches. | |
| * We will do this now with good known values. Future versions | |
| * of DINK32 are supposed to get this correct. | |
| */ | |
| if (cpu_has_feature(CPU_FTR_SPEC7450)) | |
| /* 745x is different. We only want to pass along enable. */ | |
| _set_L2CR(L2CR_L2E); | |
| else if (cpu_has_feature(CPU_FTR_L2CR)) | |
| /* All modules have 1MB of L2. We also assume that an | |
| * L2 divisor of 3 will work. | |
| */ | |
| _set_L2CR(L2CR_L2E | L2CR_L2SIZ_1MB | L2CR_L2CLK_DIV3 | |
| | L2CR_L2RAM_PIPE | L2CR_L2OH_1_0 | L2CR_L2DF); | |
| #if 0 | |
| /* Untested right now. */ | |
| if (cpu_has_feature(CPU_FTR_L3CR)) { | |
| /* Magic value. */ | |
| _set_L3CR(0x8f032000); | |
| } | |
| #endif | |
| } | |
| #define SANDPOINT_87308_CFG_ADDR 0x15c | |
| #define SANDPOINT_87308_CFG_DATA 0x15d | |
| #define SANDPOINT_87308_CFG_INB(addr, byte) { \ | |
| outb((addr), SANDPOINT_87308_CFG_ADDR); \ | |
| (byte) = inb(SANDPOINT_87308_CFG_DATA); \ | |
| } | |
| #define SANDPOINT_87308_CFG_OUTB(addr, byte) { \ | |
| outb((addr), SANDPOINT_87308_CFG_ADDR); \ | |
| outb((byte), SANDPOINT_87308_CFG_DATA); \ | |
| } | |
| #define SANDPOINT_87308_SELECT_DEV(dev_num) { \ | |
| SANDPOINT_87308_CFG_OUTB(0x07, (dev_num)); \ | |
| } | |
| #define SANDPOINT_87308_DEV_ENABLE(dev_num) { \ | |
| SANDPOINT_87308_SELECT_DEV(dev_num); \ | |
| SANDPOINT_87308_CFG_OUTB(0x30, 0x01); \ | |
| } | |
| /* | |
| * To probe the Sandpoint type, we need to check for a connection between GPIO | |
| * pins 6 and 7 on the NS87308 SuperIO. | |
| */ | |
| static void __init sandpoint_probe_type(void) | |
| { | |
| u8 x; | |
| /* First, ensure that the GPIO pins are enabled. */ | |
| SANDPOINT_87308_SELECT_DEV(0x07); /* Select GPIO logical device */ | |
| SANDPOINT_87308_CFG_OUTB(0x60, 0x07); /* Base address 0x700 */ | |
| SANDPOINT_87308_CFG_OUTB(0x61, 0x00); | |
| SANDPOINT_87308_CFG_OUTB(0x30, 0x01); /* Enable */ | |
| /* Now, set pin 7 to output and pin 6 to input. */ | |
| outb((inb(0x701) | 0x80) & 0xbf, 0x701); | |
| /* Set push-pull output */ | |
| outb(inb(0x702) | 0x80, 0x702); | |
| /* Set pull-up on input */ | |
| outb(inb(0x703) | 0x40, 0x703); | |
| /* Set output high and check */ | |
| x = inb(0x700); | |
| outb(x | 0x80, 0x700); | |
| x = inb(0x700); | |
| sandpoint_is_x2 = ! (x & 0x40); | |
| if (ppc_md.progress && sandpoint_is_x2) | |
| ppc_md.progress("High output says X2", 0); | |
| /* Set output low and check */ | |
| outb(x & 0x7f, 0x700); | |
| sandpoint_is_x2 |= inb(0x700) & 0x40; | |
| if (ppc_md.progress && sandpoint_is_x2) | |
| ppc_md.progress("Low output says X2", 0); | |
| if (ppc_md.progress && ! sandpoint_is_x2) | |
| ppc_md.progress("Sandpoint is X3", 0); | |
| } | |
| /* | |
| * Fix IDE interrupts. | |
| */ | |
| static int __init | |
| sandpoint_fix_winbond_83553(void) | |
| { | |
| /* Make some 8259 interrupt level sensitive */ | |
| outb(0xe0, 0x4d0); | |
| outb(0xde, 0x4d1); | |
| return 0; | |
| } | |
| arch_initcall(sandpoint_fix_winbond_83553); | |
| /* | |
| * Initialize the ISA devices on the Nat'l PC87308VUL SuperIO chip. | |
| */ | |
| static int __init | |
| sandpoint_setup_natl_87308(void) | |
| { | |
| u_char reg; | |
| /* | |
| * Enable all the devices on the Super I/O chip. | |
| */ | |
| SANDPOINT_87308_SELECT_DEV(0x00); /* Select kbd logical device */ | |
| SANDPOINT_87308_CFG_OUTB(0xf0, 0x00); /* Set KBC clock to 8 Mhz */ | |
| SANDPOINT_87308_DEV_ENABLE(0x00); /* Enable keyboard */ | |
| SANDPOINT_87308_DEV_ENABLE(0x01); /* Enable mouse */ | |
| SANDPOINT_87308_DEV_ENABLE(0x02); /* Enable rtc */ | |
| SANDPOINT_87308_DEV_ENABLE(0x03); /* Enable fdc (floppy) */ | |
| SANDPOINT_87308_DEV_ENABLE(0x04); /* Enable parallel */ | |
| SANDPOINT_87308_DEV_ENABLE(0x05); /* Enable UART 2 */ | |
| SANDPOINT_87308_CFG_OUTB(0xf0, 0x82); /* Enable bank select regs */ | |
| SANDPOINT_87308_DEV_ENABLE(0x06); /* Enable UART 1 */ | |
| SANDPOINT_87308_CFG_OUTB(0xf0, 0x82); /* Enable bank select regs */ | |
| /* Set up floppy in PS/2 mode */ | |
| outb(0x09, SIO_CONFIG_RA); | |
| reg = inb(SIO_CONFIG_RD); | |
| reg = (reg & 0x3F) | 0x40; | |
| outb(reg, SIO_CONFIG_RD); | |
| outb(reg, SIO_CONFIG_RD); /* Have to write twice to change! */ | |
| return 0; | |
| } | |
| arch_initcall(sandpoint_setup_natl_87308); | |
| static int __init | |
| sandpoint_request_io(void) | |
| { | |
| request_region(0x00,0x20,"dma1"); | |
| request_region(0x20,0x20,"pic1"); | |
| request_region(0x40,0x20,"timer"); | |
| request_region(0x80,0x10,"dma page reg"); | |
| request_region(0xa0,0x20,"pic2"); | |
| request_region(0xc0,0x20,"dma2"); | |
| return 0; | |
| } | |
| arch_initcall(sandpoint_request_io); | |
| /* | |
| * Interrupt setup and service. Interrrupts on the Sandpoint come | |
| * from the four PCI slots plus the 8259 in the Winbond Super I/O (SIO). | |
| * The 8259 is cascaded from EPIC IRQ0, IRQ1-4 map to PCI slots 1-4, | |
| * IDE is on EPIC 7 and 8. | |
| */ | |
| static void __init | |
| sandpoint_init_IRQ(void) | |
| { | |
| int i; | |
| OpenPIC_InitSenses = sandpoint_openpic_initsenses; | |
| OpenPIC_NumInitSenses = sizeof(sandpoint_openpic_initsenses); | |
| mpc10x_set_openpic(); | |
| openpic_hookup_cascade(sandpoint_is_x2 ? 17 : NUM_8259_INTERRUPTS, "82c59 cascade", | |
| i8259_irq); | |
| /* | |
| * The EPIC allows for a read in the range of 0xFEF00000 -> | |
| * 0xFEFFFFFF to generate a PCI interrupt-acknowledge transaction. | |
| */ | |
| i8259_init(0xfef00000, 0); | |
| } | |
| static unsigned long __init | |
| sandpoint_find_end_of_memory(void) | |
| { | |
| bd_t *bp = (bd_t *)__res; | |
| if (bp->bi_memsize) | |
| return bp->bi_memsize; | |
| /* DINK32 13.0 correctly initalizes things, so iff you use | |
| * this you _should_ be able to change this instead of a | |
| * hardcoded value. */ | |
| #if 0 | |
| return mpc10x_get_mem_size(MPC10X_MEM_MAP_B); | |
| #else | |
| return 32*1024*1024; | |
| #endif | |
| } | |
| static void __init | |
| sandpoint_map_io(void) | |
| { | |
| io_block_mapping(0xfe000000, 0xfe000000, 0x02000000, _PAGE_IO); | |
| } | |
| static void | |
| sandpoint_restart(char *cmd) | |
| { | |
| local_irq_disable(); | |
| /* Set exception prefix high - to the firmware */ | |
| _nmask_and_or_msr(0, MSR_IP); | |
| /* Reset system via Port 92 */ | |
| outb(0x00, 0x92); | |
| outb(0x01, 0x92); | |
| for(;;); /* Spin until reset happens */ | |
| } | |
| static void | |
| sandpoint_power_off(void) | |
| { | |
| local_irq_disable(); | |
| for(;;); /* No way to shut power off with software */ | |
| /* NOTREACHED */ | |
| } | |
| static void | |
| sandpoint_halt(void) | |
| { | |
| sandpoint_power_off(); | |
| /* NOTREACHED */ | |
| } | |
| static int | |
| sandpoint_show_cpuinfo(struct seq_file *m) | |
| { | |
| seq_printf(m, "vendor\t\t: Motorola SPS\n"); | |
| seq_printf(m, "machine\t\t: Sandpoint\n"); | |
| return 0; | |
| } | |
| #if defined(CONFIG_BLK_DEV_IDE) || defined(CONFIG_BLK_DEV_IDE_MODULE) | |
| /* | |
| * IDE support. | |
| */ | |
| static int sandpoint_ide_ports_known = 0; | |
| static unsigned long sandpoint_ide_regbase[MAX_HWIFS]; | |
| static unsigned long sandpoint_ide_ctl_regbase[MAX_HWIFS]; | |
| static unsigned long sandpoint_idedma_regbase; | |
| static void | |
| sandpoint_ide_probe(void) | |
| { | |
| struct pci_dev *pdev = pci_get_device(PCI_VENDOR_ID_WINBOND, | |
| PCI_DEVICE_ID_WINBOND_82C105, NULL); | |
| if (pdev) { | |
| sandpoint_ide_regbase[0]=pdev->resource[0].start; | |
| sandpoint_ide_regbase[1]=pdev->resource[2].start; | |
| sandpoint_ide_ctl_regbase[0]=pdev->resource[1].start; | |
| sandpoint_ide_ctl_regbase[1]=pdev->resource[3].start; | |
| sandpoint_idedma_regbase=pdev->resource[4].start; | |
| pci_dev_put(pdev); | |
| } | |
| sandpoint_ide_ports_known = 1; | |
| } | |
| static int | |
| sandpoint_ide_default_irq(unsigned long base) | |
| { | |
| if (sandpoint_ide_ports_known == 0) | |
| sandpoint_ide_probe(); | |
| if (base == sandpoint_ide_regbase[0]) | |
| return SANDPOINT_IDE_INT0; | |
| else if (base == sandpoint_ide_regbase[1]) | |
| return SANDPOINT_IDE_INT1; | |
| else | |
| return 0; | |
| } | |
| static unsigned long | |
| sandpoint_ide_default_io_base(int index) | |
| { | |
| if (sandpoint_ide_ports_known == 0) | |
| sandpoint_ide_probe(); | |
| return sandpoint_ide_regbase[index]; | |
| } | |
| static void __init | |
| sandpoint_ide_init_hwif_ports(hw_regs_t *hw, unsigned long data_port, | |
| unsigned long ctrl_port, int *irq) | |
| { | |
| unsigned long reg = data_port; | |
| uint alt_status_base; | |
| int i; | |
| for (i = IDE_DATA_OFFSET; i <= IDE_STATUS_OFFSET; i++) { | |
| hw->io_ports[i] = reg++; | |
| } | |
| if (data_port == sandpoint_ide_regbase[0]) { | |
| alt_status_base = sandpoint_ide_ctl_regbase[0] + 2; | |
| hw->irq = 14; | |
| } | |
| else if (data_port == sandpoint_ide_regbase[1]) { | |
| alt_status_base = sandpoint_ide_ctl_regbase[1] + 2; | |
| hw->irq = 15; | |
| } | |
| else { | |
| alt_status_base = 0; | |
| hw->irq = 0; | |
| } | |
| if (ctrl_port) { | |
| hw->io_ports[IDE_CONTROL_OFFSET] = ctrl_port; | |
| } else { | |
| hw->io_ports[IDE_CONTROL_OFFSET] = alt_status_base; | |
| } | |
| if (irq != NULL) { | |
| *irq = hw->irq; | |
| } | |
| } | |
| #endif | |
| /* | |
| * Set BAT 3 to map 0xf8000000 to end of physical memory space 1-to-1. | |
| */ | |
| static __inline__ void | |
| sandpoint_set_bat(void) | |
| { | |
| unsigned long bat3u, bat3l; | |
| __asm__ __volatile__( | |
| " lis %0,0xf800\n \ | |
| ori %1,%0,0x002a\n \ | |
| ori %0,%0,0x0ffe\n \ | |
| mtspr 0x21e,%0\n \ | |
| mtspr 0x21f,%1\n \ | |
| isync\n \ | |
| sync " | |
| : "=r" (bat3u), "=r" (bat3l)); | |
| } | |
| TODC_ALLOC(); | |
| void __init | |
| platform_init(unsigned long r3, unsigned long r4, unsigned long r5, | |
| unsigned long r6, unsigned long r7) | |
| { | |
| parse_bootinfo(find_bootinfo()); | |
| /* ASSUMPTION: If both r3 (bd_t pointer) and r6 (cmdline pointer) | |
| * are non-zero, then we should use the board info from the bd_t | |
| * structure and the cmdline pointed to by r6 instead of the | |
| * information from birecs, if any. Otherwise, use the information | |
| * from birecs as discovered by the preceeding call to | |
| * parse_bootinfo(). This rule should work with both PPCBoot, which | |
| * uses a bd_t board info structure, and the kernel boot wrapper, | |
| * which uses birecs. | |
| */ | |
| if (r3 && r6) { | |
| /* copy board info structure */ | |
| memcpy( (void *)__res,(void *)(r3+KERNELBASE), sizeof(bd_t) ); | |
| /* copy command line */ | |
| *(char *)(r7+KERNELBASE) = 0; | |
| strcpy(cmd_line, (char *)(r6+KERNELBASE)); | |
| } | |
| #ifdef CONFIG_BLK_DEV_INITRD | |
| /* take care of initrd if we have one */ | |
| if (r4) { | |
| initrd_start = r4 + KERNELBASE; | |
| initrd_end = r5 + KERNELBASE; | |
| } | |
| #endif /* CONFIG_BLK_DEV_INITRD */ | |
| /* Map in board regs, etc. */ | |
| sandpoint_set_bat(); | |
| isa_io_base = MPC10X_MAPB_ISA_IO_BASE; | |
| isa_mem_base = MPC10X_MAPB_ISA_MEM_BASE; | |
| pci_dram_offset = MPC10X_MAPB_DRAM_OFFSET; | |
| ISA_DMA_THRESHOLD = 0x00ffffff; | |
| DMA_MODE_READ = 0x44; | |
| DMA_MODE_WRITE = 0x48; | |
| ppc_do_canonicalize_irqs = 1; | |
| ppc_md.setup_arch = sandpoint_setup_arch; | |
| ppc_md.show_cpuinfo = sandpoint_show_cpuinfo; | |
| ppc_md.init_IRQ = sandpoint_init_IRQ; | |
| ppc_md.get_irq = openpic_get_irq; | |
| ppc_md.restart = sandpoint_restart; | |
| ppc_md.power_off = sandpoint_power_off; | |
| ppc_md.halt = sandpoint_halt; | |
| ppc_md.find_end_of_memory = sandpoint_find_end_of_memory; | |
| ppc_md.setup_io_mappings = sandpoint_map_io; | |
| TODC_INIT(TODC_TYPE_PC97307, 0x70, 0x00, 0x71, 8); | |
| ppc_md.time_init = todc_time_init; | |
| ppc_md.set_rtc_time = todc_set_rtc_time; | |
| ppc_md.get_rtc_time = todc_get_rtc_time; | |
| ppc_md.calibrate_decr = todc_calibrate_decr; | |
| ppc_md.nvram_read_val = todc_mc146818_read_val; | |
| ppc_md.nvram_write_val = todc_mc146818_write_val; | |
| #ifdef CONFIG_KGDB | |
| ppc_md.kgdb_map_scc = gen550_kgdb_map_scc; | |
| #endif | |
| #ifdef CONFIG_SERIAL_TEXT_DEBUG | |
| ppc_md.progress = gen550_progress; | |
| #endif | |
| #if defined(CONFIG_BLK_DEV_IDE) || defined(CONFIG_BLK_DEV_IDE_MODULE) | |
| ppc_ide_md.default_irq = sandpoint_ide_default_irq; | |
| ppc_ide_md.default_io_base = sandpoint_ide_default_io_base; | |
| ppc_ide_md.ide_init_hwif = sandpoint_ide_init_hwif_ports; | |
| #endif | |
| } |