forked from luck/tmp_suning_uos_patched
1ccea77e2a
Based on 2 normalized pattern(s): 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 http www gnu org licenses 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 [based] [from] [clk] [highbank] [c] you should have received a copy of the gnu general public license along with this program if not see http www gnu org licenses extracted by the scancode license scanner the SPDX license identifier GPL-2.0-or-later has been chosen to replace the boilerplate/reference in 355 file(s). Signed-off-by: Thomas Gleixner <tglx@linutronix.de> Reviewed-by: Kate Stewart <kstewart@linuxfoundation.org> Reviewed-by: Jilayne Lovejoy <opensource@jilayne.com> Reviewed-by: Steve Winslow <swinslow@gmail.com> Reviewed-by: Allison Randal <allison@lohutok.net> Cc: linux-spdx@vger.kernel.org Link: https://lkml.kernel.org/r/20190519154041.837383322@linutronix.de Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
81 lines
1.7 KiB
C
81 lines
1.7 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/*
|
|
* Copyright (C) 2013 Altera Corporation
|
|
* Copyright (C) 2011 Tobias Klauser <tklauser@distanz.ch>
|
|
* Copyright (C) 2008 Thomas Chou <thomas@wytron.com.tw>
|
|
*
|
|
* based on irq.c from m68k which is:
|
|
*
|
|
* Copyright (C) 2007 Greg Ungerer <gerg@snapgear.com>
|
|
*/
|
|
|
|
#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);
|
|
}
|