cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

irq-ath79-misc.c (5097B)


      1// SPDX-License-Identifier: GPL-2.0-only
      2/*
      3 *  Atheros AR71xx/AR724x/AR913x MISC interrupt controller
      4 *
      5 *  Copyright (C) 2015 Alban Bedel <albeu@free.fr>
      6 *  Copyright (C) 2010-2011 Jaiganesh Narayanan <jnarayanan@atheros.com>
      7 *  Copyright (C) 2008-2011 Gabor Juhos <juhosg@openwrt.org>
      8 *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>
      9 *
     10 *  Parts of this file are based on Atheros' 2.6.15/2.6.31 BSP
     11 */
     12
     13#include <linux/irqchip.h>
     14#include <linux/irqchip/chained_irq.h>
     15#include <linux/of_address.h>
     16#include <linux/of_irq.h>
     17
     18#define AR71XX_RESET_REG_MISC_INT_STATUS	0
     19#define AR71XX_RESET_REG_MISC_INT_ENABLE	4
     20
     21#define ATH79_MISC_IRQ_COUNT			32
     22#define ATH79_MISC_PERF_IRQ			5
     23
     24static int ath79_perfcount_irq;
     25
     26int get_c0_perfcount_int(void)
     27{
     28	return ath79_perfcount_irq;
     29}
     30EXPORT_SYMBOL_GPL(get_c0_perfcount_int);
     31
     32static void ath79_misc_irq_handler(struct irq_desc *desc)
     33{
     34	struct irq_domain *domain = irq_desc_get_handler_data(desc);
     35	struct irq_chip *chip = irq_desc_get_chip(desc);
     36	void __iomem *base = domain->host_data;
     37	u32 pending;
     38
     39	chained_irq_enter(chip, desc);
     40
     41	pending = __raw_readl(base + AR71XX_RESET_REG_MISC_INT_STATUS) &
     42		  __raw_readl(base + AR71XX_RESET_REG_MISC_INT_ENABLE);
     43
     44	if (!pending) {
     45		spurious_interrupt();
     46		chained_irq_exit(chip, desc);
     47		return;
     48	}
     49
     50	while (pending) {
     51		int bit = __ffs(pending);
     52
     53		generic_handle_domain_irq(domain, bit);
     54		pending &= ~BIT(bit);
     55	}
     56
     57	chained_irq_exit(chip, desc);
     58}
     59
     60static void ar71xx_misc_irq_unmask(struct irq_data *d)
     61{
     62	void __iomem *base = irq_data_get_irq_chip_data(d);
     63	unsigned int irq = d->hwirq;
     64	u32 t;
     65
     66	t = __raw_readl(base + AR71XX_RESET_REG_MISC_INT_ENABLE);
     67	__raw_writel(t | BIT(irq), base + AR71XX_RESET_REG_MISC_INT_ENABLE);
     68
     69	/* flush write */
     70	__raw_readl(base + AR71XX_RESET_REG_MISC_INT_ENABLE);
     71}
     72
     73static void ar71xx_misc_irq_mask(struct irq_data *d)
     74{
     75	void __iomem *base = irq_data_get_irq_chip_data(d);
     76	unsigned int irq = d->hwirq;
     77	u32 t;
     78
     79	t = __raw_readl(base + AR71XX_RESET_REG_MISC_INT_ENABLE);
     80	__raw_writel(t & ~BIT(irq), base + AR71XX_RESET_REG_MISC_INT_ENABLE);
     81
     82	/* flush write */
     83	__raw_readl(base + AR71XX_RESET_REG_MISC_INT_ENABLE);
     84}
     85
     86static void ar724x_misc_irq_ack(struct irq_data *d)
     87{
     88	void __iomem *base = irq_data_get_irq_chip_data(d);
     89	unsigned int irq = d->hwirq;
     90	u32 t;
     91
     92	t = __raw_readl(base + AR71XX_RESET_REG_MISC_INT_STATUS);
     93	__raw_writel(t & ~BIT(irq), base + AR71XX_RESET_REG_MISC_INT_STATUS);
     94
     95	/* flush write */
     96	__raw_readl(base + AR71XX_RESET_REG_MISC_INT_STATUS);
     97}
     98
     99static struct irq_chip ath79_misc_irq_chip = {
    100	.name		= "MISC",
    101	.irq_unmask	= ar71xx_misc_irq_unmask,
    102	.irq_mask	= ar71xx_misc_irq_mask,
    103};
    104
    105static int misc_map(struct irq_domain *d, unsigned int irq, irq_hw_number_t hw)
    106{
    107	irq_set_chip_and_handler(irq, &ath79_misc_irq_chip, handle_level_irq);
    108	irq_set_chip_data(irq, d->host_data);
    109	return 0;
    110}
    111
    112static const struct irq_domain_ops misc_irq_domain_ops = {
    113	.xlate = irq_domain_xlate_onecell,
    114	.map = misc_map,
    115};
    116
    117static void __init ath79_misc_intc_domain_init(
    118	struct irq_domain *domain, int irq)
    119{
    120	void __iomem *base = domain->host_data;
    121
    122	ath79_perfcount_irq = irq_create_mapping(domain, ATH79_MISC_PERF_IRQ);
    123
    124	/* Disable and clear all interrupts */
    125	__raw_writel(0, base + AR71XX_RESET_REG_MISC_INT_ENABLE);
    126	__raw_writel(0, base + AR71XX_RESET_REG_MISC_INT_STATUS);
    127
    128	irq_set_chained_handler_and_data(irq, ath79_misc_irq_handler, domain);
    129}
    130
    131static int __init ath79_misc_intc_of_init(
    132	struct device_node *node, struct device_node *parent)
    133{
    134	struct irq_domain *domain;
    135	void __iomem *base;
    136	int irq;
    137
    138	irq = irq_of_parse_and_map(node, 0);
    139	if (!irq) {
    140		pr_err("Failed to get MISC IRQ\n");
    141		return -EINVAL;
    142	}
    143
    144	base = of_iomap(node, 0);
    145	if (!base) {
    146		pr_err("Failed to get MISC IRQ registers\n");
    147		return -ENOMEM;
    148	}
    149
    150	domain = irq_domain_add_linear(node, ATH79_MISC_IRQ_COUNT,
    151				&misc_irq_domain_ops, base);
    152	if (!domain) {
    153		pr_err("Failed to add MISC irqdomain\n");
    154		return -EINVAL;
    155	}
    156
    157	ath79_misc_intc_domain_init(domain, irq);
    158	return 0;
    159}
    160
    161static int __init ar7100_misc_intc_of_init(
    162	struct device_node *node, struct device_node *parent)
    163{
    164	ath79_misc_irq_chip.irq_mask_ack = ar71xx_misc_irq_mask;
    165	return ath79_misc_intc_of_init(node, parent);
    166}
    167
    168IRQCHIP_DECLARE(ar7100_misc_intc, "qca,ar7100-misc-intc",
    169		ar7100_misc_intc_of_init);
    170
    171static int __init ar7240_misc_intc_of_init(
    172	struct device_node *node, struct device_node *parent)
    173{
    174	ath79_misc_irq_chip.irq_ack = ar724x_misc_irq_ack;
    175	return ath79_misc_intc_of_init(node, parent);
    176}
    177
    178IRQCHIP_DECLARE(ar7240_misc_intc, "qca,ar7240-misc-intc",
    179		ar7240_misc_intc_of_init);
    180
    181void __init ath79_misc_irq_init(void __iomem *regs, int irq,
    182				int irq_base, bool is_ar71xx)
    183{
    184	struct irq_domain *domain;
    185
    186	if (is_ar71xx)
    187		ath79_misc_irq_chip.irq_mask_ack = ar71xx_misc_irq_mask;
    188	else
    189		ath79_misc_irq_chip.irq_ack = ar724x_misc_irq_ack;
    190
    191	domain = irq_domain_add_legacy(NULL, ATH79_MISC_IRQ_COUNT,
    192			irq_base, 0, &misc_irq_domain_ops, regs);
    193	if (!domain)
    194		panic("Failed to create MISC irqdomain");
    195
    196	ath79_misc_intc_domain_init(domain, irq);
    197}