 6bb27d7349
			
		
	
	
	6bb27d7349
	
	
	
		
			
			Now that the only field in struct sys_timer is .init, delete the struct, and replace the machine descriptor .timer field with the initialization function itself. This will enable moving timer drivers into drivers/clocksource without having to place a public prototype of each struct sys_timer object into include/linux; the intent is to create a single of_clocksource_init() function that determines which timer driver to initialize by scanning the device dtree, much like the proposed irqchip_init() at: http://www.spinics.net/lists/arm-kernel/msg203686.html Includes mach-omap2 fixes from Igor Grinberg. Tested-by: Robert Jarzmik <robert.jarzmik@free.fr> Signed-off-by: Stephen Warren <swarren@nvidia.com>
		
			
				
	
	
		
			367 lines
		
	
	
	
		
			9.3 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			367 lines
		
	
	
	
		
			9.3 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * Buffalo Terastation Pro II/Live Board Setup
 | |
|  *
 | |
|  * Maintainer: Sylver Bruneau <sylver.bruneau@googlemail.com>
 | |
|  *
 | |
|  * This program is free software; you can redistribute it and/or
 | |
|  * modify it under the terms of the GNU General Public License
 | |
|  * as published by the Free Software Foundation; either version
 | |
|  * 2 of the License, or (at your option) any later version.
 | |
|  */
 | |
| #include <linux/gpio.h>
 | |
| #include <linux/kernel.h>
 | |
| #include <linux/init.h>
 | |
| #include <linux/platform_device.h>
 | |
| #include <linux/pci.h>
 | |
| #include <linux/irq.h>
 | |
| #include <linux/delay.h>
 | |
| #include <linux/mtd/physmap.h>
 | |
| #include <linux/mv643xx_eth.h>
 | |
| #include <linux/i2c.h>
 | |
| #include <linux/serial_reg.h>
 | |
| #include <asm/mach-types.h>
 | |
| #include <asm/mach/arch.h>
 | |
| #include <asm/mach/pci.h>
 | |
| #include <mach/orion5x.h>
 | |
| #include "common.h"
 | |
| #include "mpp.h"
 | |
| 
 | |
| /*****************************************************************************
 | |
|  * Terastation Pro 2/Live Info
 | |
|  ****************************************************************************/
 | |
| 
 | |
| /*
 | |
|  * Terastation Pro 2 hardware :
 | |
|  * - Marvell 88F5281-D0
 | |
|  * - Marvell 88SX6042 SATA controller (PCI)
 | |
|  * - Marvell 88E1118 Gigabit Ethernet PHY
 | |
|  * - 256KB NOR flash
 | |
|  * - 128MB of DDR RAM
 | |
|  * - PCIe port (not equipped)
 | |
|  */
 | |
| 
 | |
| /*
 | |
|  * 256K NOR flash Device bus boot chip select
 | |
|  */
 | |
| 
 | |
| #define TSP2_NOR_BOOT_BASE	0xf4000000
 | |
| #define TSP2_NOR_BOOT_SIZE	SZ_256K
 | |
| 
 | |
| /*****************************************************************************
 | |
|  * 256KB NOR Flash on BOOT Device
 | |
|  ****************************************************************************/
 | |
| 
 | |
| static struct physmap_flash_data tsp2_nor_flash_data = {
 | |
| 	.width    = 1,
 | |
| };
 | |
| 
 | |
| static struct resource tsp2_nor_flash_resource = {
 | |
| 	.flags = IORESOURCE_MEM,
 | |
| 	.start = TSP2_NOR_BOOT_BASE,
 | |
| 	.end   = TSP2_NOR_BOOT_BASE + TSP2_NOR_BOOT_SIZE - 1,
 | |
| };
 | |
| 
 | |
| static struct platform_device tsp2_nor_flash = {
 | |
| 	.name          = "physmap-flash",
 | |
| 	.id            = 0,
 | |
| 	.dev           = {
 | |
| 		.platform_data	= &tsp2_nor_flash_data,
 | |
| 	},
 | |
| 	.num_resources = 1,
 | |
| 	.resource      = &tsp2_nor_flash_resource,
 | |
| };
 | |
| 
 | |
| /*****************************************************************************
 | |
|  * PCI
 | |
|  ****************************************************************************/
 | |
| #define TSP2_PCI_SLOT0_OFFS		7
 | |
| #define TSP2_PCI_SLOT0_IRQ_PIN		11
 | |
| 
 | |
| void __init tsp2_pci_preinit(void)
 | |
