1 files changed, 44 insertions, 5 deletions

diff --git a/drivers/tty/serial/sh-sci.c b/drivers/tty/serial/sh-sci.c
index 3158e17b665c..4604153b7954 100644
--- a/drivers/tty/serial/sh-sci.c
+++ b/drivers/tty/serial/sh-sci.c
@@ -1052,9 +1052,17 @@ static int sci_request_irq(struct sci_port *port)
                 if (SCIx_IRQ_IS_MUXED(port)) {
                         i = SCIx_MUX_IRQ;
                         irq = up->irq;
-                } else
+                } else {
                         irq = port->cfg->irqs[i];
 
+                        /*
+                         * Certain port types won't support all of the
+                         * available interrupt sources.
+                         */
+                        if (unlikely(!irq))
+                                continue;
+                }
+
                 desc = sci_irq_desc + i;
                 port->irqstr[j] = kasprintf(GFP_KERNEL, "%s:%s",
                                             dev_name(up->dev), desc->desc);
@@ -1094,6 +1102,15 @@ static void sci_free_irq(struct sci_port *port)
          * IRQ first.
          */
         for (i = 0; i < SCIx_NR_IRQS; i++) {
+                unsigned int irq = port->cfg->irqs[i];
+
+                /*
+                 * Certain port types won't support all of the available
+                 * interrupt sources.
+                 */
+                if (unlikely(!irq))
+                        continue;
+
                 free_irq(port->cfg->irqs[i], port);
                 kfree(port->irqstr[i]);
 
@@ -1564,10 +1581,32 @@ static void sci_enable_ms(struct uart_port *port)
 
 static void sci_break_ctl(struct uart_port *port, int break_state)
 {
-        /*
-         * Not supported by hardware. Most parts couple break and rx
-         * interrupts together, with break detection always enabled.
-         */
+        struct sci_port *s = to_sci_port(port);
+        struct plat_sci_reg *reg = sci_regmap[s->cfg->regtype] + SCSPTR;
+        unsigned short scscr, scsptr;
+
+        /* check wheter the port has SCSPTR */
+        if (!reg->size) {
+                /*
+                 * Not supported by hardware. Most parts couple break and rx
+                 * interrupts together, with break detection always enabled.
+                 */
+                return;
+        }
+
+        scsptr = serial_port_in(port, SCSPTR);
+        scscr = serial_port_in(port, SCSCR);
+
+        if (break_state == -1) {
+                scsptr = (scsptr | SCSPTR_SPB2IO) & ~SCSPTR_SPB2DT;
+                scscr &= ~SCSCR_TE;
+        } else {
+                scsptr = (scsptr | SCSPTR_SPB2DT) & ~SCSPTR_SPB2IO;
+                scscr |= SCSCR_TE;
+        }
+
+        serial_port_out(port, SCSPTR, scsptr);
+        serial_port_out(port, SCSCR, scscr);
 }
 
 #ifdef CONFIG_SERIAL_SH_SCI_DMA