Some controller such as the ARM AMBA pl181 can not handle more than 16bits
data length request.

Signed-off-by: Jean-Christophe PLAGNIOL-VILLARD <[email protected]>
---
 drivers/mci/mci-core.c | 32 ++++++++++++++++++++++++--------
 include/mci.h          |  1 +
 2 files changed, 25 insertions(+), 8 deletions(-)

diff --git a/drivers/mci/mci-core.c b/drivers/mci/mci-core.c
index 66ddb5b..3d040d7 100644
--- a/drivers/mci/mci-core.c
+++ b/drivers/mci/mci-core.c
@@ -1199,6 +1199,8 @@ static int __maybe_unused mci_sd_write(struct 
block_device *blk,
        struct mci *mci = part->mci;
        struct mci_host *host = mci->host;
        int rc;
+       unsigned max_req_block = mci->host->max_req_size / mci->read_bl_len;
+       int write_block;
 
        mci_blk_part_switch(part);
 
@@ -1222,10 +1224,16 @@ static int __maybe_unused mci_sd_write(struct 
block_device *blk,
                return -EINVAL;
        }
 
-       rc = mci_block_write(mci, buffer, block, num_blocks);
-       if (rc != 0) {
-               dev_dbg(&mci->dev, "Writing block %d failed with %d\n", block, 
rc);
-               return rc;
+       while (num_blocks) {
+               write_block = min_t(int, num_blocks, max_req_block);
+               rc = mci_block_write(mci, buffer, block, write_block);
+               if (rc != 0) {
+                       dev_dbg(&mci->dev, "Writing block %d failed with %d\n", 
block, rc);
+                       return rc;
+               }
+               num_blocks -= write_block;
+               block += write_block;
+               buffer += write_block * mci->write_bl_len;
        }
 
        return 0;
@@ -1246,6 +1254,8 @@ static int mci_sd_read(struct block_device *blk, void 
*buffer, int block,
 {
        struct mci_part *part = container_of(blk, struct mci_part, blk);
        struct mci *mci = part->mci;
+       unsigned max_req_block = mci->host->max_req_size / mci->read_bl_len;
+       int read_block;
        int rc;
 
        mci_blk_part_switch(part);
@@ -1264,10 +1274,16 @@ static int mci_sd_read(struct block_device *blk, void 
*buffer, int block,
                return -EINVAL;
        }
 
-       rc = mci_read_block(mci, buffer, block, num_blocks);
-       if (rc != 0) {
-               dev_dbg(&mci->dev, "Reading block %d failed with %d\n", block, 
rc);
-               return rc;
+       while (num_blocks) {
+               read_block = min_t(int, num_blocks, max_req_block);
+               rc = mci_read_block(mci, buffer, block, read_block);
+               if (rc != 0) {
+                       dev_dbg(&mci->dev, "Reading block %d failed with %d\n", 
block, rc);
+                       return rc;
+               }
+               num_blocks -= read_block;
+               block += read_block;
+               buffer += read_block * mci->read_bl_len;
        }
 
        return 0;
diff --git a/include/mci.h b/include/mci.h
index 1ca00c7..07ac273 100644
--- a/include/mci.h
+++ b/include/mci.h
@@ -293,6 +293,7 @@ struct mci_host {
        unsigned f_max;         /**< host interface upper limit */
        unsigned clock;         /**< Current clock used to talk to the card */
        unsigned bus_width;     /**< used data bus width to the card */
+       unsigned max_req_size;
 
        /** init the host interface */
        int (*init)(struct mci_host*, struct device_d*);
-- 
1.8.4.rc3


_______________________________________________
barebox mailing list
[email protected]
http://lists.infradead.org/mailman/listinfo/barebox

Reply via email to