[444] | 1 | /* |
---|
| 2 | * Copyright (c) 2011 Aeroflex Gaisler |
---|
| 3 | * |
---|
| 4 | * BSD license: |
---|
| 5 | * |
---|
| 6 | * Permission is hereby granted, free of charge, to any person obtaining a copy |
---|
| 7 | * of this software and associated documentation files (the "Software"), to deal |
---|
| 8 | * in the Software without restriction, including without limitation the rights |
---|
| 9 | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
---|
| 10 | * copies of the Software, and to permit persons to whom the Software is |
---|
| 11 | * furnished to do so, subject to the following conditions: |
---|
| 12 | * |
---|
| 13 | * The above copyright notice and this permission notice shall be included in |
---|
| 14 | * all copies or substantial portions of the Software. |
---|
| 15 | * |
---|
| 16 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
---|
| 17 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
---|
| 18 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL |
---|
| 19 | * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
---|
| 20 | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
---|
| 21 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN |
---|
| 22 | * THE SOFTWARE. |
---|
| 23 | */ |
---|
| 24 | |
---|
| 25 | |
---|
| 26 | #include <asm-leon/leonstack.h> |
---|
| 27 | #include <asm-leon/irq.h> |
---|
| 28 | #define NULL 0 |
---|
| 29 | struct irqaction *_irqtbl[32] = |
---|
| 30 | { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, |
---|
| 31 | 0, 0, 0, 0, 0, 0, 0 }; |
---|
| 32 | struct irqaction _oirqtbl[32] = |
---|
| 33 | { INIT_IRQACTION, INIT_IRQACTION, INIT_IRQACTION, INIT_IRQACTION, |
---|
| 34 | INIT_IRQACTION, INIT_IRQACTION, INIT_IRQACTION, INIT_IRQACTION, |
---|
| 35 | INIT_IRQACTION, INIT_IRQACTION, INIT_IRQACTION, INIT_IRQACTION, |
---|
| 36 | INIT_IRQACTION, INIT_IRQACTION, INIT_IRQACTION, INIT_IRQACTION, |
---|
| 37 | INIT_IRQACTION, INIT_IRQACTION, INIT_IRQACTION, INIT_IRQACTION, |
---|
| 38 | INIT_IRQACTION, INIT_IRQACTION, INIT_IRQACTION, INIT_IRQACTION, |
---|
| 39 | INIT_IRQACTION, INIT_IRQACTION, INIT_IRQACTION, INIT_IRQACTION, |
---|
| 40 | INIT_IRQACTION, INIT_IRQACTION, INIT_IRQACTION, INIT_IRQACTION |
---|
| 41 | }; |
---|
| 42 | |
---|
| 43 | int |
---|
| 44 | catch_interrupt (int func, int irq) |
---|
| 45 | { |
---|
| 46 | struct irqaction *a = _irqtbl[irq]; |
---|
| 47 | struct irqaction *n = &_oirqtbl[irq]; |
---|
| 48 | if (irq >= 32) |
---|
| 49 | return 0; |
---|
| 50 | |
---|
| 51 | while (a) |
---|
| 52 | { |
---|
| 53 | if (a == n) |
---|
| 54 | { |
---|
| 55 | int tmp = (int) a->handler; |
---|
| 56 | a->handler = (irqhandler) func; |
---|
| 57 | return tmp; |
---|
| 58 | } |
---|
| 59 | a = a->next; |
---|
| 60 | } |
---|
| 61 | n->handler = (irqhandler) func; |
---|
| 62 | chained_catch_interrupt (irq, n); |
---|
| 63 | return 0; |
---|
| 64 | } |
---|
| 65 | |
---|
| 66 | void |
---|
| 67 | chained_catch_interrupt (int irq, struct irqaction *a) |
---|
| 68 | { |
---|
| 69 | a->next = _irqtbl[irq]; |
---|
| 70 | _irqtbl[irq] = a; |
---|
| 71 | } |
---|
| 72 | |
---|
| 73 | int no_inirq_check = 0; |
---|
| 74 | int inirq[32] = { 0, 0, 0, 0, 0, 0, 0, 0, |
---|
| 75 | 0, 0, 0, 0, 0, 0, 0, 0, |
---|
| 76 | 0, 0, 0, 0, 0, 0, 0, 0, |
---|
| 77 | 0, 0, 0, 0, 0, 0, 0, 0 |
---|
| 78 | }; |
---|
| 79 | extern struct irqmp_type irqmp; |
---|
| 80 | |
---|
| 81 | void (*handler_irq_pre) (void) = 0; |
---|
| 82 | void (*handler_irq_post) (void) = 0; |
---|
| 83 | handler_irq (int irq, struct leonbare_pt_regs *pt_regs) |
---|
| 84 | { |
---|
| 85 | struct irqaction *a; |
---|
| 86 | |
---|
| 87 | if (irq == irqmp.eirq) |
---|
| 88 | irq = irqmp.addr[48] & 0x1f; |
---|
| 89 | if (!irq) |
---|
| 90 | irq = irqmp.eirq; |
---|
| 91 | |
---|
| 92 | a = _irqtbl[irq]; |
---|
| 93 | |
---|
| 94 | while (a) |
---|
| 95 | { |
---|
| 96 | if (a->handler) |
---|
| 97 | { |
---|
| 98 | #ifndef CONFIG_LEONBARE_NONESTEDIRQ |
---|
| 99 | if (no_inirq_check || !(inirq[irq])) |
---|
| 100 | { |
---|
| 101 | #endif |
---|
| 102 | inirq[irq]++; |
---|
| 103 | if (handler_irq_pre) |
---|
| 104 | handler_irq_pre (); |
---|
| 105 | a->handler (irq, a->dev_id, pt_regs); |
---|
| 106 | if (handler_irq_post) |
---|
| 107 | handler_irq_post (); |
---|
| 108 | inirq[irq]--; |
---|
| 109 | #ifndef CONFIG_LEONBARE_NONESTEDIRQ |
---|
| 110 | } |
---|
| 111 | #endif |
---|
| 112 | } |
---|
| 113 | a = a->next; |
---|
| 114 | } |
---|
| 115 | } |
---|
| 116 | |
---|
| 117 | schedulehandler schedule_callback = 0; |
---|