arch/arm/mach-orion5x/terastation_pro2-setup.c - kernel/msm-4.9 - Gitiles

 /*
  * 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,
 	.timer		= &orion5x_timer,
 	.fixup		= tag_fixup_mem32,
 	.restart	= orion5x_restart,
 MACHINE_END
	/*
	* 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,
	.timer = &orion5x_timer,
	.fixup = tag_fixup_mem32,
	.restart = orion5x_restart,
	MACHINE_END