linux-imx

/*

 * Driver for UniPhier AIDET (ARM Interrupt Detector)

 *

 * Copyright (C) 2017 Socionext Inc.

 *   Author: Masahiro Yamada <yamada.masahiro@socionext.com>

 *

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

 *

 * This program is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 * GNU General Public License for more details.

 */

​

#include <linux/bitops.h>

#include <linux/init.h>

#include <linux/irq.h>

#include <linux/irqdomain.h>

#include <linux/kernel.h>

#include <linux/of.h>

#include <linux/of_device.h>

#include <linux/of_irq.h>

#include <linux/platform_device.h>

#include <linux/spinlock.h>

​

#define UNIPHIER_AIDET_NR_IRQS      256

​

#define UNIPHIER_AIDET_DETCONF      0x04    /* inverter register base */

​

struct uniphier_aidet_priv {

    struct irq_domain *domain;

    void __iomem *reg_base;

    spinlock_t lock;

    u32 saved_vals[UNIPHIER_AIDET_NR_IRQS / 32];

};

​

static void uniphier_aidet_reg_update(struct uniphier_aidet_priv *priv,

                      unsigned int reg, u32 mask, u32 val)

{

    unsigned long flags;

    u32 tmp;

​

    spin_lock_irqsave(&priv->lock, flags);

    tmp = readl_relaxed(priv->reg_base + reg);

    tmp &= ~mask;

    tmp |= mask & val;

    writel_relaxed(tmp, priv->reg_base + reg);

    spin_unlock_irqrestore(&priv->lock, flags);

}

​

static void uniphier_aidet_detconf_update(struct uniphier_aidet_priv *priv,

                      unsigned long index, unsigned int val)

{

    unsigned int reg;

    u32 mask;

​

    reg = UNIPHIER_AIDET_DETCONF + index / 32 * 4;

    mask = BIT(index % 32);

​

    uniphier_aidet_reg_update(priv, reg, mask, val ? mask : 0);

}