mmc: subtract boot sectors from disk size for eMMC 4.3+ devices

[firefly-linux-kernel-4.4.55.git] / drivers / mmc / core / mmc.c

diff --git a/drivers/mmc/core/mmc.c b/drivers/mmc/core/mmc.c
index 6909a54c39beac1a8ca277f317f43c4a4ea9d583..45055c46d954957be5a49196c80be2b21ae6c7a3 100644 (file)
--- a/drivers/mmc/core/mmc.c
+++ b/drivers/mmc/core/mmc.c
@@ -253,8 +253,13 @@ static int mmc_read_ext_csd(struct mmc_card *card)
                        ext_csd[EXT_CSD_SEC_CNT + 3] << 24;
 
                /* Cards with density > 2GiB are sector addressed */
-               if (card->ext_csd.sectors > (2u * 1024 * 1024 * 1024) / 512)
+               if (card->ext_csd.sectors > (2u * 1024 * 1024 * 1024) / 512) {
+                       unsigned boot_sectors;
+                       /* size is in 256K chunks, i.e. 512 sectors each */
+                       boot_sectors = ext_csd[EXT_CSD_BOOT_SIZE_MULTI] * 512;
+                       card->ext_csd.sectors -= boot_sectors;
                        mmc_card_set_blockaddr(card);
+               }
        }
 
        switch (ext_csd[EXT_CSD_CARD_TYPE] & EXT_CSD_CARD_TYPE_MASK) {