nile4_pic.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:6k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.  *  arch/mips/ddb5476/nile4.c --
  3.  *   low-level PIC code for NEC Vrc-5476 (Nile 4)
  4.  *
  5.  *  Copyright (C) 2000 Geert Uytterhoeven <geert@sonycom.com>
  6.  *                     Sony Software Development Center Europe (SDCE), Brussels
  7.  *
  8.  *  Copyright 2001 MontaVista Software Inc.
  9.  *  Author: jsun@mvista.com or jsun@junsun.net
  10.  *
  11.  */
  12. #include <linux/kernel.h>
  13. #include <linux/types.h>
  14. #include <linux/interrupt.h>
  15. #include <linux/ioport.h>
  16. #include <asm/addrspace.h>
  17. #include <asm/ddb5xxx/ddb5xxx.h>
  18. static int irq_base;
  19. /*
  20.  *  Interrupt Programming
  21.  */
  22. void nile4_map_irq(int nile4_irq, int cpu_irq)
  23. {
  24. u32 offset, t;
  25. offset = DDB_INTCTRL;
  26. if (nile4_irq >= 8) {
  27. offset += 4;
  28. nile4_irq -= 8;
  29. }
  30. t = ddb_in32(offset);
  31. t &= ~(7 << (nile4_irq * 4));
  32. t |= cpu_irq << (nile4_irq * 4);
  33. ddb_out32(offset, t);
  34. }
  35. void nile4_map_irq_all(int cpu_irq)
  36. {
  37. u32 all, t;
  38. all = cpu_irq;
  39. all |= all << 4;
  40. all |= all << 8;
  41. all |= all << 16;
  42. t = ddb_in32(DDB_INTCTRL);
  43. t &= 0x88888888;
  44. t |= all;
  45. ddb_out32(DDB_INTCTRL, t);
  46. t = ddb_in32(DDB_INTCTRL + 4);
  47. t &= 0x88888888;
  48. t |= all;
  49. ddb_out32(DDB_INTCTRL + 4, t);
  50. }
  51. void nile4_enable_irq(unsigned int nile4_irq)
  52. {
  53. u32 offset, t;
  54. nile4_irq-=irq_base;
  55. ddb5074_led_hex(8);
  56. offset = DDB_INTCTRL;
  57. if (nile4_irq >= 8) {
  58. offset += 4;
  59. nile4_irq -= 8;
  60. }
  61. ddb5074_led_hex(9);
  62. t = ddb_in32(offset);
  63. ddb5074_led_hex(0xa);
  64. t |= 8 << (nile4_irq * 4);
  65. ddb_out32(offset, t);
  66. ddb5074_led_hex(0xb);
  67. }
  68. void nile4_disable_irq(unsigned int nile4_irq)
  69. {
  70. u32 offset, t;
  71. nile4_irq-=irq_base;
  72. offset = DDB_INTCTRL;
  73. if (nile4_irq >= 8) {
  74. offset += 4;
  75. nile4_irq -= 8;
  76. }
  77. t = ddb_in32(offset);
  78. t &= ~(8 << (nile4_irq * 4));
  79. ddb_out32(offset, t);
  80. }
  81. void nile4_disable_irq_all(void)
  82. {
  83. ddb_out32(DDB_INTCTRL, 0);
  84. ddb_out32(DDB_INTCTRL + 4, 0);
  85. }
  86. u16 nile4_get_irq_stat(int cpu_irq)
  87. {
  88. return ddb_in16(DDB_INTSTAT0 + cpu_irq * 2);
  89. }
  90. void nile4_enable_irq_output(int cpu_irq)
  91. {
  92. u32 t;
  93. t = ddb_in32(DDB_INTSTAT1 + 4);
  94. t |= 1 << (16 + cpu_irq);
  95. ddb_out32(DDB_INTSTAT1, t);
  96. }
  97. void nile4_disable_irq_output(int cpu_irq)
  98. {
  99. u32 t;
  100. t = ddb_in32(DDB_INTSTAT1 + 4);
  101. t &= ~(1 << (16 + cpu_irq));
  102. ddb_out32(DDB_INTSTAT1, t);
  103. }
  104. void nile4_set_pci_irq_polarity(int pci_irq, int high)
  105. {
  106. u32 t;
  107. t = ddb_in32(DDB_INTPPES);
  108. if (high)
  109. t &= ~(1 << (pci_irq * 2));
  110. else
  111. t |= 1 << (pci_irq * 2);
  112. ddb_out32(DDB_INTPPES, t);
  113. }
  114. void nile4_set_pci_irq_level_or_edge(int pci_irq, int level)
  115. {
  116. u32 t;
  117. t = ddb_in32(DDB_INTPPES);
  118. if (level)
  119. t |= 2 << (pci_irq * 2);
  120. else
  121. t &= ~(2 << (pci_irq * 2));
  122. ddb_out32(DDB_INTPPES, t);
  123. }
  124. void nile4_clear_irq(int nile4_irq)
  125. {
  126. nile4_irq-=irq_base;
  127. ddb_out32(DDB_INTCLR, 1 << nile4_irq);
  128. }
  129. void nile4_clear_irq_mask(u32 mask)
  130. {
  131. ddb_out32(DDB_INTCLR, mask);
  132. }
  133. u8 nile4_i8259_iack(void)
  134. {
  135. u8 irq;
  136. u32 reg;
  137. /* Set window 0 for interrupt acknowledge */
  138. reg = ddb_in32(DDB_PCIINIT0);
  139. ddb_set_pmr(DDB_PCIINIT0, DDB_PCICMD_IACK, 0, DDB_PCI_ACCESS_32);
  140. irq = *(volatile u8 *) KSEG1ADDR(DDB_PCI_IACK_BASE);
  141. /* restore window 0 for PCI I/O space */
  142. // ddb_set_pmr(DDB_PCIINIT0, DDB_PCICMD_IO, 0, DDB_PCI_ACCESS_32);
  143. ddb_out32(DDB_PCIINIT0, reg);
  144. /* i8269.c set the base vector to be 0x0 */
  145. return irq ;
  146. }
  147. static unsigned int nile4_irq_startup(unsigned int irq) {
  148. nile4_enable_irq(irq);
  149. return 0;
  150. }
  151. static void nile4_ack_irq(unsigned int irq) {
  152.     ddb5074_led_hex(4);
  153. nile4_clear_irq(irq);
  154.     ddb5074_led_hex(2);
  155. nile4_disable_irq(irq);
  156.     ddb5074_led_hex(0);
  157. }
  158. static void nile4_irq_end(unsigned int irq) {
  159. ddb5074_led_hex(3);
  160. if(!(irq_desc[irq].status & (IRQ_DISABLED | IRQ_INPROGRESS))) {
  161. ddb5074_led_hex(5);
  162. nile4_enable_irq(irq);
  163. ddb5074_led_hex(7);
  164. }
  165. ddb5074_led_hex(1);
  166. }
  167. #define nile4_irq_shutdown nile4_disable_irq
  168. static hw_irq_controller nile4_irq_controller = {
  169.     "nile4",
  170.     nile4_irq_startup,
  171.     nile4_irq_shutdown,
  172.     nile4_enable_irq,
  173.     nile4_disable_irq,
  174.     nile4_ack_irq,
  175.     nile4_irq_end,
  176.     NULL
  177. };
  178. void nile4_irq_setup(u32 base) {
  179. int i;
  180. extern irq_desc_t irq_desc[];
  181. irq_base=base;
  182. /* Map all interrupts to CPU int #0 */
  183. nile4_map_irq_all(0);
  184. /* PCI INTA#-E# must be level triggered */
  185. nile4_set_pci_irq_level_or_edge(0, 1);
  186. nile4_set_pci_irq_level_or_edge(1, 1);
  187. nile4_set_pci_irq_level_or_edge(2, 1);
  188. nile4_set_pci_irq_level_or_edge(3, 1);
  189. nile4_set_pci_irq_level_or_edge(4, 1);
  190. /* PCI INTA#-D# must be active low, INTE# must be active high */
  191. nile4_set_pci_irq_polarity(0, 0);
  192. nile4_set_pci_irq_polarity(1, 0);
  193. nile4_set_pci_irq_polarity(2, 0);
  194. nile4_set_pci_irq_polarity(3, 0);
  195. nile4_set_pci_irq_polarity(4, 1);
  196. for (i = 0; i < 16; i++) {
  197. nile4_clear_irq(i);
  198. nile4_disable_irq(i);
  199. }
  200. /* Enable CPU int #0 */
  201. nile4_enable_irq_output(0);
  202. for (i= base; i< base + NUM_NILE4_INTERRUPTS; i++) {
  203. irq_desc[i].status = IRQ_DISABLED;
  204. irq_desc[i].action = NULL;
  205. irq_desc[i].depth = 1;
  206. irq_desc[i].handler = &nile4_irq_controller;
  207. }
  208. }
  209. #if defined(CONFIG_LL_DEBUG)
  210. void nile4_dump_irq_status(void)
  211. {
  212. printk(KERN_DEBUG "
  213.        CPUSTAT = %p:%pn", (void *) ddb_in32(DDB_CPUSTAT + 4),
  214.        (void *) ddb_in32(DDB_CPUSTAT));
  215. printk(KERN_DEBUG "
  216.        INTCTRL = %p:%pn", (void *) ddb_in32(DDB_INTCTRL + 4),
  217.        (void *) ddb_in32(DDB_INTCTRL));
  218. printk(KERN_DEBUG
  219.        "INTSTAT0 = %p:%pn",
  220.        (void *) ddb_in32(DDB_INTSTAT0 + 4),
  221.        (void *) ddb_in32(DDB_INTSTAT0));
  222. printk(KERN_DEBUG
  223.        "INTSTAT1 = %p:%pn",
  224.        (void *) ddb_in32(DDB_INTSTAT1 + 4),
  225.        (void *) ddb_in32(DDB_INTSTAT1));
  226. printk(KERN_DEBUG
  227.        "INTCLR = %p:%pn", (void *) ddb_in32(DDB_INTCLR + 4),
  228.        (void *) ddb_in32(DDB_INTCLR));
  229. printk(KERN_DEBUG
  230.        "INTPPES = %p:%pn", (void *) ddb_in32(DDB_INTPPES + 4),
  231.        (void *) ddb_in32(DDB_INTPPES));
  232. }
  233. #endif