[ARM] 4757/1: [AT91] UART initialization

[linux-2.6-omap-h63xx.git] / arch / arm / mach-at91 / at91sam9rl_devices.c

diff --git a/arch/arm/mach-at91/at91sam9rl_devices.c b/arch/arm/mach-at91/at91sam9rl_devices.c
index e886cdfe919d6eb89e8cb14bd8bd3e031375b2de..a942b9e355605bdc22007a853cd72b58ee5433cd 100644 (file)
--- a/arch/arm/mach-at91/at91sam9rl_devices.c
+++ b/arch/arm/mach-at91/at91sam9rl_devices.c
@@ -676,12 +676,23 @@ static struct platform_device at91sam9rl_uart0_device = {
        .num_resources  = ARRAY_SIZE(uart0_resources),
 };
 
-static inline void configure_usart0_pins(void)
+static inline void configure_usart0_pins(unsigned pins)
 {
        at91_set_A_periph(AT91_PIN_PA6, 1);             /* TXD0 */
        at91_set_A_periph(AT91_PIN_PA7, 0);             /* RXD0 */
-       at91_set_A_periph(AT91_PIN_PA9, 0);             /* RTS0 */
-       at91_set_A_periph(AT91_PIN_PA10, 0);            /* CTS0 */
+
+       if (pins & ATMEL_UART_RTS)
+               at91_set_A_periph(AT91_PIN_PA9, 0);     /* RTS0 */
+       if (pins & ATMEL_UART_CTS)
+               at91_set_A_periph(AT91_PIN_PA10, 0);    /* CTS0 */
+       if (pins & ATMEL_UART_DSR)
+               at91_set_A_periph(AT91_PIN_PD14, 0);    /* DSR0 */
+       if (pins & ATMEL_UART_DTR)
+               at91_set_A_periph(AT91_PIN_PD15, 0);    /* DTR0 */
+       if (pins & ATMEL_UART_DCD)
+               at91_set_A_periph(AT91_PIN_PD16, 0);    /* DCD0 */
+       if (pins & ATMEL_UART_RI)
+               at91_set_A_periph(AT91_PIN_PD17, 0);    /* RI0 */
 }
 
 static struct resource uart1_resources[] = {
@@ -716,10 +727,15 @@ static struct platform_device at91sam9rl_uart1_device = {
        .num_resources  = ARRAY_SIZE(uart1_resources),
 };
 
-static inline void configure_usart1_pins(void)
+static inline void configure_usart1_pins(unsigned pins)
 {
        at91_set_A_periph(AT91_PIN_PA11, 1);            /* TXD1 */
        at91_set_A_periph(AT91_PIN_PA12, 0);            /* RXD1 */
+
+       if (pins & ATMEL_UART_RTS)
+               at91_set_B_periph(AT91_PIN_PA18, 0);    /* RTS1 */
+       if (pins & ATMEL_UART_CTS)
+               at91_set_B_periph(AT91_PIN_PA19, 0);    /* CTS1 */
 }
 
 static struct resource uart2_resources[] = {
@@ -754,10 +770,15 @@ static struct platform_device at91sam9rl_uart2_device = {
        .num_resources  = ARRAY_SIZE(uart2_resources),
 };
 
-static inline void configure_usart2_pins(void)
+static inline void configure_usart2_pins(unsigned pins)
 {
        at91_set_A_periph(AT91_PIN_PA13, 1);            /* TXD2 */
        at91_set_A_periph(AT91_PIN_PA14, 0);            /* RXD2 */
+
+       if (pins & ATMEL_UART_RTS)
+               at91_set_A_periph(AT91_PIN_PA29, 0);    /* RTS2 */
+       if (pins & ATMEL_UART_CTS)
+               at91_set_A_periph(AT91_PIN_PA30, 0);    /* CTS2 */
 }
 
 static struct resource uart3_resources[] = {
@@ -792,16 +813,21 @@ static struct platform_device at91sam9rl_uart3_device = {
        .num_resources  = ARRAY_SIZE(uart3_resources),
 };
 
-static inline void configure_usart3_pins(void)
+static inline void configure_usart3_pins(unsigned pins)
 {
        at91_set_A_periph(AT91_PIN_PB0, 1);             /* TXD3 */
        at91_set_A_periph(AT91_PIN_PB1, 0);             /* RXD3 */
+
+       if (pins & ATMEL_UART_RTS)
+               at91_set_B_periph(AT91_PIN_PD4, 0);     /* RTS3 */
+       if (pins & ATMEL_UART_CTS)
+               at91_set_B_periph(AT91_PIN_PD3, 0);     /* CTS3 */
 }
 
 static struct platform_device *at91_uarts[ATMEL_MAX_UART];     /* the UARTs to use */
 struct platform_device *atmel_default_console_device;  /* the serial console device */
 
-void __init at91_init_serial(struct at91_uart_config *config)
+void __init __deprecated at91_init_serial(struct at91_uart_config *config)
 {
        int i;
 
@@ -809,22 +835,22 @@ void __init at91_init_serial(struct at91_uart_config *config)
        for (i = 0; i < config->nr_tty; i++) {
                switch (config->tty_map[i]) {
                        case 0:
-                               configure_usart0_pins();
+                               configure_usart0_pins(ATMEL_UART_CTS | ATMEL_UART_RTS);
                                at91_uarts[i] = &at91sam9rl_uart0_device;
                                at91_clock_associate("usart0_clk", &at91sam9rl_uart0_device.dev, "usart");
                                break;
                        case 1:
-                               configure_usart1_pins();
+                               configure_usart1_pins(0);
                                at91_uarts[i] = &at91sam9rl_uart1_device;
                                at91_clock_associate("usart1_clk", &at91sam9rl_uart1_device.dev, "usart");
                                break;
                        case 2:
-                               configure_usart2_pins();
+                               configure_usart2_pins(0);
                                at91_uarts[i] = &at91sam9rl_uart2_device;
                                at91_clock_associate("usart2_clk", &at91sam9rl_uart2_device.dev, "usart");
                                break;
                        case 3:
-                               configure_usart3_pins();
+                               configure_usart3_pins(0);
                                at91_uarts[i] = &at91sam9rl_uart3_device;
                                at91_clock_associate("usart3_clk", &at91sam9rl_uart3_device.dev, "usart");
                                break;
@@ -846,6 +872,53 @@ void __init at91_init_serial(struct at91_uart_config *config)
                printk(KERN_INFO "AT91: No default serial console defined.\n");
 }
 
+void __init at91_register_uart(unsigned id, unsigned portnr, unsigned pins)
+{
+       struct platform_device *pdev;
+
+       switch (id) {
+               case 0:         /* DBGU */
+                       pdev = &at91sam9rl_dbgu_device;
+                       configure_dbgu_pins();
+                       at91_clock_associate("mck", &pdev->dev, "usart");
+                       break;
+               case AT91SAM9RL_ID_US0:
+                       pdev = &at91sam9rl_uart0_device;
+                       configure_usart0_pins(pins);
+                       at91_clock_associate("usart0_clk", &pdev->dev, "usart");
+                       break;
+               case AT91SAM9RL_ID_US1:
+                       pdev = &at91sam9rl_uart1_device;
+                       configure_usart1_pins(pins);
+                       at91_clock_associate("usart1_clk", &pdev->dev, "usart");
+                       break;
+               case AT91SAM9RL_ID_US2:
+                       pdev = &at91sam9rl_uart2_device;
+                       configure_usart2_pins(pins);
+                       at91_clock_associate("usart2_clk", &pdev->dev, "usart");
+                       break;
+               case AT91SAM9RL_ID_US3:
+                       pdev = &at91sam9rl_uart3_device;
+                       configure_usart3_pins(pins);
+                       at91_clock_associate("usart3_clk", &pdev->dev, "usart");
+                       break;
+               default:
+                       return;
+       }
+       pdev->id = portnr;              /* update to mapped ID */
+
+       if (portnr < ATMEL_MAX_UART)
+               at91_uarts[portnr] = pdev;
+}
+
+void __init at91_set_serial_console(unsigned portnr)
+{
+       if (portnr < ATMEL_MAX_UART)
+               atmel_default_console_device = at91_uarts[portnr];
+       if (!atmel_default_console_device)
+               printk(KERN_INFO "AT91: No default serial console defined.\n");
+}
+
 void __init at91_add_device_serial(void)
 {
        int i;
@@ -856,7 +929,9 @@ void __init at91_add_device_serial(void)
        }
 }
 #else
-void __init at91_init_serial(struct at91_uart_config *config) {}
+void __init __deprecated at91_init_serial(struct at91_uart_config *config) {}
+void __init at91_register_uart(unsigned id, unsigned portnr, unsigned pins) {}
+void __init at91_set_serial_console(unsigned portnr) {}
 void __init at91_add_device_serial(void) {}
 #endif