This source file includes following definitions.
- i8259_set_poll
- disable_8259A_irq
- enable_8259A_irq
- make_8259A_irq
- i8259A_irq_real
- mask_and_ack_8259A
- i8259A_resume
- i8259A_shutdown
- init_8259A
- i8259A_irq_domain_map
- __init_i8259_irqs
- init_i8259_irqs
- i8259_irq_dispatch
- i8259_of_init
   1 
   2 
   3 
   4 
   5 
   6 
   7 
   8 
   9 
  10 
  11 #include <linux/delay.h>
  12 #include <linux/init.h>
  13 #include <linux/ioport.h>
  14 #include <linux/interrupt.h>
  15 #include <linux/irqchip.h>
  16 #include <linux/irqdomain.h>
  17 #include <linux/kernel.h>
  18 #include <linux/of_irq.h>
  19 #include <linux/spinlock.h>
  20 #include <linux/syscore_ops.h>
  21 #include <linux/irq.h>
  22 
  23 #include <asm/i8259.h>
  24 #include <asm/io.h>
  25 
  26 
  27 
  28 
  29 
  30 
  31 
  32 
  33 
  34 
  35 static int i8259A_auto_eoi = -1;
  36 DEFINE_RAW_SPINLOCK(i8259A_lock);
  37 static void disable_8259A_irq(struct irq_data *d);
  38 static void enable_8259A_irq(struct irq_data *d);
  39 static void mask_and_ack_8259A(struct irq_data *d);
  40 static void init_8259A(int auto_eoi);
  41 static int (*i8259_poll)(void) = i8259_irq;
  42 
  43 static struct irq_chip i8259A_chip = {
  44         .name                   = "XT-PIC",
  45         .irq_mask               = disable_8259A_irq,
  46         .irq_disable            = disable_8259A_irq,
  47         .irq_unmask             = enable_8259A_irq,
  48         .irq_mask_ack           = mask_and_ack_8259A,
  49 };
  50 
  51 
  52 
  53 
  54 
  55 void i8259_set_poll(int (*poll)(void))
  56 {
  57         i8259_poll = poll;
  58 }
  59 
  60 
  61 
  62 
  63 static unsigned int cached_irq_mask = 0xffff;
  64 
  65 #define cached_master_mask      (cached_irq_mask)
  66 #define cached_slave_mask       (cached_irq_mask >> 8)
  67 
  68 static void disable_8259A_irq(struct irq_data *d)
  69 {
  70         unsigned int mask, irq = d->irq - I8259A_IRQ_BASE;
  71         unsigned long flags;
  72 
  73         mask = 1 << irq;
  74         raw_spin_lock_irqsave(&i8259A_lock, flags);
  75         cached_irq_mask |= mask;
  76         if (irq & 8)
  77                 outb(cached_slave_mask, PIC_SLAVE_IMR);
  78         else
  79                 outb(cached_master_mask, PIC_MASTER_IMR);
  80         raw_spin_unlock_irqrestore(&i8259A_lock, flags);
  81 }
  82 
  83 static void enable_8259A_irq(struct irq_data *d)
  84 {
  85         unsigned int mask, irq = d->irq - I8259A_IRQ_BASE;
  86         unsigned long flags;
  87 
  88         mask = ~(1 << irq);
  89         raw_spin_lock_irqsave(&i8259A_lock, flags);
  90         cached_irq_mask &= mask;
  91         if (irq & 8)
  92                 outb(cached_slave_mask, PIC_SLAVE_IMR);
  93         else
  94                 outb(cached_master_mask, PIC_MASTER_IMR);
  95         raw_spin_unlock_irqrestore(&i8259A_lock, flags);
  96 }
  97 
  98 void make_8259A_irq(unsigned int irq)
  99 {
 100         disable_irq_nosync(irq);
 101         irq_set_chip_and_handler(irq, &i8259A_chip, handle_level_irq);
 102         enable_irq(irq);
 103 }
 104 
 105 
 106 
 107 
 108 
 109 
 110 
 111 static inline int i8259A_irq_real(unsigned int irq)
 112 {
 113         int value;
 114         int irqmask = 1 << irq;
 115 
 116         if (irq < 8) {
 117                 outb(0x0B, PIC_MASTER_CMD);     
 118                 value = inb(PIC_MASTER_CMD) & irqmask;
 119                 outb(0x0A, PIC_MASTER_CMD);     
 120                 return value;
 121         }
 122         outb(0x0B, PIC_SLAVE_CMD);      
 123         value = inb(PIC_SLAVE_CMD) & (irqmask >> 8);
 124         outb(0x0A, PIC_SLAVE_CMD);      
 125         return value;
 126 }
 127 
 128 
 129 
 130 
 131 
 132 
 133 
 134 static void mask_and_ack_8259A(struct irq_data *d)
 135 {
 136         unsigned int irqmask, irq = d->irq - I8259A_IRQ_BASE;
 137         unsigned long flags;
 138 
 139         irqmask = 1 << irq;
 140         raw_spin_lock_irqsave(&i8259A_lock, flags);
 141         
 142 
 143 
 144 
 145 
 146 
 147 
 148 
 149 
 150 
 151 
 152 
 153 
 154 
 155 
 156         if (cached_irq_mask & irqmask)
 157                 goto spurious_8259A_irq;
 158         cached_irq_mask |= irqmask;
 159 
 160 handle_real_irq:
 161         if (irq & 8) {
 162                 inb(PIC_SLAVE_IMR);     
 163                 outb(cached_slave_mask, PIC_SLAVE_IMR);
 164                 outb(0x60+(irq&7), PIC_SLAVE_CMD);
 165                 outb(0x60+PIC_CASCADE_IR, PIC_MASTER_CMD); 
 166         } else {
 167                 inb(PIC_MASTER_IMR);    
 168                 outb(cached_master_mask, PIC_MASTER_IMR);
 169                 outb(0x60+irq, PIC_MASTER_CMD); 
 170         }
 171         raw_spin_unlock_irqrestore(&i8259A_lock, flags);
 172         return;
 173 
 174 spurious_8259A_irq:
 175         
 176 
 177 
 178         if (i8259A_irq_real(irq))
 179                 
 180 
 181 
 182 
 183                 goto handle_real_irq;
 184 
 185         {
 186                 static int spurious_irq_mask;
 187                 
 188 
 189 
 190 
 191                 if (!(spurious_irq_mask & irqmask)) {
 192                         printk(KERN_DEBUG "spurious 8259A interrupt: IRQ%d.\n", irq);
 193                         spurious_irq_mask |= irqmask;
 194                 }
 195                 atomic_inc(&irq_err_count);
 196                 
 197 
 198 
 199 
 200 
 201                 goto handle_real_irq;
 202         }
 203 }
 204 
 205 static void i8259A_resume(void)
 206 {
 207         if (i8259A_auto_eoi >= 0)
 208                 init_8259A(i8259A_auto_eoi);
 209 }
 210 
 211 static void i8259A_shutdown(void)
 212 {
 213         
 214 
 215 
 216 
 217         if (i8259A_auto_eoi >= 0) {
 218                 outb(0xff, PIC_MASTER_IMR);     
 219                 outb(0xff, PIC_SLAVE_IMR);      
 220         }
 221 }
 222 
 223 static struct syscore_ops i8259_syscore_ops = {
 224         .resume = i8259A_resume,
 225         .shutdown = i8259A_shutdown,
 226 };
 227 
 228 static void init_8259A(int auto_eoi)
 229 {
 230         unsigned long flags;
 231 
 232         i8259A_auto_eoi = auto_eoi;
 233 
 234         raw_spin_lock_irqsave(&i8259A_lock, flags);
 235 
 236         outb(0xff, PIC_MASTER_IMR);     
 237         outb(0xff, PIC_SLAVE_IMR);      
 238 
 239         
 240 
 241 
 242         outb_p(0x11, PIC_MASTER_CMD);   
 243         outb_p(I8259A_IRQ_BASE + 0, PIC_MASTER_IMR);    
 244         outb_p(1U << PIC_CASCADE_IR, PIC_MASTER_IMR);   
 245         if (auto_eoi)   
 246                 outb_p(MASTER_ICW4_DEFAULT | PIC_ICW4_AEOI, PIC_MASTER_IMR);
 247         else            
 248                 outb_p(MASTER_ICW4_DEFAULT, PIC_MASTER_IMR);
 249 
 250         outb_p(0x11, PIC_SLAVE_CMD);    
 251         outb_p(I8259A_IRQ_BASE + 8, PIC_SLAVE_IMR);     
 252         outb_p(PIC_CASCADE_IR, PIC_SLAVE_IMR);  
 253         outb_p(SLAVE_ICW4_DEFAULT, PIC_SLAVE_IMR); 
 254         if (auto_eoi)
 255                 
 256 
 257 
 258 
 259                 i8259A_chip.irq_mask_ack = disable_8259A_irq;
 260         else
 261                 i8259A_chip.irq_mask_ack = mask_and_ack_8259A;
 262 
 263         udelay(100);            
 264 
 265         outb(cached_master_mask, PIC_MASTER_IMR); 
 266         outb(cached_slave_mask, PIC_SLAVE_IMR);   
 267 
 268         raw_spin_unlock_irqrestore(&i8259A_lock, flags);
 269 }
 270 
 271 
 272 
 273 
 274 static struct irqaction irq2 = {
 275         .handler = no_action,
 276         .name = "cascade",
 277         .flags = IRQF_NO_THREAD,
 278 };
 279 
 280 static struct resource pic1_io_resource = {
 281         .name = "pic1",
 282         .start = PIC_MASTER_CMD,
 283         .end = PIC_MASTER_IMR,
 284         .flags = IORESOURCE_IO | IORESOURCE_BUSY
 285 };
 286 
 287 static struct resource pic2_io_resource = {
 288         .name = "pic2",
 289         .start = PIC_SLAVE_CMD,
 290         .end = PIC_SLAVE_IMR,
 291         .flags = IORESOURCE_IO | IORESOURCE_BUSY
 292 };
 293 
 294 static int i8259A_irq_domain_map(struct irq_domain *d, unsigned int virq,
 295                                  irq_hw_number_t hw)
 296 {
 297         irq_set_chip_and_handler(virq, &i8259A_chip, handle_level_irq);
 298         irq_set_probe(virq);
 299         return 0;
 300 }
 301 
 302 static const struct irq_domain_ops i8259A_ops = {
 303         .map = i8259A_irq_domain_map,
 304         .xlate = irq_domain_xlate_onecell,
 305 };
 306 
 307 
 308 
 309 
 310 
 311 
 312 struct irq_domain * __init __init_i8259_irqs(struct device_node *node)
 313 {
 314         struct irq_domain *domain;
 315 
 316         insert_resource(&ioport_resource, &pic1_io_resource);
 317         insert_resource(&ioport_resource, &pic2_io_resource);
 318 
 319         init_8259A(0);
 320 
 321         domain = irq_domain_add_legacy(node, 16, I8259A_IRQ_BASE, 0,
 322                                        &i8259A_ops, NULL);
 323         if (!domain)
 324                 panic("Failed to add i8259 IRQ domain");
 325 
 326         setup_irq(I8259A_IRQ_BASE + PIC_CASCADE_IR, &irq2);
 327         register_syscore_ops(&i8259_syscore_ops);
 328         return domain;
 329 }
 330 
 331 void __init init_i8259_irqs(void)
 332 {
 333         __init_i8259_irqs(NULL);
 334 }
 335 
 336 static void i8259_irq_dispatch(struct irq_desc *desc)
 337 {
 338         struct irq_domain *domain = irq_desc_get_handler_data(desc);
 339         int hwirq = i8259_poll();
 340         unsigned int irq;
 341 
 342         if (hwirq < 0)
 343                 return;
 344 
 345         irq = irq_linear_revmap(domain, hwirq);
 346         generic_handle_irq(irq);
 347 }
 348 
 349 int __init i8259_of_init(struct device_node *node, struct device_node *parent)
 350 {
 351         struct irq_domain *domain;
 352         unsigned int parent_irq;
 353 
 354         domain = __init_i8259_irqs(node);
 355 
 356         parent_irq = irq_of_parse_and_map(node, 0);
 357         if (!parent_irq) {
 358                 pr_err("Failed to map i8259 parent IRQ\n");
 359                 irq_domain_remove(domain);
 360                 return -ENODEV;
 361         }
 362 
 363         irq_set_chained_handler_and_data(parent_irq, i8259_irq_dispatch,
 364                                          domain);
 365         return 0;
 366 }
 367 IRQCHIP_DECLARE(i8259, "intel,i8259", i8259_of_init);