|
@@ -244,3 +244,124 @@ static int tsp2_miconsend(const unsigned char *data, int count)
|
|
} else {
|
|
} else {
|
|
/* Check Received Data */
|
|
/* Check Received Data */
|
|
if (correct_ack[0] == recv_buf[0] &&
|
|
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
|