Blame view
arch/score/kernel/irq.c
2.92 KB
6bc9a3966 score: Add suppor... |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 |
/* * arch/score/kernel/irq.c * * Score Processor version. * * Copyright (C) 2009 Sunplus Core Technology Co., Ltd. * Chen Liqin <liqin.chen@sunplusct.com> * Lennox Wu <lennox.wu@sunplusct.com> * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, see the file COPYING, or write * to the Free Software Foundation, Inc., * 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA */ #include <linux/interrupt.h> #include <linux/kernel_stat.h> #include <linux/seq_file.h> #include <asm/io.h> |
9b05706a7 score: make irq.h... |
31 32 33 34 35 36 37 38 39 40 41 42 |
/* the interrupt controller is hardcoded at this address */ #define SCORE_PIC ((u32 __iomem __force *)0x95F50000) #define INT_PNDL 0 #define INT_PNDH 1 #define INT_PRIORITY_M 2 #define INT_PRIORITY_SG0 4 #define INT_PRIORITY_SG1 5 #define INT_PRIORITY_SG2 6 #define INT_PRIORITY_SG3 7 #define INT_MASKL 8 #define INT_MASKH 9 |
6bc9a3966 score: Add suppor... |
43 44 45 46 47 48 49 50 51 |
/* * handles all normal device IRQs */ asmlinkage void do_IRQ(int irq) { irq_enter(); generic_handle_irq(irq); irq_exit(); } |
7182297eb score: Convert ir... |
52 |
static void score_mask(struct irq_data *d) |
6bc9a3966 score: Add suppor... |
53 |
{ |
7182297eb score: Convert ir... |
54 |
unsigned int irq_source = 63 - d->irq; |
6bc9a3966 score: Add suppor... |
55 56 |
if (irq_source < 32) |
9b05706a7 score: make irq.h... |
57 58 |
__raw_writel((__raw_readl(SCORE_PIC + INT_MASKL) | \ (1 << irq_source)), SCORE_PIC + INT_MASKL); |
6bc9a3966 score: Add suppor... |
59 |
else |
9b05706a7 score: make irq.h... |
60 61 |
__raw_writel((__raw_readl(SCORE_PIC + INT_MASKH) | \ (1 << (irq_source - 32))), SCORE_PIC + INT_MASKH); |
6bc9a3966 score: Add suppor... |
62 |
} |
7182297eb score: Convert ir... |
63 |
static void score_unmask(struct irq_data *d) |
6bc9a3966 score: Add suppor... |
64 |
{ |
7182297eb score: Convert ir... |
65 |
unsigned int irq_source = 63 - d->irq; |
6bc9a3966 score: Add suppor... |
66 67 |
if (irq_source < 32) |
9b05706a7 score: make irq.h... |
68 69 |
__raw_writel((__raw_readl(SCORE_PIC + INT_MASKL) & \ ~(1 << irq_source)), SCORE_PIC + INT_MASKL); |
6bc9a3966 score: Add suppor... |
70 |
else |
9b05706a7 score: make irq.h... |
71 72 |
__raw_writel((__raw_readl(SCORE_PIC + INT_MASKH) & \ ~(1 << (irq_source - 32))), SCORE_PIC + INT_MASKH); |
6bc9a3966 score: Add suppor... |
73 74 75 76 |
} struct irq_chip score_irq_chip = { .name = "Score7-level", |
7182297eb score: Convert ir... |
77 78 79 |
.irq_mask = score_mask, .irq_mask_ack = score_mask, .irq_unmask = score_unmask, |
6bc9a3966 score: Add suppor... |
80 81 82 83 84 85 86 87 88 89 90 |
}; /* * initialise the interrupt system */ void __init init_IRQ(void) { int index; unsigned long target_addr; for (index = 0; index < NR_IRQS; ++index) |
991353510 score: Convert to... |
91 |
irq_set_chip_and_handler(index, &score_irq_chip, |
6bc9a3966 score: Add suppor... |
92 93 94 95 96 97 98 |
handle_level_irq); for (target_addr = IRQ_VECTOR_BASE_ADDR; target_addr <= IRQ_VECTOR_END_ADDR; target_addr += IRQ_VECTOR_SIZE) memcpy((void *)target_addr, \ interrupt_exception_vector, IRQ_VECTOR_SIZE); |
9b05706a7 score: make irq.h... |
99 100 |
__raw_writel(0xffffffff, SCORE_PIC + INT_MASKL); __raw_writel(0xffffffff, SCORE_PIC + INT_MASKH); |
6bc9a3966 score: Add suppor... |
101 102 103 104 105 106 107 |
__asm__ __volatile__( "mtcr %0, cr3 \t" : : "r" (EXCEPTION_VECTOR_BASE_ADDR | \ VECTOR_ADDRESS_OFFSET_MODE16)); } |