linux-imx

/*

 * Copyright (C) 2017 Marvell

 *

 * Thomas Petazzoni <thomas.petazzoni@free-electrons.com>

 *

 * 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/io.h>

#include <linux/irq.h>

#include <linux/irqdomain.h>

#include <linux/msi.h>

#include <linux/of.h>

#include <linux/of_irq.h>

#include <linux/of_platform.h>

#include <linux/platform_device.h>

​

#include <dt-bindings/interrupt-controller/arm-gic.h>

​

#define GICP_SETSPI_NSR_OFFSET  0x0

#define GICP_CLRSPI_NSR_OFFSET  0x8

​

struct mvebu_gicp_spi_range {

    unsigned int start;

    unsigned int count;

};

​

struct mvebu_gicp {

    struct mvebu_gicp_spi_range *spi_ranges;

    unsigned int spi_ranges_cnt;

    unsigned int spi_cnt;

    unsigned long *spi_bitmap;

    spinlock_t spi_lock;

    struct resource *res;

    struct device *dev;

};

​

static int gicp_idx_to_spi(struct mvebu_gicp *gicp, int idx)

{

    int i;

​

    for (i = 0; i < gicp->spi_ranges_cnt; i++) {

        struct mvebu_gicp_spi_range *r = &gicp->spi_ranges[i];

​

        if (idx < r->count)

            return r->start + idx;

​

        idx -= r->count;

    }

​

    return -EINVAL;

}

​

static void gicp_compose_msi_msg(struct irq_data *data, struct msi_msg *msg)

{

    struct mvebu_gicp *gicp = data->chip_data;

    phys_addr_t setspi = gicp->res->start + GICP_SETSPI_NSR_OFFSET;

    phys_addr_t clrspi = gicp->res->start + GICP_CLRSPI_NSR_OFFSET;

​

    msg[0].data = data->hwirq;

    msg[0].address_lo = lower_32_bits(setspi);