linux-imx

/*

 * Broadcom BCM7120 style Level 2 interrupt controller driver

 *

 * Copyright (C) 2014 Broadcom Corporation

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License version 2 as

 * published by the Free Software Foundation.

 */

​

#define pr_fmt(fmt) KBUILD_MODNAME  ": " fmt

​

#include <linux/init.h>

#include <linux/slab.h>

#include <linux/module.h>

#include <linux/kernel.h>

#include <linux/platform_device.h>

#include <linux/of.h>

#include <linux/of_irq.h>

#include <linux/of_address.h>

#include <linux/of_platform.h>

#include <linux/interrupt.h>

#include <linux/irq.h>

#include <linux/io.h>

#include <linux/irqdomain.h>

#include <linux/reboot.h>

#include <linux/bitops.h>

#include <linux/irqchip.h>

#include <linux/irqchip/chained_irq.h>

​

/* Register offset in the L2 interrupt controller */

#define IRQEN       0x00

#define IRQSTAT     0x04

​

#define MAX_WORDS   4

#define MAX_MAPPINGS    (MAX_WORDS * 2)

#define IRQS_PER_WORD   32

​

struct bcm7120_l1_intc_data {

    struct bcm7120_l2_intc_data *b;

    u32 irq_map_mask[MAX_WORDS];

};

​

struct bcm7120_l2_intc_data {

    unsigned int n_words;

    void __iomem *map_base[MAX_MAPPINGS];

    void __iomem *pair_base[MAX_WORDS];

    int en_offset[MAX_WORDS];

    int stat_offset[MAX_WORDS];

    struct irq_domain *domain;

    bool can_wake;

    u32 irq_fwd_mask[MAX_WORDS];

    struct bcm7120_l1_intc_data *l1_data;

    int num_parent_irqs;

    const __be32 *map_mask_prop;

};

​

static void bcm7120_l2_intc_irq_handle(struct irq_desc *desc)

{

    struct bcm7120_l1_intc_data *data = irq_desc_get_handler_data(desc);

    struct bcm7120_l2_intc_data *b = data->b;

    struct irq_chip *chip = irq_desc_get_chip(desc);

    unsigned int idx;

​

    chained_irq_enter(chip, desc);

​

    for (idx = 0; idx < b->n_words; idx++) {

        int base = idx * IRQS_PER_WORD;

        struct irq_chip_generic *gc =

            irq_get_domain_generic_chip(b->domain, base);

        unsigned long pending;

        int hwirq;

​

        irq_gc_lock(gc);

        pending = irq_reg_readl(gc, b->stat_offset[idx]) &

                        gc->mask_cache &

                        data->irq_map_mask[idx];

        irq_gc_unlock(gc);

​

        for_each_set_bit(hwirq, &pending, IRQS_PER_WORD) {

            generic_handle_irq(irq_find_mapping(b->domain,

                       base + hwirq));

        }

    }

​

    chained_irq_exit(chip, desc);

}

​

static void bcm7120_l2_intc_suspend(struct irq_chip_generic *gc)

{

    struct bcm7120_l2_intc_data *b = gc->private;

    struct irq_chip_type *ct = gc->chip_types;