misc: rtsx: Check mmc support for RTS5261

This patch check mmc support when RTS5261 initialize,
and not support mmc default.

Signed-off-by: Rui Feng <rui_feng@realsil.com.cn>
Acked-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
Link: https://lore.kernel.org/r/1604397298-2921-1-git-send-email-rui_feng@realsil.com.cn
Signed-off-by: Ulf Hansson <ulf.hansson@linaro.org>

diff --git a/drivers/misc/cardreader/rts5261.c b/drivers/misc/cardreader/rts5261.c
index b299e47..ce65c57 100644 (file)
--- a/drivers/misc/cardreader/rts5261.c
+++ b/drivers/misc/cardreader/rts5261.c
@@ -67,10 +67,18 @@ static void rtsx5261_fetch_vendor_settings(struct rtsx_pcr *pcr)
        pcr_dbg(pcr, "Cfg 0x%x: 0x%x\n", PCR_SETTING_REG2, reg);
 
        if (!rts5261_vendor_setting_valid(reg)) {
+               /* Not support MMC default */
+               pcr->extra_caps |= EXTRA_CAPS_NO_MMC;
                pcr_dbg(pcr, "skip fetch vendor setting\n");
                return;
        }
 
+       if (!rts5261_reg_check_mmc_support(reg))
+               pcr->extra_caps |= EXTRA_CAPS_NO_MMC;
+
+       /* TO do: need to add rtd3 function */
+       pcr->rtd3_en = rts5261_reg_to_rtd3(reg);
+
        if (rts5261_reg_check_reverse_socket(reg))
                pcr->flags |= PCR_REVERSE_SOCKET;
 

diff --git a/drivers/misc/cardreader/rts5261.h b/drivers/misc/cardreader/rts5261.h
index 2e47c79..2344c56 100644 (file)
--- a/drivers/misc/cardreader/rts5261.h
+++ b/drivers/misc/cardreader/rts5261.h
@@ -17,6 +17,8 @@
 #define rts5261_reg_check_reverse_socket(reg)  ((reg) & 0x04)
 #define rts5261_reg_to_sd30_drive_sel_1v8(reg) (((reg) >> 22) & 0x03)
 #define rts5261_reg_to_sd30_drive_sel_3v3(reg) (((reg) >> 16) & 0x03)
+#define rts5261_reg_to_rtd3(reg)               ((reg) & 0x08)
+#define rts5261_reg_check_mmc_support(reg)     ((reg) & 0x10)
 
 #define RTS5261_AUTOLOAD_CFG0          0xFF7B
 #define RTS5261_AUTOLOAD_CFG1          0xFF7C