linux-imx

/*

 * Copyright (C) 2015 Freescale Semiconductor, Inc.

 *

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

#include <linux/of_irq.h>

#include <linux/slab.h>

#include <linux/irqchip.h>

#include <linux/syscore_ops.h>

​

#define IMR_NUM         4

#define GPC_MAX_IRQS            (IMR_NUM * 32)

​

#define GPC_IMR1_CORE0      0x30

#define GPC_IMR1_CORE1      0x40

#define GPC_IMR1_CORE2      0x1c0

#define GPC_IMR1_CORE3      0x1d0

​

​

struct gpcv2_irqchip_data {

    struct raw_spinlock rlock;

    void __iomem        *gpc_base;

    u32         wakeup_sources[IMR_NUM];

    u32         saved_irq_mask[IMR_NUM];

    u32         cpu2wakeup;

};

​

static struct gpcv2_irqchip_data *imx_gpcv2_instance;

​

static void __iomem *gpcv2_idx_to_reg(struct gpcv2_irqchip_data *cd, int i)

{

    return cd->gpc_base + cd->cpu2wakeup + i * 4;

}

​

static int gpcv2_wakeup_source_save(void)

{

    struct gpcv2_irqchip_data *cd;

    void __iomem *reg;

    int i;

​

    cd = imx_gpcv2_instance;

    if (!cd)

        return 0;

​

    for (i = 0; i < IMR_NUM; i++) {

        reg = gpcv2_idx_to_reg(cd, i);

        cd->saved_irq_mask[i] = readl_relaxed(reg);

        writel_relaxed(cd->wakeup_sources[i], reg);

    }

​

    return 0;

}

​

static void gpcv2_wakeup_source_restore(void)

{

    struct gpcv2_irqchip_data *cd;

    int i;

​

    cd = imx_gpcv2_instance;