mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
80 lines
1.7 KiB
80 lines
1.7 KiB
// SPDX-License-Identifier: GPL-2.0-or-later |
|
/* |
|
* Copyright (C) 2013 Altera Corporation |
|
* Copyright (C) 2011 Tobias Klauser <[email protected]> |
|
* Copyright (C) 2008 Thomas Chou <[email protected]> |
|
* |
|
* based on irq.c from m68k which is: |
|
* |
|
* Copyright (C) 2007 Greg Ungerer <[email protected]> |
|
*/ |
|
|
|
#include <linux/init.h> |
|
#include <linux/interrupt.h> |
|
#include <linux/of.h> |
|
|
|
static u32 ienable; |
|
|
|
asmlinkage void do_IRQ(int hwirq, struct pt_regs *regs) |
|
{ |
|
struct pt_regs *oldregs = set_irq_regs(regs); |
|
int irq; |
|
|
|
irq_enter(); |
|
irq = irq_find_mapping(NULL, hwirq); |
|
generic_handle_irq(irq); |
|
irq_exit(); |
|
|
|
set_irq_regs(oldregs); |
|
} |
|
|
|
static void chip_unmask(struct irq_data *d) |
|
{ |
|
ienable |= (1 << d->hwirq); |
|
WRCTL(CTL_IENABLE, ienable); |
|
} |
|
|
|
static void chip_mask(struct irq_data *d) |
|
{ |
|
ienable &= ~(1 << d->hwirq); |
|
WRCTL(CTL_IENABLE, ienable); |
|
} |
|
|
|
static struct irq_chip m_irq_chip = { |
|
.name = "NIOS2-INTC", |
|
.irq_unmask = chip_unmask, |
|
.irq_mask = chip_mask, |
|
}; |
|
|
|
static int irq_map(struct irq_domain *h, unsigned int virq, |
|
irq_hw_number_t hw_irq_num) |
|
{ |
|
irq_set_chip_and_handler(virq, &m_irq_chip, handle_level_irq); |
|
|
|
return 0; |
|
} |
|
|
|
static const struct irq_domain_ops irq_ops = { |
|
.map = irq_map, |
|
.xlate = irq_domain_xlate_onecell, |
|
}; |
|
|
|
void __init init_IRQ(void) |
|
{ |
|
struct irq_domain *domain; |
|
struct device_node *node; |
|
|
|
node = of_find_compatible_node(NULL, NULL, "altr,nios2-1.0"); |
|
if (!node) |
|
node = of_find_compatible_node(NULL, NULL, "altr,nios2-1.1"); |
|
|
|
BUG_ON(!node); |
|
|
|
domain = irq_domain_add_linear(node, NIOS2_CPU_NR_IRQS, &irq_ops, NULL); |
|
BUG_ON(!domain); |
|
|
|
irq_set_default_host(domain); |
|
of_node_put(node); |
|
/* Load the initial ienable value */ |
|
ienable = RDCTL(CTL_IENABLE); |
|
}
|
|
|