1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/gpio.h>
15#include <linux/gpio-pxa.h>
16#include <linux/module.h>
17#include <linux/kernel.h>
18#include <linux/init.h>
19#include <linux/irqchip.h>
20#include <linux/suspend.h>
21#include <linux/platform_device.h>
22#include <linux/syscore_ops.h>
23#include <linux/io.h>
24#include <linux/irq.h>
25#include <linux/platform_data/i2c-pxa.h>
26
27#include <asm/mach/map.h>
28#include <mach/hardware.h>
29#include <asm/irq.h>
30#include <asm/suspend.h>
31#include <mach/irqs.h>
32#include "pxa27x.h"
33#include <mach/reset.h>
34#include <linux/platform_data/usb-ohci-pxa27x.h>
35#include "pm.h"
36#include <mach/dma.h>
37#include <mach/smemc.h>
38
39#include "generic.h"
40#include "devices.h"
41#include <linux/clk-provider.h>
42#include <linux/clkdev.h>
43
44void pxa27x_clear_otgph(void)
45{
46 if (cpu_is_pxa27x() && (PSSR & PSSR_OTGPH))
47 PSSR |= PSSR_OTGPH;
48}
49EXPORT_SYMBOL(pxa27x_clear_otgph);
50
51static unsigned long ac97_reset_config[] = {
52 GPIO113_AC97_nRESET_GPIO_HIGH,
53 GPIO113_AC97_nRESET,
54 GPIO95_AC97_nRESET_GPIO_HIGH,
55 GPIO95_AC97_nRESET,
56};
57
58void pxa27x_configure_ac97reset(int reset_gpio, bool to_gpio)
59{
60
61
62
63
64
65
66
67
68 if (reset_gpio == 113)
69 pxa2xx_mfp_config(to_gpio ? &ac97_reset_config[0] :
70 &ac97_reset_config[1], 1);
71
72 if (reset_gpio == 95)
73 pxa2xx_mfp_config(to_gpio ? &ac97_reset_config[2] :
74 &ac97_reset_config[3], 1);
75}
76EXPORT_SYMBOL_GPL(pxa27x_configure_ac97reset);
77
78#ifdef CONFIG_PM
79
80#define SAVE(x) sleep_save[SLEEP_SAVE_##x] = x
81#define RESTORE(x) x = sleep_save[SLEEP_SAVE_##x]
82
83
84
85
86static unsigned int pwrmode = PWRMODE_SLEEP;
87
88int pxa27x_set_pwrmode(unsigned int mode)
89{
90 switch (mode) {
91 case PWRMODE_SLEEP:
92 case PWRMODE_DEEPSLEEP:
93 pwrmode = mode;
94 return 0;
95 }
96
97 return -EINVAL;
98}
99
100
101
102
103
104
105enum {
106 SLEEP_SAVE_PSTR,
107 SLEEP_SAVE_MDREFR,
108 SLEEP_SAVE_PCFR,
109 SLEEP_SAVE_COUNT
110};
111
112void pxa27x_cpu_pm_save(unsigned long *sleep_save)
113{
114 sleep_save[SLEEP_SAVE_MDREFR] = __raw_readl(MDREFR);
115 SAVE(PCFR);
116
117 SAVE(PSTR);
118}
119
120void pxa27x_cpu_pm_restore(unsigned long *sleep_save)
121{
122 __raw_writel(sleep_save[SLEEP_SAVE_MDREFR], MDREFR);
123 RESTORE(PCFR);
124
125 PSSR = PSSR_RDH | PSSR_PH;
126
127 RESTORE(PSTR);
128}
129
130void pxa27x_cpu_pm_enter(suspend_state_t state)
131{
132 extern void pxa_cpu_standby(void);
133#ifndef CONFIG_IWMMXT
134 u64 acc0;
135
136 asm volatile(".arch_extension xscale\n\t"
137 "mra %Q0, %R0, acc0" : "=r" (acc0));
138#endif
139
140
141 PCFR &= ~PCFR_FVC;
142
143
144 PEDR = 0xDF12FE1B;
145
146
147 RCSR = RCSR_HWR | RCSR_WDR | RCSR_SMR | RCSR_GPR;
148
149 switch (state) {
150 case PM_SUSPEND_STANDBY:
151 pxa_cpu_standby();
152 break;
153 case PM_SUSPEND_MEM:
154 cpu_suspend(pwrmode, pxa27x_finish_suspend);
155#ifndef CONFIG_IWMMXT
156 asm volatile(".arch_extension xscale\n\t"
157 "mar acc0, %Q0, %R0" : "=r" (acc0));
158#endif
159 break;
160 }
161}
162
163static int pxa27x_cpu_pm_valid(suspend_state_t state)
164{
165 return state == PM_SUSPEND_MEM || state == PM_SUSPEND_STANDBY;
166}
167
168static int pxa27x_cpu_pm_prepare(void)
169{
170
171 PSPR = __pa_symbol(cpu_resume);
172 return 0;
173}
174
175static void pxa27x_cpu_pm_finish(void)
176{
177
178 PSPR = 0;
179}
180
181static struct pxa_cpu_pm_fns pxa27x_cpu_pm_fns = {
182 .save_count = SLEEP_SAVE_COUNT,
183 .save = pxa27x_cpu_pm_save,
184 .restore = pxa27x_cpu_pm_restore,
185 .valid = pxa27x_cpu_pm_valid,
186 .enter = pxa27x_cpu_pm_enter,
187 .prepare = pxa27x_cpu_pm_prepare,
188 .finish = pxa27x_cpu_pm_finish,
189};
190
191static void __init pxa27x_init_pm(void)
192{
193 pxa_cpu_pm_fns = &pxa27x_cpu_pm_fns;
194}
195#else
196static inline void pxa27x_init_pm(void) {}
197#endif
198
199
200
201
202static int pxa27x_set_wake(struct irq_data *d, unsigned int on)
203{
204 int gpio = pxa_irq_to_gpio(d->irq);
205 uint32_t mask;
206
207 if (gpio >= 0 && gpio < 128)
208 return gpio_set_wake(gpio, on);
209
210 if (d->irq == IRQ_KEYPAD)
211 return keypad_set_wake(on);
212
213 switch (d->irq) {
214 case IRQ_RTCAlrm:
215 mask = PWER_RTC;
216 break;
217 case IRQ_USB:
218 mask = 1u << 26;
219 break;
220 default:
221 return -EINVAL;
222 }
223
224 if (on)
225 PWER |= mask;
226 else
227 PWER &=~mask;
228
229 return 0;
230}
231
232void __init pxa27x_init_irq(void)
233{
234 pxa_init_irq(34, pxa27x_set_wake);
235}
236
237static int __init
238pxa27x_dt_init_irq(struct device_node *node, struct device_node *parent)
239{
240 pxa_dt_irq_init(pxa27x_set_wake);
241 set_handle_irq(ichp_handle_irq);
242
243 return 0;
244}
245IRQCHIP_DECLARE(pxa27x_intc, "marvell,pxa-intc", pxa27x_dt_init_irq);
246
247static struct map_desc pxa27x_io_desc[] __initdata = {
248 {
249 .virtual = (unsigned long)SMEMC_VIRT,
250 .pfn = __phys_to_pfn(PXA2XX_SMEMC_BASE),
251 .length = SMEMC_SIZE,
252 .type = MT_DEVICE
253 }, {
254 .virtual = UNCACHED_PHYS_0,
255 .pfn = __phys_to_pfn(0x00000000),
256 .length = UNCACHED_PHYS_0_SIZE,
257 .type = MT_DEVICE
258 },
259};
260
261void __init pxa27x_map_io(void)
262{
263 pxa_map_io();
264 iotable_init(ARRAY_AND_SIZE(pxa27x_io_desc));
265 pxa27x_get_clk_frequency_khz(1);
266}
267
268
269
270
271void __init pxa27x_set_i2c_power_info(struct i2c_pxa_platform_data *info)
272{
273 local_irq_disable();
274 PCFR |= PCFR_PI2CEN;
275 local_irq_enable();
276 pxa_register_device(&pxa27x_device_i2c_power, info);
277}
278
279static struct pxa_gpio_platform_data pxa27x_gpio_info __initdata = {
280 .irq_base = PXA_GPIO_TO_IRQ(0),
281 .gpio_set_wake = gpio_set_wake,
282};
283
284static struct platform_device *devices[] __initdata = {
285 &pxa27x_device_udc,
286 &pxa_device_pmu,
287 &pxa_device_i2s,
288 &pxa_device_asoc_ssp1,
289 &pxa_device_asoc_ssp2,
290 &pxa_device_asoc_ssp3,
291 &pxa_device_asoc_platform,
292 &pxa_device_rtc,
293 &pxa27x_device_ssp1,
294 &pxa27x_device_ssp2,
295 &pxa27x_device_ssp3,
296 &pxa27x_device_pwm0,
297 &pxa27x_device_pwm1,
298};
299
300static int __init pxa27x_init(void)
301{
302 int ret = 0;
303
304 if (cpu_is_pxa27x()) {
305
306 reset_status = RCSR;
307
308 pxa27x_init_pm();
309
310 register_syscore_ops(&pxa_irq_syscore_ops);
311 register_syscore_ops(&pxa2xx_mfp_syscore_ops);
312
313 if (!of_have_populated_dt()) {
314 pxa_register_device(&pxa27x_device_gpio,
315 &pxa27x_gpio_info);
316 pxa2xx_set_dmac_info(32, 75);
317 ret = platform_add_devices(devices,
318 ARRAY_SIZE(devices));
319 }
320 }
321
322 return ret;
323}
324
325postcore_initcall(pxa27x_init);
326
