Commit | Line | Data |
---|---|---|
0317e52e BD |
1 | /* arch/arm/plat-samsung/wakeup-mask.c |
2 | * | |
3 | * Copyright 2010 Ben Dooks <ben-linux@fluff.org> | |
4 | * | |
5 | * Support for wakeup mask interrupts on newer SoCs | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify | |
8 | * it under the terms of the GNU General Public License version 2 as | |
9 | * published by the Free Software Foundation. | |
10 | */ | |
11 | ||
12 | #include <linux/kernel.h> | |
13 | #include <linux/spinlock.h> | |
14 | #include <linux/sysdev.h> | |
15 | #include <linux/types.h> | |
16 | #include <linux/irq.h> | |
17 | #include <linux/io.h> | |
18 | ||
19 | #include <plat/wakeup-mask.h> | |
20 | #include <plat/pm.h> | |
21 | ||
22 | void samsung_sync_wakemask(void __iomem *reg, | |
23 | struct samsung_wakeup_mask *mask, int nr_mask) | |
24 | { | |
25 | struct irq_desc *desc; | |
26 | u32 val; | |
27 | ||
28 | val = __raw_readl(reg); | |
29 | ||
30 | for (; nr_mask > 0; nr_mask--, mask++) { | |
31 | if (mask->irq == NO_WAKEUP_IRQ) { | |
32 | val |= mask->bit; | |
33 | continue; | |
34 | } | |
35 | ||
36 | desc = irq_to_desc(mask->irq); | |
37 | ||
38 | /* bit of a liberty to read this directly from irq_desc. */ | |
39 | if (desc->wake_depth > 0) | |
40 | val &= ~mask->bit; | |
41 | else | |
42 | val |= mask->bit; | |
43 | } | |
44 | ||
45 | printk(KERN_INFO "wakemask %08x => %08x\n", __raw_readl(reg), val); | |
46 | __raw_writel(val, reg); | |
47 | } |