From: Rui Feng <rui_f...@realsil.com.cn>

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

Signed-off-by: Rui Feng <rui_f...@realsil.com.cn>
---
 drivers/misc/cardreader/rts5261.c | 8 ++++++++
 drivers/misc/cardreader/rts5261.h | 2 ++
 2 files changed, 10 insertions(+)

diff --git a/drivers/misc/cardreader/rts5261.c 
b/drivers/misc/cardreader/rts5261.c
index b299e472e87b..ce65c5703453 100644
--- 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 2e47c798607b..2344c560a637 100644
--- 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
-- 
2.17.1

Reply via email to