1 #include <linux/kernel.h> 2 #include <linux/stddef.h> 3 #include <linux/sched.h> 4 #include <linux/signal.h> 5 #include <linux/irq.h> 6 #include <linux/dma-mapping.h> 7 #include <linux/of_address.h> 8 #include <linux/of_irq.h> 9 #include <asm/irq.h> 10 #include <asm/io.h> 11 #include <asm/8xx_immap.h> 12 13 #include "pic.h" 14 15 16 #define PIC_VEC_SPURRIOUS 15 17 18 extern int cpm_get_irq(struct pt_regs *regs); 19 20 static struct irq_domain *mpc8xx_pic_host; 21 static unsigned long mpc8xx_cached_irq_mask; 22 static sysconf8xx_t __iomem *siu_reg; 23 24 static inline unsigned long mpc8xx_irqd_to_bit(struct irq_data *d) 25 { 26 return 0x80000000 >> irqd_to_hwirq(d); 27 } 28 29 static void mpc8xx_unmask_irq(struct irq_data *d) 30 { 31 mpc8xx_cached_irq_mask |= mpc8xx_irqd_to_bit(d); 32 out_be32(&siu_reg->sc_simask, mpc8xx_cached_irq_mask); 33 } 34 35 static void mpc8xx_mask_irq(struct irq_data *d) 36 { 37 mpc8xx_cached_irq_mask &= ~mpc8xx_irqd_to_bit(d); 38 out_be32(&siu_reg->sc_simask, mpc8xx_cached_irq_mask); 39 } 40 41 static void mpc8xx_ack(struct irq_data *d) 42 { 43 out_be32(&siu_reg->sc_sipend, mpc8xx_irqd_to_bit(d)); 44 } 45 46 static void mpc8xx_end_irq(struct irq_data *d) 47 { 48 mpc8xx_cached_irq_mask |= mpc8xx_irqd_to_bit(d); 49 out_be32(&siu_reg->sc_simask, mpc8xx_cached_irq_mask); 50 } 51 52 static int mpc8xx_set_irq_type(struct irq_data *d, unsigned int flow_type) 53 { 54 /* only external IRQ senses are programmable */ 55 if ((flow_type & IRQ_TYPE_EDGE_FALLING) && !(irqd_to_hwirq(d) & 1)) { 56 unsigned int siel = in_be32(&siu_reg->sc_siel); 57 siel |= mpc8xx_irqd_to_bit(d); 58 out_be32(&siu_reg->sc_siel, siel); 59 irq_set_handler_locked(d, handle_edge_irq); 60 } 61 return 0; 62 } 63 64 static struct irq_chip mpc8xx_pic = { 65 .name = "8XX SIU", 66 .irq_unmask = mpc8xx_unmask_irq, 67 .irq_mask = mpc8xx_mask_irq, 68 .irq_ack = mpc8xx_ack, 69 .irq_eoi = mpc8xx_end_irq, 70 .irq_set_type = mpc8xx_set_irq_type, 71 }; 72 73 unsigned int mpc8xx_get_irq(void) 74 { 75 int irq; 76 77 /* For MPC8xx, read the SIVEC register and shift the bits down 78 * to get the irq number. 79 */ 80 irq = in_be32(&siu_reg->sc_sivec) >> 26; 81 82 if (irq == PIC_VEC_SPURRIOUS) 83 return 0; 84 85 return irq_linear_revmap(mpc8xx_pic_host, irq); 86 87 } 88 89 static int mpc8xx_pic_host_map(struct irq_domain *h, unsigned int virq, 90 irq_hw_number_t hw) 91 { 92 pr_debug("mpc8xx_pic_host_map(%d, 0x%lx)\n", virq, hw); 93 94 /* Set default irq handle */ 95 irq_set_chip_and_handler(virq, &mpc8xx_pic, handle_level_irq); 96 return 0; 97 } 98 99 100 static int mpc8xx_pic_host_xlate(struct irq_domain *h, struct device_node *ct, 101 const u32 *intspec, unsigned int intsize, 102 irq_hw_number_t *out_hwirq, unsigned int *out_flags) 103 { 104 static unsigned char map_pic_senses[4] = { 105 IRQ_TYPE_EDGE_RISING, 106 IRQ_TYPE_LEVEL_LOW, 107 IRQ_TYPE_LEVEL_HIGH, 108 IRQ_TYPE_EDGE_FALLING, 109 }; 110 111 if (intspec[0] > 0x1f) 112 return 0; 113 114 *out_hwirq = intspec[0]; 115 if (intsize > 1 && intspec[1] < 4) 116 *out_flags = map_pic_senses[intspec[1]]; 117 else 118 *out_flags = IRQ_TYPE_NONE; 119 120 return 0; 121 } 122 123 124 static const struct irq_domain_ops mpc8xx_pic_host_ops = { 125 .map = mpc8xx_pic_host_map, 126 .xlate = mpc8xx_pic_host_xlate, 127 }; 128 129 int __init mpc8xx_pic_init(void) 130 { 131 struct resource res; 132 struct device_node *np; 133 int ret; 134 135 np = of_find_compatible_node(NULL, NULL, "fsl,pq1-pic"); 136 if (np == NULL) 137 np = of_find_node_by_type(NULL, "mpc8xx-pic"); 138 if (np == NULL) { 139 printk(KERN_ERR "Could not find fsl,pq1-pic node\n"); 140 return -ENOMEM; 141 } 142 143 ret = of_address_to_resource(np, 0, &res); 144 if (ret) 145 goto out; 146 147 siu_reg = ioremap(res.start, resource_size(&res)); 148 if (siu_reg == NULL) { 149 ret = -EINVAL; 150 goto out; 151 } 152 153 mpc8xx_pic_host = irq_domain_add_linear(np, 64, &mpc8xx_pic_host_ops, NULL); 154 if (mpc8xx_pic_host == NULL) { 155 printk(KERN_ERR "MPC8xx PIC: failed to allocate irq host!\n"); 156 ret = -ENOMEM; 157 goto out; 158 } 159 160 ret = 0; 161 out: 162 of_node_put(np); 163 return ret; 164 } 165