dn_ints.c 1.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748
  1. // SPDX-License-Identifier: GPL-2.0
  2. #include <linux/interrupt.h>
  3. #include <linux/irq.h>
  4. #include <asm/traps.h>
  5. #include <asm/apollohw.h>
  6. unsigned int apollo_irq_startup(struct irq_data *data)
  7. {
  8. unsigned int irq = data->irq;
  9. if (irq < 8)
  10. *(volatile unsigned char *)(pica+1) &= ~(1 << irq);
  11. else
  12. *(volatile unsigned char *)(picb+1) &= ~(1 << (irq - 8));
  13. return 0;
  14. }
  15. void apollo_irq_shutdown(struct irq_data *data)
  16. {
  17. unsigned int irq = data->irq;
  18. if (irq < 8)
  19. *(volatile unsigned char *)(pica+1) |= (1 << irq);
  20. else
  21. *(volatile unsigned char *)(picb+1) |= (1 << (irq - 8));
  22. }
  23. void apollo_irq_eoi(struct irq_data *data)
  24. {
  25. *(volatile unsigned char *)(pica) = 0x20;
  26. *(volatile unsigned char *)(picb) = 0x20;
  27. }
  28. static struct irq_chip apollo_irq_chip = {
  29. .name = "apollo",
  30. .irq_startup = apollo_irq_startup,
  31. .irq_shutdown = apollo_irq_shutdown,
  32. .irq_eoi = apollo_irq_eoi,
  33. };
  34. void __init dn_init_IRQ(void)
  35. {
  36. m68k_setup_user_interrupt(VEC_USER + 96, 16);
  37. m68k_setup_irq_controller(&apollo_irq_chip, handle_fasteoi_irq,
  38. IRQ_APOLLO, 16);
  39. }