[PATCH 02/13] ARM: pxa: Access SMEMC via virtual addresses

[haojian.zhuang@gmail.com (Haojian Zhuang)]

On Sun, Oct 10, 2010 at 6:39 AM, Marek Vasut <marek.vasut@gmail.com> wrote:
> This is important because on PXA3xx, the physical mapping of SMEMC registers
> differs from the one on PXA2xx. In order to get PCMCIA working on both PXA2xx
> and PXA320, the PCMCIA driver was adjusted accordingly as well.
>
> Also, various places in the kernel had to be patched to use
> __raw_read/__raw_write.
>
> Signed-off-by: Marek Vasut <marek.vasut@gmail.com>
> ---
> ?arch/arm/mach-pxa/cm-x2xx.c ? ? ? ? ? ? ? ? ?| ? 13 +++--
> ?arch/arm/mach-pxa/cpufreq-pxa2xx.c ? ? ? ? ? | ? 10 ++--
> ?arch/arm/mach-pxa/csb726.c ? ? ? ? ? ? ? ? ? | ? ?7 ++-
> ?arch/arm/mach-pxa/generic.c ? ? ? ? ? ? ? ? ?| ? ?9 ++--
> ?arch/arm/mach-pxa/h5000.c ? ? ? ? ? ? ? ? ? ?| ? ?9 ++--
> ?arch/arm/mach-pxa/include/mach/pxa-smemc.h ? | ? 74 ++++++++++++++++++++++++++
> ?arch/arm/mach-pxa/include/mach/pxa2xx-regs.h | ? 55 -------------------
> ?arch/arm/mach-pxa/lpd270.c ? ? ? ? ? ? ? ? ? | ? ?3 +-
> ?arch/arm/mach-pxa/lubbock.c ? ? ? ? ? ? ? ? ?| ? ?3 +-
> ?arch/arm/mach-pxa/mainstone.c ? ? ? ? ? ? ? ?| ? ?5 +-
> ?arch/arm/mach-pxa/pxa27x.c ? ? ? ? ? ? ? ? ? | ? ?6 ++-
> ?arch/arm/mach-pxa/sleep.S ? ? ? ? ? ? ? ? ? ?| ? ?2 +-
> ?arch/arm/mach-pxa/smemc.c ? ? ? ? ? ? ? ? ? ?| ? 51 ++++++------------
> ?arch/arm/mach-pxa/stargate2.c ? ? ? ? ? ? ? ?| ? ?3 +-
> ?arch/arm/mach-pxa/tosa.c ? ? ? ? ? ? ? ? ? ? | ? ?7 ++-
> ?arch/arm/mach-pxa/trizeps4.c ? ? ? ? ? ? ? ? | ? ?3 +-
> ?arch/arm/mach-pxa/xcep.c ? ? ? ? ? ? ? ? ? ? | ? ?5 +-
> ?arch/arm/mach-pxa/zeus.c ? ? ? ? ? ? ? ? ? ? | ? ?5 +-
> ?drivers/pcmcia/pxa2xx_base.c ? ? ? ? ? ? ? ? | ? 65 +++++++++++++++-------
> ?19 files changed, 189 insertions(+), 146 deletions(-)
> ?create mode 100644 arch/arm/mach-pxa/include/mach/pxa-smemc.h
>
> diff --git a/arch/arm/mach-pxa/cm-x2xx.c b/arch/arm/mach-pxa/cm-x2xx.c
> index c698836..2823466 100644
> --- a/arch/arm/mach-pxa/cm-x2xx.c
> +++ b/arch/arm/mach-pxa/cm-x2xx.c
> @@ -24,6 +24,7 @@
> ?#include <mach/pxa2xx-regs.h>
> ?#include <mach/audio.h>
> ?#include <mach/pxafb.h>
> +#include <mach/pxa-smemc.h>
>
> ?#include <asm/hardware/it8152.h>
>
> @@ -392,9 +393,9 @@ static int cmx2xx_suspend(struct sys_device *dev, pm_message_t state)
> ? ? ? ?cmx2xx_pci_suspend();
>
> ? ? ? ?/* save MSC registers */
> - ? ? ? sleep_save_msc[0] = MSC0;
> - ? ? ? sleep_save_msc[1] = MSC1;
> - ? ? ? sleep_save_msc[2] = MSC2;
> + ? ? ? sleep_save_msc[0] = __raw_readl(MSC0);
> + ? ? ? sleep_save_msc[1] = __raw_readl(MSC1);
> + ? ? ? sleep_save_msc[2] = __raw_readl(MSC2);
>
> ? ? ? ?/* setup power saving mode registers */
> ? ? ? ?PCFR = 0x0;
> @@ -416,9 +417,9 @@ static int cmx2xx_resume(struct sys_device *dev)
> ? ? ? ?cmx2xx_pci_resume();
>
> ? ? ? ?/* restore MSC registers */
> - ? ? ? MSC0 = sleep_save_msc[0];
> - ? ? ? MSC1 = sleep_save_msc[1];
> - ? ? ? MSC2 = sleep_save_msc[2];
> + ? ? ? __raw_writel(sleep_save_msc[0], MSC0);
> + ? ? ? __raw_writel(sleep_save_msc[1], MSC1);
> + ? ? ? __raw_writel(sleep_save_msc[2], MSC2);
>
> ? ? ? ?return 0;
> ?}
> diff --git a/arch/arm/mach-pxa/cpufreq-pxa2xx.c b/arch/arm/mach-pxa/cpufreq-pxa2xx.c
> index 58093d9..1af67ad 100644
> --- a/arch/arm/mach-pxa/cpufreq-pxa2xx.c
> +++ b/arch/arm/mach-pxa/cpufreq-pxa2xx.c
> @@ -38,8 +38,10 @@
> ?#include <linux/cpufreq.h>
> ?#include <linux/err.h>
> ?#include <linux/regulator/consumer.h>
> +#include <linux/io.h>
>
> ?#include <mach/pxa2xx-regs.h>
> +#include <mach/pxa-smemc.h>
>
> ?#ifdef DEBUG
> ?static unsigned int freq_debug;
> @@ -242,7 +244,7 @@ static void pxa27x_guess_max_freq(void)
>
> ?static void init_sdram_rows(void)
> ?{
> - ? ? ? uint32_t mdcnfg = MDCNFG;
> + ? ? ? uint32_t mdcnfg = __raw_readl(MDCNFG);
> ? ? ? ?unsigned int drac2 = 0, drac0 = 0;
>
> ? ? ? ?if (mdcnfg & (MDCNFG_DE2 | MDCNFG_DE3))
> @@ -331,8 +333,8 @@ static int pxa_set_target(struct cpufreq_policy *policy,
> ? ? ? ? * we need to preset the smaller DRI before the change. ?If we're
> ? ? ? ? * speeding up we need to set the larger DRI value after the change.
> ? ? ? ? */
> - ? ? ? preset_mdrefr = postset_mdrefr = MDREFR;
> - ? ? ? if ((MDREFR & MDREFR_DRI_MASK) > mdrefr_dri(new_freq_mem)) {
> + ? ? ? preset_mdrefr = postset_mdrefr = __raw_readl(MDREFR);
> + ? ? ? if ((__raw_readl(MDREFR) & MDREFR_DRI_MASK) > mdrefr_dri(new_freq_mem)) {
> ? ? ? ? ? ? ? ?preset_mdrefr = (preset_mdrefr & ~MDREFR_DRI_MASK);
> ? ? ? ? ? ? ? ?preset_mdrefr |= mdrefr_dri(new_freq_mem);
> ? ? ? ?}
> @@ -370,7 +372,7 @@ static int pxa_set_target(struct cpufreq_policy *policy,
> ?3: ? ? ? ? ? ? nop ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? \n\
> ? ? ? ? ?"
> ? ? ? ? ? ? ? ? ? ? : "=&r" (unused)
> - ? ? ? ? ? ? ? ? ? ?: "r" (&MDREFR), "r" (cclkcfg),
> + ? ? ? ? ? ? ? ? ? ?: "r" (MDREFR), "r" (cclkcfg),
> ? ? ? ? ? ? ? ? ? ? ? "r" (preset_mdrefr), "r" (postset_mdrefr)
> ? ? ? ? ? ? ? ? ? ? : "r4", "r5");
> ? ? ? ?local_irq_restore(flags);
> diff --git a/arch/arm/mach-pxa/csb726.c b/arch/arm/mach-pxa/csb726.c
> index dab9d92..317adbd 100644
> --- a/arch/arm/mach-pxa/csb726.c
> +++ b/arch/arm/mach-pxa/csb726.c
> @@ -27,6 +27,7 @@
> ?#include <mach/ohci.h>
> ?#include <mach/pxa2xx-regs.h>
> ?#include <mach/audio.h>
> +#include <mach/pxa-smemc.h>
>
> ?#include "generic.h"
> ?#include "devices.h"
> @@ -255,9 +256,9 @@ static struct platform_device *devices[] __initdata = {
> ?static void __init csb726_init(void)
> ?{
> ? ? ? ?pxa2xx_mfp_config(ARRAY_AND_SIZE(csb726_pin_config));
> -/* ? ? MSC1 = 0x7ffc3ffc; *//* LAN9215/EXP_CS */
> -/* ? ? MSC2 = 0x06697ff4; *//* none/SM501 */
> - ? ? ? MSC2 = (MSC2 & ~0xffff) | 0x7ff4; /* SM501 */
> +/* ? ? __raw_writel(0x7ffc3ffc, MSC1); *//* LAN9215/EXP_CS */
> +/* ? ? __raw_writel(0x06697ff4, MSC2); *//* none/SM501 */
> + ? ? ? __raw_writel((__raw_readl(MSC2) & ~0xffff) | 0x7ff4, MSC2); /* SM501 */
>
> ? ? ? ?pxa_set_ffuart_info(NULL);
> ? ? ? ?pxa_set_btuart_info(NULL);
> diff --git a/arch/arm/mach-pxa/generic.c b/arch/arm/mach-pxa/generic.c
> index 971f994..6d621bb 100644
> --- a/arch/arm/mach-pxa/generic.c
> +++ b/arch/arm/mach-pxa/generic.c
> @@ -28,6 +28,7 @@
>
> ?#include <mach/reset.h>
> ?#include <mach/gpio.h>
> +#include <mach/pxa-smemc.h>
>
> ?#include "generic.h"
>
> @@ -117,8 +118,8 @@ static struct map_desc common_io_desc[] __initdata = {
>
> ?static struct map_desc pxa2xx_io_desc[] __initdata = {
> ? ? ? ?{ ? ? ? /* Mem Ctl */
> - ? ? ? ? ? ? ? .virtual ? ? ? ?= ?0xf6000000,
> - ? ? ? ? ? ? ? .pfn ? ? ? ? ? ?= __phys_to_pfn(0x48000000),
> + ? ? ? ? ? ? ? .virtual ? ? ? ?= ?PXA_SMEMC_VIRT,
> + ? ? ? ? ? ? ? .pfn ? ? ? ? ? ?= __phys_to_pfn(PXA2XX_SMEMC_BASE),
> ? ? ? ? ? ? ? ?.length ? ? ? ? = 0x00200000,
> ? ? ? ? ? ? ? ?.type ? ? ? ? ? = MT_DEVICE
> ? ? ? ?}
> @@ -126,8 +127,8 @@ static struct map_desc pxa2xx_io_desc[] __initdata = {
>
> ?static struct map_desc pxa3xx_io_desc[] __initdata = {
> ? ? ? ?{ ? ? ? /* Mem Ctl */
> - ? ? ? ? ? ? ? .virtual ? ? ? ?= ?0xf6000000,
> - ? ? ? ? ? ? ? .pfn ? ? ? ? ? ?= __phys_to_pfn(0x4a000000),
> + ? ? ? ? ? ? ? .virtual ? ? ? ?= ?PXA_SMEMC_VIRT,
> + ? ? ? ? ? ? ? .pfn ? ? ? ? ? ?= __phys_to_pfn(PXA3XX_SMEMC_BASE),
> ? ? ? ? ? ? ? ?.length ? ? ? ? = 0x00200000,
> ? ? ? ? ? ? ? ?.type ? ? ? ? ? = MT_DEVICE
> ? ? ? ?}
> diff --git a/arch/arm/mach-pxa/h5000.c b/arch/arm/mach-pxa/h5000.c
> index 9048066..3f69fce 100644
> --- a/arch/arm/mach-pxa/h5000.c
> +++ b/arch/arm/mach-pxa/h5000.c
> @@ -32,6 +32,7 @@
> ?#include <mach/pxa25x.h>
> ?#include <mach/h5000.h>
> ?#include <mach/udc.h>
> +#include <mach/pxa-smemc.h>
>
> ?#include "generic.h"
>
> @@ -172,11 +173,11 @@ static unsigned long h5000_pin_config[] __initdata = {
>
> ?static void fix_msc(void)
> ?{
> - ? ? ? MSC0 = 0x129c24f2;
> - ? ? ? MSC1 = 0x7ff424fa;
> - ? ? ? MSC2 = 0x7ff47ff4;
> + ? ? ? __raw_writel(0x129c24f2, MSC0);
> + ? ? ? __raw_writel(0x7ff424fa, MSC1);
> + ? ? ? __raw_writel(0x7ff47ff4, MSC2);
>
> - ? ? ? MDREFR |= 0x02080000;
> + ? ? ? __raw_writel(__raw_readl(MDREFR) | 0x02080000, MDREFR);
> ?}
>
> ?/*
> diff --git a/arch/arm/mach-pxa/include/mach/pxa-smemc.h b/arch/arm/mach-pxa/include/mach/pxa-smemc.h
> new file mode 100644
> index 0000000..e3b270b
> --- /dev/null
> +++ b/arch/arm/mach-pxa/include/mach/pxa-smemc.h
> @@ -0,0 +1,74 @@
> +/*
> + * Static memory controller register definitions for PXA CPUs
> + *
> + * Copyright (C) 2010 Marek Vasut <marek.vasut@gmail.com>
> + *
> + * 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.
> + */
> +
> +#ifndef __PXA_SMEMC_REGS_H
> +#define __PXA_SMEMC_REGS_H
> +
> +#define ? ? ? ?PXA2XX_SMEMC_BASE ? ? ? 0x48000000
> +#define ? ? ? ?PXA3XX_SMEMC_BASE ? ? ? 0x4a000000
> +#define ? ? ? ?PXA_SMEMC_VIRT ? ? ? ? ?0xf6000000
> +
> +#define MDCNFG ? ? ? ? (PXA_SMEMC_VIRT + 0x00) ?/* SDRAM Configuration Register 0 */
> +#define MDREFR ? ? ? ? (PXA_SMEMC_VIRT + 0x04) ?/* SDRAM Refresh Control Register */
> +#define MSC0 ? ? ? ? ? (PXA_SMEMC_VIRT + 0x08) ?/* Static Memory Control Register 0 */
> +#define MSC1 ? ? ? ? ? (PXA_SMEMC_VIRT + 0x0C) ?/* Static Memory Control Register 1 */
> +#define MSC2 ? ? ? ? ? (PXA_SMEMC_VIRT + 0x10) ?/* Static Memory Control Register 2 */
> +#define MECR ? ? ? ? ? (PXA_SMEMC_VIRT + 0x14) ?/* Expansion Memory (PCMCIA/Compact Flash) Bus Configuration */
> +#define SXLCR ? ? ? ? ?(PXA_SMEMC_VIRT + 0x18) ?/* LCR value to be written to SDRAM-Timing Synchronous Flash */
> +#define SXCNFG ? ? ? ? (PXA_SMEMC_VIRT + 0x1C) ?/* Synchronous Static Memory Control Register */
> +#define SXMRS ? ? ? ? ?(PXA_SMEMC_VIRT + 0x24) ?/* MRS value to be written to Synchronous Flash or SMROM */
> +#define MCMEM0 ? ? ? ? (PXA_SMEMC_VIRT + 0x28) ?/* Card interface Common Memory Space Socket 0 Timing */
> +#define MCMEM1 ? ? ? ? (PXA_SMEMC_VIRT + 0x2C) ?/* Card interface Common Memory Space Socket 1 Timing */
> +#define MCATT0 ? ? ? ? (PXA_SMEMC_VIRT + 0x30) ?/* Card interface Attribute Space Socket 0 Timing Configuration */
> +#define MCATT1 ? ? ? ? (PXA_SMEMC_VIRT + 0x34) ?/* Card interface Attribute Space Socket 1 Timing Configuration */
> +#define MCIO0 ? ? ? ? ?(PXA_SMEMC_VIRT + 0x38) ?/* Card interface I/O Space Socket 0 Timing Configuration */
> +#define MCIO1 ? ? ? ? ?(PXA_SMEMC_VIRT + 0x3C) ?/* Card interface I/O Space Socket 1 Timing Configuration */
> +#define MDMRS ? ? ? ? ?(PXA_SMEMC_VIRT + 0x40) ?/* MRS value to be written to SDRAM */
> +#define BOOT_DEF ? ? ? (PXA_SMEMC_VIRT + 0x44) ?/* Read-Only Boot-Time Register. Contains BOOT_SEL and PKG_SEL */
> +#define MEMCLKCFG ? ? ?(PXA_SMEMC_VIRT + 0x68) /* Clock Configuration */
> +#define CSADRCFG0 ? ? ?(PXA_SMEMC_VIRT + 0x80) /* Address Configuration Register for CS0 */
> +#define CSADRCFG1 ? ? ?(PXA_SMEMC_VIRT + 0x84) /* Address Configuration Register for CS1 */
> +#define CSADRCFG2 ? ? ?(PXA_SMEMC_VIRT + 0x88) /* Address Configuration Register for CS2 */
> +#define CSADRCFG3 ? ? ?(PXA_SMEMC_VIRT + 0x8C) /* Address Configuration Register for CS3 */
> +
> +/*
> + * More handy macros for PCMCIA
> + *
> + * Arg is socket number
> + */
> +#define MCMEM(s) ? ? ? (PXA_SMEMC_VIRT + 0x28 + ((s)<<2)) ?/* Card interface Common Memory Space Socket s Timing */
> +#define MCATT(s) ? ? ? (PXA_SMEMC_VIRT + 0x30 + ((s)<<2)) ?/* Card interface Attribute Space Socket s Timing Configuration */
> +#define MCIO(s) ? ? ? ? ? ? ? ?(PXA_SMEMC_VIRT + 0x38 + ((s)<<2)) ?/* Card interface I/O Space Socket s Timing Configuration */
> +
> +/* MECR register defines */
> +#define MECR_NOS ? ? ? (1 << 0) ? ? ? ?/* Number Of Sockets: 0 -> 1 sock, 1 -> 2 sock */
> +#define MECR_CIT ? ? ? (1 << 1) ? ? ? ?/* Card Is There: 0 -> no card, 1 -> card inserted */
> +
> +#define MDCNFG_DE0 ? ? (1 << 0) ? ? ? ?/* SDRAM Bank 0 Enable */
> +#define MDCNFG_DE1 ? ? (1 << 1) ? ? ? ?/* SDRAM Bank 1 Enable */
> +#define MDCNFG_DE2 ? ? (1 << 16) ? ? ? /* SDRAM Bank 2 Enable */
> +#define MDCNFG_DE3 ? ? (1 << 17) ? ? ? /* SDRAM Bank 3 Enable */
> +
> +#define MDREFR_K0DB4 ? (1 << 29) ? ? ? /* SDCLK0 Divide by 4 Control/Status */
> +#define MDREFR_K2FREE ?(1 << 25) ? ? ? /* SDRAM Free-Running Control */
> +#define MDREFR_K1FREE ?(1 << 24) ? ? ? /* SDRAM Free-Running Control */
> +#define MDREFR_K0FREE ?(1 << 23) ? ? ? /* SDRAM Free-Running Control */
> +#define MDREFR_SLFRSH ?(1 << 22) ? ? ? /* SDRAM Self-Refresh Control/Status */
> +#define MDREFR_APD ? ? (1 << 20) ? ? ? /* SDRAM/SSRAM Auto-Power-Down Enable */
> +#define MDREFR_K2DB2 ? (1 << 19) ? ? ? /* SDCLK2 Divide by 2 Control/Status */
> +#define MDREFR_K2RUN ? (1 << 18) ? ? ? /* SDCLK2 Run Control/Status */
> +#define MDREFR_K1DB2 ? (1 << 17) ? ? ? /* SDCLK1 Divide by 2 Control/Status */
> +#define MDREFR_K1RUN ? (1 << 16) ? ? ? /* SDCLK1 Run Control/Status */
> +#define MDREFR_E1PIN ? (1 << 15) ? ? ? /* SDCKE1 Level Control/Status */
> +#define MDREFR_K0DB2 ? (1 << 14) ? ? ? /* SDCLK0 Divide by 2 Control/Status */
> +#define MDREFR_K0RUN ? (1 << 13) ? ? ? /* SDCLK0 Run Control/Status */
> +#define MDREFR_E0PIN ? (1 << 12) ? ? ? /* SDCKE0 Level Control/Status */
> +
> +#endif
> diff --git a/arch/arm/mach-pxa/include/mach/pxa2xx-regs.h b/arch/arm/mach-pxa/include/mach/pxa2xx-regs.h
> index 4fcddd9..b98f236 100644
> --- a/arch/arm/mach-pxa/include/mach/pxa2xx-regs.h
> +++ b/arch/arm/mach-pxa/include/mach/pxa2xx-regs.h
> @@ -28,61 +28,6 @@
> ?#define PXA_CS5_PHYS ? 0x14000000
>
> ?/*
> - * Memory controller
> - */
> -
> -#define MDCNFG ? ? ? ? __REG(0x48000000) ?/* SDRAM Configuration Register 0 */
> -#define MDREFR ? ? ? ? __REG(0x48000004) ?/* SDRAM Refresh Control Register */
> -#define MSC0 ? ? ? ? ? __REG(0x48000008) ?/* Static Memory Control Register 0 */
> -#define MSC1 ? ? ? ? ? __REG(0x4800000C) ?/* Static Memory Control Register 1 */
> -#define MSC2 ? ? ? ? ? __REG(0x48000010) ?/* Static Memory Control Register 2 */
> -#define MECR ? ? ? ? ? __REG(0x48000014) ?/* Expansion Memory (PCMCIA/Compact Flash) Bus Configuration */
> -#define SXLCR ? ? ? ? ?__REG(0x48000018) ?/* LCR value to be written to SDRAM-Timing Synchronous Flash */
> -#define SXCNFG ? ? ? ? __REG(0x4800001C) ?/* Synchronous Static Memory Control Register */
> -#define SXMRS ? ? ? ? ?__REG(0x48000024) ?/* MRS value to be written to Synchronous Flash or SMROM */
> -#define MCMEM0 ? ? ? ? __REG(0x48000028) ?/* Card interface Common Memory Space Socket 0 Timing */
> -#define MCMEM1 ? ? ? ? __REG(0x4800002C) ?/* Card interface Common Memory Space Socket 1 Timing */
> -#define MCATT0 ? ? ? ? __REG(0x48000030) ?/* Card interface Attribute Space Socket 0 Timing Configuration */
> -#define MCATT1 ? ? ? ? __REG(0x48000034) ?/* Card interface Attribute Space Socket 1 Timing Configuration */
> -#define MCIO0 ? ? ? ? ?__REG(0x48000038) ?/* Card interface I/O Space Socket 0 Timing Configuration */
> -#define MCIO1 ? ? ? ? ?__REG(0x4800003C) ?/* Card interface I/O Space Socket 1 Timing Configuration */
> -#define MDMRS ? ? ? ? ?__REG(0x48000040) ?/* MRS value to be written to SDRAM */
> -#define BOOT_DEF ? ? ? __REG(0x48000044) ?/* Read-Only Boot-Time Register. Contains BOOT_SEL and PKG_SEL */
> -
> -/*
> - * More handy macros for PCMCIA
> - *
> - * Arg is socket number
> - */
> -#define MCMEM(s) ? ? ? __REG2(0x48000028, (s)<<2 ) ?/* Card interface Common Memory Space Socket s Timing */
> -#define MCATT(s) ? ? ? __REG2(0x48000030, (s)<<2 ) ?/* Card interface Attribute Space Socket s Timing Configuration */
> -#define MCIO(s) ? ? ? ? ? ? ? ?__REG2(0x48000038, (s)<<2 ) ?/* Card interface I/O Space Socket s Timing Configuration */
> -
> -/* MECR register defines */
> -#define MECR_NOS ? ? ? (1 << 0) ? ? ? ?/* Number Of Sockets: 0 -> 1 sock, 1 -> 2 sock */
> -#define MECR_CIT ? ? ? (1 << 1) ? ? ? ?/* Card Is There: 0 -> no card, 1 -> card inserted */
> -
> -#define MDCNFG_DE0 ? ? (1 << 0) ? ? ? ?/* SDRAM Bank 0 Enable */
> -#define MDCNFG_DE1 ? ? (1 << 1) ? ? ? ?/* SDRAM Bank 1 Enable */
> -#define MDCNFG_DE2 ? ? (1 << 16) ? ? ? /* SDRAM Bank 2 Enable */
> -#define MDCNFG_DE3 ? ? (1 << 17) ? ? ? /* SDRAM Bank 3 Enable */
> -
> -#define MDREFR_K0DB4 ? (1 << 29) ? ? ? /* SDCLK0 Divide by 4 Control/Status */
> -#define MDREFR_K2FREE ?(1 << 25) ? ? ? /* SDRAM Free-Running Control */
> -#define MDREFR_K1FREE ?(1 << 24) ? ? ? /* SDRAM Free-Running Control */
> -#define MDREFR_K0FREE ?(1 << 23) ? ? ? /* SDRAM Free-Running Control */
> -#define MDREFR_SLFRSH ?(1 << 22) ? ? ? /* SDRAM Self-Refresh Control/Status */
> -#define MDREFR_APD ? ? (1 << 20) ? ? ? /* SDRAM/SSRAM Auto-Power-Down Enable */
> -#define MDREFR_K2DB2 ? (1 << 19) ? ? ? /* SDCLK2 Divide by 2 Control/Status */
> -#define MDREFR_K2RUN ? (1 << 18) ? ? ? /* SDCLK2 Run Control/Status */
> -#define MDREFR_K1DB2 ? (1 << 17) ? ? ? /* SDCLK1 Divide by 2 Control/Status */
> -#define MDREFR_K1RUN ? (1 << 16) ? ? ? /* SDCLK1 Run Control/Status */
> -#define MDREFR_E1PIN ? (1 << 15) ? ? ? /* SDCKE1 Level Control/Status */
> -#define MDREFR_K0DB2 ? (1 << 14) ? ? ? /* SDCLK0 Divide by 2 Control/Status */
> -#define MDREFR_K0RUN ? (1 << 13) ? ? ? /* SDCLK0 Run Control/Status */
> -#define MDREFR_E0PIN ? (1 << 12) ? ? ? /* SDCKE0 Level Control/Status */
> -
> -/*
> ?* Power Manager
> ?*/
>
> diff --git a/arch/arm/mach-pxa/lpd270.c b/arch/arm/mach-pxa/lpd270.c
> index f1685cc..40a219a 100644
> --- a/arch/arm/mach-pxa/lpd270.c
> +++ b/arch/arm/mach-pxa/lpd270.c
> @@ -46,6 +46,7 @@
> ?#include <mach/mmc.h>
> ?#include <mach/irda.h>
> ?#include <mach/ohci.h>
> +#include <mach/pxa-smemc.h>
>
> ?#include "generic.h"
> ?#include "devices.h"
> @@ -463,7 +464,7 @@ static void __init lpd270_init(void)
> ? ? ? ?pxa_set_btuart_info(NULL);
> ? ? ? ?pxa_set_stuart_info(NULL);
>
> - ? ? ? lpd270_flash_data[0].width = (BOOT_DEF & 1) ? 2 : 4;
> + ? ? ? lpd270_flash_data[0].width = (__raw_readl(BOOT_DEF) & 1) ? 2 : 4;
> ? ? ? ?lpd270_flash_data[1].width = 4;
>
> ? ? ? ?/*
> diff --git a/arch/arm/mach-pxa/lubbock.c b/arch/arm/mach-pxa/lubbock.c
> index e73fc1d..e16450e 100644
> --- a/arch/arm/mach-pxa/lubbock.c
> +++ b/arch/arm/mach-pxa/lubbock.c
> @@ -50,6 +50,7 @@
> ?#include <mach/pxafb.h>
> ?#include <mach/mmc.h>
> ?#include <mach/pm.h>
> +#include <mach/pxa-smemc.h>
>
> ?#include "generic.h"
> ?#include "clock.h"
> @@ -525,7 +526,7 @@ static void __init lubbock_init(void)
> ? ? ? ?pxa_set_ac97_info(NULL);
>
> ? ? ? ?lubbock_flash_data[0].width = lubbock_flash_data[1].width =
> - ? ? ? ? ? ? ? (BOOT_DEF & 1) ? 2 : 4;
> + ? ? ? ? ? ? ? (__raw_readl(BOOT_DEF) & 1) ? 2 : 4;
> ? ? ? ?/* Compensate for the nROMBT switch which swaps the flash banks */
> ? ? ? ?printk(KERN_NOTICE "Lubbock configured to boot from %s (bank %d)\n",
> ? ? ? ? ? ? ? flashboot?"Flash":"ROM", flashboot);
> diff --git a/arch/arm/mach-pxa/mainstone.c b/arch/arm/mach-pxa/mainstone.c
> index 12f5e9e..f3ea1d7 100644
> --- a/arch/arm/mach-pxa/mainstone.c
> +++ b/arch/arm/mach-pxa/mainstone.c
> @@ -41,7 +41,7 @@
> ?#include <asm/mach/irq.h>
> ?#include <asm/mach/flash.h>
>
> -#include <plat/pxa27x.h>
> +#include <mach/pxa27x.h>
> ?#include <mach/gpio.h>
> ?#include <mach/mainstone.h>
> ?#include <mach/audio.h>
> @@ -51,6 +51,7 @@
> ?#include <mach/irda.h>
> ?#include <mach/ohci.h>
> ?#include <plat/pxa27x_keypad.h>
> +#include <mach/pxa-smemc.h>
>
> ?#include "generic.h"
> ?#include "devices.h"
> @@ -565,7 +566,7 @@ static void __init mainstone_init(void)
> ? ? ? ?pxa_set_btuart_info(NULL);
> ? ? ? ?pxa_set_stuart_info(NULL);
>
> - ? ? ? mst_flash_data[0].width = (BOOT_DEF & 1) ? 2 : 4;
> + ? ? ? mst_flash_data[0].width = (__raw_readl(BOOT_DEF) & 1) ? 2 : 4;
> ? ? ? ?mst_flash_data[1].width = 4;
>
> ? ? ? ?/* Compensate for SW7 which swaps the flash banks */
> diff --git a/arch/arm/mach-pxa/pxa27x.c b/arch/arm/mach-pxa/pxa27x.c
> index 12e5b9f..b1b01e6 100644
> --- a/arch/arm/mach-pxa/pxa27x.c
> +++ b/arch/arm/mach-pxa/pxa27x.c
> @@ -17,6 +17,7 @@
> ?#include <linux/suspend.h>
> ?#include <linux/platform_device.h>
> ?#include <linux/sysdev.h>
> +#include <linux/io.h>
>
> ?#include <mach/hardware.h>
> ?#include <asm/irq.h>
> @@ -27,6 +28,7 @@
> ?#include <mach/ohci.h>
> ?#include <mach/pm.h>
> ?#include <mach/dma.h>
> +#include <mach/pxa-smemc.h>
> ?#include <plat/i2c.h>
>
> ?#include "generic.h"
> @@ -254,7 +256,7 @@ enum {
>
> ?void pxa27x_cpu_pm_save(unsigned long *sleep_save)
> ?{
> - ? ? ? SAVE(MDREFR);
> + ? ? ? sleep_save[SLEEP_SAVE_MDREFR] = __raw_readl(MDREFR);
> ? ? ? ?SAVE(PCFR);
>
> ? ? ? ?SAVE(CKEN);
> @@ -263,7 +265,7 @@ void pxa27x_cpu_pm_save(unsigned long *sleep_save)
>
> ?void pxa27x_cpu_pm_restore(unsigned long *sleep_save)
> ?{
> - ? ? ? RESTORE(MDREFR);
> + ? ? ? __raw_writel(sleep_save[SLEEP_SAVE_MDREFR], MDREFR);
> ? ? ? ?RESTORE(PCFR);
>
> ? ? ? ?PSSR = PSSR_RDH | PSSR_PH;
> diff --git a/arch/arm/mach-pxa/sleep.S b/arch/arm/mach-pxa/sleep.S
> index 52c30b0..227df3a 100644
> --- a/arch/arm/mach-pxa/sleep.S
> +++ b/arch/arm/mach-pxa/sleep.S
> @@ -14,7 +14,7 @@
> ?#include <linux/linkage.h>
> ?#include <asm/assembler.h>
> ?#include <mach/hardware.h>
> -
> +#include <mach/pxa-smemc.h>
> ?#include <mach/pxa2xx-regs.h>
>
> ?#define MDREFR_KDIV ? ?0x200a4000 ? ? ?// all banks
> diff --git a/arch/arm/mach-pxa/smemc.c b/arch/arm/mach-pxa/smemc.c
> index d6f6904..91edda8 100644
> --- a/arch/arm/mach-pxa/smemc.c
> +++ b/arch/arm/mach-pxa/smemc.c
> @@ -9,50 +9,37 @@
> ?#include <linux/sysdev.h>
>
> ?#include <mach/hardware.h>
> -
> -#define SMEMC_PHYS_BASE ? ? ? ?(0x4A000000)
> -#define SMEMC_PHYS_SIZE ? ? ? ?(0x90)
> -
> -#define MSC0 ? ? ? ? ? (0x08) ?/* Static Memory Controller Register 0 */
> -#define MSC1 ? ? ? ? ? (0x0C) ?/* Static Memory Controller Register 1 */
> -#define SXCNFG ? ? ? ? (0x1C) ?/* Synchronous Static Memory Control Register */
> -#define MEMCLKCFG ? ? ?(0x68) ?/* Clock Configuration */
> -#define CSADRCFG0 ? ? ?(0x80) ?/* Address Configuration Register for CS0 */
> -#define CSADRCFG1 ? ? ?(0x84) ?/* Address Configuration Register for CS1 */
> -#define CSADRCFG2 ? ? ?(0x88) ?/* Address Configuration Register for CS2 */
> -#define CSADRCFG3 ? ? ?(0x8C) ?/* Address Configuration Register for CS3 */
> +#include <mach/pxa-smemc.h>
>
> ?#ifdef CONFIG_PM
> -static void __iomem *smemc_mmio_base;
> -
> ?static unsigned long msc[2];
> ?static unsigned long sxcnfg, memclkcfg;
> ?static unsigned long csadrcfg[4];
>
> ?static int pxa3xx_smemc_suspend(struct sys_device *dev, pm_message_t state)
> ?{
> - ? ? ? msc[0] = __raw_readl(smemc_mmio_base + MSC0);
> - ? ? ? msc[1] = __raw_readl(smemc_mmio_base + MSC1);
> - ? ? ? sxcnfg = __raw_readl(smemc_mmio_base + SXCNFG);
> - ? ? ? memclkcfg = __raw_readl(smemc_mmio_base + MEMCLKCFG);
> - ? ? ? csadrcfg[0] = __raw_readl(smemc_mmio_base + CSADRCFG0);
> - ? ? ? csadrcfg[1] = __raw_readl(smemc_mmio_base + CSADRCFG1);
> - ? ? ? csadrcfg[2] = __raw_readl(smemc_mmio_base + CSADRCFG2);
> - ? ? ? csadrcfg[3] = __raw_readl(smemc_mmio_base + CSADRCFG3);
> + ? ? ? msc[0] = __raw_readl(MSC0);
> + ? ? ? msc[1] = __raw_readl(MSC1);
> + ? ? ? sxcnfg = __raw_readl(SXCNFG);
> + ? ? ? memclkcfg = __raw_readl(MEMCLKCFG);
> + ? ? ? csadrcfg[0] = __raw_readl(CSADRCFG0);
> + ? ? ? csadrcfg[1] = __raw_readl(CSADRCFG1);
> + ? ? ? csadrcfg[2] = __raw_readl(CSADRCFG2);
> + ? ? ? csadrcfg[3] = __raw_readl(CSADRCFG3);
>
> ? ? ? ?return 0;
> ?}
>
> ?static int pxa3xx_smemc_resume(struct sys_device *dev)
> ?{
> - ? ? ? __raw_writel(msc[0], smemc_mmio_base + MSC0);
> - ? ? ? __raw_writel(msc[1], smemc_mmio_base + MSC1);
> - ? ? ? __raw_writel(sxcnfg, smemc_mmio_base + SXCNFG);
> - ? ? ? __raw_writel(memclkcfg, smemc_mmio_base + MEMCLKCFG);
> - ? ? ? __raw_writel(csadrcfg[0], smemc_mmio_base + CSADRCFG0);
> - ? ? ? __raw_writel(csadrcfg[1], smemc_mmio_base + CSADRCFG1);
> - ? ? ? __raw_writel(csadrcfg[2], smemc_mmio_base + CSADRCFG2);
> - ? ? ? __raw_writel(csadrcfg[3], smemc_mmio_base + CSADRCFG3);
> + ? ? ? __raw_writel(msc[0], MSC0);
> + ? ? ? __raw_writel(msc[1], MSC1);
> + ? ? ? __raw_writel(sxcnfg, SXCNFG);
> + ? ? ? __raw_writel(memclkcfg, MEMCLKCFG);
> + ? ? ? __raw_writel(csadrcfg[0], CSADRCFG0);
> + ? ? ? __raw_writel(csadrcfg[1], CSADRCFG1);
> + ? ? ? __raw_writel(csadrcfg[2], CSADRCFG2);
> + ? ? ? __raw_writel(csadrcfg[3], CSADRCFG3);
>
> ? ? ? ?return 0;
> ?}
> @@ -73,10 +60,6 @@ static int __init smemc_init(void)
> ? ? ? ?int ret = 0;
>
> ? ? ? ?if (cpu_is_pxa3xx()) {
> - ? ? ? ? ? ? ? smemc_mmio_base = ioremap(SMEMC_PHYS_BASE, SMEMC_PHYS_SIZE);
> - ? ? ? ? ? ? ? if (smemc_mmio_base == NULL)
> - ? ? ? ? ? ? ? ? ? ? ? return -ENODEV;
> -
> ? ? ? ? ? ? ? ?ret = sysdev_class_register(&smemc_sysclass);
> ? ? ? ? ? ? ? ?if (ret)
> ? ? ? ? ? ? ? ? ? ? ? ?return ret;
> diff --git a/arch/arm/mach-pxa/stargate2.c b/arch/arm/mach-pxa/stargate2.c
> index 2f45af4..61af9a0 100644
> --- a/arch/arm/mach-pxa/stargate2.c
> +++ b/arch/arm/mach-pxa/stargate2.c
> @@ -48,6 +48,7 @@
> ?#include <mach/udc.h>
> ?#include <mach/pxa2xx_spi.h>
> ?#include <mach/pxa27x-udc.h>
> +#include <mach/pxa-smemc.h>
>
> ?#include <linux/spi/spi.h>
> ?#include <linux/mfd/da903x.h>
> @@ -976,7 +977,7 @@ static void __init stargate2_init(void)
> ?{
> ? ? ? ?/* This is probably a board specific hack as this must be set
> ? ? ? ? ? prior to connecting the MFP stuff up. */
> - ? ? ? MECR &= ~MECR_NOS;
> + ? ? ? __raw_writel(__raw_readl(MECR) & ~MECR_NOS, MECR);
>
> ? ? ? ?pxa2xx_mfp_config(ARRAY_AND_SIZE(stargate2_pin_config));
>
> diff --git a/arch/arm/mach-pxa/tosa.c b/arch/arm/mach-pxa/tosa.c
> index 86b6c7a..1fe9e98 100644
> --- a/arch/arm/mach-pxa/tosa.c
> +++ b/arch/arm/mach-pxa/tosa.c
> @@ -46,6 +46,7 @@
> ?#include <mach/tosa_bt.h>
> ?#include <mach/pxa2xx_spi.h>
> ?#include <mach/audio.h>
> +#include <mach/pxa-smemc.h>
>
> ?#include <asm/mach/arch.h>
> ?#include <mach/tosa.h>
> @@ -893,9 +894,11 @@ static void tosa_poweroff(void)
>
> ?static void tosa_restart(char mode, const char *cmd)
> ?{
> + ? ? ? uint32_t msc0 = __raw_readl(MSC0);
> +
> ? ? ? ?/* Bootloader magic for a reboot */
> - ? ? ? if((MSC0 & 0xffff0000) == 0x7ff00000)
> - ? ? ? ? ? ? ? MSC0 = (MSC0 & 0xffff) | 0x7ee00000;
> + ? ? ? if((msc0 & 0xffff0000) == 0x7ff00000)
> + ? ? ? ? ? ? ? __raw_writel((msc0 & 0xffff) | 0x7ee00000, MSC0);
>
> ? ? ? ?tosa_poweroff();
> ?}
> diff --git a/arch/arm/mach-pxa/trizeps4.c b/arch/arm/mach-pxa/trizeps4.c
> index d4ecc25..881f77d 100644
> --- a/arch/arm/mach-pxa/trizeps4.c
> +++ b/arch/arm/mach-pxa/trizeps4.c
> @@ -47,6 +47,7 @@
> ?#include <mach/mmc.h>
> ?#include <mach/irda.h>
> ?#include <mach/ohci.h>
> +#include <mach/pxa-smemc.h>
> ?#include <plat/i2c.h>
>
> ?#include "generic.h"
> @@ -542,7 +543,7 @@ static void __init trizeps4_map_io(void)
> ? ? ? ?pxa2xx_map_io();
> ? ? ? ?iotable_init(trizeps4_io_desc, ARRAY_SIZE(trizeps4_io_desc));
>
> - ? ? ? if ((MSC0 & 0x8) && (BOOT_DEF & 0x1)) {
> + ? ? ? if ((__raw_readl(MSC0) & 0x8) && (__raw_readl(BOOT_DEF) & 0x1)) {
> ? ? ? ? ? ? ? ?/* if flash is 16 bit wide its a Trizeps4 WL */
> ? ? ? ? ? ? ? ?__machine_arch_type = MACH_TYPE_TRIZEPS4WL;
> ? ? ? ? ? ? ? ?trizeps4_flash_data[0].width = 2;
> diff --git a/arch/arm/mach-pxa/xcep.c b/arch/arm/mach-pxa/xcep.c
> index 649e74b..bd8a38f 100644
> --- a/arch/arm/mach-pxa/xcep.c
> +++ b/arch/arm/mach-pxa/xcep.c
> @@ -31,6 +31,7 @@
> ?#include <mach/hardware.h>
> ?#include <mach/pxa2xx-regs.h>
> ?#include <mach/mfp-pxa25x.h>
> +#include <mach/pxa-smemc.h>
>
> ?#include "generic.h"
>
> @@ -172,9 +173,9 @@ static void __init xcep_init(void)
>
> ? ? ? ?/* See Intel XScale Developer's Guide for details */
> ? ? ? ?/* Set RDF and RDN to appropriate values (chip select 3 (smc91x)) */
> - ? ? ? MSC1 = (MSC1 & 0xffff) | 0xD5540000;
> + ? ? ? __raw_writel((__raw_readl(MSC1) & 0xffff) | 0xD5540000, MSC1);
> ? ? ? ?/* Set RDF and RDN to appropriate values (chip select 5 (fpga)) */
> - ? ? ? MSC2 = (MSC2 & 0xffff) | 0x72A00000;
> + ? ? ? __raw_writel((__raw_readl(MSC2) & 0xffff) | 0x72A00000, MSC2);
>
> ? ? ? ?platform_add_devices(ARRAY_AND_SIZE(devices));
> ? ? ? ?pxa_set_i2c_info(&xcep_i2c_platform_data);
> diff --git a/arch/arm/mach-pxa/zeus.c b/arch/arm/mach-pxa/zeus.c
> index 96a064f..cf410ba 100644
> --- a/arch/arm/mach-pxa/zeus.c
> +++ b/arch/arm/mach-pxa/zeus.c
> @@ -47,6 +47,7 @@
> ?#include <mach/audio.h>
> ?#include <mach/arcom-pcmcia.h>
> ?#include <mach/zeus.h>
> +#include <mach/pxa-smemc.h>
>
> ?#include "generic.h"
>
> @@ -828,8 +829,8 @@ static void __init zeus_init(void)
> ? ? ? ?pr_info("Zeus CPLD V%dI%d\n", (system_rev & 0xf0) >> 4, (system_rev & 0x0f));
>
> ? ? ? ?/* Fix timings for dm9000s (CS1/CS2)*/
> - ? ? ? MSC0 = (MSC0 & 0xffff) | (dm9000_msc << 16);
> - ? ? ? MSC1 = (MSC1 & 0xffff0000) | dm9000_msc;
> + ? ? ? __raw_writel((MSC0 & 0xffff) | (dm9000_msc << 16), MSC0);
> + ? ? ? __raw_writel((MSC1 & 0xffff0000) | dm9000_msc, MSC1);
>
> ? ? ? ?pm_power_off = zeus_power_off;
> ? ? ? ?zeus_setup_apm();
> diff --git a/drivers/pcmcia/pxa2xx_base.c b/drivers/pcmcia/pxa2xx_base.c
> index ae07b4d..65a8b6f 100644
> --- a/drivers/pcmcia/pxa2xx_base.c
> +++ b/drivers/pcmcia/pxa2xx_base.c
> @@ -26,6 +26,7 @@
> ?#include <linux/platform_device.h>
>
> ?#include <mach/hardware.h>
> +#include <mach/pxa-smemc.h>
> ?#include <asm/io.h>
> ?#include <asm/irq.h>
> ?#include <asm/system.h>
> @@ -116,37 +117,49 @@ static inline u_int pxa2xx_pcmcia_cmd_time(u_int mem_clk_10khz,
>
> ?static int pxa2xx_pcmcia_set_mcmem( int sock, int speed, int clock )
> ?{
> - ? ? ? MCMEM(sock) = ((pxa2xx_mcxx_setup(speed, clock)
> + ? ? ? uint32_t val;
> +
> + ? ? ? val = ((pxa2xx_mcxx_setup(speed, clock)
> ? ? ? ? ? ? ? ?& MCXX_SETUP_MASK) << MCXX_SETUP_SHIFT)
> ? ? ? ? ? ? ? ?| ((pxa2xx_mcxx_asst(speed, clock)
> ? ? ? ? ? ? ? ?& MCXX_ASST_MASK) << MCXX_ASST_SHIFT)
> ? ? ? ? ? ? ? ?| ((pxa2xx_mcxx_hold(speed, clock)
> ? ? ? ? ? ? ? ?& MCXX_HOLD_MASK) << MCXX_HOLD_SHIFT);
>
> + ? ? ? __raw_writel(val, MCMEM(sock));
> +
> ? ? ? ?return 0;
> ?}
>
> ?static int pxa2xx_pcmcia_set_mcio( int sock, int speed, int clock )
> ?{
> - ? ? ? MCIO(sock) = ((pxa2xx_mcxx_setup(speed, clock)
> + ? ? ? uint32_t val;
> +
> + ? ? ? val = ((pxa2xx_mcxx_setup(speed, clock)
> ? ? ? ? ? ? ? ?& MCXX_SETUP_MASK) << MCXX_SETUP_SHIFT)
> ? ? ? ? ? ? ? ?| ((pxa2xx_mcxx_asst(speed, clock)
> ? ? ? ? ? ? ? ?& MCXX_ASST_MASK) << MCXX_ASST_SHIFT)
> ? ? ? ? ? ? ? ?| ((pxa2xx_mcxx_hold(speed, clock)
> ? ? ? ? ? ? ? ?& MCXX_HOLD_MASK) << MCXX_HOLD_SHIFT);
>
> + ? ? ? __raw_writel(val, MCIO(sock));
> +
> ? ? ? ?return 0;
> ?}
>
> ?static int pxa2xx_pcmcia_set_mcatt( int sock, int speed, int clock )
> ?{
> - ? ? ? MCATT(sock) = ((pxa2xx_mcxx_setup(speed, clock)
> + ? ? ? uint32_t val;
> +
> + ? ? ? val = ((pxa2xx_mcxx_setup(speed, clock)
> ? ? ? ? ? ? ? ?& MCXX_SETUP_MASK) << MCXX_SETUP_SHIFT)
> ? ? ? ? ? ? ? ?| ((pxa2xx_mcxx_asst(speed, clock)
> ? ? ? ? ? ? ? ?& MCXX_ASST_MASK) << MCXX_ASST_SHIFT)
> ? ? ? ? ? ? ? ?| ((pxa2xx_mcxx_hold(speed, clock)
> ? ? ? ? ? ? ? ?& MCXX_HOLD_MASK) << MCXX_HOLD_SHIFT);
>
> + ? ? ? __raw_writel(val, MCATT(sock));
> +
> ? ? ? ?return 0;
> ?}
>
> @@ -205,19 +218,18 @@ pxa2xx_pcmcia_frequency_change(struct soc_pcmcia_socket *skt,
> ?static void pxa2xx_configure_sockets(struct device *dev)
> ?{
> ? ? ? ?struct pcmcia_low_level *ops = dev->platform_data;
> -
> ? ? ? ?/*
> ? ? ? ? * We have at least one socket, so set MECR:CIT
> ? ? ? ? * (Card Is There)
> ? ? ? ? */
> - ? ? ? MECR |= MECR_CIT;
> + ? ? ? uint32_t mecr = MECR_CIT;
>
> ? ? ? ?/* Set MECR:NOS (Number Of Sockets) */
> ? ? ? ?if ((ops->first + ops->nr) > 1 ||
> ? ? ? ? ? ?machine_is_viper() || machine_is_arcom_zeus())
> - ? ? ? ? ? ? ? MECR |= MECR_NOS;
> - ? ? ? else
> - ? ? ? ? ? ? ? MECR &= ~MECR_NOS;
> + ? ? ? ? ? ? ? mecr |= MECR_NOS;
> +
> + ? ? ? __raw_writel(mecr, MECR);
In original, it only wants MECR |= MECR_NOS. But now, it becomes MECR
= MECR_NOS. The meaning is changed.

> ?}
>
> ?static const char *skt_names[] = {
> @@ -272,14 +284,24 @@ static int pxa2xx_drv_pcmcia_probe(struct platform_device *dev)
> ? ? ? ?struct soc_pcmcia_socket *skt;
>
> ? ? ? ?ops = (struct pcmcia_low_level *)dev->dev.platform_data;
> - ? ? ? if (!ops)
> - ? ? ? ? ? ? ? return -ENODEV;
> + ? ? ? if (!ops) {
> + ? ? ? ? ? ? ? ret = -ENODEV;
> + ? ? ? ? ? ? ? goto err0;
> + ? ? ? }
> +
> + ? ? ? if (cpu_is_pxa320() && ops->nr > 1) {
> + ? ? ? ? ? ? ? dev_err(&dev->dev, "pxa320 supports only one pcmcia slot");
> + ? ? ? ? ? ? ? ret = -EINVAL;
> + ? ? ? ? ? ? ? goto err0;
> + ? ? ? }
>
> ? ? ? ?pxa2xx_drv_pcmcia_ops(ops);
>
> ? ? ? ?sinfo = kzalloc(SKT_DEV_INFO_SIZE(ops->nr), GFP_KERNEL);
> - ? ? ? if (!sinfo)
> - ? ? ? ? ? ? ? return -ENOMEM;
> + ? ? ? if (!sinfo) {
> + ? ? ? ? ? ? ? ret = -ENOMEM;
> + ? ? ? ? ? ? ? goto err0;
> + ? ? ? }
>
> ? ? ? ?sinfo->nskt = ops->nr;
>
> @@ -295,18 +317,19 @@ static int pxa2xx_drv_pcmcia_probe(struct platform_device *dev)
>
> ? ? ? ? ? ? ? ?ret = pxa2xx_drv_pcmcia_add_one(skt);
> ? ? ? ? ? ? ? ?if (ret)
> - ? ? ? ? ? ? ? ? ? ? ? break;
> + ? ? ? ? ? ? ? ? ? ? ? goto err1;
> ? ? ? ?}
>
> - ? ? ? if (ret) {
> - ? ? ? ? ? ? ? while (--i >= 0)
> - ? ? ? ? ? ? ? ? ? ? ? soc_pcmcia_remove_one(&sinfo->skt[i]);
> - ? ? ? ? ? ? ? kfree(sinfo);
> - ? ? ? } else {
> - ? ? ? ? ? ? ? pxa2xx_configure_sockets(&dev->dev);
> - ? ? ? ? ? ? ? dev_set_drvdata(&dev->dev, sinfo);
> - ? ? ? }
> + ? ? ? pxa2xx_configure_sockets(&dev->dev);
> + ? ? ? dev_set_drvdata(&dev->dev, sinfo);
>
> + ? ? ? return 0;
> +
> +err1:
> + ? ? ? while (--i >= 0)
> + ? ? ? ? ? ? ? soc_pcmcia_remove_one(&sinfo->skt[i]);
> + ? ? ? kfree(sinfo);
> +err0:
> ? ? ? ?return ret;
> ?}
>
> --
> 1.7.1
>
>