| {
 | |
| 	int pin;
 | |
| 
 | |
| 	/*
 | |
| 	 * Configure PCI GPIO IRQ pins
 | |
| 	 */
 | |
| 	pin = TSP2_PCI_SLOT0_IRQ_PIN;
 | |
| 	if (gpio_request(pin, "PCI Int1") == 0) {
 | |
| 		if (gpio_direction_input(pin) == 0) {
 | |
| 			irq_set_irq_type(gpio_to_irq(pin), IRQ_TYPE_LEVEL_LOW);
 | |
| 		} else {
 | |
| 			printk(KERN_ERR "tsp2_pci_preinit failed "
 | |
| 					"to set_irq_type pin %d\n", pin);
 | |
| 			gpio_free(pin);
 | |
| 		}
 | |
| 	} else {
 | |
| 		printk(KERN_ERR "tsp2_pci_preinit failed to "
 | |
| 				"gpio_request %d\n", pin);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static int __init tsp2_pci_map_irq(const struct pci_dev *dev, u8 slot, u8 pin)
 | |
| {
 | |
| 	int irq;
 | |
| 
 | |
| 	/*
 | |
| 	 * Check for devices with hard-wired IRQs.
 | |
| 	 */
 | |
| 	irq = orion5x_pci_map_irq(dev, slot, pin);
 | |
| 	if (irq != -1)
 | |
| 		return irq;
 | |
| 
 | |
| 	/*
 | |
| 	 * PCI IRQs are connected via GPIOs.
 | |
| 	 */
 | |
| 	if (slot == TSP2_PCI_SLOT0_OFFS)
 | |
| 		return gpio_to_irq(TSP2_PCI_SLOT0_IRQ_PIN);
 | |
| 
 | |
| 	return -1;
 | |
| }
 | |
| 
 | |
| static struct hw_pci tsp2_pci __initdata = {
 | |
| 	.nr_controllers = 2,
 | |
| 	.preinit        = tsp2_pci_preinit,
 | |
| 	.setup          = orion5x_pci_sys_setup,
 | |
| 	.scan           = orion5x_pci_sys_scan_bus,
 | |
| 	.map_irq        = tsp2_pci_map_irq,
 | |
| };
 | |
| 
 | |
| static int __init tsp2_pci_init(void)
 | |
| {
 | |
| 	if (machine_is_terastation_pro2())
 | |
| 		pci_common_init(&tsp2_pci);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| subsys_initcall(tsp2_pci_init);
 | |
| 
 | |
| /*****************************************************************************
 | |
|  * Ethernet
 | |
|  ****************************************************************************/
 | |
| 
 | |
| static struct mv643xx_eth_platform_data tsp2_eth_data = {
 | |
| 	.phy_addr	= 0,
 | |
| };
 | |
| 
 | |
| /*****************************************************************************
 | |
|  * RTC 5C372a on I2C bus
 | |
|  ****************************************************************************/
 | |
| 
 | |
| #define TSP2_RTC_GPIO	9
 | |
| 
 | |
| static struct i2c_board_info __initdata tsp2_i2c_rtc = {
 | |
| 	I2C_BOARD_INFO("rs5c372a", 0x32),
 | |
| };
 | |
| 
 | |
| /*****************************************************************************
 | |
|  * Terastation Pro II specific power off method via UART1-attached
 | |
|  * microcontroller
 | |
|  ****************************************************************************/
 | |
| 
 | |
| #define UART1_REG(x)	(UART1_VIRT_BASE + ((UART_##x) << 2))
 | |
| 
 | |
| static int tsp2_miconread(unsigned char *buf, int count)
 | |
| {
 | |
| 	int i;
 | |
| 	int timeout;
 | |
| 
 | |
| 	for (i = 0; i < count; i++) {
 | |
| 		timeout = 10;
 | |
| 
 | |
| 		while (!(readl(UART1_REG(LSR)) & UART_LSR_DR)) {
 | |
| 			if (--timeout == 0)
 | |
| 				break;
 | |
| 			udelay(1000);
 | |
| 		}
 | |
| 
 | |
| 		if (timeout == 0)
 | |
| 			break;
 | |
| 		buf[i] = readl(UART1_REG(RX));
 | |
| 	}
 | |
| 
 | |
| 	/* return read bytes */
 | |
| 	return i;
 | |
| }
 | |
| 
 | |
| static int tsp2_miconwrite(const unsigned char *buf, int count)
 | |
| {
 | |
| 	int i = 0;
 | |
| 
 | |
| 	while (count--) {
 | |
| 		while (!(readl(UART1_REG(LSR)) & UART_LSR_THRE))
 | |
| 			barrier();
 | |
| 		writel(buf[i++], UART1_REG(TX));
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int tsp2_miconsend(const unsigned char *data, int count)
 | |
| {
 | |
| 	int i;
 | |
| 	unsigned char checksum = 0;
 | |
| 	unsigned char recv_buf[40];
 | |
| 	unsigned char send_buf[40];
 | |
| 	unsigned char correct_ack[3];
 | |
| 	int retry = 2;
 | |
| 
 | |
| 	/* Generate checksum */
 | |
| 	for (i = 0; i < count; i++)
 | |
| 		checksum -=  data[i];
 | |
| 
 | |
| 	do {
 | |
| 		/* Send data */
 | |
| 		tsp2_miconwrite(data, count);
 | |
| 
 | |
| 		/* send checksum */
 | |
| 		tsp2_miconwrite(&checksum, 1);
 | |
| 
 | |
| 		if (tsp2_miconread(recv_buf, sizeof(recv_buf)) <= 3) {
 | |
| 			printk(KERN_ERR ">%s: receive failed.\n", __func__);
 | |
| 
 | |
| 			/* send preamble to clear the receive buffer */
 | |
| 			memset(&send_buf, 0xff, sizeof(send_buf));
 | |
| 			tsp2_miconwrite(send_buf, sizeof(send_buf));
 | |
| 
 | |
| 			/* make dummy reads */
 | |
| 			mdelay(100);
 | |
| 			tsp2_miconread(recv_buf, sizeof(recv_buf));
 | |
| 		} else {
 | |
| 			/* Generate expected ack */
 | |
| 			correct_ack[0] = 0x01;
 | |
| 			correct_ack[1] = data[1];
 | |
| 			correct_ack[2] = 0x00;
 | |
| 
 | |
| 			/* checksum Check */
 | |
| 			if ((recv_buf[0] + recv_buf[1] + recv_buf[2] +
 | |
| 			     recv_buf[3]) & 0xFF) {
 | |
| 				printk(KERN_ERR ">%s: Checksum Error : "
 | |
| 					"Received data[%02x, %02x, %02x, %02x]"
 | |
| 					"\n", __func__, recv_buf[0],
 | |
| 					recv_buf[1], recv_buf[2], recv_buf[3]);
 | |
| 			} else {
 | |
| 				/* Check Received Data */
 | |
| 				if (correct_ack[0] == recv_buf[0] &&
 | |
| 				    correct_ack[1] == recv_buf[1] &&
 | |
| 				    correct_ack[2] == recv_buf[2]) {
 | |
| 					/* Interval for next command */
 | |
| 					mdelay(10);
 | |
| 
 | |
| 					/* Receive ACK */
 | |
| 					return 0;
 | |
| 				}
 | |
| 			}
 | |
| 			/* Received NAK or illegal Data */
 | |
| 			printk(KERN_ERR ">%s: Error : NAK or Illegal Data "
 | |
| 					"Received\n", __func__);
 | |
| 		}
 | |
| 	} while (retry--);
 | |
| 
 | |
| 	/* Interval for next command */
 | |
| 	mdelay(10);
 | |
| 
 | |
| 	return -1;
 | |
| }
 | |
| 
 | |
| static void tsp2_power_off(void)
 | |
| {
 | |
| 	const unsigned char watchdogkill[]	= {0x01, 0x35, 0x00};
 | |
| 	const unsigned char shutdownwait[]	= {0x00, 0x0c};
 | |
| 	const unsigned char poweroff[]		= {0x00, 0x06};
 | |
| 	/* 38400 baud divisor */
 | |
| 	const unsigned divisor = ((orion5x_tclk + (8 * 38400)) / (16 * 38400));
 | |
| 
 | |
| 	pr_info("%s: triggering power-off...\n", __func__);
 | |
| 
 | |
| 	/* hijack uart1 and reset into sane state (38400,8n1,even parity) */
 | |
| 	writel(0x83, UART1_REG(LCR));
 | |
| 	writel(divisor & 0xff, UART1_REG(DLL));
 | |
| 	writel((divisor >> 8) & 0xff, UART1_REG(DLM));
 | |
| 	writel(0x1b, UART1_REG(LCR));
 | |
| 	writel(0x00, UART1_REG(IER));
 | |
| 	writel(0x07, UART1_REG(FCR));
 | |
| 	writel(0x00, UART1_REG(MCR));
 | |
| 
 | |
| 	/* Send the commands to shutdown the Terastation Pro II */
 | |
| 	tsp2_miconsend(watchdogkill, sizeof(watchdogkill)) ;
 | |
| 	tsp2_miconsend(shutdownwait, sizeof(shutdownwait)) ;
 | |
| 	tsp2_miconsend(poweroff, sizeof(poweroff));
 | |
| }
 | |
| 
 | |
| /*****************************************************************************
 | |
|  * General Setup
 | |
|  ****************************************************************************/
 | |
| static unsigned int tsp2_mpp_modes[] __initdata = {
 | |
| 	MPP0_PCIE_RST_OUTn,
 | |
| 	MPP1_UNUSED,
 | |
| 	MPP2_UNUSED,
 | |
| 	MPP3_UNUSED,
 | |
| 	MPP4_NAND,		/* BOOT NAND Flash REn */
 | |
| 	MPP5_NAND,		/* BOOT NAND Flash WEn */
 | |
| 	MPP6_NAND,		/* BOOT NAND Flash HREn[0] */
 | |
| 	MPP7_NAND,		/* BOOT NAND Flash WEn[0] */
 | |
| 	MPP8_GPIO,		/* MICON int */
 | |
| 	MPP9_GPIO,		/* RTC int */
 | |
| 	MPP10_UNUSED,
 | |
| 	MPP11_GPIO,		/* PCI Int A */
 | |
| 	MPP12_UNUSED,
 | |
| 	MPP13_GPIO,		/* UPS on UART0 enable */
 | |
| 	MPP14_GPIO,		/* UPS low battery detection */
 | |
| 	MPP15_UNUSED,
 | |
| 	MPP16_UART,		/* UART1 RXD */
 | |
| 	MPP17_UART,		/* UART1 TXD */
 | |
| 	MPP18_UART,		/* UART1 CTSn */
 | |
| 	MPP19_UART,		/* UART1 RTSn */
 | |
| 	0,
 | |
| };
 | |
| 
 | |
| static void __init tsp2_init(void)
 | |
| {
 | |
| 	/*
 | |
| 	 * Setup basic Orion functions. Need to be called early.
 | |
| 	 */
 | |
| 	orion5x_init();
 | |
| 
 | |
| 	orion5x_mpp_conf(tsp2_mpp_modes);
 | |
| 
 | |
| 	/*
 | |
| 	 * Configure peripherals.
 | |
| 	 */
 | |
| 	orion5x_setup_dev_boot_win(TSP2_NOR_BOOT_BASE,
 | |
| 				   TSP2_NOR_BOOT_SIZE);
 | |
| 	platform_device_register(&tsp2_nor_flash);
 | |
| 
 | |
| 	orion5x_ehci0_init();
 | |
| 	orion5x_eth_init(&tsp2_eth_data);
 | |
| 	orion5x_i2c_init();
 | |
| 	orion5x_uart0_init();
 | |
| 	orion5x_uart1_init();
 | |
| 
 | |
| 	/* Get RTC IRQ and register the chip */
 | |
| 	if (gpio_request(TSP2_RTC_GPIO, "rtc") == 0) {
 | |
| 		if (gpio_direction_input(TSP2_RTC_GPIO) == 0)
 | |
| 			tsp2_i2c_rtc.irq = gpio_to_irq(TSP2_RTC_GPIO);
 | |
| 		else
 | |
| 			gpio_free(TSP2_RTC_GPIO);
 | |
| 	}
 | |
| 	if (tsp2_i2c_rtc.irq == 0)
 | |
| 		pr_warning("tsp2_init: failed to get RTC IRQ\n");
 | |
| 	i2c_register_board_info(0, &tsp2_i2c_rtc, 1);
 | |
| 
 | |
| 	/* register Terastation Pro II specific power-off method */
 | |
| 	pm_power_off = tsp2_power_off;
 | |
| }
 | |
| 
 | |
| MACHINE_START(TERASTATION_PRO2, "Buffalo Terastation Pro II/Live")
 | |
| 	/* Maintainer:  Sylver Bruneau <sylver.bruneau@googlemail.com> */
 | |
| 	.atag_offset	= 0x100,
 | |
| 	.init_machine	= tsp2_init,
 | |
| 	.map_io		= orion5x_map_io,
 | |
| 	.init_early	= orion5x_init_early,
 | |
| 	.init_irq	= orion5x_init_irq,
 | |
| 	.init_time	= orion5x_timer_init,
 | |
| 	.fixup		= tag_fixup_mem32,
 | |
| 	.restart	= orion5x_restart,
 | |
| MACHINE_END
 |