mmc: core: Read the SD function extension registers for power management

In the SD spec v4.0 the CMD48/49 and CMD58/59 were introduced as optional
commands. In the SD spec v4.1 the SD function extension registers were
introduced, which requires support for CMD48/49/58/59 to be read/written
from/to.

Moreover, a specific function extension register were added to let the card
announce support for optional features in regards to power management. The
features that were added are "Power Off Notification", "Power Down Mode"
and "Power Sustenance".

As a first step to support this, let's read and parse the register for
power management during the SD card initialization and store the
information about the supported features in the struct mmc_card. In this
way, we prepare for subsequent changes to implement the complete support
for the new features.

Signed-off-by: Ulf Hansson <ulf.hansson@linaro.org>
Reviewed-by: Linus Walleij <linus.walleij@linaro.org>
Reviewed-by: Shawn Lin <shawn.lin@rock-chips.com>
Acked-by: Avri Altman <avri.altman@wdc.com>
Link: https://lore.kernel.org/r/20210504161222.101536-10-ulf.hansson@linaro.org

diff --git a/drivers/mmc/core/sd.c b/drivers/mmc/core/sd.c
index de7b5f8..2e687f1 100644 (file)
--- a/drivers/mmc/core/sd.c
+++ b/drivers/mmc/core/sd.c
@@ -996,6 +996,177 @@ static bool mmc_sd_card_using_v18(struct mmc_card *card)
               (SD_MODE_UHS_SDR50 | SD_MODE_UHS_SDR104 | SD_MODE_UHS_DDR50);
 }
 
