1 files changed, 3 insertions, 7 deletions

diff --git a/arch/arm/mach-lpc32xx/clock.c b/arch/arm/mach-lpc32xx/clock.c
index eb1b12092951..b64f98537b5d 100644
--- a/arch/arm/mach-lpc32xx/clock.c
+++ b/arch/arm/mach-lpc32xx/clock.c
@@ -871,7 +871,7 @@ static unsigned long mmc_round_rate(struct clk *clk, unsigned long rate)
 
 static int mmc_set_rate(struct clk *clk, unsigned long rate)
 {
-        u32 oldclk, tmp;
+        u32 tmp;
         unsigned long prate, div, crate = mmc_round_rate(clk, rate);
 
         prate = clk->parent->get_rate(clk->parent);
@@ -879,16 +879,12 @@ static int mmc_set_rate(struct clk *clk, unsigned long rate)
         div = prate / crate;
 
         /* The MMC clock must be on when accessing an MMC register */
-        oldclk = __raw_readl(LPC32XX_CLKPWR_MS_CTRL);
-        __raw_writel(oldclk | LPC32XX_CLKPWR_MSCARD_SDCARD_EN,
-                LPC32XX_CLKPWR_MS_CTRL);
         tmp = __raw_readl(LPC32XX_CLKPWR_MS_CTRL) &
                 ~LPC32XX_CLKPWR_MSCARD_SDCARD_DIV(0xf);
-        tmp |= LPC32XX_CLKPWR_MSCARD_SDCARD_DIV(div);
+        tmp |= LPC32XX_CLKPWR_MSCARD_SDCARD_DIV(div) |
+                LPC32XX_CLKPWR_MSCARD_SDCARD_EN;
         __raw_writel(tmp, LPC32XX_CLKPWR_MS_CTRL);
 
-        __raw_writel(oldclk, LPC32XX_CLKPWR_MS_CTRL);
-
         return 0;
 }