"Govindraj.R" <govindraj.r...@ti.com> writes:

> Adapts omap-serial driver to use pm_runtime api's.
>
> 1.) Populate reg values to uart port which can be used for context restore.
> 2.) Moving context_restore func to driver from serial.c
> 3.) Adding port_enable/disable func to enable/disable given uart port.
>     enable port using get_sync and disable using autosuspend.
> 4.) using runtime irq safe api to make get_sync be called from irq context.
>
> Signed-off-by: Govindraj.R <govindraj.r...@ti.com>
> ---
>  arch/arm/mach-omap2/serial.c                  |   16 ++
>  arch/arm/plat-omap/include/plat/omap-serial.h |    2 +
>  drivers/tty/serial/omap-serial.c              |  211 
> ++++++++++++++++++++++---
>  3 files changed, 203 insertions(+), 26 deletions(-)
>
> diff --git a/arch/arm/mach-omap2/serial.c b/arch/arm/mach-omap2/serial.c
> index 8c1a4c7..314d82f 100644
> --- a/arch/arm/mach-omap2/serial.c
> +++ b/arch/arm/mach-omap2/serial.c
> @@ -189,6 +189,21 @@ static void omap_serial_fill_default_pads(struct 
> omap_board_data *bdata)
>       }
>  }
>  
> +static void omap_uart_wakeup_enable(struct platform_device *pdev, bool 
> enable)
> +{
> +     struct omap_uart_port_info *up = pdev->dev.platform_data;
> +
> +     /* Set or clear wake-enable bit */
> +     if (up->wk_en && up->wk_mask) {
> +             u32 v = __raw_readl(up->wk_en);
> +             if (enable)
> +                     v |= up->wk_mask;
> +             else
> +                     v &= ~up->wk_mask;
> +             __raw_writel(v, up->wk_en);
> +     }
> +}

Rather than having the driver do this via the PRCM, can you do an
experiment?  Can you try to leave the module-level wakeup enabled all
the time in the PRCM, and the driver can then enable/disable
module-level wakeups simply by toggling ENAWAKEUP in the module's
SYSCONFIG?  If that works, than you can just use
omap_hwmod_enable_wakeup() for this and not need the above function.

