xref: /openbmc/linux/arch/arm/mach-s3c/wakeup-mask.c (revision cbecf716ca618fd44feda6bd9a64a8179d031fc5)
171b9114dSArnd Bergmann // SPDX-License-Identifier: GPL-2.0
271b9114dSArnd Bergmann //
371b9114dSArnd Bergmann // Copyright 2010 Ben Dooks <ben-linux@fluff.org>
471b9114dSArnd Bergmann //
571b9114dSArnd Bergmann // Support for wakeup mask interrupts on newer SoCs
671b9114dSArnd Bergmann 
771b9114dSArnd Bergmann #include <linux/kernel.h>
871b9114dSArnd Bergmann #include <linux/spinlock.h>
971b9114dSArnd Bergmann #include <linux/device.h>
1071b9114dSArnd Bergmann #include <linux/types.h>
1171b9114dSArnd Bergmann #include <linux/irq.h>
1271b9114dSArnd Bergmann #include <linux/io.h>
1371b9114dSArnd Bergmann 
14*c6ff132dSArnd Bergmann #include "wakeup-mask.h"
15*c6ff132dSArnd Bergmann #include "pm.h"
1671b9114dSArnd Bergmann 
samsung_sync_wakemask(void __iomem * reg,const struct samsung_wakeup_mask * mask,int nr_mask)1771b9114dSArnd Bergmann void samsung_sync_wakemask(void __iomem *reg,
1871b9114dSArnd Bergmann 			   const struct samsung_wakeup_mask *mask, int nr_mask)
1971b9114dSArnd Bergmann {
2071b9114dSArnd Bergmann 	struct irq_data *data;
2171b9114dSArnd Bergmann 	u32 val;
2271b9114dSArnd Bergmann 
2371b9114dSArnd Bergmann 	val = __raw_readl(reg);
2471b9114dSArnd Bergmann 
2571b9114dSArnd Bergmann 	for (; nr_mask > 0; nr_mask--, mask++) {
2671b9114dSArnd Bergmann 		if (mask->irq == NO_WAKEUP_IRQ) {
2771b9114dSArnd Bergmann 			val |= mask->bit;
2871b9114dSArnd Bergmann 			continue;
2971b9114dSArnd Bergmann 		}
3071b9114dSArnd Bergmann 
3171b9114dSArnd Bergmann 		data = irq_get_irq_data(mask->irq);
3271b9114dSArnd Bergmann 
3371b9114dSArnd Bergmann 		/* bit of a liberty to read this directly from irq_data. */
3471b9114dSArnd Bergmann 		if (irqd_is_wakeup_set(data))
3571b9114dSArnd Bergmann 			val &= ~mask->bit;
3671b9114dSArnd Bergmann 		else
3771b9114dSArnd Bergmann 			val |= mask->bit;
3871b9114dSArnd Bergmann 	}
3971b9114dSArnd Bergmann 
4071b9114dSArnd Bergmann 	printk(KERN_INFO "wakemask %08x => %08x\n", __raw_readl(reg), val);
4171b9114dSArnd Bergmann 	__raw_writel(val, reg);
4271b9114dSArnd Bergmann }
43