MMC: OMAP: Fix timeout calculation for MMC multislot support

Fix the data timeout calculation for MMC multislot support.

Signed-off-by: Juha Yrjola <juha.yrjola@solidboot.com>
Signed-off-by: Jarkko Lavinen <jarkko.lavinen@nokia.com>
Signed-off-by: Carlos Eduardo Aguiar <carlos.aguiar@indt.org.br>
Signed-off-by: Tony Lindgren <tony@atomide.com>
Signed-off-by: Pierre Ossman <drzeus@drzeus.cx>

1 files changed, 4 insertions, 5 deletions

diff --git a/drivers/mmc/host/omap.c b/drivers/mmc/host/omap.c
index 90e9d68e7998..0d3cd3c23f8f 100644
--- a/drivers/mmc/host/omap.c
+++ b/drivers/mmc/host/omap.c
@@ -861,13 +861,12 @@ static inline void set_cmd_timeout(struct mmc_omap_host *host, struct mmc_reques
 
 static inline void set_data_timeout(struct mmc_omap_host *host, struct mmc_request *req)
 {
-        int timeout;
+        unsigned int timeout, cycle_ns;
         u16 reg;
 
-        /* Convert ns to clock cycles by assuming 20MHz frequency
-         * 1 cycle at 20MHz = 500 ns
-         */
-        timeout = req->data->timeout_clks + req->data->timeout_ns / 500;
+        cycle_ns = 1000000000 / host->current_slot->fclk_freq;
+        timeout = req->data->timeout_ns / cycle_ns;
+        timeout += req->data->timeout_clks;
 
         /* Check if we need to use timeout multiplier register */
         reg = OMAP_MMC_READ(host, SDIO);