linux-imx

/*

 * Copyright 2015-2016 Vladimir Zapolskiy <vz@mleia.com>

 *

 * The code contained herein is licensed under the GNU General Public

 * License. You may obtain a copy of the GNU General Public License

 * Version 2 or later at the following locations:

 *

 * http://www.opensource.org/licenses/gpl-license.html

 * http://www.gnu.org/copyleft/gpl.html

 */

​

#define pr_fmt(fmt) "%s: " fmt, __func__

​

#include <linux/io.h>

#include <linux/irqchip.h>

#include <linux/irqchip/chained_irq.h>

#include <linux/of_address.h>

#include <linux/of_irq.h>

#include <linux/of_platform.h>

#include <linux/slab.h>

#include <asm/exception.h>

​

#define LPC32XX_INTC_MASK       0x00

#define LPC32XX_INTC_RAW        0x04

#define LPC32XX_INTC_STAT       0x08

#define LPC32XX_INTC_POL        0x0C

#define LPC32XX_INTC_TYPE       0x10

#define LPC32XX_INTC_FIQ        0x14

​

#define NR_LPC32XX_IC_IRQS      32

​

struct lpc32xx_irq_chip {

    void __iomem *base;

    struct irq_domain *domain;

    struct irq_chip chip;

};

​

static struct lpc32xx_irq_chip *lpc32xx_mic_irqc;

​

static inline u32 lpc32xx_ic_read(struct lpc32xx_irq_chip *ic, u32 reg)

{

    return readl_relaxed(ic->base + reg);

}

​

static inline void lpc32xx_ic_write(struct lpc32xx_irq_chip *ic,

                    u32 reg, u32 val)

{

    writel_relaxed(val, ic->base + reg);

}

​

static void lpc32xx_irq_mask(struct irq_data *d)

{

    struct lpc32xx_irq_chip *ic = irq_data_get_irq_chip_data(d);

    u32 val, mask = BIT(d->hwirq);

​

    val = lpc32xx_ic_read(ic, LPC32XX_INTC_MASK) & ~mask;

    lpc32xx_ic_write(ic, LPC32XX_INTC_MASK, val);

}

​

static void lpc32xx_irq_unmask(struct irq_data *d)

{

    struct lpc32xx_irq_chip *ic = irq_data_get_irq_chip_data(d);

    u32 val, mask = BIT(d->hwirq);

​

    val = lpc32xx_ic_read(ic, LPC32XX_INTC_MASK) | mask;

    lpc32xx_ic_write(ic, LPC32XX_INTC_MASK, val);

}

​

static void lpc32xx_irq_ack(struct irq_data *d)

{

    struct lpc32xx_irq_chip *ic = irq_data_get_irq_chip_data(d);

    u32 mask = BIT(d->hwirq);

​

    lpc32xx_ic_write(ic, LPC32XX_INTC_RAW, mask);

}

​

static int lpc32xx_irq_set_type(struct irq_data *d, unsigned int type)

{

    struct lpc32xx_irq_chip *ic = irq_data_get_irq_chip_data(d);

    u32 val, mask = BIT(d->hwirq);

    bool high, edge;

​

    switch (type) {

    case IRQ_TYPE_EDGE_RISING:

        edge = true;

        high = true;

        break;

    case IRQ_TYPE_EDGE_FALLING:

        edge = true;

        high = false;

        break;

    case IRQ_TYPE_LEVEL_HIGH: