ARM: OMAP: Correct use of CONTROL_ regs for OMAP2

[linux-2.6-omap-h63xx.git] / arch / arm / plat-omap / devices.c

diff --git a/arch/arm/plat-omap/devices.c b/arch/arm/plat-omap/devices.c
index f8a341bdb9d624fc2cea026a2dbad3af9f87d4a6..c2828fe3dd7040e88999b909190ecf146b518ee0 100644 (file)
--- a/arch/arm/plat-omap/devices.c
+++ b/arch/arm/plat-omap/devices.c
@@ -141,7 +141,7 @@ static void omap_init_i2c(void)
         * either don't wire up I2C, or chips that mux it differently...
         * it can include clocking and address info, maybe more.
         */
-       if (cpu_is_omap24xx()) {
+       if (cpu_class_is_omap2()) {
                if (machine_is_omap_h4()) {
                        omap_cfg_reg(M19_24XX_I2C1_SCL);
                        omap_cfg_reg(L15_24XX_I2C1_SDA);
@@ -164,7 +164,7 @@ static inline void omap_init_i2c(void) {}
 static void omap_init_kp(void)
 {
        /* REVISIT: 2430 keypad is on TWL4030 */
-       if (cpu_is_omap2430())
+       if (cpu_is_omap2430() || cpu_is_omap34xx())
                return;
 
        if (machine_is_omap_h2() || machine_is_omap_h3()) {
@@ -295,7 +295,7 @@ static void __init omap_init_mmc(void)
        const struct omap_mmc_conf      *mmc;
 
        /* REVISIT: 2430 has HS MMC */
-       if (cpu_is_omap2430())
+       if (cpu_is_omap2430() || cpu_is_omap34xx())
                return;
 
        /* NOTE:  assumes MMC was never (wrongly) enabled */
@@ -339,6 +339,17 @@ static void __init omap_init_mmc(void)
                                omap_cfg_reg(MMC_DAT3);
                        }
                }
+               if (mmc->internal_clock) {
+                       /*
+                        * Use internal loop-back in MMC/SDIO
+                        * Module Input Clock selection
+                        */
+                       if (cpu_is_omap24xx()) {
+                               u32 v = omap_readl(OMAP2_CONTROL_DEVCONF);
+                               v |= (1 << 24);
+                               omap_writel(v, OMAP2_CONTROL_DEVCONF);
+                       }
+               }
                mmc1_conf = *mmc;
                (void) platform_device_register(&mmc_omap_device1);
        }
@@ -526,7 +537,7 @@ static int __init omap_init_devices(void)
        omap_init_uwire();
        omap_init_wdt();
        omap_init_rng();
-       if (!cpu_is_omap2430()) {
+       if (!cpu_is_omap2430() && !cpu_is_omap34xx()) {
                omap_init_i2c();
        }
        return 0;