sparc64: vcc: Add break_ctl TTY operation

Add handler to support TTY break_ctl operation

Signed-off-by: Jagannathan Raman <jag.raman@oracle.com>
Reviewed-by: Liam Merwick <liam.merwick@oracle.com>
Reviewed-by: Shannon Nelson <shannon.nelson@oracle.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

diff --git a/drivers/tty/vcc.c b/drivers/tty/vcc.c
index 070c54188971b83aa138d753bccedd5861e39d2c..f913217159ee29c02b8da33e731681f8b58c1857 100644 (file)
--- a/drivers/tty/vcc.c
+++ b/drivers/tty/vcc.c
@@ -960,6 +960,40 @@ static int vcc_chars_in_buffer(struct tty_struct *tty)
        return num;
 }
 
+static int vcc_break_ctl(struct tty_struct *tty, int state)
+{
+       struct vcc_port *port;
+       unsigned long flags;
+
+       if (unlikely(!tty)) {
+               pr_err("VCC: break_ctl: Invalid TTY handle\n");
+               return -ENXIO;
+       }
+
+       port = vcc_get_ne(tty->index);
+       if (unlikely(!port)) {
+               pr_err("VCC: break_ctl: Failed to find VCC port\n");
+               return -ENODEV;
+       }
+
+       /* Turn off break */
+       if (state == 0) {
+               vcc_put(port, false);
+               return 0;
+       }
+
+       spin_lock_irqsave(&port->lock, flags);
+
+       if (vcc_send_ctl(port, VCC_CTL_BREAK) < 0)
+               vcc_kick_tx(port);
+
+       spin_unlock_irqrestore(&port->lock, flags);
+
+       vcc_put(port, false);
+
+       return 0;
+}
+
 static const struct tty_operations vcc_ops = {
        .open                   = vcc_open,
        .close                  = vcc_close,
@@ -967,6 +1001,7 @@ static const struct tty_operations vcc_ops = {
        .write                  = vcc_write,
        .write_room             = vcc_write_room,
        .chars_in_buffer        = vcc_chars_in_buffer,
+       .break_ctl              = vcc_break_ctl,
 };
 
 #define VCC_TTY_FLAGS   (TTY_DRIVER_DYNAMIC_DEV | TTY_DRIVER_REAL_RAW)