linux-imx

/*

 * Copyright (C) 2014-2015 Toradex AG

 * Author: Stefan Agner <stefan@agner.ch>

 *

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

 *

 *

 * IRQ chip driver for MSCM interrupt router available on Vybrid SoC's.

 * The interrupt router is between the CPU's interrupt controller and the

 * peripheral. The router allows to route the peripheral interrupts to

 * one of the two available CPU's on Vybrid VF6xx SoC's (Cortex-A5 or

 * Cortex-M4). The router will be configured transparently on a IRQ

 * request.

 *

 * o All peripheral interrupts of the Vybrid SoC can be routed to

 *   CPU 0, CPU 1 or both. The routing is useful for dual-core

 *   variants of Vybrid SoC such as VF6xx. This driver routes the

 *   requested interrupt to the CPU currently running on.

 *

 * o It is required to setup the interrupt router even on single-core

 *   variants of Vybrid.

 */

​

#include <linux/cpu_pm.h>

#include <linux/io.h>

#include <linux/irq.h>

#include <linux/irqchip.h>

#include <linux/irqdomain.h>

#include <linux/mfd/syscon.h>

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

#include <linux/of.h>

#include <linux/of_address.h>

#include <linux/slab.h>

#include <linux/regmap.h>

​

#define MSCM_CPxNUM     0x4

​

#define MSCM_IRSPRC(n)      (0x80 + 2 * (n))

#define MSCM_IRSPRC_CPEN_MASK   0x3

​

#define MSCM_IRSPRC_NUM     112

​

struct vf610_mscm_ir_chip_data {

    void __iomem *mscm_ir_base;

    u16 cpu_mask;

    u16 saved_irsprc[MSCM_IRSPRC_NUM];

    bool is_nvic;

};

​

static struct vf610_mscm_ir_chip_data *mscm_ir_data;

​

static inline void vf610_mscm_ir_save(struct vf610_mscm_ir_chip_data *data)

{

    int i;

​

    for (i = 0; i < MSCM_IRSPRC_NUM; i++)

        data->saved_irsprc[i] = readw_relaxed(data->mscm_ir_base + MSCM_IRSPRC(i));

}

​

static inline void vf610_mscm_ir_restore(struct vf610_mscm_ir_chip_data *data)

{