mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
42 lines
906 B
42 lines
906 B
// SPDX-License-Identifier: GPL-2.0 |
|
// |
|
// Copyright 2010 Ben Dooks <[email protected]> |
|
// |
|
// Support for wakeup mask interrupts on newer SoCs |
|
|
|
#include <linux/kernel.h> |
|
#include <linux/spinlock.h> |
|
#include <linux/device.h> |
|
#include <linux/types.h> |
|
#include <linux/irq.h> |
|
#include <linux/io.h> |
|
|
|
#include "wakeup-mask.h" |
|
#include "pm.h" |
|
|
|
void samsung_sync_wakemask(void __iomem *reg, |
|
const struct samsung_wakeup_mask *mask, int nr_mask) |
|
{ |
|
struct irq_data *data; |
|
u32 val; |
|
|
|
val = __raw_readl(reg); |
|
|
|
for (; nr_mask > 0; nr_mask--, mask++) { |
|
if (mask->irq == NO_WAKEUP_IRQ) { |
|
val |= mask->bit; |
|
continue; |
|
} |
|
|
|
data = irq_get_irq_data(mask->irq); |
|
|
|
/* bit of a liberty to read this directly from irq_data. */ |
|
if (irqd_is_wakeup_set(data)) |
|
val &= ~mask->bit; |
|
else |
|
val |= mask->bit; |
|
} |
|
|
|
printk(KERN_INFO "wakemask %08x => %08x\n", __raw_readl(reg), val); |
|
__raw_writel(val, reg); |
|
}
|
|
|