Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
| 2 | * linux/arch/arm/mach-pxa/pxa27x.c |
| 3 | * |
| 4 | * Author: Nicolas Pitre |
| 5 | * Created: Nov 05, 2002 |
| 6 | * Copyright: MontaVista Software Inc. |
| 7 | * |
| 8 | * Code specific to PXA27x aka Bulverde. |
| 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 | */ |
Russell King | 2f8163b | 2011-07-26 10:53:52 +0100 | [diff] [blame] | 14 | #include <linux/gpio.h> |
Haojian Zhuang | 157d264 | 2011-10-17 20:37:52 +0800 | [diff] [blame] | 15 | #include <linux/gpio-pxa.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 16 | #include <linux/module.h> |
| 17 | #include <linux/kernel.h> |
| 18 | #include <linux/init.h> |
Rafael J. Wysocki | 95d9ffb | 2007-10-18 03:04:39 -0700 | [diff] [blame] | 19 | #include <linux/suspend.h> |
Russell King | d052d1b | 2005-10-29 19:07:23 +0100 | [diff] [blame] | 20 | #include <linux/platform_device.h> |
Rafael J. Wysocki | 2eaa03b | 2011-04-22 22:03:11 +0200 | [diff] [blame] | 21 | #include <linux/syscore_ops.h> |
Marek Vasut | ad68bb9 | 2010-11-03 16:29:35 +0100 | [diff] [blame] | 22 | #include <linux/io.h> |
Lennert Buytenhek | a3f4c92 | 2010-11-29 11:18:26 +0100 | [diff] [blame] | 23 | #include <linux/irq.h> |
Sebastian Andrzej Siewior | b459396 | 2011-02-23 12:38:16 +0100 | [diff] [blame] | 24 | #include <linux/i2c/pxa-i2c.h> |
Linus Walleij | f55be1b | 2011-09-28 09:11:30 +0100 | [diff] [blame] | 25 | #include <linux/gpio.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 26 | |
Marek Vasut | 851982c | 2010-10-11 02:20:19 +0200 | [diff] [blame] | 27 | #include <asm/mach/map.h> |
Russell King | a09e64f | 2008-08-05 16:14:15 +0100 | [diff] [blame] | 28 | #include <mach/hardware.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 29 | #include <asm/irq.h> |
Russell King | 2c74a0c | 2011-06-22 17:41:48 +0100 | [diff] [blame] | 30 | #include <asm/suspend.h> |
Russell King | a09e64f | 2008-08-05 16:14:15 +0100 | [diff] [blame] | 31 | #include <mach/irqs.h> |
Eric Miao | 51c6298 | 2009-01-02 23:17:22 +0800 | [diff] [blame] | 32 | #include <mach/pxa27x.h> |
Russell King | afd2fc0 | 2008-08-07 11:05:25 +0100 | [diff] [blame] | 33 | #include <mach/reset.h> |
Russell King | a09e64f | 2008-08-05 16:14:15 +0100 | [diff] [blame] | 34 | #include <mach/ohci.h> |
| 35 | #include <mach/pm.h> |
| 36 | #include <mach/dma.h> |
Marek Vasut | ad68bb9 | 2010-11-03 16:29:35 +0100 | [diff] [blame] | 37 | #include <mach/smemc.h> |
| 38 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 39 | #include "generic.h" |
Russell King | 46c41e6 | 2007-05-15 15:39:36 +0100 | [diff] [blame] | 40 | #include "devices.h" |
Russell King | a6dba20 | 2007-08-20 10:18:02 +0100 | [diff] [blame] | 41 | #include "clock.h" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 42 | |
Eric Miao | 0cb0b0d | 2008-10-04 12:45:39 +0800 | [diff] [blame] | 43 | void pxa27x_clear_otgph(void) |
| 44 | { |
| 45 | if (cpu_is_pxa27x() && (PSSR & PSSR_OTGPH)) |
| 46 | PSSR |= PSSR_OTGPH; |
| 47 | } |
| 48 | EXPORT_SYMBOL(pxa27x_clear_otgph); |
| 49 | |
Eric Miao | fb1bf8c | 2010-01-04 16:30:58 +0800 | [diff] [blame] | 50 | static unsigned long ac97_reset_config[] = { |
Eric Miao | fb1bf8c | 2010-01-04 16:30:58 +0800 | [diff] [blame] | 51 | GPIO113_GPIO, |
Eric Miao | 5e16e3c | 2010-07-13 09:41:28 +0800 | [diff] [blame] | 52 | GPIO113_AC97_nRESET, |
| 53 | GPIO95_GPIO, |
| 54 | GPIO95_AC97_nRESET, |
Eric Miao | fb1bf8c | 2010-01-04 16:30:58 +0800 | [diff] [blame] | 55 | }; |
| 56 | |
| 57 | void pxa27x_assert_ac97reset(int reset_gpio, int on) |
| 58 | { |
| 59 | if (reset_gpio == 113) |
| 60 | pxa2xx_mfp_config(on ? &ac97_reset_config[0] : |
| 61 | &ac97_reset_config[1], 1); |
| 62 | |
| 63 | if (reset_gpio == 95) |
| 64 | pxa2xx_mfp_config(on ? &ac97_reset_config[2] : |
| 65 | &ac97_reset_config[3], 1); |
| 66 | } |
| 67 | EXPORT_SYMBOL_GPL(pxa27x_assert_ac97reset); |
| 68 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 69 | /* Crystal clock: 13MHz */ |
| 70 | #define BASE_CLK 13000000 |
| 71 | |
| 72 | /* |
| 73 | * Get the clock frequency as reflected by CCSR and the turbo flag. |
| 74 | * We assume these values have been applied via a fcs. |
| 75 | * If info is not 0 we also display the current settings. |
| 76 | */ |
Russell King | 15a4033 | 2007-08-20 10:07:44 +0100 | [diff] [blame] | 77 | unsigned int pxa27x_get_clk_frequency_khz(int info) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 78 | { |
| 79 | unsigned long ccsr, clkcfg; |
| 80 | unsigned int l, L, m, M, n2, N, S; |
| 81 | int cccr_a, t, ht, b; |
| 82 | |
| 83 | ccsr = CCSR; |
| 84 | cccr_a = CCCR & (1 << 25); |
| 85 | |
| 86 | /* Read clkcfg register: it has turbo, b, half-turbo (and f) */ |
| 87 | asm( "mrc\tp14, 0, %0, c6, c0, 0" : "=r" (clkcfg) ); |
Richard Purdie | afe5df2 | 2006-02-01 19:25:59 +0000 | [diff] [blame] | 88 | t = clkcfg & (1 << 0); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 89 | ht = clkcfg & (1 << 2); |
| 90 | b = clkcfg & (1 << 3); |
| 91 | |
| 92 | l = ccsr & 0x1f; |
| 93 | n2 = (ccsr>>7) & 0xf; |
| 94 | m = (l <= 10) ? 1 : (l <= 20) ? 2 : 4; |
| 95 | |
| 96 | L = l * BASE_CLK; |
| 97 | N = (L * n2) / 2; |
| 98 | M = (!cccr_a) ? (L/m) : ((b) ? L : (L/2)); |
| 99 | S = (b) ? L : (L/2); |
| 100 | |
| 101 | if (info) { |
| 102 | printk( KERN_INFO "Run Mode clock: %d.%02dMHz (*%d)\n", |
| 103 | L / 1000000, (L % 1000000) / 10000, l ); |
| 104 | printk( KERN_INFO "Turbo Mode clock: %d.%02dMHz (*%d.%d, %sactive)\n", |
| 105 | N / 1000000, (N % 1000000)/10000, n2 / 2, (n2 % 2)*5, |
| 106 | (t) ? "" : "in" ); |
| 107 | printk( KERN_INFO "Memory clock: %d.%02dMHz (/%d)\n", |
| 108 | M / 1000000, (M % 1000000) / 10000, m ); |
| 109 | printk( KERN_INFO "System bus clock: %d.%02dMHz \n", |
| 110 | S / 1000000, (S % 1000000) / 10000 ); |
| 111 | } |
| 112 | |
| 113 | return (t) ? (N/1000) : (L/1000); |
| 114 | } |
| 115 | |
| 116 | /* |
Eric Miao | 2a125dd | 2010-11-22 22:48:49 +0800 | [diff] [blame] | 117 | * Return the current mem clock frequency as reflected by CCCR[A], B, and L |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 118 | */ |
Eric Miao | 2a125dd | 2010-11-22 22:48:49 +0800 | [diff] [blame] | 119 | static unsigned long clk_pxa27x_mem_getrate(struct clk *clk) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 120 | { |
| 121 | unsigned long ccsr, clkcfg; |
| 122 | unsigned int l, L, m, M; |
| 123 | int cccr_a, b; |
| 124 | |
| 125 | ccsr = CCSR; |
| 126 | cccr_a = CCCR & (1 << 25); |
| 127 | |
| 128 | /* Read clkcfg register: it has turbo, b, half-turbo (and f) */ |
| 129 | asm( "mrc\tp14, 0, %0, c6, c0, 0" : "=r" (clkcfg) ); |
| 130 | b = clkcfg & (1 << 3); |
| 131 | |
| 132 | l = ccsr & 0x1f; |
| 133 | m = (l <= 10) ? 1 : (l <= 20) ? 2 : 4; |
| 134 | |
| 135 | L = l * BASE_CLK; |
| 136 | M = (!cccr_a) ? (L/m) : ((b) ? L : (L/2)); |
| 137 | |
Eric Miao | 2a125dd | 2010-11-22 22:48:49 +0800 | [diff] [blame] | 138 | return M; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 139 | } |
| 140 | |
Eric Miao | 2a125dd | 2010-11-22 22:48:49 +0800 | [diff] [blame] | 141 | static const struct clkops clk_pxa27x_mem_ops = { |
| 142 | .enable = clk_dummy_enable, |
| 143 | .disable = clk_dummy_disable, |
| 144 | .getrate = clk_pxa27x_mem_getrate, |
| 145 | }; |
| 146 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 147 | /* |
| 148 | * Return the current LCD clock frequency in units of 10kHz as |
| 149 | */ |
Russell King | a88a447 | 2007-08-20 10:34:37 +0100 | [diff] [blame] | 150 | static unsigned int pxa27x_get_lcdclk_frequency_10khz(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 151 | { |
| 152 | unsigned long ccsr; |
| 153 | unsigned int l, L, k, K; |
| 154 | |
| 155 | ccsr = CCSR; |
| 156 | |
| 157 | l = ccsr & 0x1f; |
| 158 | k = (l <= 7) ? 1 : (l <= 16) ? 2 : 4; |
| 159 | |
| 160 | L = l * BASE_CLK; |
| 161 | K = L / k; |
| 162 | |
| 163 | return (K / 10000); |
| 164 | } |
| 165 | |
Russell King | a6dba20 | 2007-08-20 10:18:02 +0100 | [diff] [blame] | 166 | static unsigned long clk_pxa27x_lcd_getrate(struct clk *clk) |
| 167 | { |
| 168 | return pxa27x_get_lcdclk_frequency_10khz() * 10000; |
| 169 | } |
| 170 | |
| 171 | static const struct clkops clk_pxa27x_lcd_ops = { |
Eric Miao | 4029813 | 2010-11-22 10:49:55 +0800 | [diff] [blame] | 172 | .enable = clk_pxa2xx_cken_enable, |
| 173 | .disable = clk_pxa2xx_cken_disable, |
Russell King | a6dba20 | 2007-08-20 10:18:02 +0100 | [diff] [blame] | 174 | .getrate = clk_pxa27x_lcd_getrate, |
| 175 | }; |
| 176 | |
Eric Miao | 4029813 | 2010-11-22 10:49:55 +0800 | [diff] [blame] | 177 | static DEFINE_PXA2_CKEN(pxa27x_ffuart, FFUART, 14857000, 1); |
| 178 | static DEFINE_PXA2_CKEN(pxa27x_btuart, BTUART, 14857000, 1); |
| 179 | static DEFINE_PXA2_CKEN(pxa27x_stuart, STUART, 14857000, 1); |
| 180 | static DEFINE_PXA2_CKEN(pxa27x_i2s, I2S, 14682000, 0); |
| 181 | static DEFINE_PXA2_CKEN(pxa27x_i2c, I2C, 32842000, 0); |
| 182 | static DEFINE_PXA2_CKEN(pxa27x_usb, USB, 48000000, 5); |
| 183 | static DEFINE_PXA2_CKEN(pxa27x_mmc, MMC, 19500000, 0); |
| 184 | static DEFINE_PXA2_CKEN(pxa27x_ficp, FICP, 48000000, 0); |
| 185 | static DEFINE_PXA2_CKEN(pxa27x_usbhost, USBHOST, 48000000, 0); |
| 186 | static DEFINE_PXA2_CKEN(pxa27x_pwri2c, PWRI2C, 13000000, 0); |
| 187 | static DEFINE_PXA2_CKEN(pxa27x_keypad, KEYPAD, 32768, 0); |
| 188 | static DEFINE_PXA2_CKEN(pxa27x_ssp1, SSP1, 13000000, 0); |
| 189 | static DEFINE_PXA2_CKEN(pxa27x_ssp2, SSP2, 13000000, 0); |
| 190 | static DEFINE_PXA2_CKEN(pxa27x_ssp3, SSP3, 13000000, 0); |
| 191 | static DEFINE_PXA2_CKEN(pxa27x_pwm0, PWM0, 13000000, 0); |
| 192 | static DEFINE_PXA2_CKEN(pxa27x_pwm1, PWM1, 13000000, 0); |
| 193 | static DEFINE_PXA2_CKEN(pxa27x_ac97, AC97, 24576000, 0); |
| 194 | static DEFINE_PXA2_CKEN(pxa27x_ac97conf, AC97CONF, 24576000, 0); |
| 195 | static DEFINE_PXA2_CKEN(pxa27x_msl, MSL, 48000000, 0); |
| 196 | static DEFINE_PXA2_CKEN(pxa27x_usim, USIM, 48000000, 0); |
| 197 | static DEFINE_PXA2_CKEN(pxa27x_memstk, MEMSTK, 19500000, 0); |
| 198 | static DEFINE_PXA2_CKEN(pxa27x_im, IM, 0, 0); |
| 199 | static DEFINE_PXA2_CKEN(pxa27x_memc, MEMC, 0, 0); |
| 200 | |
Russell King | 8c3abc7 | 2008-11-08 20:25:21 +0000 | [diff] [blame] | 201 | static DEFINE_CK(pxa27x_lcd, LCD, &clk_pxa27x_lcd_ops); |
| 202 | static DEFINE_CK(pxa27x_camera, CAMERA, &clk_pxa27x_lcd_ops); |
Eric Miao | 2a125dd | 2010-11-22 22:48:49 +0800 | [diff] [blame] | 203 | static DEFINE_CLK(pxa27x_mem, &clk_pxa27x_mem_ops, 0, 0); |
Russell King | a6dba20 | 2007-08-20 10:18:02 +0100 | [diff] [blame] | 204 | |
Russell King | 8c3abc7 | 2008-11-08 20:25:21 +0000 | [diff] [blame] | 205 | static struct clk_lookup pxa27x_clkregs[] = { |
| 206 | INIT_CLKREG(&clk_pxa27x_lcd, "pxa2xx-fb", NULL), |
| 207 | INIT_CLKREG(&clk_pxa27x_camera, "pxa27x-camera.0", NULL), |
| 208 | INIT_CLKREG(&clk_pxa27x_ffuart, "pxa2xx-uart.0", NULL), |
| 209 | INIT_CLKREG(&clk_pxa27x_btuart, "pxa2xx-uart.1", NULL), |
| 210 | INIT_CLKREG(&clk_pxa27x_stuart, "pxa2xx-uart.2", NULL), |
| 211 | INIT_CLKREG(&clk_pxa27x_i2s, "pxa2xx-i2s", NULL), |
| 212 | INIT_CLKREG(&clk_pxa27x_i2c, "pxa2xx-i2c.0", NULL), |
| 213 | INIT_CLKREG(&clk_pxa27x_usb, "pxa27x-udc", NULL), |
| 214 | INIT_CLKREG(&clk_pxa27x_mmc, "pxa2xx-mci.0", NULL), |
| 215 | INIT_CLKREG(&clk_pxa27x_stuart, "pxa2xx-ir", "UARTCLK"), |
| 216 | INIT_CLKREG(&clk_pxa27x_ficp, "pxa2xx-ir", "FICPCLK"), |
| 217 | INIT_CLKREG(&clk_pxa27x_usbhost, "pxa27x-ohci", NULL), |
| 218 | INIT_CLKREG(&clk_pxa27x_pwri2c, "pxa2xx-i2c.1", NULL), |
| 219 | INIT_CLKREG(&clk_pxa27x_keypad, "pxa27x-keypad", NULL), |
| 220 | INIT_CLKREG(&clk_pxa27x_ssp1, "pxa27x-ssp.0", NULL), |
| 221 | INIT_CLKREG(&clk_pxa27x_ssp2, "pxa27x-ssp.1", NULL), |
| 222 | INIT_CLKREG(&clk_pxa27x_ssp3, "pxa27x-ssp.2", NULL), |
| 223 | INIT_CLKREG(&clk_pxa27x_pwm0, "pxa27x-pwm.0", NULL), |
| 224 | INIT_CLKREG(&clk_pxa27x_pwm1, "pxa27x-pwm.1", NULL), |
| 225 | INIT_CLKREG(&clk_pxa27x_ac97, NULL, "AC97CLK"), |
| 226 | INIT_CLKREG(&clk_pxa27x_ac97conf, NULL, "AC97CONFCLK"), |
| 227 | INIT_CLKREG(&clk_pxa27x_msl, NULL, "MSLCLK"), |
| 228 | INIT_CLKREG(&clk_pxa27x_usim, NULL, "USIMCLK"), |
| 229 | INIT_CLKREG(&clk_pxa27x_memstk, NULL, "MSTKCLK"), |
| 230 | INIT_CLKREG(&clk_pxa27x_im, NULL, "IMCLK"), |
| 231 | INIT_CLKREG(&clk_pxa27x_memc, NULL, "MEMCLK"), |
Eric Miao | 2a125dd | 2010-11-22 22:48:49 +0800 | [diff] [blame] | 232 | INIT_CLKREG(&clk_pxa27x_mem, "pxa2xx-pcmcia", NULL), |
Haojian Zhuang | 43de6a7 | 2012-02-28 10:57:48 +0800 | [diff] [blame] | 233 | INIT_CLKREG(&clk_dummy, "pxa-gpio", NULL), |
Russell King | a6dba20 | 2007-08-20 10:18:02 +0100 | [diff] [blame] | 234 | }; |
| 235 | |
Nicolas Pitre | a8fa3f0 | 2005-06-13 22:35:41 +0100 | [diff] [blame] | 236 | #ifdef CONFIG_PM |
| 237 | |
Eric Miao | 711be5c | 2007-07-18 11:38:45 +0100 | [diff] [blame] | 238 | #define SAVE(x) sleep_save[SLEEP_SAVE_##x] = x |
| 239 | #define RESTORE(x) x = sleep_save[SLEEP_SAVE_##x] |
| 240 | |
Eric Miao | 711be5c | 2007-07-18 11:38:45 +0100 | [diff] [blame] | 241 | /* |
Mike Rapoport | d082d36 | 2009-05-26 09:10:18 +0300 | [diff] [blame] | 242 | * allow platforms to override default PWRMODE setting used for PM_SUSPEND_MEM |
| 243 | */ |
| 244 | static unsigned int pwrmode = PWRMODE_SLEEP; |
| 245 | |
| 246 | int __init pxa27x_set_pwrmode(unsigned int mode) |
| 247 | { |
| 248 | switch (mode) { |
| 249 | case PWRMODE_SLEEP: |
| 250 | case PWRMODE_DEEPSLEEP: |
| 251 | pwrmode = mode; |
| 252 | return 0; |
| 253 | } |
| 254 | |
| 255 | return -EINVAL; |
| 256 | } |
| 257 | |
| 258 | /* |
Eric Miao | 711be5c | 2007-07-18 11:38:45 +0100 | [diff] [blame] | 259 | * List of global PXA peripheral registers to preserve. |
| 260 | * More ones like CP and general purpose register values are preserved |
| 261 | * with the stack pointer in sleep.S. |
| 262 | */ |
Eric Miao | 5a3d965 | 2008-09-03 18:06:34 +0800 | [diff] [blame] | 263 | enum { |
Eric Miao | 711be5c | 2007-07-18 11:38:45 +0100 | [diff] [blame] | 264 | SLEEP_SAVE_PSTR, |
Eric Miao | 711be5c | 2007-07-18 11:38:45 +0100 | [diff] [blame] | 265 | SLEEP_SAVE_MDREFR, |
Eric Miao | 5a3d965 | 2008-09-03 18:06:34 +0800 | [diff] [blame] | 266 | SLEEP_SAVE_PCFR, |
Robert Jarzmik | 649de51 | 2008-05-02 21:17:06 +0100 | [diff] [blame] | 267 | SLEEP_SAVE_COUNT |
Eric Miao | 711be5c | 2007-07-18 11:38:45 +0100 | [diff] [blame] | 268 | }; |
| 269 | |
| 270 | void pxa27x_cpu_pm_save(unsigned long *sleep_save) |
| 271 | { |
Marek Vasut | ad68bb9 | 2010-11-03 16:29:35 +0100 | [diff] [blame] | 272 | sleep_save[SLEEP_SAVE_MDREFR] = __raw_readl(MDREFR); |
Eric Miao | 5a3d965 | 2008-09-03 18:06:34 +0800 | [diff] [blame] | 273 | SAVE(PCFR); |
Eric Miao | 711be5c | 2007-07-18 11:38:45 +0100 | [diff] [blame] | 274 | |
Eric Miao | 711be5c | 2007-07-18 11:38:45 +0100 | [diff] [blame] | 275 | SAVE(PSTR); |
Eric Miao | 711be5c | 2007-07-18 11:38:45 +0100 | [diff] [blame] | 276 | } |
| 277 | |
| 278 | void pxa27x_cpu_pm_restore(unsigned long *sleep_save) |
| 279 | { |
Marek Vasut | ad68bb9 | 2010-11-03 16:29:35 +0100 | [diff] [blame] | 280 | __raw_writel(sleep_save[SLEEP_SAVE_MDREFR], MDREFR); |
Eric Miao | 5a3d965 | 2008-09-03 18:06:34 +0800 | [diff] [blame] | 281 | RESTORE(PCFR); |
Eric Miao | 711be5c | 2007-07-18 11:38:45 +0100 | [diff] [blame] | 282 | |
| 283 | PSSR = PSSR_RDH | PSSR_PH; |
| 284 | |
Eric Miao | 711be5c | 2007-07-18 11:38:45 +0100 | [diff] [blame] | 285 | RESTORE(PSTR); |
| 286 | } |
| 287 | |
| 288 | void pxa27x_cpu_pm_enter(suspend_state_t state) |
Todd Poynor | 8775420 | 2005-06-03 20:52:27 +0100 | [diff] [blame] | 289 | { |
| 290 | extern void pxa_cpu_standby(void); |
Russell King | a9503d2 | 2011-06-21 16:29:30 +0100 | [diff] [blame] | 291 | #ifndef CONFIG_IWMMXT |
| 292 | u64 acc0; |
| 293 | |
| 294 | asm volatile("mra %Q0, %R0, acc0" : "=r" (acc0)); |
| 295 | #endif |
Todd Poynor | 8775420 | 2005-06-03 20:52:27 +0100 | [diff] [blame] | 296 | |
Todd Poynor | 8775420 | 2005-06-03 20:52:27 +0100 | [diff] [blame] | 297 | /* ensure voltage-change sequencer not initiated, which hangs */ |
| 298 | PCFR &= ~PCFR_FVC; |
| 299 | |
| 300 | /* Clear edge-detect status register. */ |
| 301 | PEDR = 0xDF12FE1B; |
| 302 | |
Russell King | dc38e2a | 2008-05-08 16:50:39 +0100 | [diff] [blame] | 303 | /* Clear reset status */ |
| 304 | RCSR = RCSR_HWR | RCSR_WDR | RCSR_SMR | RCSR_GPR; |
| 305 | |
Todd Poynor | 8775420 | 2005-06-03 20:52:27 +0100 | [diff] [blame] | 306 | switch (state) { |
Todd Poynor | 26705ca | 2005-07-01 11:27:05 +0100 | [diff] [blame] | 307 | case PM_SUSPEND_STANDBY: |
| 308 | pxa_cpu_standby(); |
| 309 | break; |
Todd Poynor | 8775420 | 2005-06-03 20:52:27 +0100 | [diff] [blame] | 310 | case PM_SUSPEND_MEM: |
Russell King | 2c74a0c | 2011-06-22 17:41:48 +0100 | [diff] [blame] | 311 | cpu_suspend(pwrmode, pxa27x_finish_suspend); |
Russell King | a9503d2 | 2011-06-21 16:29:30 +0100 | [diff] [blame] | 312 | #ifndef CONFIG_IWMMXT |
| 313 | asm volatile("mar acc0, %Q0, %R0" : "=r" (acc0)); |
| 314 | #endif |
Todd Poynor | 8775420 | 2005-06-03 20:52:27 +0100 | [diff] [blame] | 315 | break; |
| 316 | } |
| 317 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 318 | |
Eric Miao | 711be5c | 2007-07-18 11:38:45 +0100 | [diff] [blame] | 319 | static int pxa27x_cpu_pm_valid(suspend_state_t state) |
Russell King | 88dfe98 | 2007-05-15 11:22:48 +0100 | [diff] [blame] | 320 | { |
| 321 | return state == PM_SUSPEND_MEM || state == PM_SUSPEND_STANDBY; |
| 322 | } |
| 323 | |
Russell King | 4104980 | 2008-08-27 12:55:04 +0100 | [diff] [blame] | 324 | static int pxa27x_cpu_pm_prepare(void) |
| 325 | { |
| 326 | /* set resume return address */ |
Russell King | 4f5ad99 | 2011-02-06 17:41:26 +0000 | [diff] [blame] | 327 | PSPR = virt_to_phys(cpu_resume); |
Russell King | 4104980 | 2008-08-27 12:55:04 +0100 | [diff] [blame] | 328 | return 0; |
| 329 | } |
| 330 | |
| 331 | static void pxa27x_cpu_pm_finish(void) |
| 332 | { |
| 333 | /* ensure not to come back here if it wasn't intended */ |
| 334 | PSPR = 0; |
| 335 | } |
| 336 | |
Eric Miao | 711be5c | 2007-07-18 11:38:45 +0100 | [diff] [blame] | 337 | static struct pxa_cpu_pm_fns pxa27x_cpu_pm_fns = { |
Robert Jarzmik | 649de51 | 2008-05-02 21:17:06 +0100 | [diff] [blame] | 338 | .save_count = SLEEP_SAVE_COUNT, |
Eric Miao | 711be5c | 2007-07-18 11:38:45 +0100 | [diff] [blame] | 339 | .save = pxa27x_cpu_pm_save, |
| 340 | .restore = pxa27x_cpu_pm_restore, |
| 341 | .valid = pxa27x_cpu_pm_valid, |
| 342 | .enter = pxa27x_cpu_pm_enter, |
Russell King | 4104980 | 2008-08-27 12:55:04 +0100 | [diff] [blame] | 343 | .prepare = pxa27x_cpu_pm_prepare, |
| 344 | .finish = pxa27x_cpu_pm_finish, |
Russell King | e176bb0 | 2007-05-15 11:16:10 +0100 | [diff] [blame] | 345 | }; |
Eric Miao | 711be5c | 2007-07-18 11:38:45 +0100 | [diff] [blame] | 346 | |
| 347 | static void __init pxa27x_init_pm(void) |
| 348 | { |
| 349 | pxa_cpu_pm_fns = &pxa27x_cpu_pm_fns; |
| 350 | } |
eric miao | f79299c | 2008-01-02 08:24:49 +0800 | [diff] [blame] | 351 | #else |
| 352 | static inline void pxa27x_init_pm(void) {} |
Nicolas Pitre | a8fa3f0 | 2005-06-13 22:35:41 +0100 | [diff] [blame] | 353 | #endif |
| 354 | |
eric miao | c95530c | 2007-08-29 10:22:17 +0100 | [diff] [blame] | 355 | /* PXA27x: Various gpios can issue wakeup events. This logic only |
| 356 | * handles the simple cases, not the WEMUX2 and WEMUX3 options |
| 357 | */ |
Lennert Buytenhek | a3f4c92 | 2010-11-29 11:18:26 +0100 | [diff] [blame] | 358 | static int pxa27x_set_wake(struct irq_data *d, unsigned int on) |
eric miao | c95530c | 2007-08-29 10:22:17 +0100 | [diff] [blame] | 359 | { |
Haojian Zhuang | 4929f5a | 2011-10-10 16:03:51 +0800 | [diff] [blame] | 360 | int gpio = pxa_irq_to_gpio(d->irq); |
eric miao | c95530c | 2007-08-29 10:22:17 +0100 | [diff] [blame] | 361 | uint32_t mask; |
| 362 | |
eric miao | c0a596d | 2008-03-11 09:46:28 +0800 | [diff] [blame] | 363 | if (gpio >= 0 && gpio < 128) |
| 364 | return gpio_set_wake(gpio, on); |
eric miao | c95530c | 2007-08-29 10:22:17 +0100 | [diff] [blame] | 365 | |
Lennert Buytenhek | a3f4c92 | 2010-11-29 11:18:26 +0100 | [diff] [blame] | 366 | if (d->irq == IRQ_KEYPAD) |
eric miao | c0a596d | 2008-03-11 09:46:28 +0800 | [diff] [blame] | 367 | return keypad_set_wake(on); |
eric miao | c95530c | 2007-08-29 10:22:17 +0100 | [diff] [blame] | 368 | |
Lennert Buytenhek | a3f4c92 | 2010-11-29 11:18:26 +0100 | [diff] [blame] | 369 | switch (d->irq) { |
eric miao | c95530c | 2007-08-29 10:22:17 +0100 | [diff] [blame] | 370 | case IRQ_RTCAlrm: |
| 371 | mask = PWER_RTC; |
| 372 | break; |
| 373 | case IRQ_USB: |
| 374 | mask = 1u << 26; |
| 375 | break; |
| 376 | default: |
| 377 | return -EINVAL; |
| 378 | } |
| 379 | |
eric miao | c95530c | 2007-08-29 10:22:17 +0100 | [diff] [blame] | 380 | if (on) |
| 381 | PWER |= mask; |
| 382 | else |
| 383 | PWER &=~mask; |
| 384 | |
| 385 | return 0; |
| 386 | } |
| 387 | |
| 388 | void __init pxa27x_init_irq(void) |
| 389 | { |
eric miao | b9e25ac | 2008-03-04 14:19:58 +0800 | [diff] [blame] | 390 | pxa_init_irq(34, pxa27x_set_wake); |
eric miao | c95530c | 2007-08-29 10:22:17 +0100 | [diff] [blame] | 391 | } |
| 392 | |
Marek Vasut | 851982c | 2010-10-11 02:20:19 +0200 | [diff] [blame] | 393 | static struct map_desc pxa27x_io_desc[] __initdata = { |
| 394 | { /* Mem Ctl */ |
Arnd Bergmann | 97b09da | 2011-10-01 22:03:45 +0200 | [diff] [blame] | 395 | .virtual = (unsigned long)SMEMC_VIRT, |
Marek Vasut | ad68bb9 | 2010-11-03 16:29:35 +0100 | [diff] [blame] | 396 | .pfn = __phys_to_pfn(PXA2XX_SMEMC_BASE), |
Marek Vasut | 851982c | 2010-10-11 02:20:19 +0200 | [diff] [blame] | 397 | .length = 0x00200000, |
| 398 | .type = MT_DEVICE |
| 399 | }, { /* IMem ctl */ |
| 400 | .virtual = 0xfe000000, |
| 401 | .pfn = __phys_to_pfn(0x58000000), |
| 402 | .length = 0x00100000, |
| 403 | .type = MT_DEVICE |
| 404 | }, |
| 405 | }; |
| 406 | |
| 407 | void __init pxa27x_map_io(void) |
| 408 | { |
| 409 | pxa_map_io(); |
| 410 | iotable_init(ARRAY_AND_SIZE(pxa27x_io_desc)); |
| 411 | pxa27x_get_clk_frequency_khz(1); |
| 412 | } |
| 413 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 414 | /* |
| 415 | * device registration specific to PXA27x. |
| 416 | */ |
Mike Rapoport | 9ba63c4 | 2008-08-17 06:23:05 +0100 | [diff] [blame] | 417 | void __init pxa27x_set_i2c_power_info(struct i2c_pxa_platform_data *info) |
Mike Rapoport | b7a3670 | 2008-01-27 18:14:50 +0100 | [diff] [blame] | 418 | { |
Philipp Zabel | bc3a595 | 2008-06-02 18:49:27 +0100 | [diff] [blame] | 419 | local_irq_disable(); |
| 420 | PCFR |= PCFR_PI2CEN; |
| 421 | local_irq_enable(); |
Eric Miao | 1475822 | 2008-11-28 15:24:12 +0800 | [diff] [blame] | 422 | pxa_register_device(&pxa27x_device_i2c_power, info); |
Mike Rapoport | b7a3670 | 2008-01-27 18:14:50 +0100 | [diff] [blame] | 423 | } |
| 424 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 425 | static struct platform_device *devices[] __initdata = { |
Haojian Zhuang | 157d264 | 2011-10-17 20:37:52 +0800 | [diff] [blame] | 426 | &pxa_device_gpio, |
Philipp Zabel | 7a85762 | 2008-06-22 23:36:39 +0100 | [diff] [blame] | 427 | &pxa27x_device_udc, |
Eric Miao | 09a5358 | 2010-06-14 00:43:00 +0800 | [diff] [blame] | 428 | &pxa_device_pmu, |
Eric Miao | e09d02e | 2007-07-17 10:45:58 +0100 | [diff] [blame] | 429 | &pxa_device_i2s, |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 430 | &pxa_device_asoc_ssp1, |
| 431 | &pxa_device_asoc_ssp2, |
| 432 | &pxa_device_asoc_ssp3, |
| 433 | &pxa_device_asoc_platform, |
Robert Jarzmik | 7249314 | 2008-11-13 23:50:56 +0100 | [diff] [blame] | 434 | &sa1100_device_rtc, |
Eric Miao | e09d02e | 2007-07-17 10:45:58 +0100 | [diff] [blame] | 435 | &pxa_device_rtc, |
eric miao | d8e0db1 | 2007-12-10 17:54:36 +0800 | [diff] [blame] | 436 | &pxa27x_device_ssp1, |
| 437 | &pxa27x_device_ssp2, |
| 438 | &pxa27x_device_ssp3, |
eric miao | 75540c1 | 2008-04-13 21:44:04 +0100 | [diff] [blame] | 439 | &pxa27x_device_pwm0, |
| 440 | &pxa27x_device_pwm1, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 441 | }; |
| 442 | |
| 443 | static int __init pxa27x_init(void) |
| 444 | { |
Rafael J. Wysocki | 2eaa03b | 2011-04-22 22:03:11 +0200 | [diff] [blame] | 445 | int ret = 0; |
eric miao | c0165504 | 2008-01-28 23:00:02 +0000 | [diff] [blame] | 446 | |
Russell King | e176bb0 | 2007-05-15 11:16:10 +0100 | [diff] [blame] | 447 | if (cpu_is_pxa27x()) { |
Eric Miao | 04fef22 | 2008-07-29 14:26:00 +0800 | [diff] [blame] | 448 | |
| 449 | reset_status = RCSR; |
| 450 | |
Russell King | 0a0300d | 2010-01-12 12:28:00 +0000 | [diff] [blame] | 451 | clkdev_add_table(pxa27x_clkregs, ARRAY_SIZE(pxa27x_clkregs)); |
Russell King | a6dba20 | 2007-08-20 10:18:02 +0100 | [diff] [blame] | 452 | |
Eric Miao | fef1f99 | 2009-01-02 16:26:33 +0800 | [diff] [blame] | 453 | if ((ret = pxa_init_dma(IRQ_DMA, 32))) |
Eric Miao | f53f066 | 2007-06-22 05:40:17 +0100 | [diff] [blame] | 454 | return ret; |
eric miao | f79299c | 2008-01-02 08:24:49 +0800 | [diff] [blame] | 455 | |
Eric Miao | 711be5c | 2007-07-18 11:38:45 +0100 | [diff] [blame] | 456 | pxa27x_init_pm(); |
eric miao | f79299c | 2008-01-02 08:24:49 +0800 | [diff] [blame] | 457 | |
Rafael J. Wysocki | 2eaa03b | 2011-04-22 22:03:11 +0200 | [diff] [blame] | 458 | register_syscore_ops(&pxa_irq_syscore_ops); |
| 459 | register_syscore_ops(&pxa2xx_mfp_syscore_ops); |
| 460 | register_syscore_ops(&pxa_gpio_syscore_ops); |
| 461 | register_syscore_ops(&pxa2xx_clock_syscore_ops); |
eric miao | c0165504 | 2008-01-28 23:00:02 +0000 | [diff] [blame] | 462 | |
Russell King | e176bb0 | 2007-05-15 11:16:10 +0100 | [diff] [blame] | 463 | ret = platform_add_devices(devices, ARRAY_SIZE(devices)); |
| 464 | } |
eric miao | c0165504 | 2008-01-28 23:00:02 +0000 | [diff] [blame] | 465 | |
Russell King | e176bb0 | 2007-05-15 11:16:10 +0100 | [diff] [blame] | 466 | return ret; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 467 | } |
| 468 | |
Russell King | 1c104e0 | 2008-04-19 10:59:24 +0100 | [diff] [blame] | 469 | postcore_initcall(pxa27x_init); |