1 files changed, 28 insertions, 4 deletions

diff --git a/drivers/mmc/core/sdio_ops.c b/drivers/mmc/core/sdio_ops.c
index d29e20630eed..62508b457c4f 100644
--- a/drivers/mmc/core/sdio_ops.c
+++ b/drivers/mmc/core/sdio_ops.c
@@ -124,7 +124,10 @@ int mmc_io_rw_extended(struct mmc_card *card, int write, unsigned fn,
         struct mmc_request mrq = {NULL};
         struct mmc_command cmd = {0};
         struct mmc_data data = {0};
-        struct scatterlist sg;
+        struct scatterlist sg, *sg_ptr;
+        struct sg_table sgtable;
+        unsigned int nents, left_size, i;
+        unsigned int seg_size = card->host->max_seg_size;
 
         BUG_ON(!card);
         BUG_ON(fn > 7);
@@ -152,15 +155,36 @@ int mmc_io_rw_extended(struct mmc_card *card, int write, unsigned fn,
         /* Code in host drivers/fwk assumes that "blocks" always is >=1 */
         data.blocks = blocks ? blocks : 1;
         data.flags = write ? MMC_DATA_WRITE : MMC_DATA_READ;
-        data.sg = &sg;
-        data.sg_len = 1;
 
-        sg_init_one(&sg, buf, data.blksz * data.blocks);
+        left_size = data.blksz * data.blocks;
+        nents = (left_size - 1) / seg_size + 1;
+        if (nents > 1) {
+                if (sg_alloc_table(&sgtable, nents, GFP_KERNEL))
+                        return -ENOMEM;
+
+                data.sg = sgtable.sgl;
+                data.sg_len = nents;
+
+                for_each_sg(data.sg, sg_ptr, data.sg_len, i) {
+                        sg_set_page(sg_ptr, virt_to_page(buf + (i * seg_size)),
+                                        min(seg_size, left_size),
+                                        offset_in_page(buf + (i * seg_size)));
+                        left_size = left_size - seg_size;
+                }
+        } else {
+                data.sg = &sg;
+                data.sg_len = 1;
+
+                sg_init_one(&sg, buf, left_size);
+        }
 
         mmc_set_data_timeout(&data, card);
 
         mmc_wait_for_req(card->host, &mrq);
 
+        if (nents > 1)
+                sg_free_table(&sgtable);
+
         if (cmd.error)
                 return cmd.error;
         if (data.error)