ipack/devices/ipoctal: added shutdown callback

[firefly-linux-kernel-4.4.55.git] / drivers / ipack / devices / ipoctal.c

diff --git a/drivers/ipack/devices/ipoctal.c b/drivers/ipack/devices/ipoctal.c
index 8666d2d05eef9ab30bfe8f62d5f28ac35e7cfe9e..0b3c4b8fe83012a7a77480ee4a87c1f23202d712 100644 (file)
--- a/drivers/ipack/devices/ipoctal.c
+++ b/drivers/ipack/devices/ipoctal.c
@@ -625,6 +625,22 @@ static void ipoctal_hangup(struct tty_struct *tty)
        wake_up_interruptible(&channel->tty_port.open_wait);
 }
 
+static void ipoctal_shutdown(struct tty_struct *tty)
+{
+       struct ipoctal_channel *channel = tty->driver_data;
+
+       if (channel == NULL)
+               return;
+
+       iowrite8(CR_DISABLE_RX | CR_DISABLE_TX, &channel->regs->w.cr);
+       channel->rx_enable = 0;
+       iowrite8(CR_CMD_RESET_RX, &channel->regs->w.cr);
+       iowrite8(CR_CMD_RESET_TX, &channel->regs->w.cr);
+       iowrite8(CR_CMD_RESET_ERR_STATUS, &channel->regs->w.cr);
+       iowrite8(CR_CMD_RESET_MR, &channel->regs->w.cr);
+       clear_bit(ASYNCB_INITIALIZED, &channel->tty_port.flags);
+}
+
 static const struct tty_operations ipoctal_fops = {
        .ioctl =                NULL,
        .open =                 ipoctal_open,
@@ -635,6 +651,7 @@ static const struct tty_operations ipoctal_fops = {
        .chars_in_buffer =      ipoctal_chars_in_buffer,
        .get_icount =           ipoctal_get_icount,
        .hangup =               ipoctal_hangup,
+       .shutdown =             ipoctal_shutdown,
 };
 
 static int ipoctal_probe(struct ipack_device *dev)