+static int sd_read_ext_reg(struct mmc_card *card, u8 fno, u8 page,
+                          u16 offset, u16 len, u8 *reg_buf)
+{
+       u32 cmd_args;
+
+       /*
+        * Command arguments of CMD48:
+        * [31:31] MIO (0 = memory).
+        * [30:27] FNO (function number).
+        * [26:26] reserved (0).
+        * [25:18] page number.
+        * [17:9] offset address.
+        * [8:0] length (0 = 1 byte, 1ff = 512 bytes).
+        */
+       cmd_args = fno << 27 | page << 18 | offset << 9 | (len -1);
+
+       return mmc_send_adtc_data(card, card->host, SD_READ_EXTR_SINGLE,
+                                 cmd_args, reg_buf, 512);
+}
+
+static int sd_parse_ext_reg_power(struct mmc_card *card, u8 fno, u8 page,
+                                 u16 offset)
+{
+       int err;
+       u8 *reg_buf;
+
+       reg_buf = kzalloc(512, GFP_KERNEL);
+       if (!reg_buf)
+               return -ENOMEM;
+
+       /* Read the extension register for power management function. */
+       err = sd_read_ext_reg(card, fno, page, offset, 512, reg_buf);
+       if (err) {
+               pr_warn("%s: error %d reading PM func of ext reg\n",
+                       mmc_hostname(card->host), err);
+               goto out;
+       }
+
+       /* PM revision consists of 4 bits. */
+       card->ext_power.rev = reg_buf[0] & 0xf;
+
+       /* Power Off Notification support at bit 4. */
+       if (reg_buf[1] & BIT(4))
+               card->ext_power.feature_support |= SD_EXT_POWER_OFF_NOTIFY;
+
+       /* Power Sustenance support at bit 5. */
+       if (reg_buf[1] & BIT(5))
+               card->ext_power.feature_support |= SD_EXT_POWER_SUSTENANCE;
+
+       /* Power Down Mode support at bit 6. */
+       if (reg_buf[1] & BIT(6))
+               card->ext_power.feature_support |= SD_EXT_POWER_DOWN_MODE;
+
+       card->ext_power.fno = fno;
+       card->ext_power.page = page;
+       card->ext_power.offset = offset;
+
+out:
+       kfree(reg_buf);
+       return err;
+}
+
+static int sd_parse_ext_reg(struct mmc_card *card, u8 *gen_info_buf,
+                           u16 *next_ext_addr)
+{
+       u8 num_regs, fno, page;
+       u16 sfc, offset, ext = *next_ext_addr;
+       u32 reg_addr;
+
+       /*
+        * Parse only one register set per extension, as that is sufficient to
+        * support the standard functions. This means another 48 bytes in the
+        * buffer must be available.
+        */
+       if (ext + 48 > 512)
+               return -EFAULT;
+
+       /* Standard Function Code */
+       memcpy(&sfc, &gen_info_buf[ext], 2);
+
+       /* Address to the next extension. */
+       memcpy(next_ext_addr, &gen_info_buf[ext + 40], 2);
+
+       /* Number of registers for this extension. */
+       num_regs = gen_info_buf[ext + 42];
+
+       /* We support only one register per extension. */
+       if (num_regs != 1)
+               return 0;
+
+       /* Extension register address. */
+       memcpy(&reg_addr, &gen_info_buf[ext + 44], 4);
+
+       /* 9 bits (0 to 8) contains the offset address. */
+       offset = reg_addr & 0x1ff;
+
+       /* 8 bits (9 to 16) contains the page number. */
+       page = reg_addr >> 9 & 0xff ;
+
+       /* 4 bits (18 to 21) contains the function number. */
+       fno = reg_addr >> 18 & 0xf;
+
+       /* Standard Function Code for power management. */
+       if (sfc == 0x1)
+               return sd_parse_ext_reg_power(card, fno, page, offset);
+
+       return 0;
+}
+
+static int sd_read_ext_regs(struct mmc_card *card)
+{
+       int err, i;
+       u8 num_ext, *gen_info_buf;
+       u16 rev, len, next_ext_addr;
+
+       if (mmc_host_is_spi(card->host))
+               return 0;
+
+       if (!(card->scr.cmds & SD_SCR_CMD48_SUPPORT))
+               return 0;
+
+       gen_info_buf = kzalloc(512, GFP_KERNEL);
+       if (!gen_info_buf)
+               return -ENOMEM;
+
+       /*
+        * Read 512 bytes of general info, which is found at function number 0,
+        * at page 0 and with no offset.
+        */
+       err = sd_read_ext_reg(card, 0, 0, 0, 512, gen_info_buf);
+       if (err) {
+               pr_warn("%s: error %d reading general info of SD ext reg\n",
+                       mmc_hostname(card->host), err);
+               goto out;
+       }
+
+       /* General info structure revision. */
+       memcpy(&rev, &gen_info_buf[0], 2);
+
+       /* Length of general info in bytes. */
+       memcpy(&len, &gen_info_buf[2], 2);
+
+       /* Number of extensions to be find. */
+       num_ext = gen_info_buf[4];
+
+       /* We support revision 0, but limit it to 512 bytes for simplicity. */
+       if (rev != 0 || len > 512) {
+               pr_warn("%s: non-supported SD ext reg layout\n",
+                       mmc_hostname(card->host));
+               goto out;
+       }
+
+       /*
+        * Parse the extension registers. The first extension should start
+        * immediately after the general info header (16 bytes).
+        */
+       next_ext_addr = 16;
+       for (i = 0; i < num_ext; i++) {
+               err = sd_parse_ext_reg(card, gen_info_buf, &next_ext_addr);
+               if (err) {
+                       pr_warn("%s: error %d parsing SD ext reg\n",
+                               mmc_hostname(card->host), err);
+                       goto out;
+               }
+       }
+
+out:
+       kfree(gen_info_buf);
+       return err;
+}
+
 /*
  * Handle the detection and initialisation of a card.
  *
@@ -1144,6 +1315,13 @@ retry:
                }
        }
 
+       if (!oldcard) {
+               /* Read/parse the extension registers. */
+               err = sd_read_ext_regs(card);
+               if (err)
+                       goto free_card;
+       }
+
        if (host->cqe_ops && !host->cqe_enabled) {
                err = host->cqe_ops->cqe_enable(host, card);
                if (!err) {

diff --git a/include/linux/mmc/card.h b/include/linux/mmc/card.h
index 858fc4d..03a862e 100644 (file)
--- a/include/linux/mmc/card.h
+++ b/include/linux/mmc/card.h
@@ -191,6 +191,18 @@ struct sd_switch_caps {
 #define SD_MAX_CURRENT_800     (1 << SD_SET_CURRENT_LIMIT_800)
 };
 
+struct sd_ext_reg {
+       u8                      fno;
+       u8                      page;
+       u16                     offset;
+       u8                      rev;
+       u8                      feature_support;
+/* Power Management Function. */
+#define SD_EXT_POWER_OFF_NOTIFY        (1<<0)
+#define SD_EXT_POWER_SUSTENANCE        (1<<1)
+#define SD_EXT_POWER_DOWN_MODE (1<<2)
+};
+
 struct sdio_cccr {
        unsigned int            sdio_vsn;
        unsigned int            sd_vsn;
@@ -292,6 +304,7 @@ struct mmc_card {
        struct sd_scr           scr;            /* extra SD information */
        struct sd_ssr           ssr;            /* yet more SD information */
        struct sd_switch_caps   sw_caps;        /* switch (CMD6) caps */
+       struct sd_ext_reg       ext_power;      /* SD extension reg for PM */
 
        unsigned int            sdio_funcs;     /* number of SDIO functions */
        atomic_t                sdio_funcs_probed; /* number of probed SDIO funcs */

diff --git a/include/linux/mmc/sd.h b/include/linux/mmc/sd.h
index 2236aa5..43bfc5c 100644 (file)
--- a/include/linux/mmc/sd.h
+++ b/include/linux/mmc/sd.h
@@ -29,6 +29,9 @@
 #define SD_APP_OP_COND           41   /* bcr  [31:0] OCR         R3  */
 #define SD_APP_SEND_SCR          51   /* adtc                    R1  */
 
+  /* class 11 */
+#define SD_READ_EXTR_SINGLE      48   /* adtc [31:0]             R1  */
+
 /* OCR bit definitions */
 #define SD_OCR_S18R            (1 << 24)    /* 1.8V switching request */
 #define SD_ROCR_S18A           SD_OCR_S18R  /* 1.8V switching accepted by card */