Blame view

kernel/linux-imx6_3.14.28/arch/arm/mach-s3c24xx/irq-pm.c 2.99 KB
6b13f685e   김민수   BSP 최초 추가
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
  /* linux/arch/arm/plat-s3c24xx/irq-om.c
   *
   * Copyright (c) 2003-2004 Simtec Electronics
   *	Ben Dooks <ben@simtec.co.uk>
   *	http://armlinux.simtec.co.uk/
   *
   * S3C24XX - IRQ PM code
   *
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License version 2 as
   * published by the Free Software Foundation.
   */
  
  #include <linux/init.h>
  #include <linux/module.h>
  #include <linux/interrupt.h>
  #include <linux/irq.h>
  #include <linux/syscore_ops.h>
  #include <linux/io.h>
  
  #include <plat/cpu.h>
  #include <plat/pm.h>
  #include <plat/map-base.h>
  #include <plat/map-s3c.h>
  
  #include <mach/regs-irq.h>
  #include <mach/regs-gpio.h>
  
  #include <asm/irq.h>
  
  /* state for IRQs over sleep */
  
  /* default is to allow for EINT0..EINT15, and IRQ_RTC as wakeup sources
   *
   * set bit to 1 in allow bitfield to enable the wakeup settings on it
  */
  
  unsigned long s3c_irqwake_intallow	= 1L << 30 | 0xfL;
  unsigned long s3c_irqwake_eintallow	= 0x0000fff0L;
  
  int s3c_irq_wake(struct irq_data *data, unsigned int state)
  {
  	unsigned long irqbit = 1 << data->hwirq;
  
  	if (!(s3c_irqwake_intallow & irqbit))
  		return -ENOENT;
  
  	pr_info("wake %s for hwirq %lu
  ",
  		state ? "enabled" : "disabled", data->hwirq);
  
  	if (!state)
  		s3c_irqwake_intmask |= irqbit;
  	else
  		s3c_irqwake_intmask &= ~irqbit;
  
  	return 0;
  }
  
  static struct sleep_save irq_save[] = {
  	SAVE_ITEM(S3C2410_INTMSK),
  	SAVE_ITEM(S3C2410_INTSUBMSK),
  };
  
  /* the extint values move between the s3c2410/s3c2440 and the s3c2412
   * so we use an array to hold them, and to calculate the address of
   * the register at run-time
  */
  
  static unsigned long save_extint[3];
  static unsigned long save_eintflt[4];
  static unsigned long save_eintmask;
  
  static int s3c24xx_irq_suspend(void)
  {
  	unsigned int i;
  
  	for (i = 0; i < ARRAY_SIZE(save_extint); i++)
  		save_extint[i] = __raw_readl(S3C24XX_EXTINT0 + (i*4));
  
  	for (i = 0; i < ARRAY_SIZE(save_eintflt); i++)
  		save_eintflt[i] = __raw_readl(S3C24XX_EINFLT0 + (i*4));
  
  	s3c_pm_do_save(irq_save, ARRAY_SIZE(irq_save));
  	save_eintmask = __raw_readl(S3C24XX_EINTMASK);
  
  	return 0;
  }
  
  static void s3c24xx_irq_resume(void)
  {
  	unsigned int i;
  
  	for (i = 0; i < ARRAY_SIZE(save_extint); i++)
  		__raw_writel(save_extint[i], S3C24XX_EXTINT0 + (i*4));
  
  	for (i = 0; i < ARRAY_SIZE(save_eintflt); i++)
  		__raw_writel(save_eintflt[i], S3C24XX_EINFLT0 + (i*4));
  
  	s3c_pm_do_restore(irq_save, ARRAY_SIZE(irq_save));
  	__raw_writel(save_eintmask, S3C24XX_EINTMASK);
  }
  
  struct syscore_ops s3c24xx_irq_syscore_ops = {
  	.suspend	= s3c24xx_irq_suspend,
  	.resume		= s3c24xx_irq_resume,
  };
  
  #ifdef CONFIG_CPU_S3C2416
  static struct sleep_save s3c2416_irq_save[] = {
  	SAVE_ITEM(S3C2416_INTMSK2),
  };
  
  static int s3c2416_irq_suspend(void)
  {
  	s3c_pm_do_save(s3c2416_irq_save, ARRAY_SIZE(s3c2416_irq_save));
  
  	return 0;
  }
  
  static void s3c2416_irq_resume(void)
  {
  	s3c_pm_do_restore(s3c2416_irq_save, ARRAY_SIZE(s3c2416_irq_save));
  }
  
  struct syscore_ops s3c2416_irq_syscore_ops = {
  	.suspend	= s3c2416_irq_suspend,
  	.resume		= s3c2416_irq_resume,
  };
  #endif