Sorry, there is something wrong.
Please ignore this mail.

On Wed, 2012-12-05 at 18:01 +0800, Joseph Lo wrote:
>       return ret;
> diff --git a/drivers/gpio/gpio-tegra.c b/drivers/gpio/gpio-tegra.c
> index 63cb643..32ecdb6 100644
> --- a/drivers/gpio/gpio-tegra.c
> +++ b/drivers/gpio/gpio-tegra.c
> @@ -71,6 +71,7 @@ struct tegra_gpio_bank {
>       u32 oe[4];
>       u32 int_enb[4];
>       u32 int_lvl[4];
> +     u32 wake_enb[4];
>  #endif
>  };
>  
> @@ -332,6 +333,9 @@ static int tegra_gpio_suspend(struct device *dev)
>                       bank->oe[p] = tegra_gpio_readl(GPIO_OE(gpio));
>                       bank->int_enb[p] = tegra_gpio_readl(GPIO_INT_ENB(gpio));
>                       bank->int_lvl[p] = tegra_gpio_readl(GPIO_INT_LVL(gpio));
> +
> +                     /* Enable gpio irq for wake up source */
> +                     tegra_gpio_writel(bank->wake_enb[p], 
> GPIO_INT_ENB(gpio));
>               }
>       }
>       local_irq_restore(flags);
> @@ -341,6 +345,36 @@ static int tegra_gpio_suspend(struct device *dev)
>  static int tegra_gpio_wake_enable(struct irq_data *d, unsigned int enable)
>  {
>       struct tegra_gpio_bank *bank = irq_data_get_irq_chip_data(d);
> +     u8 port, bit, mask;
> +     int gpio = d->hwirq;
> +
> +     if (gpio < 0)
> +             return -EIO;
> +
> +     port = GPIO_PORT(gpio);
> +     bit = GPIO_BIT(gpio);
> +     mask = BIT(bit);
> +
> +     if (enable)
> +             bank->wake_enb[port] |= mask;
> +     else
> +             bank->wake_enb[port] &= ~mask;
> +
> +     return 0;
> +}
> +
> +static int tegra_gpio_irq_set_wake(struct irq_data *d, unsigned int enable)
> +{
> +     struct tegra_gpio_bank *bank = irq_data_get_irq_chip_data(d);
> +     int ret;
> +
> +     ret = tegra_gpio_wake_enable(d, enable);
> +     if (ret) {
> +             pr_err("Failed gpio wake %s for irq=%d error=%d\n",
> +                             (enable ? "enable" : "disable"), d->irq, ret);
> +             return ret;
> +     }
> +printk(KERN_EMERG "gpio back->irq: %d hwirq: %d irq: %d\n", bank->irq, 
> d->hwirq, d->irq);
>       return irq_set_irq_wake(bank->irq, enable);
>  }
>  #endif
> @@ -352,7 +386,7 @@ static struct irq_chip tegra_gpio_irq_chip = {
>       .irq_unmask     = tegra_gpio_irq_unmask,
>       .irq_set_type   = tegra_gpio_irq_set_type,
>  #ifdef CONFIG_PM_SLEEP
> -     .irq_set_wake   = tegra_gpio_wake_enable,
> +     .irq_set_wake   = tegra_gpio_irq_set_wake,
>  #endif
>  };
>  
> diff --git a/drivers/input/keyboard/gpio_keys.c 
> b/drivers/input/keyboard/gpio_keys.c
> index 79435de..0a14ec0 100644
> --- a/drivers/input/keyboard/gpio_keys.c
> +++ b/drivers/input/keyboard/gpio_keys.c
> @@ -398,7 +398,7 @@ static irqreturn_t gpio_keys_irq_isr(int irq, void 
> *dev_id)
>       BUG_ON(irq != bdata->irq);
>  
>       spin_lock_irqsave(&bdata->lock, flags);
> -
> +printk(KERN_EMERG "key pressed irq %d\n", bdata->irq);
>       if (!bdata->key_pressed) {
>               if (bdata->button->wakeup)
>                       pm_wakeup_event(bdata->input->dev.parent, 0);
> @@ -809,8 +809,10 @@ static int gpio_keys_suspend(struct device *dev)
>       if (device_may_wakeup(dev)) {
>               for (i = 0; i < ddata->pdata->nbuttons; i++) {
>                       struct gpio_button_data *bdata = &ddata->data[i];
> -                     if (bdata->button->wakeup)
> +                     if (bdata->button->wakeup) {
> +printk(KERN_EMERG "gpio-key wake irq:%d\n", bdata->irq);
>                               enable_irq_wake(bdata->irq);
> +                     }
>               }
>       } else {
>               mutex_lock(&input->mutex);
> --
> To unsubscribe from this list: send the line "unsubscribe linux-tegra" in
> the body of a message to [email protected]
> More majordomo info at  http://vger.kernel.org/majordomo-info.html


--
To unsubscribe from this list: send the line "unsubscribe linux-tegra" in
the body of a message to [email protected]
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to