dn_ints.c 1.0 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647
  1. #include <linux/interrupt.h>
  2. #include <asm/irq.h>
  3. #include <asm/traps.h>
  4. #include <asm/apollohw.h>
  5. void dn_process_int(unsigned int irq, struct pt_regs *fp)
  6. {
  7. __m68k_handle_int(irq, fp);
  8. *(volatile unsigned char *)(pica)=0x20;
  9. *(volatile unsigned char *)(picb)=0x20;
  10. }
  11. unsigned int apollo_irq_startup(struct irq_data *data)
  12. {
  13. unsigned int irq = data->irq;
  14. if (irq < 8)
  15. *(volatile unsigned char *)(pica+1) &= ~(1 << irq);
  16. else
  17. *(volatile unsigned char *)(picb+1) &= ~(1 << (irq - 8));
  18. return 0;
  19. }
  20. void apollo_irq_shutdown(struct irq_data *data)
  21. {
  22. unsigned int irq = data->irq;
  23. if (irq < 8)
  24. *(volatile unsigned char *)(pica+1) |= (1 << irq);
  25. else
  26. *(volatile unsigned char *)(picb+1) |= (1 << (irq - 8));
  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. };
  33. void __init dn_init_IRQ(void)
  34. {
  35. m68k_setup_user_interrupt(VEC_USER + 96, 16, dn_process_int);
  36. m68k_setup_irq_chip(&apollo_irq_chip, IRQ_APOLLO, 16);
  37. }