openwrt/target/linux/at91/patches-2.6.22/008-fdl-serial.patch

Index: linux-2.6.22.19/drivers/serial/atmel_serial.c
===================================================================
--- linux-2.6.22.19.orig/drivers/serial/atmel_serial.c
+++ linux-2.6.22.19/drivers/serial/atmel_serial.c
@@ -174,7 +174,35 @@ static void atmel_set_mctrl(struct uart_
 				at91_set_gpio_value(AT91_PIN_PA21, 0);
 			else
 				at91_set_gpio_value(AT91_PIN_PA21, 1);
+
+      /*
+       * FDL VersaLink adds GPIOS to provide full modem control on
+       * USART 0 - Drive DTR and RI pins manually
+       */
+      if (mctrl & TIOCM_DTR)
+        at91_set_gpio_value(AT91_PIN_PB6, 0);
+      else
+        at91_set_gpio_value(AT91_PIN_PB6, 1);
+      if (mctrl & TIOCM_RI)
+        at91_set_gpio_value(AT91_PIN_PB7, 0);
+      else
+        at91_set_gpio_value(AT91_PIN_PB7, 1);
 		}
+
+    /*
+     * FDL VersaLink adds GPIOS to provide full modem control on
+     * USART 3 - Drive DTR and RI pins manually
+     */
+    if (port->mapbase == AT91RM9200_BASE_US3) {
+      if (mctrl & TIOCM_DTR)
+        at91_set_gpio_value(AT91_PIN_PB29, 0);
+      else
+        at91_set_gpio_value(AT91_PIN_PB29, 1);
+      if (mctrl & TIOCM_RI)
+        at91_set_gpio_value(AT91_PIN_PB2, 0);
+      else
+        at91_set_gpio_value(AT91_PIN_PB2, 1);
+    }
 	}
 #endif
 
@@ -211,8 +239,10 @@ static u_int atmel_get_mctrl(struct uart
 	/*
 	 * The control signals are active low.
 	 */
-	if (!(status & ATMEL_US_DCD))
-		ret |= TIOCM_CD;
+
+  if (!(port->mapbase == AT91RM9200_BASE_US0 || port->mapbase == AT91RM9200_BASE_US3))
+		if (!(status & ATMEL_US_DCD))
+			ret |= TIOCM_CD;
 	if (!(status & ATMEL_US_CTS))
 		ret |= TIOCM_CTS;
 	if (!(status & ATMEL_US_DSR))
@@ -220,6 +250,16 @@ static u_int atmel_get_mctrl(struct uart
 	if (!(status & ATMEL_US_RI))
 		ret |= TIOCM_RI;
 
+  /*
+   * Read the GPIO's for the FDL VersaLink special case
+   */
+  if (port->mapbase == AT91RM9200_BASE_US0)
+    if (!(at91_get_gpio_value(AT91_PIN_PA19)))
+      ret |= TIOCM_CD;
+  if (port->mapbase == AT91RM9200_BASE_US3)
+    if (!(at91_get_gpio_value(AT91_PIN_PA24)))
+      ret |= TIOCM_CD;
+
 	return ret;
 }
 
@@ -511,6 +551,34 @@ static void atmel_tx_chars(struct uart_p
 }
 
 /*
+ * USART0 DCD Interrupt handler
+ */
+
+static irqreturn_t atmel_u0_DCD_interrupt(int irq, void *dev_id)
+{
+  struct uart_port *port = dev_id;
+  int status = at91_get_gpio_value(irq);
+
+  uart_handle_dcd_change(port, !(status));
+
+  return IRQ_HANDLED;
+}
+
+/*
+ * USART3 DCD Interrupt handler
+ */
+
+static irqreturn_t atmel_u3_DCD_interrupt(int irq, void *dev_id)
+{
+  struct uart_port *port = dev_id;
+  int status = at91_get_gpio_value(irq);
+
+  uart_handle_dcd_change(port, !(status));
+
+  return IRQ_HANDLED;
+}
+
+/*
  * Interrupt handler
  */
 static irqreturn_t atmel_interrupt(int irq, void *dev_id)
@@ -587,6 +655,23 @@ static int atmel_startup(struct uart_por
 		return retval;
 	}
 
+	if (port->mapbase == AT91RM9200_BASE_US0) {
+		retval = request_irq(AT91_PIN_PA19, atmel_u0_DCD_interrupt, 0, "atmel_serial", port);
+		if (retval) {
+			printk("atmel_serial: atmel_startup - Can't get u0DCD irq\n");
+			free_irq(port->irq, port);
+			return retval;
+		}
+	}
+	if (port->mapbase == AT91RM9200_BASE_US3) {
+		retval = request_irq(AT91_PIN_PA24, atmel_u3_DCD_interrupt, 0, "atmel_serial", port);
+		if (retval) {
+			printk("atmel_serial: atmel_startup - Can't get u3DCD irq\n");
+			free_irq(port->irq, port);
+			return retval;
+		}
+	}
+
 	/*
 	 * Initialize DMA (if necessary)
 	 */
@@ -603,6 +688,10 @@ static int atmel_startup(struct uart_por
 					kfree(atmel_port->pdc_rx[0].buf);
 				}
 				free_irq(port->irq, port);
+        if (port->mapbase == AT91RM9200_BASE_US0)
+          free_irq(AT91_PIN_PA19, port);
+        if (port->mapbase == AT91RM9200_BASE_US3)
+          free_irq(AT91_PIN_PA24, port);
 				return -ENOMEM;
 			}
 			pdc->dma_addr = dma_map_single(port->dev, pdc->buf, PDC_BUFFER_SIZE, DMA_FROM_DEVICE);
@@ -636,6 +725,10 @@ static int atmel_startup(struct uart_por
 		retval = atmel_open_hook(port);
 		if (retval) {
 			free_irq(port->irq, port);
+      if (port->mapbase == AT91RM9200_BASE_US0)
+        free_irq(AT91_PIN_PA19, port);
+      if (port->mapbase == AT91RM9200_BASE_US3)
+        free_irq(AT91_PIN_PA24, port);
 			return retval;
 		}
 	}
@@ -701,6 +794,10 @@ static void atmel_shutdown(struct uart_p
 	 * Free the interrupt
 	 */
 	free_irq(port->irq, port);
+  if (port->mapbase == AT91RM9200_BASE_US0)
+    free_irq(AT91_PIN_PA19, port);
+  if (port->mapbase == AT91RM9200_BASE_US3)
+    free_irq(AT91_PIN_PA24, port);
 
 	/*
 	 * If there is a specific "close" function (to unregister