>  static void omap_uart_idle_init(struct omap_uart_port_info *uart,
>                               unsigned short num)
>  {
> @@ -332,6 +347,7 @@ void __init omap_serial_init_port(struct omap_board_data 
> *bdata)
>  
>       pdata->uartclk = OMAP24XX_BASE_BAUD * 16;
>       pdata->flags = UPF_BOOT_AUTOCONF;
> +     pdata->enable_wakeup = omap_uart_wakeup_enable;
>       if (bdata->id == omap_uart_con_id)
>               pdata->console_uart = true;
>  
> diff --git a/arch/arm/plat-omap/include/plat/omap-serial.h 
> b/arch/arm/plat-omap/include/plat/omap-serial.h
> index 2ca885b..ac30de8 100644
> --- a/arch/arm/plat-omap/include/plat/omap-serial.h
> +++ b/arch/arm/plat-omap/include/plat/omap-serial.h
> @@ -65,6 +65,7 @@ struct omap_uart_port_info {
>       unsigned int            errata;
>       unsigned int            console_uart;
>  
> +     void (*enable_wakeup)(struct platform_device *, bool);
>       void __iomem *wk_st;
>       void __iomem *wk_en;
>       u32 wk_mask;
> @@ -120,6 +121,7 @@ struct uart_omap_port {
>       char                    name[20];
>       unsigned long           port_activity;
>       unsigned int            errata;
> +     void (*enable_wakeup)(struct platform_device *, bool);
>  };
>  
>  #endif /* __OMAP_SERIAL_H__ */
> diff --git a/drivers/tty/serial/omap-serial.c 
> b/drivers/tty/serial/omap-serial.c
> index 47cadf4..633dfb4 100644
> --- a/drivers/tty/serial/omap-serial.c
> +++ b/drivers/tty/serial/omap-serial.c
> @@ -37,10 +37,14 @@
>  #include <linux/clk.h>
>  #include <linux/serial_core.h>
>  #include <linux/irq.h>
> +#include <linux/pm_runtime.h>
>  
>  #include <plat/dma.h>
>  #include <plat/dmtimer.h>
>  #include <plat/omap-serial.h>
> +#include <plat/omap_device.h>
> +
> +#define OMAP_UART_AUTOSUSPEND_DELAY (30 * HZ) /* Value is msecs */
>  
>  static struct uart_omap_port *ui[OMAP_MAX_HSUART_PORTS];
>  
> @@ -94,6 +98,17 @@ serial_omap_get_divisor(struct uart_port *port, unsigned 
> int baud)
>       return port->uartclk/(baud * divisor);
>  }
>  
> +static inline void serial_omap_port_disable(struct uart_omap_port *up)
> +{
> +     pm_runtime_mark_last_busy(&up->pdev->dev);
> +     pm_runtime_put_autosuspend(&up->pdev->dev);
> +}
> +
> +static inline void serial_omap_port_enable(struct uart_omap_port *up)
> +{
> +     pm_runtime_get_sync(&up->pdev->dev);
> +}
> +
>  static void serial_omap_stop_rxdma(struct uart_omap_port *up)
>  {
>       if (up->uart_dma.rx_dma_used) {
> @@ -110,8 +125,11 @@ static void serial_omap_enable_ms(struct uart_port *port)
>       struct uart_omap_port *up = (struct uart_omap_port *)port;
>  
>       dev_dbg(up->port.dev, "serial_omap_enable_ms+%d\n", up->pdev->id);
> +
> +     serial_omap_port_enable(up);
>       up->ier |= UART_IER_MSI;
>       serial_out(up, UART_IER, up->ier);
> +     serial_omap_port_disable(up);
>  }
>  
>  static void serial_omap_stop_tx(struct uart_port *port)
> @@ -131,21 +149,26 @@ static void serial_omap_stop_tx(struct uart_port *port)
>               up->uart_dma.tx_dma_channel = OMAP_UART_DMA_CH_FREE;
>       }
>  
> +     serial_omap_port_enable(up);
>       if (up->ier & UART_IER_THRI) {
>               up->ier &= ~UART_IER_THRI;
>               serial_out(up, UART_IER, up->ier);
>       }
> +
> +     serial_omap_port_disable(up);
>  }
>  
>  static void serial_omap_stop_rx(struct uart_port *port)
>  {
>       struct uart_omap_port *up = (struct uart_omap_port *)port;
>  
> +     serial_omap_port_enable(up);
>       if (up->use_dma)
>               serial_omap_stop_rxdma(up);
>       up->ier &= ~UART_IER_RLSI;
>       up->port.read_status_mask &= ~UART_LSR_DR;
>       serial_out(up, UART_IER, up->ier);
> +     serial_omap_port_disable(up);
>  }
>  
>  static inline void receive_chars(struct uart_omap_port *up, int *status)
> @@ -261,8 +284,10 @@ static void serial_omap_start_tx(struct uart_port *port)
>       unsigned int start;
>       int ret = 0;
>  
> +     serial_omap_port_enable(up);
>       if (!up->use_dma) {
>               serial_omap_enable_ier_thri(up);
> +             serial_omap_port_disable(up);
>               return;
>       }
>  
> @@ -354,9 +379,12 @@ static inline irqreturn_t serial_omap_irq(int irq, void 
> *dev_id)
>       unsigned int iir, lsr;
>       unsigned long flags;
>  
> +     serial_omap_port_enable(up);
>       iir = serial_in(up, UART_IIR);
> -     if (iir & UART_IIR_NO_INT)
> +     if (iir & UART_IIR_NO_INT) {
> +             serial_omap_port_disable(up);
>               return IRQ_NONE;
> +     }
>  
>       spin_lock_irqsave(&up->port.lock, flags);
>       lsr = serial_in(up, UART_LSR);
> @@ -378,6 +406,8 @@ static inline irqreturn_t serial_omap_irq(int irq, void 
> *dev_id)
>               transmit_chars(up);
>  
>       spin_unlock_irqrestore(&up->port.lock, flags);
> +     serial_omap_port_disable(up);
> +
>       up->port_activity = jiffies;
>       return IRQ_HANDLED;
>  }
> @@ -388,11 +418,12 @@ static unsigned int serial_omap_tx_empty(struct 
> uart_port *port)
>       unsigned long flags = 0;
>       unsigned int ret = 0;
>  
> +     serial_omap_port_enable(up);
>       dev_dbg(up->port.dev, "serial_omap_tx_empty+%d\n", up->pdev->id);
>       spin_lock_irqsave(&up->port.lock, flags);
>       ret = serial_in(up, UART_LSR) & UART_LSR_TEMT ? TIOCSER_TEMT : 0;
>       spin_unlock_irqrestore(&up->port.lock, flags);
> -
> +     serial_omap_port_disable(up);
>       return ret;
>  }
>  
> @@ -402,7 +433,10 @@ static unsigned int serial_omap_get_mctrl(struct 
> uart_port *port)
>       unsigned char status;
>       unsigned int ret = 0;
>  
> +     serial_omap_port_enable(up);
>       status = check_modem_status(up);
> +     serial_omap_port_disable(up);
> +
>       dev_dbg(up->port.dev, "serial_omap_get_mctrl+%d\n", up->pdev->id);
>  
>       if (status & UART_MSR_DCD)
> @@ -434,7 +468,9 @@ static void serial_omap_set_mctrl(struct uart_port *port, 
> unsigned int mctrl)
>               mcr |= UART_MCR_LOOP;
>  
>       mcr |= up->mcr;
> +     serial_omap_port_enable(up);
>       serial_out(up, UART_MCR, mcr);
> +     serial_omap_port_disable(up);
>  }
>  
>  static void serial_omap_break_ctl(struct uart_port *port, int break_state)
> @@ -443,6 +479,7 @@ static void serial_omap_break_ctl(struct uart_port *port, 
> int break_state)
>       unsigned long flags = 0;
>  
>       dev_dbg(up->port.dev, "serial_omap_break_ctl+%d\n", up->pdev->id);
> +     serial_omap_port_enable(up);
>       spin_lock_irqsave(&up->port.lock, flags);
>       if (break_state == -1)
>               up->lcr |= UART_LCR_SBC;
> @@ -450,6 +487,7 @@ static void serial_omap_break_ctl(struct uart_port *port, 
> int break_state)
>               up->lcr &= ~UART_LCR_SBC;
>       serial_out(up, UART_LCR, up->lcr);
>       spin_unlock_irqrestore(&up->port.lock, flags);
> +     serial_omap_port_disable(up);
>  }
>  
>  static int serial_omap_startup(struct uart_port *port)
> @@ -468,6 +506,7 @@ static int serial_omap_startup(struct uart_port *port)
>  
>       dev_dbg(up->port.dev, "serial_omap_startup+%d\n", up->pdev->id);
>  
> +     serial_omap_port_enable(up);
>       /*
>        * Clear the FIFO buffers and disable them.
>        * (they will be reenabled in set_termios())
> @@ -523,6 +562,7 @@ static int serial_omap_startup(struct uart_port *port)
>       /* Enable module level wake up */
>       serial_out(up, UART_OMAP_WER, OMAP_UART_WER_MOD_WKUP);
>  
> +     serial_omap_port_disable(up);
>       up->port_activity = jiffies;
>       return 0;
>  }
> @@ -533,6 +573,8 @@ static void serial_omap_shutdown(struct uart_port *port)
>       unsigned long flags = 0;
>  
>       dev_dbg(up->port.dev, "serial_omap_shutdown+%d\n", up->pdev->id);
> +
> +     serial_omap_port_enable(up);
>       /*
>        * Disable interrupts from this port
>        */
> @@ -566,6 +608,7 @@ static void serial_omap_shutdown(struct uart_port *port)
>                       up->uart_dma.rx_buf_dma_phys);
>               up->uart_dma.rx_buf = NULL;
>       }
> +     serial_omap_port_disable(up);
>       free_irq(up->port.irq, up);
>  }
>  
> @@ -671,6 +714,10 @@ serial_omap_set_termios(struct uart_port *port, struct 
> ktermios *termios,
>       baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk/13);
>       quot = serial_omap_get_divisor(port, baud);
>  
> +     up->dll = quot & 0xff;
> +     up->dlh = quot >> 8;
> +     up->mdr1 = UART_OMAP_MDR1_DISABLE;
> +
>       up->fcr = UART_FCR_R_TRIG_01 | UART_FCR_T_TRIG_01 |
>                       UART_FCR_ENABLE_FIFO;
>       if (up->use_dma)
> @@ -680,6 +727,7 @@ serial_omap_set_termios(struct uart_port *port, struct 
> ktermios *termios,
>        * Ok, we're now changing the port state. Do it with
>        * interrupts disabled.
>        */
> +     serial_omap_port_enable(up);
>       spin_lock_irqsave(&up->port.lock, flags);
>  
>       /*
> @@ -758,8 +806,7 @@ serial_omap_set_termios(struct uart_port *port, struct 
> ktermios *termios,
>       serial_out(up, UART_MCR, up->mcr);
>  
>       /* Protocol, Baud Rate, and Interrupt Settings */
> -
> -     serial_out(up, UART_OMAP_MDR1, UART_OMAP_MDR1_DISABLE);
> +     serial_out(up, UART_OMAP_MDR1, up->mdr1);
>       serial_out(up, UART_LCR, UART_LCR_CONF_MODE_B);
>  
>       up->efr = serial_in(up, UART_EFR);
> @@ -769,8 +816,8 @@ serial_omap_set_termios(struct uart_port *port, struct 
> ktermios *termios,
>       serial_out(up, UART_IER, 0);
>       serial_out(up, UART_LCR, UART_LCR_CONF_MODE_B);
>  
> -     serial_out(up, UART_DLL, quot & 0xff);          /* LS of divisor */
> -     serial_out(up, UART_DLM, quot >> 8);            /* MS of divisor */
> +     serial_out(up, UART_DLL, up->dll);      /* LS of divisor */
> +     serial_out(up, UART_DLM, up->dlh);      /* MS of divisor */
>  
>       serial_out(up, UART_LCR, 0);
>       serial_out(up, UART_IER, up->ier);
> @@ -780,9 +827,11 @@ serial_omap_set_termios(struct uart_port *port, struct 
> ktermios *termios,
>       serial_out(up, UART_LCR, cval);
>  
>       if (baud > 230400 && baud != 3000000)
> -             serial_out(up, UART_OMAP_MDR1, UART_OMAP_MDR1_13X_MODE);
> +             up->mdr1 = UART_OMAP_MDR1_13X_MODE;
>       else
> -             serial_out(up, UART_OMAP_MDR1, UART_OMAP_MDR1_16X_MODE);
> +             up->mdr1 = UART_OMAP_MDR1_16X_MODE;
> +
> +     serial_out(up, UART_OMAP_MDR1, up->mdr1)
>  
>       /* Hardware Flow Control Configuration */
>  
> @@ -810,6 +859,7 @@ serial_omap_set_termios(struct uart_port *port, struct 
> ktermios *termios,
>               serial_omap_configure_xonxoff(up, termios);
>  
>       spin_unlock_irqrestore(&up->port.lock, flags);
> +     serial_omap_port_disable(up);
>       dev_dbg(up->port.dev, "serial_omap_set_termios+%d\n", up->pdev->id);
>  }
>  
> @@ -821,6 +871,8 @@ serial_omap_pm(struct uart_port *port, unsigned int state,
>       unsigned char efr;
>  
>       dev_dbg(up->port.dev, "serial_omap_pm+%d\n", up->pdev->id);
> +
> +     serial_omap_port_enable(up);
>       serial_out(up, UART_LCR, UART_LCR_CONF_MODE_B);
>       efr = serial_in(up, UART_EFR);
>       serial_out(up, UART_EFR, efr | UART_EFR_ECB);
> @@ -830,6 +882,10 @@ serial_omap_pm(struct uart_port *port, unsigned int 
> state,
>       serial_out(up, UART_LCR, UART_LCR_CONF_MODE_B);
>       serial_out(up, UART_EFR, efr);
>       serial_out(up, UART_LCR, 0);
> +     if (state)
> +             pm_runtime_put_sync(&up->pdev->dev);
> +     else
> +             serial_omap_port_disable(up);
>  }
>  
>  static void serial_omap_release_port(struct uart_port *port)
> @@ -907,25 +963,31 @@ static inline void wait_for_xmitr(struct uart_omap_port 
> *up)
>  static void serial_omap_poll_put_char(struct uart_port *port, unsigned char 
> ch)
>  {
>       struct uart_omap_port *up = (struct uart_omap_port *)port;
> +
> +     serial_omap_port_enable(up);
>       wait_for_xmitr(up);
>       serial_out(up, UART_TX, ch);
> +     serial_omap_port_disable(up);
>  }
>  
>  static int serial_omap_poll_get_char(struct uart_port *port)
>  {
>       struct uart_omap_port *up = (struct uart_omap_port *)port;
> -     unsigned int status = serial_in(up, UART_LSR);
> +     unsigned int status;
>  
> +     serial_omap_port_enable(up);
> +     status = serial_in(up, UART_LSR);
>       if (!(status & UART_LSR_DR))
>               return NO_POLL_CHAR;
>  
> -     return serial_in(up, UART_RX);
> +     status = serial_in(up, UART_RX);
> +     serial_omap_port_disable(up);
> +     return status;
>  }
>  
>  #endif /* CONFIG_CONSOLE_POLL */
>  
>  #ifdef CONFIG_SERIAL_OMAP_CONSOLE
> -
>  static struct uart_omap_port *serial_omap_console_ports[4];
>  
>  static struct uart_driver serial_omap_reg;
> @@ -955,6 +1017,8 @@ serial_omap_console_write(struct console *co, const char 
> *s,
>       else
>               spin_lock(&up->port.lock);
>  
> +     serial_omap_port_enable(up);
> +
>       /*
>        * First save the IER then disable the interrupts
>        */
> @@ -979,6 +1043,7 @@ serial_omap_console_write(struct console *co, const char 
> *s,
>       if (up->msr_saved_flags)
>               check_modem_status(up);
>  
> +     serial_omap_port_disable(up);
>       if (locked)
>               spin_unlock(&up->port.lock);
>       local_irq_restore(flags);
> @@ -1061,22 +1126,27 @@ static struct uart_driver serial_omap_reg = {
>       .cons           = OMAP_CONSOLE,
>  };
>  
> -static int
> -serial_omap_suspend(struct platform_device *pdev, pm_message_t state)
> +static int serial_omap_suspend(struct device *dev)
>  {
> -     struct uart_omap_port *up = platform_get_drvdata(pdev);
> +     struct uart_omap_port *up = dev_get_drvdata(dev);
>  
> -     if (up)
> +     if (up) {
>               uart_suspend_port(&serial_omap_reg, &up->port);
> +             console_trylock();
> +             serial_omap_pm(&up->port, 3, 0);
> +     }
>       return 0;
>  }
>  
> -static int serial_omap_resume(struct platform_device *dev)
> +static int serial_omap_resume(struct device *dev)
>  {
> -     struct uart_omap_port *up = platform_get_drvdata(dev);
> +     struct uart_omap_port *up = dev_get_drvdata(dev);
>  
> -     if (up)
> +     if (up) {
>               uart_resume_port(&serial_omap_reg, &up->port);
> +             console_unlock();
> +     }
> +
>       return 0;
>  }
>  
> @@ -1097,6 +1167,7 @@ static void serial_omap_rx_timeout(unsigned long 
> uart_no)
>                       serial_omap_stop_rxdma(up);
>                       up->ier |= (UART_IER_RDI | UART_IER_RLSI);
>                       serial_out(up, UART_IER, up->ier);
> +                     serial_omap_port_disable(up);
>               }
>               return;
>       }
> @@ -1128,6 +1199,9 @@ static void serial_omap_rx_timeout(unsigned long 
> uart_no)
>  
>  static void uart_rx_dma_callback(int lch, u16 ch_status, void *data)
>  {
> +     struct uart_omap_port *up = (struct uart_omap_port *)data;
> +
> +     serial_omap_port_disable(up);
>       return;
>  }
>  
> @@ -1135,6 +1209,7 @@ static int serial_omap_start_rxdma(struct 
> uart_omap_port *up)
>  {
>       int ret = 0;
>  
> +     serial_omap_port_enable(up);
>       if (up->uart_dma.rx_dma_channel == -1) {
>               ret = omap_request_dma(up->uart_dma.uart_dma_rx,
>                               "UART Rx DMA",
> @@ -1214,6 +1289,7 @@ static void uart_tx_dma_callback(int lch, u16 
> ch_status, void *data)
>               serial_omap_stop_tx(&up->port);
>               up->uart_dma.tx_dma_used = false;
>               spin_unlock(&(up->uart_dma.tx_lock));
> +             serial_omap_port_disable(up);
>       } else {
>               omap_stop_dma(up->uart_dma.tx_dma_channel);
>               serial_omap_continue_tx(up);
> @@ -1224,9 +1300,10 @@ static void uart_tx_dma_callback(int lch, u16 
> ch_status, void *data)
>  
>  static int serial_omap_probe(struct platform_device *pdev)
>  {
> -     struct uart_omap_port   *up;
> +     struct uart_omap_port   *up = NULL;
>       struct resource         *mem, *irq, *dma_tx, *dma_rx;
>       struct omap_uart_port_info *omap_up_info = pdev->dev.platform_data;
> +     struct omap_device *od;
>       int ret = -ENOSPC;
>  
>       mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
> @@ -1276,12 +1353,20 @@ static int serial_omap_probe(struct platform_device 
> *pdev)
>       up->port.ops = &serial_omap_pops;
>       up->port.line = pdev->id;
>  
> -     up->port.membase = omap_up_info->membase;
> -     up->port.mapbase = omap_up_info->mapbase;
> +     up->port.mapbase = mem->start;
> +     up->port.membase = ioremap(mem->start, mem->end - mem->start);
> +
> +     if (!up->port.membase) {
> +             dev_err(&pdev->dev, "can't ioremap UART\n");
> +             ret = -ENOMEM;
> +             goto err1;
> +     }
> +
>       up->port.flags = omap_up_info->flags;
> -     up->port.irqflags = omap_up_info->irqflags;
>       up->port.uartclk = omap_up_info->uartclk;
>       up->uart_dma.uart_base = mem->start;
> +     up->errata = omap_up_info->errata;
> +     up->enable_wakeup = omap_up_info->enable_wakeup;
>  
>       if (omap_up_info->dma_enabled) {
>               up->uart_dma.uart_dma_tx = dma_tx->start;
> @@ -1295,18 +1380,36 @@ static int serial_omap_probe(struct platform_device 
> *pdev)
>               up->uart_dma.rx_dma_channel = OMAP_UART_DMA_CH_FREE;
>       }
>  
> +     pm_runtime_use_autosuspend(&pdev->dev);
> +     pm_runtime_set_autosuspend_delay(&pdev->dev,
> +                     OMAP_UART_AUTOSUSPEND_DELAY);
> +
> +     pm_runtime_enable(&pdev->dev);
> +     pm_runtime_irq_safe(&pdev->dev);
> +
> +     if (omap_up_info->console_uart) {
> +             od = to_omap_device(up->pdev);
> +             omap_hwmod_idle(od->hwmods[0]);

Driver should have know knowlege of the underlying hwmod.  

I assume this is here because of the usage of HWMOD_INIT_NO_IDLE and
HWMOD_INIT_NO_RESET, right?  With proper runtime PM, we should be able to
remove the need for using those flags.

Kevin

> +             serial_omap_port_enable(up);
> +             serial_omap_port_disable(up);
> +     }
> +
>       ui[pdev->id] = up;
>       serial_omap_add_console_port(up);
>  
>       ret = uart_add_one_port(&serial_omap_reg, &up->port);
>       if (ret != 0)
> -             goto do_release_region;
> +             goto err1;
>  
> +     dev_set_drvdata(&pdev->dev, up);
>       platform_set_drvdata(pdev, up);
> +
>       return 0;
>  err:
>       dev_err(&pdev->dev, "[UART%d]: failure [%s]: %d\n",
>                               pdev->id, __func__, ret);
> +err1:
> +     kfree(up);
>  do_release_region:
>       release_mem_region(mem->start, (mem->end - mem->start) + 1);
>       return ret;
> @@ -1318,20 +1421,76 @@ static int serial_omap_remove(struct platform_device 
> *dev)
>  
>       platform_set_drvdata(dev, NULL);
>       if (up) {
> +             pm_runtime_disable(&up->pdev->dev);
>               uart_remove_one_port(&serial_omap_reg, &up->port);
>               kfree(up);
>       }
>       return 0;
>  }
>  
> +static void omap_uart_restore_context(struct uart_omap_port *up)
> +{
> +     u16 efr = 0;
> +
> +     serial_out(up, UART_OMAP_MDR1, up->mdr1);
> +     serial_out(up, UART_LCR, 0xBF); /* Config B mode */
> +     efr = serial_in(up, UART_EFR);
> +     serial_out(up, UART_EFR, UART_EFR_ECB);
> +     serial_out(up, UART_LCR, 0x0); /* Operational mode */
> +     serial_out(up, UART_IER, 0x0);
> +     serial_out(up, UART_LCR, 0xBF); /* Config B mode */
> +     serial_out(up, UART_DLL, up->dll);
> +     serial_out(up, UART_DLM, up->dlh);
> +     serial_out(up, UART_LCR, 0x0); /* Operational mode */
> +     serial_out(up, UART_IER, up->ier);
> +     serial_out(up, UART_FCR, up->fcr);
> +     serial_out(up, UART_LCR, 0x80);
> +     serial_out(up, UART_MCR, up->mcr);
> +     serial_out(up, UART_LCR, 0xBF); /* Config B mode */
> +     serial_out(up, UART_EFR, efr);
> +     serial_out(up, UART_LCR, UART_LCR_WLEN8);
> +     /* UART 16x mode */
> +     serial_out(up, UART_OMAP_MDR1, up->mdr1);
> +}
> +
> +static int omap_serial_runtime_suspend(struct device *dev)
> +{
> +     struct uart_omap_port *up = dev_get_drvdata(dev);
> +
> +     if (!up)
> +             goto done;
> +
> +     if (device_may_wakeup(dev))
> +             up->enable_wakeup(up->pdev, true);
> +     else
> +             up->enable_wakeup(up->pdev, false);
> +done:
> +     return 0;
> +}
> +
> +static int omap_serial_runtime_resume(struct device *dev)
> +{
> +     struct uart_omap_port *up = dev_get_drvdata(dev);
> +
> +     if (up)
> +             omap_uart_restore_context(up);
> +
> +     return 0;
> +}
> +
> +static const struct dev_pm_ops omap_serial_dev_pm_ops = {
> +     .suspend = serial_omap_suspend,
> +     .resume = serial_omap_resume,
> +     .runtime_suspend = omap_serial_runtime_suspend,
> +     .runtime_resume = omap_serial_runtime_resume,
> +};
> +
>  static struct platform_driver serial_omap_driver = {
>       .probe          = serial_omap_probe,
>       .remove         = serial_omap_remove,
> -
> -     .suspend        = serial_omap_suspend,
> -     .resume         = serial_omap_resume,
>       .driver         = {
>               .name   = DRIVER_NAME,
> +             .pm = &omap_serial_dev_pm_ops,
>       },
>  };
--
To unsubscribe from this list: send the line "unsubscribe linux-omap" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to