openwrt/target/linux/realtek/files-5.4/arch/mips/rtl838x/irq.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Realtek RTL83XX architecture specific IRQ handling
 *
 * based on the original BSP
 * Copyright (C) 2006-2012 Tony Wu ([email protected])
 * Copyright (C) 2020 B. Koblitz
 * Copyright (C) 2020 Bert Vermeulen <[email protected]>
 * Copyright (C) 2020 John Crispin <[email protected]>
 */

#include <linux/irqchip.h>
#include <linux/spinlock.h>
#include <linux/of_address.h>
#include <asm/irq_cpu.h>
#include <linux/of_irq.h>
#include <asm/cevt-r4k.h>

#include <mach-rtl83xx.h>
#include "irq.h"

#define REALTEK_CPU_IRQ_SHARED0		(MIPS_CPU_IRQ_BASE + 2)
#define REALTEK_CPU_IRQ_UART		(MIPS_CPU_IRQ_BASE + 3)
#define REALTEK_CPU_IRQ_SWITCH		(MIPS_CPU_IRQ_BASE + 4)
#define REALTEK_CPU_IRQ_SHARED1		(MIPS_CPU_IRQ_BASE + 5)
#define REALTEK_CPU_IRQ_EXTERNAL	(MIPS_CPU_IRQ_BASE + 6)
#define REALTEK_CPU_IRQ_COUNTER		(MIPS_CPU_IRQ_BASE + 7)

#define REG(x)				(rtl83xx_ictl_base + x)

extern struct rtl83xx_soc_info soc_info;

static DEFINE_RAW_SPINLOCK(irq_lock);
static void __iomem *rtl83xx_ictl_base;

static void rtl83xx_ictl_enable_irq(struct irq_data *i)
{
	unsigned long flags;
	u32 value;

	raw_spin_lock_irqsave(&irq_lock, flags);

	value = rtl83xx_r32(REG(RTL83XX_ICTL_GIMR));
	value |= BIT(i->hwirq);
	rtl83xx_w32(value, REG(RTL83XX_ICTL_GIMR));

	raw_spin_unlock_irqrestore(&irq_lock, flags);
}

static void rtl83xx_ictl_disable_irq(struct irq_data *i)
{
	unsigned long flags;
	u32 value;

	raw_spin_lock_irqsave(&irq_lock, flags);

	value = rtl83xx_r32(REG(RTL83XX_ICTL_GIMR));
	value &= ~BIT(i->hwirq);
	rtl83xx_w32(value, REG(RTL83XX_ICTL_GIMR));

	raw_spin_unlock_irqrestore(&irq_lock, flags);
}

static struct irq_chip rtl83xx_ictl_irq = {
	.name = "RTL83xx",
	.irq_enable = rtl83xx_ictl_enable_irq,
	.irq_disable = rtl83xx_ictl_disable_irq,
	.irq_ack = rtl83xx_ictl_disable_irq,
	.irq_mask = rtl83xx_ictl_disable_irq,
	.irq_unmask = rtl83xx_ictl_enable_irq,
	.irq_eoi = rtl83xx_ictl_enable_irq,
};

static int intc_map(struct irq_domain *d, unsigned int irq, irq_hw_number_t hw)
{
	irq_set_chip_and_handler(hw, &rtl83xx_ictl_irq, handle_level_irq);

	return 0;
}

static const struct irq_domain_ops irq_domain_ops = {
	.map = intc_map,
	.xlate = irq_domain_xlate_onecell,
};

static void rtl838x_irq_dispatch(struct irq_desc *desc)
{
	unsigned int pending = rtl83xx_r32(REG(RTL83XX_ICTL_GIMR)) & rtl83xx_r32(REG(RTL83XX_ICTL_GISR));

	if (pending) {
		struct irq_domain *domain = irq_desc_get_handler_data(desc);
		generic_handle_irq(irq_find_mapping(domain, __ffs(pending)));
	} else {
		spurious_interrupt();
	}
}

asmlinkage void plat_irq_dispatch(void)
{
	unsigned int pending;

	pending =  read_c0_cause() & read_c0_status() & ST0_IM;

	if (pending & CAUSEF_IP7)
		do_IRQ(REALTEK_CPU_IRQ_COUNTER);

	else if (pending & CAUSEF_IP6)
		do_IRQ(REALTEK_CPU_IRQ_EXTERNAL);

	else if (pending & CAUSEF_IP5)
		do_IRQ(REALTEK_CPU_IRQ_SHARED1);

	else if (pending & CAUSEF_IP4)
		do_IRQ(REALTEK_CPU_IRQ_SWITCH);

	else if (pending & CAUSEF_IP3)
		do_IRQ(REALTEK_CPU_IRQ_UART);

	else if (pending & CAUSEF_IP2)
		do_IRQ(REALTEK_CPU_IRQ_SHARED0);

	else
		spurious_interrupt();
}

static void __init icu_of_init(struct device_node *node, struct device_node *parent)
{
	struct irq_domain *domain;

	domain = irq_domain_add_simple(node, 32, 0,
				       &irq_domain_ops, NULL);
        irq_set_chained_handler_and_data(2, rtl838x_irq_dispatch, domain);
        irq_set_chained_handler_and_data(5, rtl838x_irq_dispatch, domain);

	rtl83xx_ictl_base = of_iomap(node, 0);
	if (!rtl83xx_ictl_base)
		return;

	/* Disable all cascaded interrupts */
	rtl83xx_w32(0, REG(RTL83XX_ICTL_GIMR));

	/* Set up interrupt routing */
	rtl83xx_w32(RTL83XX_IRR0_SETTING, REG(RTL83XX_IRR0));
	rtl83xx_w32(RTL83XX_IRR1_SETTING, REG(RTL83XX_IRR1));
	rtl83xx_w32(RTL83XX_IRR2_SETTING, REG(RTL83XX_IRR2));
	rtl83xx_w32(RTL83XX_IRR3_SETTING, REG(RTL83XX_IRR3));

	/* Clear timer interrupt */
	write_c0_compare(0);

	/* Enable all CPU interrupts */
	write_c0_status(read_c0_status() | ST0_IM);

	/* Enable timer0 and uart0 interrupts */
	rtl83xx_w32(BIT(RTL83XX_IRQ_TC0) | BIT(RTL83XX_IRQ_UART0), REG(RTL83XX_ICTL_GIMR));
}

static struct of_device_id __initdata of_irq_ids[] = {
	{ .compatible = "mti,cpu-interrupt-controller", .data = mips_cpu_irq_of_init },
	{ .compatible = "realtek,rt8380-intc", .data = icu_of_init },
	{},
};

void __init arch_init_irq(void)
{
	of_irq_init(of_irq_ids);
}