1 files changed, 35 insertions, 81 deletions

diff --git a/drivers/char/stallion.c b/drivers/char/stallion.c
index b4ba5edea33d..0e511d61f544 100644
--- a/drivers/char/stallion.c
+++ b/drivers/char/stallion.c
@@ -702,6 +702,24 @@ static struct stlbrd *stl_allocbrd(void)
 
 /*****************************************************************************/
 
+static int stl_activate(struct tty_port *port, struct tty_struct *tty)
+{
+        struct stlport *portp = container_of(port, struct stlport, port);
+        if (!portp->tx.buf) {
+                portp->tx.buf = kmalloc(STL_TXBUFSIZE, GFP_KERNEL);
+                if (!portp->tx.buf)
+                        return -ENOMEM;
+                portp->tx.head = portp->tx.buf;
+                portp->tx.tail = portp->tx.buf;
+        }
+        stl_setport(portp, tty->termios);
+        portp->sigs = stl_getsignals(portp);
+        stl_setsignals(portp, 1, 1);
+        stl_enablerxtx(portp, 1, 1);
+        stl_startrxtx(portp, 1, 0);
+        return 0;
+}
+
 static int stl_open(struct tty_struct *tty, struct file *filp)
 {
         struct stlport  *portp;
@@ -737,32 +755,8 @@ static int stl_open(struct tty_struct *tty, struct file *filp)
         if (portp == NULL)
                 return -ENODEV;
         port = &portp->port;
+        return tty_port_open(&portp->port, tty, filp);
 
-/*
- *      On the first open of the device setup the port hardware, and
- *      initialize the per port data structure.
- */
-        tty_port_tty_set(port, tty);
-        tty->driver_data = portp;
-        port->count++;
-
-        if ((port->flags & ASYNC_INITIALIZED) == 0) {
-                if (!portp->tx.buf) {
-                        portp->tx.buf = kmalloc(STL_TXBUFSIZE, GFP_KERNEL);
-                        if (!portp->tx.buf)
-                                return -ENOMEM;
-                        portp->tx.head = portp->tx.buf;
-                        portp->tx.tail = portp->tx.buf;
-                }
-                stl_setport(portp, tty->termios);
-                portp->sigs = stl_getsignals(portp);
-                stl_setsignals(portp, 1, 1);
-                stl_enablerxtx(portp, 1, 1);
-                stl_startrxtx(portp, 1, 0);
-                clear_bit(TTY_IO_ERROR, &tty->flags);
-                port->flags |= ASYNC_INITIALIZED;
-        }
-        return tty_port_block_til_ready(port, tty, filp);
 }
 
 /*****************************************************************************/
@@ -826,38 +820,12 @@ static void stl_waituntilsent(struct tty_struct *tty, int timeout)
 
 /*****************************************************************************/
 
-static void stl_close(struct tty_struct *tty, struct file *filp)
+static void stl_shutdown(struct tty_port *port)
 {
-        struct stlport  *portp;
-        struct tty_port *port;
-        unsigned long   flags;
-
-        pr_debug("stl_close(tty=%p,filp=%p)\n", tty, filp);
-
-        portp = tty->driver_data;
-        BUG_ON(portp == NULL);
-
-        port = &portp->port;
-
-        if (tty_port_close_start(port, tty, filp) == 0)
-                return;
-/*
- *      May want to wait for any data to drain before closing. The BUSY
- *      flag keeps track of whether we are still sending or not - it is
- *      very accurate for the cd1400, not quite so for the sc26198.
- *      (The sc26198 has no "end-of-data" interrupt only empty FIFO)
- */
-        stl_waituntilsent(tty, (HZ / 2));
-
-        spin_lock_irqsave(&port->lock, flags);
-        portp->port.flags &= ~ASYNC_INITIALIZED;
-        spin_unlock_irqrestore(&port->lock, flags);
-
+        struct stlport *portp = container_of(port, struct stlport, port);
         stl_disableintrs(portp);
-        if (tty->termios->c_cflag & HUPCL)
-                stl_setsignals(portp, 0, 0);
         stl_enablerxtx(portp, 0, 0);
-        stl_flushbuffer(tty);
+        stl_flush(portp);
         portp->istate = 0;
         if (portp->tx.buf != NULL) {
                 kfree(portp->tx.buf);
@@ -865,9 +833,16 @@ static void stl_close(struct tty_struct *tty, struct file *filp)
                 portp->tx.head = NULL;
                 portp->tx.tail = NULL;
         }
+}
+
+static void stl_close(struct tty_struct *tty, struct file *filp)
+{
+        struct stlport*portp;
+        pr_debug("stl_close(tty=%p,filp=%p)\n", tty, filp);
 
-        tty_port_close_end(port, tty);
-        tty_port_tty_set(port, NULL);
+        portp = tty->driver_data;
+        BUG_ON(portp == NULL);
+        tty_port_close(&portp->port, tty, filp);
 }
 
 /*****************************************************************************/
@@ -1314,35 +1289,12 @@ static void stl_stop(struct tty_struct *tty)
 
 static void stl_hangup(struct tty_struct *tty)
 {
-        struct stlport  *portp;
-        struct tty_port *port;
-        unsigned long flags;
-
+        struct stlport  *portp = tty->driver_data;
         pr_debug("stl_hangup(tty=%p)\n", tty);
 
-        portp = tty->driver_data;
         if (portp == NULL)
                 return;
-        port = &portp->port;
-
-        spin_lock_irqsave(&port->lock, flags);
-        port->flags &= ~ASYNC_INITIALIZED;
-        spin_unlock_irqrestore(&port->lock, flags);
-
-        stl_disableintrs(portp);
-        if (tty->termios->c_cflag & HUPCL)
-                stl_setsignals(portp, 0, 0);
-        stl_enablerxtx(portp, 0, 0);
-        stl_flushbuffer(tty);
-        portp->istate = 0;
-        set_bit(TTY_IO_ERROR, &tty->flags);
-        if (portp->tx.buf != NULL) {
-                kfree(portp->tx.buf);
-                portp->tx.buf = NULL;
-                portp->tx.head = NULL;
-                portp->tx.tail = NULL;
-        }
-        tty_port_hangup(port);
+        tty_port_hangup(&portp->port);
 }
 
 /*****************************************************************************/
@@ -2550,6 +2502,8 @@ static const struct tty_operations stl_ops = {
 static const struct tty_port_operations stl_port_ops = {
         .carrier_raised = stl_carrier_raised,
         .dtr_rts = stl_dtr_rts,
+        .activate = stl_activate,
+        .shutdown = stl_shutdown,
 };
 
 /*****************************************************************************/