From e942e5775c87aee2b21179aa45e78b81e062b246 Mon Sep 17 00:00:00 2001 From: Jag Raman Date: Tue, 15 Aug 2017 17:03:08 -0400 Subject: [PATCH] sparc64: vcc: Add break_ctl TTY operation Add handler to support TTY break_ctl operation Signed-off-by: Jagannathan Raman Reviewed-by: Liam Merwick Reviewed-by: Shannon Nelson Signed-off-by: David S. Miller --- drivers/tty/vcc.c | 35 +++++++++++++++++++++++++++++++++++ 1 file changed, 35 insertions(+) diff --git a/drivers/tty/vcc.c b/drivers/tty/vcc.c index 070c54188971..f913217159ee 100644 --- 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) -- 2.20.1