irq.c 1.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * arch/arm/mach-orion5x/irq.c
  4. *
  5. * Core IRQ functions for Marvell Orion System On Chip
  6. *
  7. * Maintainer: Tzachi Perelstein <[email protected]>
  8. */
  9. #include <linux/gpio.h>
  10. #include <linux/kernel.h>
  11. #include <linux/irq.h>
  12. #include <linux/io.h>
  13. #include <plat/orion-gpio.h>
  14. #include <plat/irq.h>
  15. #include <asm/exception.h>
  16. #include "bridge-regs.h"
  17. #include "common.h"
  18. static int __initdata gpio0_irqs[4] = {
  19. IRQ_ORION5X_GPIO_0_7,
  20. IRQ_ORION5X_GPIO_8_15,
  21. IRQ_ORION5X_GPIO_16_23,
  22. IRQ_ORION5X_GPIO_24_31,
  23. };
  24. static asmlinkage void
  25. __exception_irq_entry orion5x_legacy_handle_irq(struct pt_regs *regs)
  26. {
  27. u32 stat;
  28. stat = readl_relaxed(MAIN_IRQ_CAUSE);
  29. stat &= readl_relaxed(MAIN_IRQ_MASK);
  30. if (stat) {
  31. unsigned int hwirq = 1 + __fls(stat);
  32. handle_IRQ(hwirq, regs);
  33. return;
  34. }
  35. }
  36. void __init orion5x_init_irq(void)
  37. {
  38. orion_irq_init(1, MAIN_IRQ_MASK);
  39. set_handle_irq(orion5x_legacy_handle_irq);
  40. /*
  41. * Initialize gpiolib for GPIOs 0-31.
  42. */
  43. orion_gpio_init(0, 32, GPIO_VIRT_BASE, 0,
  44. IRQ_ORION5X_GPIO_START, gpio0_irqs);
  45. }