summaryrefslogtreecommitdiffstats
path: root/arch/arm/boards/animeo_ip/init.c
diff options
context:
space:
mode:
Diffstat (limited to 'arch/arm/boards/animeo_ip/init.c')
-rw-r--r--arch/arm/boards/animeo_ip/init.c88
1 files changed, 83 insertions, 5 deletions
diff --git a/arch/arm/boards/animeo_ip/init.c b/arch/arm/boards/animeo_ip/init.c
index 81a8cdf..2fee1ff 100644
--- a/arch/arm/boards/animeo_ip/init.c
+++ b/arch/arm/boards/animeo_ip/init.c
@@ -327,20 +327,37 @@ static int animeo_ip_devices_init(void)
device_initcall(animeo_ip_devices_init);
-static int animeo_ip_console_init(void)
+static struct device_d *usart0, *usart1;
+
+static void animeo_ip_shutdown_uart(void *base)
+{
+#define ATMEL_US_BRGR 0x0020
+ writel(0, base + ATMEL_US_BRGR);
+}
+
+static void animeo_ip_shutdown(void)
{
/*
- * disable the dbgu enable by the bootstrap
+ * disable the dbgu and others enable by the bootstrap
* so linux can detect that we only enable the uart2
* and use it for decompress
*/
-#define ATMEL_US_BRGR 0x0020
- at91_sys_write(AT91_DBGU + ATMEL_US_BRGR, 0);
+ animeo_ip_shutdown_uart(IOMEM(AT91_DBGU + AT91_BASE_SYS));
+ animeo_ip_shutdown_uart(IOMEM(AT91SAM9260_BASE_US0));
+ animeo_ip_shutdown_uart(IOMEM(AT91SAM9260_BASE_US1));
+}
+
+static int animeo_ip_console_init(void)
+{
+ at91_register_uart(3, 0);
+
+ usart0 = at91_register_uart(1, ATMEL_UART_RTS);
+ usart1 = at91_register_uart(2, ATMEL_UART_RTS);
+ board_shutdown = animeo_ip_shutdown;
barebox_set_model("Somfy Animeo IP");
barebox_set_hostname("animeoip");
- at91_register_uart(3, 0);
return 0;
}
console_initcall(animeo_ip_console_init);
@@ -351,3 +368,64 @@ static int animeo_ip_main_clock(void)
return 0;
}
pure_initcall(animeo_ip_main_clock);
+
+static unsigned int get_char_timeout(struct console_device *cs, int timeout)
+{
+ uint64_t start = get_time_ns();
+
+ do {
+ if (!cs->tstc(cs))
+ continue;
+ return cs->getc(cs);
+ } while (!is_timeout(start, timeout));
+
+ return -1;
+}
+
+static int animeo_ip_cross_detect_init(void)
+{
+ struct console_device *cs0, *cs1;
+ int i;
+ char *s = "loop";
+ int crossed = 0;
+
+ cs0 = console_get_by_dev(usart0);
+ if (!cs0)
+ return -EINVAL;
+ cs1 = console_get_by_dev(usart1);
+ if (!cs1)
+ return -EINVAL;
+
+ at91_set_gpio_input(AT91_PIN_PC16, 0);
+ cs0->set_mode(cs0, CONSOLE_MODE_RS485);
+ cs0->setbrg(cs0, 38400);
+ cs1->set_mode(cs1, CONSOLE_MODE_RS485);
+ cs1->setbrg(cs1, 38400);
+
+ /* empty the bus */
+ while (cs1->tstc(cs1))
+ cs1->getc(cs1);
+
+ for (i = 0; i < strlen(s); i++) {
+ unsigned int ch = s[i];
+ unsigned int c;
+
+resend:
+ cs0->putc(cs0, ch);
+ c = get_char_timeout(cs1, 10 * MSECOND);
+ if (c == 0)
+ goto resend;
+ else if (c != ch)
+ goto err;
+ }
+
+ crossed = 1;
+
+err:
+ export_env_ull("rs485_crossed", crossed);
+
+ pr_info("rs485 ports %scrossed\n", crossed ? "" : "not ");
+
+ return 0;
+}
+late_initcall(animeo_ip_cross_detect_init);