mpc85xx_8259.c 1.4 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * MPC85xx 8259 functions for DS Board Setup
  4. *
  5. * Author Xianghua Xiao (x.xiao@freescale.com)
  6. * Roy Zang <tie-fei.zang@freescale.com>
  7. * - Add PCI/PCI Express support
  8. * Copyright 2007 Freescale Semiconductor Inc.
  9. */
  10. #include <linux/stddef.h>
  11. #include <linux/kernel.h>
  12. #include <linux/interrupt.h>
  13. #include <linux/of_irq.h>
  14. #include <linux/of_platform.h>
  15. #include <asm/mpic.h>
  16. #include <asm/i8259.h>
  17. #include "mpc85xx.h"
  18. static void mpc85xx_8259_cascade(struct irq_desc *desc)
  19. {
  20. struct irq_chip *chip = irq_desc_get_chip(desc);
  21. unsigned int cascade_irq = i8259_irq();
  22. if (cascade_irq)
  23. generic_handle_irq(cascade_irq);
  24. chip->irq_eoi(&desc->irq_data);
  25. }
  26. void __init mpc85xx_8259_init(void)
  27. {
  28. struct device_node *np;
  29. struct device_node *cascade_node = NULL;
  30. int cascade_irq;
  31. /* Initialize the i8259 controller */
  32. for_each_node_by_type(np, "interrupt-controller") {
  33. if (of_device_is_compatible(np, "chrp,iic")) {
  34. cascade_node = np;
  35. break;
  36. }
  37. }
  38. if (cascade_node == NULL) {
  39. pr_debug("i8259: Could not find i8259 PIC\n");
  40. return;
  41. }
  42. cascade_irq = irq_of_parse_and_map(cascade_node, 0);
  43. if (!cascade_irq) {
  44. pr_err("i8259: Failed to map cascade interrupt\n");
  45. return;
  46. }
  47. pr_debug("i8259: cascade mapped to irq %d\n", cascade_irq);
  48. i8259_init(cascade_node, 0);
  49. of_node_put(cascade_node);
  50. irq_set_chained_handler(cascade_irq, mpc85xx_8259_cascade);
  51. }