12c8086a5Seric miao /* 22c8086a5Seric miao * linux/arch/arm/mach-pxa/pxa3xx.c 32c8086a5Seric miao * 42c8086a5Seric miao * code specific to pxa3xx aka Monahans 52c8086a5Seric miao * 62c8086a5Seric miao * Copyright (C) 2006 Marvell International Ltd. 72c8086a5Seric miao * 8e9bba8eeSeric miao * 2007-09-02: eric miao <eric.miao@marvell.com> 92c8086a5Seric miao * initial version 102c8086a5Seric miao * 112c8086a5Seric miao * This program is free software; you can redistribute it and/or modify 122c8086a5Seric miao * it under the terms of the GNU General Public License version 2 as 132c8086a5Seric miao * published by the Free Software Foundation. 142c8086a5Seric miao */ 152c8086a5Seric miao 162c8086a5Seric miao #include <linux/module.h> 172c8086a5Seric miao #include <linux/kernel.h> 182c8086a5Seric miao #include <linux/init.h> 192c8086a5Seric miao #include <linux/pm.h> 202c8086a5Seric miao #include <linux/platform_device.h> 212c8086a5Seric miao #include <linux/irq.h> 227b5dea12SRussell King #include <linux/io.h> 23c0165504Seric miao #include <linux/sysdev.h> 242c8086a5Seric miao 252c8086a5Seric miao #include <asm/hardware.h> 262c8086a5Seric miao #include <asm/arch/pxa3xx-regs.h> 272c8086a5Seric miao #include <asm/arch/ohci.h> 282c8086a5Seric miao #include <asm/arch/pm.h> 292c8086a5Seric miao #include <asm/arch/dma.h> 302c8086a5Seric miao #include <asm/arch/ssp.h> 312c8086a5Seric miao 322c8086a5Seric miao #include "generic.h" 332c8086a5Seric miao #include "devices.h" 342c8086a5Seric miao #include "clock.h" 352c8086a5Seric miao 362c8086a5Seric miao /* Crystal clock: 13MHz */ 372c8086a5Seric miao #define BASE_CLK 13000000 382c8086a5Seric miao 392c8086a5Seric miao /* Ring Oscillator Clock: 60MHz */ 402c8086a5Seric miao #define RO_CLK 60000000 412c8086a5Seric miao 422c8086a5Seric miao #define ACCR_D0CS (1 << 26) 432c8086a5Seric miao 442c8086a5Seric miao /* crystal frequency to static memory controller multiplier (SMCFS) */ 452c8086a5Seric miao static unsigned char smcfs_mult[8] = { 6, 0, 8, 0, 0, 16, }; 462c8086a5Seric miao 472c8086a5Seric miao /* crystal frequency to HSIO bus frequency multiplier (HSS) */ 482c8086a5Seric miao static unsigned char hss_mult[4] = { 8, 12, 16, 0 }; 492c8086a5Seric miao 502c8086a5Seric miao /* 512c8086a5Seric miao * Get the clock frequency as reflected by CCSR and the turbo flag. 522c8086a5Seric miao * We assume these values have been applied via a fcs. 532c8086a5Seric miao * If info is not 0 we also display the current settings. 542c8086a5Seric miao */ 552c8086a5Seric miao unsigned int pxa3xx_get_clk_frequency_khz(int info) 562c8086a5Seric miao { 572c8086a5Seric miao unsigned long acsr, xclkcfg; 582c8086a5Seric miao unsigned int t, xl, xn, hss, ro, XL, XN, CLK, HSS; 592c8086a5Seric miao 602c8086a5Seric miao /* Read XCLKCFG register turbo bit */ 612c8086a5Seric miao __asm__ __volatile__("mrc\tp14, 0, %0, c6, c0, 0" : "=r"(xclkcfg)); 622c8086a5Seric miao t = xclkcfg & 0x1; 632c8086a5Seric miao 642c8086a5Seric miao acsr = ACSR; 652c8086a5Seric miao 662c8086a5Seric miao xl = acsr & 0x1f; 672c8086a5Seric miao xn = (acsr >> 8) & 0x7; 682c8086a5Seric miao hss = (acsr >> 14) & 0x3; 692c8086a5Seric miao 702c8086a5Seric miao XL = xl * BASE_CLK; 712c8086a5Seric miao XN = xn * XL; 722c8086a5Seric miao 732c8086a5Seric miao ro = acsr & ACCR_D0CS; 742c8086a5Seric miao 752c8086a5Seric miao CLK = (ro) ? RO_CLK : ((t) ? XN : XL); 762c8086a5Seric miao HSS = (ro) ? RO_CLK : hss_mult[hss] * BASE_CLK; 772c8086a5Seric miao 782c8086a5Seric miao if (info) { 792c8086a5Seric miao pr_info("RO Mode clock: %d.%02dMHz (%sactive)\n", 802c8086a5Seric miao RO_CLK / 1000000, (RO_CLK % 1000000) / 10000, 812c8086a5Seric miao (ro) ? "" : "in"); 822c8086a5Seric miao pr_info("Run Mode clock: %d.%02dMHz (*%d)\n", 832c8086a5Seric miao XL / 1000000, (XL % 1000000) / 10000, xl); 842c8086a5Seric miao pr_info("Turbo Mode clock: %d.%02dMHz (*%d, %sactive)\n", 852c8086a5Seric miao XN / 1000000, (XN % 1000000) / 10000, xn, 862c8086a5Seric miao (t) ? "" : "in"); 872c8086a5Seric miao pr_info("HSIO bus clock: %d.%02dMHz\n", 882c8086a5Seric miao HSS / 1000000, (HSS % 1000000) / 10000); 892c8086a5Seric miao } 902c8086a5Seric miao 916232be32Seric miao return CLK / 1000; 922c8086a5Seric miao } 932c8086a5Seric miao 942c8086a5Seric miao /* 952c8086a5Seric miao * Return the current static memory controller clock frequency 962c8086a5Seric miao * in units of 10kHz 972c8086a5Seric miao */ 982c8086a5Seric miao unsigned int pxa3xx_get_memclk_frequency_10khz(void) 992c8086a5Seric miao { 1002c8086a5Seric miao unsigned long acsr; 1012c8086a5Seric miao unsigned int smcfs, clk = 0; 1022c8086a5Seric miao 1032c8086a5Seric miao acsr = ACSR; 1042c8086a5Seric miao 1052c8086a5Seric miao smcfs = (acsr >> 23) & 0x7; 1062c8086a5Seric miao clk = (acsr & ACCR_D0CS) ? RO_CLK : smcfs_mult[smcfs] * BASE_CLK; 1072c8086a5Seric miao 1082c8086a5Seric miao return (clk / 10000); 1092c8086a5Seric miao } 1102c8086a5Seric miao 1112c8086a5Seric miao /* 1122c8086a5Seric miao * Return the current HSIO bus clock frequency 1132c8086a5Seric miao */ 1142c8086a5Seric miao static unsigned long clk_pxa3xx_hsio_getrate(struct clk *clk) 1152c8086a5Seric miao { 1162c8086a5Seric miao unsigned long acsr; 1172c8086a5Seric miao unsigned int hss, hsio_clk; 1182c8086a5Seric miao 1192c8086a5Seric miao acsr = ACSR; 1202c8086a5Seric miao 1212c8086a5Seric miao hss = (acsr >> 14) & 0x3; 1222c8086a5Seric miao hsio_clk = (acsr & ACCR_D0CS) ? RO_CLK : hss_mult[hss] * BASE_CLK; 1232c8086a5Seric miao 1242c8086a5Seric miao return hsio_clk; 1252c8086a5Seric miao } 1262c8086a5Seric miao 1272c8086a5Seric miao static void clk_pxa3xx_cken_enable(struct clk *clk) 1282c8086a5Seric miao { 1292c8086a5Seric miao unsigned long mask = 1ul << (clk->cken & 0x1f); 1302c8086a5Seric miao 1312c8086a5Seric miao local_irq_disable(); 1322c8086a5Seric miao 1332c8086a5Seric miao if (clk->cken < 32) 1342c8086a5Seric miao CKENA |= mask; 1352c8086a5Seric miao else 1362c8086a5Seric miao CKENB |= mask; 1372c8086a5Seric miao 1382c8086a5Seric miao local_irq_enable(); 1392c8086a5Seric miao } 1402c8086a5Seric miao 1412c8086a5Seric miao static void clk_pxa3xx_cken_disable(struct clk *clk) 1422c8086a5Seric miao { 1432c8086a5Seric miao unsigned long mask = 1ul << (clk->cken & 0x1f); 1442c8086a5Seric miao 1452c8086a5Seric miao local_irq_disable(); 1462c8086a5Seric miao 1472c8086a5Seric miao if (clk->cken < 32) 1482c8086a5Seric miao CKENA &= ~mask; 1492c8086a5Seric miao else 1502c8086a5Seric miao CKENB &= ~mask; 1512c8086a5Seric miao 1522c8086a5Seric miao local_irq_enable(); 1532c8086a5Seric miao } 1542c8086a5Seric miao 1552a0d7187Seric miao static const struct clkops clk_pxa3xx_cken_ops = { 1562a0d7187Seric miao .enable = clk_pxa3xx_cken_enable, 1572a0d7187Seric miao .disable = clk_pxa3xx_cken_disable, 1582a0d7187Seric miao }; 1592a0d7187Seric miao 1602c8086a5Seric miao static const struct clkops clk_pxa3xx_hsio_ops = { 1612c8086a5Seric miao .enable = clk_pxa3xx_cken_enable, 1622c8086a5Seric miao .disable = clk_pxa3xx_cken_disable, 1632c8086a5Seric miao .getrate = clk_pxa3xx_hsio_getrate, 1642c8086a5Seric miao }; 1652c8086a5Seric miao 1662a0d7187Seric miao #define PXA3xx_CKEN(_name, _cken, _rate, _delay, _dev) \ 1672a0d7187Seric miao { \ 1682a0d7187Seric miao .name = _name, \ 1692a0d7187Seric miao .dev = _dev, \ 1702a0d7187Seric miao .ops = &clk_pxa3xx_cken_ops, \ 1712a0d7187Seric miao .rate = _rate, \ 1722a0d7187Seric miao .cken = CKEN_##_cken, \ 1732a0d7187Seric miao .delay = _delay, \ 1742a0d7187Seric miao } 1752a0d7187Seric miao 1762a0d7187Seric miao #define PXA3xx_CK(_name, _cken, _ops, _dev) \ 1772a0d7187Seric miao { \ 1782a0d7187Seric miao .name = _name, \ 1792a0d7187Seric miao .dev = _dev, \ 1802a0d7187Seric miao .ops = _ops, \ 1812a0d7187Seric miao .cken = CKEN_##_cken, \ 1822a0d7187Seric miao } 1832a0d7187Seric miao 1842c8086a5Seric miao static struct clk pxa3xx_clks[] = { 1852a0d7187Seric miao PXA3xx_CK("LCDCLK", LCD, &clk_pxa3xx_hsio_ops, &pxa_device_fb.dev), 1862a0d7187Seric miao PXA3xx_CK("CAMCLK", CAMERA, &clk_pxa3xx_hsio_ops, NULL), 1872c8086a5Seric miao 1882a0d7187Seric miao PXA3xx_CKEN("UARTCLK", FFUART, 14857000, 1, &pxa_device_ffuart.dev), 1892a0d7187Seric miao PXA3xx_CKEN("UARTCLK", BTUART, 14857000, 1, &pxa_device_btuart.dev), 1902a0d7187Seric miao PXA3xx_CKEN("UARTCLK", STUART, 14857000, 1, NULL), 1912c8086a5Seric miao 1922a0d7187Seric miao PXA3xx_CKEN("I2CCLK", I2C, 32842000, 0, &pxa_device_i2c.dev), 1932a0d7187Seric miao PXA3xx_CKEN("UDCCLK", UDC, 48000000, 5, &pxa_device_udc.dev), 194f92a629cSeric miao PXA3xx_CKEN("USBCLK", USBH, 48000000, 0, &pxa27x_device_ohci.dev), 195d8e0db11Seric miao 196d8e0db11Seric miao PXA3xx_CKEN("SSPCLK", SSP1, 13000000, 0, &pxa27x_device_ssp1.dev), 197d8e0db11Seric miao PXA3xx_CKEN("SSPCLK", SSP2, 13000000, 0, &pxa27x_device_ssp2.dev), 198d8e0db11Seric miao PXA3xx_CKEN("SSPCLK", SSP3, 13000000, 0, &pxa27x_device_ssp3.dev), 199d8e0db11Seric miao PXA3xx_CKEN("SSPCLK", SSP4, 13000000, 0, &pxa3xx_device_ssp4.dev), 200fafc9d3fSBridge Wu 201fafc9d3fSBridge Wu PXA3xx_CKEN("MMCCLK", MMC1, 19500000, 0, &pxa_device_mci.dev), 2028d33b055SBridge Wu PXA3xx_CKEN("MMCCLK", MMC2, 19500000, 0, &pxa3xx_device_mci2.dev), 2035a1f21b1SBridge Wu PXA3xx_CKEN("MMCCLK", MMC3, 19500000, 0, &pxa3xx_device_mci3.dev), 2042c8086a5Seric miao }; 2052c8086a5Seric miao 2067b5dea12SRussell King #ifdef CONFIG_PM 2077b5dea12SRussell King #define SLEEP_SAVE_SIZE 4 2087b5dea12SRussell King 2097b5dea12SRussell King #define ISRAM_START 0x5c000000 2107b5dea12SRussell King #define ISRAM_SIZE SZ_256K 2117b5dea12SRussell King 2127b5dea12SRussell King static void __iomem *sram; 2137b5dea12SRussell King static unsigned long wakeup_src; 2147b5dea12SRussell King 2157b5dea12SRussell King static void pxa3xx_cpu_pm_save(unsigned long *sleep_save) 2167b5dea12SRussell King { 2177b5dea12SRussell King pr_debug("PM: CKENA=%08x CKENB=%08x\n", CKENA, CKENB); 2187b5dea12SRussell King 2197b5dea12SRussell King if (CKENA & (1 << CKEN_USBH)) { 2207b5dea12SRussell King printk(KERN_ERR "PM: USB host clock not stopped?\n"); 2217b5dea12SRussell King CKENA &= ~(1 << CKEN_USBH); 2227b5dea12SRussell King } 2237b5dea12SRussell King // CKENA |= 1 << (CKEN_ISC & 31); 2247b5dea12SRussell King 2257b5dea12SRussell King /* 2267b5dea12SRussell King * Low power modes require the HSIO2 clock to be enabled. 2277b5dea12SRussell King */ 2287b5dea12SRussell King CKENB |= 1 << (CKEN_HSIO2 & 31); 2297b5dea12SRussell King } 2307b5dea12SRussell King 2317b5dea12SRussell King static void pxa3xx_cpu_pm_restore(unsigned long *sleep_save) 2327b5dea12SRussell King { 2337b5dea12SRussell King CKENB &= ~(1 << (CKEN_HSIO2 & 31)); 2347b5dea12SRussell King } 2357b5dea12SRussell King 2367b5dea12SRussell King /* 2377b5dea12SRussell King * Enter a standby mode (S0D1C2 or S0D2C2). Upon wakeup, the dynamic 2387b5dea12SRussell King * memory controller has to be reinitialised, so we place some code 2397b5dea12SRussell King * in the SRAM to perform this function. 2407b5dea12SRussell King * 2417b5dea12SRussell King * We disable FIQs across the standby - otherwise, we might receive a 2427b5dea12SRussell King * FIQ while the SDRAM is unavailable. 2437b5dea12SRussell King */ 2447b5dea12SRussell King static void pxa3xx_cpu_standby(unsigned int pwrmode) 2457b5dea12SRussell King { 2467b5dea12SRussell King extern const char pm_enter_standby_start[], pm_enter_standby_end[]; 2477b5dea12SRussell King void (*fn)(unsigned int) = (void __force *)(sram + 0x8000); 2487b5dea12SRussell King 2497b5dea12SRussell King memcpy_toio(sram + 0x8000, pm_enter_standby_start, 2507b5dea12SRussell King pm_enter_standby_end - pm_enter_standby_start); 2517b5dea12SRussell King 2527b5dea12SRussell King AD2D0SR = ~0; 2537b5dea12SRussell King AD2D1SR = ~0; 2547b5dea12SRussell King AD2D0ER = wakeup_src; 2557b5dea12SRussell King AD2D1ER = 0; 2567b5dea12SRussell King ASCR = ASCR; 2577b5dea12SRussell King ARSR = ARSR; 2587b5dea12SRussell King 2597b5dea12SRussell King local_fiq_disable(); 2607b5dea12SRussell King fn(pwrmode); 2617b5dea12SRussell King local_fiq_enable(); 2627b5dea12SRussell King 2637b5dea12SRussell King AD2D0ER = 0; 2647b5dea12SRussell King AD2D1ER = 0; 2657b5dea12SRussell King 2667b5dea12SRussell King printk("PM: AD2D0SR=%08x ASCR=%08x\n", AD2D0SR, ASCR); 2677b5dea12SRussell King } 2687b5dea12SRussell King 2697b5dea12SRussell King static void pxa3xx_cpu_pm_enter(suspend_state_t state) 2707b5dea12SRussell King { 2717b5dea12SRussell King /* 2727b5dea12SRussell King * Don't sleep if no wakeup sources are defined 2737b5dea12SRussell King */ 2747b5dea12SRussell King if (wakeup_src == 0) 2757b5dea12SRussell King return; 2767b5dea12SRussell King 2777b5dea12SRussell King switch (state) { 2787b5dea12SRussell King case PM_SUSPEND_STANDBY: 2797b5dea12SRussell King pxa3xx_cpu_standby(PXA3xx_PM_S0D2C2); 2807b5dea12SRussell King break; 2817b5dea12SRussell King 2827b5dea12SRussell King case PM_SUSPEND_MEM: 2837b5dea12SRussell King break; 2847b5dea12SRussell King } 2857b5dea12SRussell King } 2867b5dea12SRussell King 2877b5dea12SRussell King static int pxa3xx_cpu_pm_valid(suspend_state_t state) 2887b5dea12SRussell King { 2897b5dea12SRussell King return state == PM_SUSPEND_MEM || state == PM_SUSPEND_STANDBY; 2907b5dea12SRussell King } 2917b5dea12SRussell King 2927b5dea12SRussell King static struct pxa_cpu_pm_fns pxa3xx_cpu_pm_fns = { 2937b5dea12SRussell King .save_size = SLEEP_SAVE_SIZE, 2947b5dea12SRussell King .save = pxa3xx_cpu_pm_save, 2957b5dea12SRussell King .restore = pxa3xx_cpu_pm_restore, 2967b5dea12SRussell King .valid = pxa3xx_cpu_pm_valid, 2977b5dea12SRussell King .enter = pxa3xx_cpu_pm_enter, 2987b5dea12SRussell King }; 2997b5dea12SRussell King 3007b5dea12SRussell King static void __init pxa3xx_init_pm(void) 3017b5dea12SRussell King { 3027b5dea12SRussell King sram = ioremap(ISRAM_START, ISRAM_SIZE); 3037b5dea12SRussell King if (!sram) { 3047b5dea12SRussell King printk(KERN_ERR "Unable to map ISRAM: disabling standby/suspend\n"); 3057b5dea12SRussell King return; 3067b5dea12SRussell King } 3077b5dea12SRussell King 3087b5dea12SRussell King /* 3097b5dea12SRussell King * Since we copy wakeup code into the SRAM, we need to ensure 3107b5dea12SRussell King * that it is preserved over the low power modes. Note: bit 8 3117b5dea12SRussell King * is undocumented in the developer manual, but must be set. 3127b5dea12SRussell King */ 3137b5dea12SRussell King AD1R |= ADXR_L2 | ADXR_R0; 3147b5dea12SRussell King AD2R |= ADXR_L2 | ADXR_R0; 3157b5dea12SRussell King AD3R |= ADXR_L2 | ADXR_R0; 3167b5dea12SRussell King 3177b5dea12SRussell King /* 3187b5dea12SRussell King * Clear the resume enable registers. 3197b5dea12SRussell King */ 3207b5dea12SRussell King AD1D0ER = 0; 3217b5dea12SRussell King AD2D0ER = 0; 3227b5dea12SRussell King AD2D1ER = 0; 3237b5dea12SRussell King AD3ER = 0; 3247b5dea12SRussell King 3257b5dea12SRussell King pxa_cpu_pm_fns = &pxa3xx_cpu_pm_fns; 3267b5dea12SRussell King } 3277b5dea12SRussell King 3287b5dea12SRussell King static int pxa3xx_set_wake(unsigned int irq, unsigned int on) 3297b5dea12SRussell King { 3307b5dea12SRussell King unsigned long flags, mask = 0; 3317b5dea12SRussell King 3327b5dea12SRussell King switch (irq) { 3337b5dea12SRussell King case IRQ_SSP3: 3347b5dea12SRussell King mask = ADXER_MFP_WSSP3; 3357b5dea12SRussell King break; 3367b5dea12SRussell King case IRQ_MSL: 3377b5dea12SRussell King mask = ADXER_WMSL0; 3387b5dea12SRussell King break; 3397b5dea12SRussell King case IRQ_USBH2: 3407b5dea12SRussell King case IRQ_USBH1: 3417b5dea12SRussell King mask = ADXER_WUSBH; 3427b5dea12SRussell King break; 3437b5dea12SRussell King case IRQ_KEYPAD: 3447b5dea12SRussell King mask = ADXER_WKP; 3457b5dea12SRussell King break; 3467b5dea12SRussell King case IRQ_AC97: 3477b5dea12SRussell King mask = ADXER_MFP_WAC97; 3487b5dea12SRussell King break; 3497b5dea12SRussell King case IRQ_USIM: 3507b5dea12SRussell King mask = ADXER_WUSIM0; 3517b5dea12SRussell King break; 3527b5dea12SRussell King case IRQ_SSP2: 3537b5dea12SRussell King mask = ADXER_MFP_WSSP2; 3547b5dea12SRussell King break; 3557b5dea12SRussell King case IRQ_I2C: 3567b5dea12SRussell King mask = ADXER_MFP_WI2C; 3577b5dea12SRussell King break; 3587b5dea12SRussell King case IRQ_STUART: 3597b5dea12SRussell King mask = ADXER_MFP_WUART3; 3607b5dea12SRussell King break; 3617b5dea12SRussell King case IRQ_BTUART: 3627b5dea12SRussell King mask = ADXER_MFP_WUART2; 3637b5dea12SRussell King break; 3647b5dea12SRussell King case IRQ_FFUART: 3657b5dea12SRussell King mask = ADXER_MFP_WUART1; 3667b5dea12SRussell King break; 3677b5dea12SRussell King case IRQ_MMC: 3687b5dea12SRussell King mask = ADXER_MFP_WMMC1; 3697b5dea12SRussell King break; 3707b5dea12SRussell King case IRQ_SSP: 3717b5dea12SRussell King mask = ADXER_MFP_WSSP1; 3727b5dea12SRussell King break; 3737b5dea12SRussell King case IRQ_RTCAlrm: 3747b5dea12SRussell King mask = ADXER_WRTC; 3757b5dea12SRussell King break; 3767b5dea12SRussell King case IRQ_SSP4: 3777b5dea12SRussell King mask = ADXER_MFP_WSSP4; 3787b5dea12SRussell King break; 3797b5dea12SRussell King case IRQ_TSI: 3807b5dea12SRussell King mask = ADXER_WTSI; 3817b5dea12SRussell King break; 3827b5dea12SRussell King case IRQ_USIM2: 3837b5dea12SRussell King mask = ADXER_WUSIM1; 3847b5dea12SRussell King break; 3857b5dea12SRussell King case IRQ_MMC2: 3867b5dea12SRussell King mask = ADXER_MFP_WMMC2; 3877b5dea12SRussell King break; 3887b5dea12SRussell King case IRQ_NAND: 3897b5dea12SRussell King mask = ADXER_MFP_WFLASH; 3907b5dea12SRussell King break; 3917b5dea12SRussell King case IRQ_USB2: 3927b5dea12SRussell King mask = ADXER_WUSB2; 3937b5dea12SRussell King break; 3947b5dea12SRussell King case IRQ_WAKEUP0: 3957b5dea12SRussell King mask = ADXER_WEXTWAKE0; 3967b5dea12SRussell King break; 3977b5dea12SRussell King case IRQ_WAKEUP1: 3987b5dea12SRussell King mask = ADXER_WEXTWAKE1; 3997b5dea12SRussell King break; 4007b5dea12SRussell King case IRQ_MMC3: 4017b5dea12SRussell King mask = ADXER_MFP_GEN12; 4027b5dea12SRussell King break; 4037b5dea12SRussell King } 4047b5dea12SRussell King 4057b5dea12SRussell King local_irq_save(flags); 4067b5dea12SRussell King if (on) 4077b5dea12SRussell King wakeup_src |= mask; 4087b5dea12SRussell King else 4097b5dea12SRussell King wakeup_src &= ~mask; 4107b5dea12SRussell King local_irq_restore(flags); 4117b5dea12SRussell King 4127b5dea12SRussell King return 0; 4137b5dea12SRussell King } 4147b5dea12SRussell King 4157b5dea12SRussell King static void pxa3xx_init_irq_pm(void) 4167b5dea12SRussell King { 4177b5dea12SRussell King pxa_init_irq_set_wake(pxa3xx_set_wake); 4187b5dea12SRussell King } 4197b5dea12SRussell King 4207b5dea12SRussell King #else 4217b5dea12SRussell King static inline void pxa3xx_init_pm(void) {} 4227b5dea12SRussell King static inline void pxa3xx_init_irq_pm(void) {} 4237b5dea12SRussell King #endif 4247b5dea12SRussell King 4252c8086a5Seric miao void __init pxa3xx_init_irq(void) 4262c8086a5Seric miao { 4272c8086a5Seric miao /* enable CP6 access */ 4282c8086a5Seric miao u32 value; 4292c8086a5Seric miao __asm__ __volatile__("mrc p15, 0, %0, c15, c1, 0\n": "=r"(value)); 4302c8086a5Seric miao value |= (1 << 6); 4312c8086a5Seric miao __asm__ __volatile__("mcr p15, 0, %0, c15, c1, 0\n": :"r"(value)); 4322c8086a5Seric miao 4332c8086a5Seric miao pxa_init_irq_low(); 4342c8086a5Seric miao pxa_init_irq_high(); 4352c8086a5Seric miao pxa_init_irq_gpio(128); 4367b5dea12SRussell King pxa3xx_init_irq_pm(); 4372c8086a5Seric miao } 4382c8086a5Seric miao 4392c8086a5Seric miao /* 4402c8086a5Seric miao * device registration specific to PXA3xx. 4412c8086a5Seric miao */ 4422c8086a5Seric miao 4432c8086a5Seric miao static struct platform_device *devices[] __initdata = { 4442c8086a5Seric miao &pxa_device_udc, 4452c8086a5Seric miao &pxa_device_ffuart, 4462c8086a5Seric miao &pxa_device_btuart, 4472c8086a5Seric miao &pxa_device_stuart, 4482c8086a5Seric miao &pxa_device_i2s, 4492c8086a5Seric miao &pxa_device_rtc, 450d8e0db11Seric miao &pxa27x_device_ssp1, 451d8e0db11Seric miao &pxa27x_device_ssp2, 452d8e0db11Seric miao &pxa27x_device_ssp3, 453d8e0db11Seric miao &pxa3xx_device_ssp4, 4542c8086a5Seric miao }; 4552c8086a5Seric miao 456c0165504Seric miao static struct sys_device pxa3xx_sysdev[] = { 457c0165504Seric miao { 458c0165504Seric miao .id = 0, 459c0165504Seric miao .cls = &pxa_irq_sysclass, 460c0165504Seric miao }, { 461c0165504Seric miao .id = 1, 462c0165504Seric miao .cls = &pxa_irq_sysclass, 463c0165504Seric miao }, 464c0165504Seric miao }; 465c0165504Seric miao 4662c8086a5Seric miao static int __init pxa3xx_init(void) 4672c8086a5Seric miao { 468c0165504Seric miao int i, ret = 0; 4692c8086a5Seric miao 4702c8086a5Seric miao if (cpu_is_pxa3xx()) { 4712c8086a5Seric miao clks_register(pxa3xx_clks, ARRAY_SIZE(pxa3xx_clks)); 4722c8086a5Seric miao 4732c8086a5Seric miao if ((ret = pxa_init_dma(32))) 4742c8086a5Seric miao return ret; 4752c8086a5Seric miao 4767b5dea12SRussell King pxa3xx_init_pm(); 4777b5dea12SRussell King 478c0165504Seric miao for (i = 0; i < ARRAY_SIZE(pxa3xx_sysdev); i++) { 479c0165504Seric miao ret = sysdev_register(&pxa3xx_sysdev[i]); 480c0165504Seric miao if (ret) 481c0165504Seric miao pr_err("failed to register sysdev[%d]\n", i); 4822c8086a5Seric miao } 483c0165504Seric miao 484c0165504Seric miao ret = platform_add_devices(devices, ARRAY_SIZE(devices)); 485c0165504Seric miao } 486c0165504Seric miao 487c0165504Seric miao return ret; 4882c8086a5Seric miao } 4892c8086a5Seric miao 4902c8086a5Seric miao subsys_initcall(pxa3xx_init); 491