linux-imx

/*

 * Copyright (C) 2015 Dmitry Eremin-Solenikov

 * Copyright (C) 1999-2001 Nicolas Pitre

 *

 * Generic IRQ handling for the SA11x0.

 *

 * 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.

 */

#include <linux/init.h>

#include <linux/module.h>

#include <linux/interrupt.h>

#include <linux/io.h>

#include <linux/irq.h>

#include <linux/irqdomain.h>

#include <linux/syscore_ops.h>

#include <linux/irqchip/irq-sa11x0.h>

​

#include <soc/sa1100/pwer.h>

​

#include <asm/exception.h>

​

#define ICIP    0x00  /* IC IRQ Pending reg. */

#define ICMR    0x04  /* IC Mask Reg.        */

#define ICLR    0x08  /* IC Level Reg.       */

#define ICCR    0x0C  /* IC Control Reg.     */

#define ICFP    0x10  /* IC FIQ Pending reg. */

#define ICPR    0x20  /* IC Pending Reg.     */

​

static void __iomem *iobase;

​

/*

 * We don't need to ACK IRQs on the SA1100 unless they're GPIOs

 * this is for internal IRQs i.e. from IRQ LCD to RTCAlrm.

 */

static void sa1100_mask_irq(struct irq_data *d)

{

    u32 reg;

​

    reg = readl_relaxed(iobase + ICMR);

    reg &= ~BIT(d->hwirq);

    writel_relaxed(reg, iobase + ICMR);

}

​

static void sa1100_unmask_irq(struct irq_data *d)

{

    u32 reg;

​

    reg = readl_relaxed(iobase + ICMR);

    reg |= BIT(d->hwirq);

    writel_relaxed(reg, iobase + ICMR);

}

​

static int sa1100_set_wake(struct irq_data *d, unsigned int on)

{

    return sa11x0_sc_set_wake(d->hwirq, on);

}

​

static struct irq_chip sa1100_normal_chip = {

    .name       = "SC",

    .irq_ack    = sa1100_mask_irq,

    .irq_mask   = sa1100_mask_irq,

    .irq_unmask = sa1100_unmask_irq,

    .irq_set_wake   = sa1100_set_wake,

};

​

static int sa1100_normal_irqdomain_map(struct irq_domain *d,

        unsigned int irq, irq_hw_number_t hwirq)

{

    irq_set_chip_and_handler(irq, &sa1100_normal_chip,

                 handle_level_irq);

​

    return 0;

}

​

static const struct irq_domain_ops sa1100_normal_irqdomain_ops = {

    .map = sa1100_normal_irqdomain_map,

    .xlate = irq_domain_xlate_onetwocell,

};

​

static struct irq_domain *sa1100_normal_irqdomain;

​

static struct sa1100irq_state {

    unsigned int    saved;

    unsigned int    icmr;

    unsigned int    iclr;

    unsigned int    iccr;

} sa1100irq_state;

​

static int sa1100irq_suspend(void)

{