linux-imx

/*

 * Multiplexed-IRQs driver for TS-4800's FPGA

 *

 * Copyright (c) 2015 - Savoir-faire Linux

 *

 * This file is licensed under the terms of the GNU General Public

 * License version 2. This program is licensed "as is" without any

 * warranty of any kind, whether express or implied.

 */

​

#include <linux/interrupt.h>

#include <linux/io.h>

#include <linux/irq.h>

#include <linux/irqchip.h>

#include <linux/irqchip/chained_irq.h>

#include <linux/irqdomain.h>

#include <linux/module.h>

#include <linux/of.h>

#include <linux/of_address.h>

#include <linux/of_irq.h>

#include <linux/platform_device.h>

​

#define IRQ_MASK        0x4

#define IRQ_STATUS      0x8

​

struct ts4800_irq_data {

    void __iomem            *base;

    struct irq_domain       *domain;

    struct irq_chip         irq_chip;

};

​

static void ts4800_irq_mask(struct irq_data *d)

{

    struct ts4800_irq_data *data = irq_data_get_irq_chip_data(d);

    u16 reg = readw(data->base + IRQ_MASK);

    u16 mask = 1 << d->hwirq;

​

    writew(reg | mask, data->base + IRQ_MASK);

}

​

static void ts4800_irq_unmask(struct irq_data *d)

{

    struct ts4800_irq_data *data = irq_data_get_irq_chip_data(d);

    u16 reg = readw(data->base + IRQ_MASK);

    u16 mask = 1 << d->hwirq;

​

    writew(reg & ~mask, data->base + IRQ_MASK);

}

​

static int ts4800_irqdomain_map(struct irq_domain *d, unsigned int irq,

                irq_hw_number_t hwirq)

{

    struct ts4800_irq_data *data = d->host_data;

​

    irq_set_chip_and_handler(irq, &data->irq_chip, handle_simple_irq);

    irq_set_chip_data(irq, data);

    irq_set_noprobe(irq);

​

    return 0;

}

​

static const struct irq_domain_ops ts4800_ic_ops = {

    .map = ts4800_irqdomain_map,