Commit | Line | Data |
---|---|---|
6b6844dd AK |
1 | /* linux/arch/arm/mach-s5p64x0/irq-pm.c |
2 | * | |
3 | * Copyright (c) 2011 Samsung Electronics Co., Ltd. | |
4 | * http://www.samsung.com | |
5 | * | |
6 | * S5P64X0 - Interrupt handling Power Management | |
7 | * | |
8 | * Based on arch/arm/mach-s3c64xx/irq-pm.c by Ben Dooks | |
9 | * | |
10 | * This program is free software; you can redistribute it and/or modify | |
11 | * it under the terms of the GNU General Public License version 2 as | |
12 | * published by the Free Software Foundation. | |
13 | */ | |
14 | ||
15 | #include <linux/syscore_ops.h> | |
16 | #include <linux/serial_core.h> | |
334a1c70 | 17 | #include <linux/serial_s3c.h> |
6b6844dd AK |
18 | #include <linux/io.h> |
19 | ||
6b6844dd AK |
20 | #include <plat/pm.h> |
21 | ||
22 | #include <mach/regs-gpio.h> | |
23 | ||
24 | static struct sleep_save irq_save[] = { | |
25 | SAVE_ITEM(S5P64X0_EINT0CON0), | |
26 | SAVE_ITEM(S5P64X0_EINT0FLTCON0), | |
27 | SAVE_ITEM(S5P64X0_EINT0FLTCON1), | |
28 | SAVE_ITEM(S5P64X0_EINT0MASK), | |
29 | }; | |
30 | ||
31 | static struct irq_grp_save { | |
32 | u32 con; | |
33 | u32 fltcon; | |
34 | u32 mask; | |
35 | } eint_grp_save[4]; | |
36 | ||
0443a653 | 37 | #ifdef CONFIG_SERIAL_SAMSUNG |
6b6844dd | 38 | static u32 irq_uart_mask[CONFIG_SERIAL_SAMSUNG_UARTS]; |
0443a653 | 39 | #endif |
6b6844dd AK |
40 | |
41 | static int s5p64x0_irq_pm_suspend(void) | |
42 | { | |
43 | struct irq_grp_save *grp = eint_grp_save; | |
44 | int i; | |
45 | ||
46 | S3C_PMDBG("%s: suspending IRQs\n", __func__); | |
47 | ||
48 | s3c_pm_do_save(irq_save, ARRAY_SIZE(irq_save)); | |
49 | ||
0443a653 | 50 | #ifdef CONFIG_SERIAL_SAMSUNG |
6b6844dd AK |
51 | for (i = 0; i < CONFIG_SERIAL_SAMSUNG_UARTS; i++) |
52 | irq_uart_mask[i] = __raw_readl(S3C_VA_UARTx(i) + S3C64XX_UINTM); | |
0443a653 | 53 | #endif |
6b6844dd AK |
54 | |
55 | for (i = 0; i < ARRAY_SIZE(eint_grp_save); i++, grp++) { | |
56 | grp->con = __raw_readl(S5P64X0_EINT12CON + (i * 4)); | |
57 | grp->mask = __raw_readl(S5P64X0_EINT12MASK + (i * 4)); | |
58 | grp->fltcon = __raw_readl(S5P64X0_EINT12FLTCON + (i * 4)); | |
59 | } | |
60 | ||
61 | return 0; | |
62 | } | |
63 | ||
64 | static void s5p64x0_irq_pm_resume(void) | |
65 | { | |
66 | struct irq_grp_save *grp = eint_grp_save; | |
67 | int i; | |
68 | ||
69 | S3C_PMDBG("%s: resuming IRQs\n", __func__); | |
70 | ||
71 | s3c_pm_do_restore(irq_save, ARRAY_SIZE(irq_save)); | |
72 | ||
0443a653 | 73 | #ifdef CONFIG_SERIAL_SAMSUNG |
6b6844dd AK |
74 | for (i = 0; i < CONFIG_SERIAL_SAMSUNG_UARTS; i++) |
75 | __raw_writel(irq_uart_mask[i], S3C_VA_UARTx(i) + S3C64XX_UINTM); | |
0443a653 | 76 | #endif |
6b6844dd AK |
77 | |
78 | for (i = 0; i < ARRAY_SIZE(eint_grp_save); i++, grp++) { | |
79 | __raw_writel(grp->con, S5P64X0_EINT12CON + (i * 4)); | |
80 | __raw_writel(grp->mask, S5P64X0_EINT12MASK + (i * 4)); | |
81 | __raw_writel(grp->fltcon, S5P64X0_EINT12FLTCON + (i * 4)); | |
82 | } | |
83 | ||
84 | S3C_PMDBG("%s: IRQ configuration restored\n", __func__); | |
85 | } | |
86 | ||
87 | static struct syscore_ops s5p64x0_irq_syscore_ops = { | |
88 | .suspend = s5p64x0_irq_pm_suspend, | |
89 | .resume = s5p64x0_irq_pm_resume, | |
90 | }; | |
91 | ||
92 | static int __init s5p64x0_syscore_init(void) | |
93 | { | |
94 | register_syscore_ops(&s5p64x0_irq_syscore_ops); | |
95 | ||
96 | return 0; | |
97 | } | |
98 | core_initcall(s5p64x0_syscore_init); |