aboutsummaryrefslogtreecommitdiffstats
diff options
context:
space:
mode:
-rw-r--r--drivers/gpio/gpio-zynq.c34
1 files changed, 20 insertions, 14 deletions
diff --git a/drivers/gpio/gpio-zynq.c b/drivers/gpio/gpio-zynq.c
index d80d722529ad..1e6f19a07454 100644
--- a/drivers/gpio/gpio-zynq.c
+++ b/drivers/gpio/gpio-zynq.c
@@ -88,16 +88,17 @@
88 * @chip: instance of the gpio_chip 88 * @chip: instance of the gpio_chip
89 * @base_addr: base address of the GPIO device 89 * @base_addr: base address of the GPIO device
90 * @clk: clock resource for this controller 90 * @clk: clock resource for this controller
91 * @irq: interrupt for the GPIO device
91 */ 92 */
92struct zynq_gpio { 93struct zynq_gpio {
93 struct gpio_chip chip; 94 struct gpio_chip chip;
94 void __iomem *base_addr; 95 void __iomem *base_addr;
95 struct clk *clk; 96 struct clk *clk;
97 int irq;
96}; 98};
97 99
98static struct irq_chip zynq_gpio_level_irqchip; 100static struct irq_chip zynq_gpio_level_irqchip;
99static struct irq_chip zynq_gpio_edge_irqchip; 101static struct irq_chip zynq_gpio_edge_irqchip;
100
101/** 102/**
102 * zynq_gpio_get_bank_pin - Get the bank number and pin number within that bank 103 * zynq_gpio_get_bank_pin - Get the bank number and pin number within that bank
103 * for a given pin in the GPIO device 104 * for a given pin in the GPIO device
@@ -434,10 +435,9 @@ static int zynq_gpio_set_irq_type(struct irq_data *irq_data, unsigned int type)
434 435
435static int zynq_gpio_set_wake(struct irq_data *data, unsigned int on) 436static int zynq_gpio_set_wake(struct irq_data *data, unsigned int on)
436{ 437{
437 if (on) 438 struct zynq_gpio *gpio = irq_data_get_irq_chip_data(data);
438 zynq_gpio_irq_unmask(data); 439
439 else 440 irq_set_irq_wake(gpio->irq, on);
440 zynq_gpio_irq_mask(data);
441 441
442 return 0; 442 return 0;
443} 443}
@@ -518,7 +518,11 @@ static void zynq_gpio_irqhandler(unsigned int irq, struct irq_desc *desc)
518 518
519static int __maybe_unused zynq_gpio_suspend(struct device *dev) 519static int __maybe_unused zynq_gpio_suspend(struct device *dev)
520{ 520{
521 if (!device_may_wakeup(dev)) 521 struct platform_device *pdev = to_platform_device(dev);
522 int irq = platform_get_irq(pdev, 0);
523 struct irq_data *data = irq_get_irq_data(irq);
524
525 if (!irqd_is_wakeup_set(data))
522 return pm_runtime_force_suspend(dev); 526 return pm_runtime_force_suspend(dev);
523 527
524 return 0; 528 return 0;
@@ -526,7 +530,11 @@ static int __maybe_unused zynq_gpio_suspend(struct device *dev)
526 530
527static int __maybe_unused zynq_gpio_resume(struct device *dev) 531static int __maybe_unused zynq_gpio_resume(struct device *dev)
528{ 532{
529 if (!device_may_wakeup(dev)) 533 struct platform_device *pdev = to_platform_device(dev);
534 int irq = platform_get_irq(pdev, 0);
535 struct irq_data *data = irq_get_irq_data(irq);
536
537 if (!irqd_is_wakeup_set(data))
530 return pm_runtime_force_resume(dev); 538 return pm_runtime_force_resume(dev);
531 539
532 return 0; 540 return 0;
@@ -587,7 +595,7 @@ static const struct dev_pm_ops zynq_gpio_dev_pm_ops = {
587 */ 595 */
588static int zynq_gpio_probe(struct platform_device *pdev) 596static int zynq_gpio_probe(struct platform_device *pdev)
589{ 597{
590 int ret, bank_num, irq; 598 int ret, bank_num;
591 struct zynq_gpio *gpio; 599 struct zynq_gpio *gpio;
592 struct gpio_chip *chip; 600 struct gpio_chip *chip;
593 struct resource *res; 601 struct resource *res;
@@ -603,10 +611,10 @@ static int zynq_gpio_probe(struct platform_device *pdev)
603 if (IS_ERR(gpio->base_addr)) 611 if (IS_ERR(gpio->base_addr))
604 return PTR_ERR(gpio->base_addr); 612 return PTR_ERR(gpio->base_addr);
605 613
606 irq = platform_get_irq(pdev, 0); 614 gpio->irq = platform_get_irq(pdev, 0);
607 if (irq < 0) { 615 if (gpio->irq < 0) {
608 dev_err(&pdev->dev, "invalid IRQ\n"); 616 dev_err(&pdev->dev, "invalid IRQ\n");
609 return irq; 617 return gpio->irq;
610 } 618 }
611 619
612 /* configure the gpio chip */ 620 /* configure the gpio chip */
@@ -654,14 +662,12 @@ static int zynq_gpio_probe(struct platform_device *pdev)
654 goto err_rm_gpiochip; 662 goto err_rm_gpiochip;
655 } 663 }
656 664
657 gpiochip_set_chained_irqchip(chip, &zynq_gpio_edge_irqchip, irq, 665 gpiochip_set_chained_irqchip(chip, &zynq_gpio_edge_irqchip, gpio->irq,
658 zynq_gpio_irqhandler); 666 zynq_gpio_irqhandler);
659 667
660 pm_runtime_set_active(&pdev->dev); 668 pm_runtime_set_active(&pdev->dev);
661 pm_runtime_enable(&pdev->dev); 669 pm_runtime_enable(&pdev->dev);
662 670
663 device_set_wakeup_capable(&pdev->dev, 1);
664
665 return 0; 671 return 0;
666 672
667err_rm_gpiochip: 673err_rm_gpiochip: