mmc: omap_hsmmc: add cmd23 support

Add set block count command support for close ended multiblock read/write.

Signed-off-by: Balaji T K <balajitk@ti.com>
Signed-off-by: Chris Ball <chris@printf.net>

1 files changed, 17 insertions, 4 deletions

diff --git a/drivers/mmc/host/omap_hsmmc.c b/drivers/mmc/host/omap_hsmmc.c
index cdeca5e6fae4..476c6a632bfc 100644
--- a/drivers/mmc/host/omap_hsmmc.c
+++ b/drivers/mmc/host/omap_hsmmc.c
@@ -202,6 +202,8 @@ struct omap_mmc_of_data {
         u8 controller_flags;
 };
 
+static void omap_hsmmc_start_dma_transfer(struct omap_hsmmc_host *host);
+
 static int omap_hsmmc_card_detect(struct device *dev, int slot)
 {
         struct omap_hsmmc_host *host = dev_get_drvdata(dev);
@@ -888,11 +890,10 @@ omap_hsmmc_xfer_done(struct omap_hsmmc_host *host, struct mmc_data *data)
         else
                 data->bytes_xfered = 0;
 
-        if (!data->stop) {
+        if (data->stop && (data->error || !host->mrq->sbc))
+                omap_hsmmc_start_command(host, data->stop, NULL);
+        else
                 omap_hsmmc_request_done(host, data->mrq);
-                return;
-        }
-        omap_hsmmc_start_command(host, data->stop, NULL);
 }
 
 /*
@@ -903,6 +904,14 @@ omap_hsmmc_cmd_done(struct omap_hsmmc_host *host, struct mmc_command *cmd)
 {
         host->cmd = NULL;
 
+        if (host->mrq->sbc && (host->cmd == host->mrq->sbc) &&
+            !host->mrq->sbc->error) {
+                omap_hsmmc_start_dma_transfer(host);
+                omap_hsmmc_start_command(host, host->mrq->cmd,
+                                                host->mrq->data);
+                return;
+        }
+
         if (cmd->flags & MMC_RSP_PRESENT) {
                 if (cmd->flags & MMC_RSP_136) {
                         /* response type 2 */
@@ -1504,6 +1513,10 @@ static void omap_hsmmc_request(struct mmc_host *mmc, struct mmc_request *req)
                 mmc_request_done(mmc, req);
                 return;
         }
+        if (req->sbc) {
+                omap_hsmmc_start_command(host, req->sbc, NULL);
+                return;
+        }
 
         omap_hsmmc_start_dma_transfer(host);
         omap_hsmmc_start_command(host, req->cmd, req->data);