]>
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> | |
17 | #include <linux/io.h> | |
18 | ||
19 | #include <plat/regs-serial.h> | |
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 | ||
37 | static u32 irq_uart_mask[CONFIG_SERIAL_SAMSUNG_UARTS]; | |
38 | ||
39 | static int s5p64x0_irq_pm_suspend(void) | |
40 | { | |
41 | struct irq_grp_save *grp = eint_grp_save; | |
42 | int i; | |
43 | ||
44 | S3C_PMDBG("%s: suspending IRQs\n", __func__); | |
45 | ||
46 | s3c_pm_do_save(irq_save, ARRAY_SIZE(irq_save)); | |
47 | ||
48 | for (i = 0; i < CONFIG_SERIAL_SAMSUNG_UARTS; i++) | |
49 | irq_uart_mask[i] = __raw_readl(S3C_VA_UARTx(i) + S3C64XX_UINTM); | |
50 | ||
51 | for (i = 0; i < ARRAY_SIZE(eint_grp_save); i++, grp++) { | |
52 | grp->con = __raw_readl(S5P64X0_EINT12CON + (i * 4)); | |
53 | grp->mask = __raw_readl(S5P64X0_EINT12MASK + (i * 4)); | |
54 | grp->fltcon = __raw_readl(S5P64X0_EINT12FLTCON + (i * 4)); | |
55 | } | |
56 | ||
57 | return 0; | |
58 | } | |
59 | ||
60 | static void s5p64x0_irq_pm_resume(void) | |
61 | { | |
62 | struct irq_grp_save *grp = eint_grp_save; | |
63 | int i; | |
64 | ||
65 | S3C_PMDBG("%s: resuming IRQs\n", __func__); | |
66 | ||
67 | s3c_pm_do_restore(irq_save, ARRAY_SIZE(irq_save)); | |
68 | ||
69 | for (i = 0; i < CONFIG_SERIAL_SAMSUNG_UARTS; i++) | |
70 | __raw_writel(irq_uart_mask[i], S3C_VA_UARTx(i) + S3C64XX_UINTM); | |
71 | ||
72 | for (i = 0; i < ARRAY_SIZE(eint_grp_save); i++, grp++) { | |
73 | __raw_writel(grp->con, S5P64X0_EINT12CON + (i * 4)); | |
74 | __raw_writel(grp->mask, S5P64X0_EINT12MASK + (i * 4)); | |
75 | __raw_writel(grp->fltcon, S5P64X0_EINT12FLTCON + (i * 4)); | |
76 | } | |
77 | ||
78 | S3C_PMDBG("%s: IRQ configuration restored\n", __func__); | |
79 | } | |
80 | ||
81 | static struct syscore_ops s5p64x0_irq_syscore_ops = { | |
82 | .suspend = s5p64x0_irq_pm_suspend, | |
83 | .resume = s5p64x0_irq_pm_resume, | |
84 | }; | |
85 | ||
86 | static int __init s5p64x0_syscore_init(void) | |
87 | { | |
88 | register_syscore_ops(&s5p64x0_irq_syscore_ops); | |
89 | ||
90 | return 0; | |
91 | } | |
92 | core_initcall(s5p64x0_syscore_init); |