[PATCH V8 06/10] USB: f81232: implement port enable/disable method

[Peter Hung]

We put FCR/IER initial step to f81232_port_enable()/f81232_port_disable().
When port is open, it set MSR interrupt on. Otherwise set it off.

Signed-off-by: Peter Hung <hpeter+linux_ker...@gmail.com>
---
 drivers/usb/serial/f81232.c | 49 +++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 49 insertions(+)

diff --git a/drivers/usb/serial/f81232.c b/drivers/usb/serial/f81232.c
index b70f9b9..a3f9530 100644
--- a/drivers/usb/serial/f81232.c
+++ b/drivers/usb/serial/f81232.c
@@ -37,6 +37,8 @@ MODULE_DEVICE_TABLE(usb, id_table);
 #define F81232_SET_REGISTER    0x40
 
 #define SERIAL_BASE_ADDRESS    0x0120
+#define INTERRUPT_ENABLE_REGISTER      (0x01 + SERIAL_BASE_ADDRESS)
+#define FIFO_CONTROL_REGISTER  (0x02 + SERIAL_BASE_ADDRESS)
 #define MODEM_CONTROL_REGISTER (0x04 + SERIAL_BASE_ADDRESS)
 #define MODEM_STATUS_REGISTER  (0x06 + SERIAL_BASE_ADDRESS)
 
@@ -344,6 +346,48 @@ static void f81232_break_ctl(struct tty_struct *tty, int 
break_state)
         */
 }
 
+static int f81232_port_enable(struct usb_serial_port *port)
+{
+       u8 val;
+       int status;
+
+       /* fifo on, trigger8, clear TX/RX*/
+       val = UART_FCR_TRIGGER_8 | UART_FCR_ENABLE_FIFO | UART_FCR_CLEAR_RCVR |
+                       UART_FCR_CLEAR_XMIT;
+
+       status = f81232_set_register(port, FIFO_CONTROL_REGISTER, val);
+       if (status) {
+               dev_err(&port->dev, "%s failed to set FCR: %d\n",
+                       __func__, status);
+               return status;
+       }
+
+       /* MSR Interrupt only, LSR will read from Bulk-in odd byte */
+       status = f81232_set_register(port, INTERRUPT_ENABLE_REGISTER,
+                       UART_IER_MSI);
+       if (status) {
+               dev_err(&port->dev, "%s failed to set IER: %d\n",
+                       __func__, status);
+               return status;
+       }
+
+       return 0;
+}
+
+static int f81232_port_disable(struct usb_serial_port *port)
+{
+       int status;
+
+       status = f81232_set_register(port, INTERRUPT_ENABLE_REGISTER, 0);
+       if (status) {
+               dev_err(&port->dev, "%s failed to set IER: %d\n",
+                       __func__, status);
+               return status;
+       }
+
+       return 0;
+}
+
 static void f81232_set_termios(struct tty_struct *tty,
                struct usb_serial_port *port, struct ktermios *old_termios)
 {
@@ -395,6 +439,10 @@ static int f81232_open(struct tty_struct *tty, struct 
usb_serial_port *port)
 {
        int result;
 
+       result = f81232_port_enable(port);
+       if (result)
+               return result;
+
        /* Setup termios */
        if (tty)
                f81232_set_termios(tty, port, NULL);
@@ -417,6 +465,7 @@ static int f81232_open(struct tty_struct *tty, struct 
usb_serial_port *port)
 
 static void f81232_close(struct usb_serial_port *port)
 {
+       f81232_port_disable(port);
        usb_serial_generic_close(port);
        usb_kill_urb(port->interrupt_in_urb);
 }
-- 
1.9.1

--
To unsubscribe from this list: send the line "unsubscribe linux-usb" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html