+ LOG_ERR("sd not ready.\n");
+ }
+
+ return -1;
+}
+
+
+int sd_getCid(Sd *sd, uint32_t addr, uint8_t flag)
+{
+ ASSERT(sd);
+ memset(&(sd->cid), 0, sizeof(SDcid));
+
+ uint8_t idx = 9; // CMD9 get cid from gived sd address (RCA)
+ if (flag & SD_SEND_ALL_CID)
+ idx = 2;
+
+
+ if (hsmci_sendCmd(idx, SD_ADDR_TO_RCA(addr), HSMCI_CMDR_RSPTYP_136_BIT))
+ {
+ LOG_ERR("GET_CID %lx\n", HSMCI_SR);
+ return -1;
+ }
+ else
+ {
+ uint32_t resp[4];
+ hsmci_readResp(resp, 4);
+ LOG_INFOB(dump("CID", resp, 4););
+
+ sd->cid.manfid = UNSTUFF_BITS(resp, 120, 8);
+ sd->cid.oemid = UNSTUFF_BITS(resp, 104, 16);
+ sd->cid.prod_name[0] = UNSTUFF_BITS(resp, 96, 8);
+ sd->cid.prod_name[1] = UNSTUFF_BITS(resp, 88, 8);
+ sd->cid.prod_name[2] = UNSTUFF_BITS(resp, 80, 8);
+ sd->cid.prod_name[3] = UNSTUFF_BITS(resp, 72, 8);
+ sd->cid.prod_name[4] = UNSTUFF_BITS(resp, 64, 8);
+ sd->cid.m_rev = UNSTUFF_BITS(resp, 60, 4);
+ sd->cid.l_rev = UNSTUFF_BITS(resp, 56, 4);
+ sd->cid.serial = (uint32_t)UNSTUFF_BITS(resp, 24, 32);
+ sd->cid.year_off = UNSTUFF_BITS(resp, 8, 12);
+ }
+
+ return 0;
+}
+
+int sd_getCsd(Sd *sd)
+{
+ ASSERT(sd);
+ memset(&(sd->csd), 0, sizeof(SDcsd));
+
+ LOG_INFO("Send to RCA: %lx\n", SD_ADDR_TO_RCA(sd->addr));
+ if (hsmci_sendCmd(9, SD_ADDR_TO_RCA(sd->addr), HSMCI_CMDR_RSPTYP_136_BIT))
+ {
+ LOG_ERR("GET_CSD %lx\n", HSMCI_SR);
+ return -1;
+ }
+ else
+ {
+ uint32_t resp[4];
+ hsmci_readResp(resp, 4);
+ LOG_INFOB(dump("CSD", resp, 4););
+ sd_decodeCsd(&(sd->csd), resp, 4);
+ }
+
+ return 0;
+}
+
+int sd_getRelativeAddr(Sd *sd)
+{
+ ASSERT(sd);
+ if (hsmci_sendCmd(3, 0, HSMCI_CMDR_RSPTYP_48_BIT))
+ {
+ LOG_ERR("RCA: %lx\n", HSMCI_SR);
+ return -1;
+ }
+
+ hsmci_readResp(&sd->addr, 1);
+ sd->addr = sd->addr >> 16;
+
+ LOG_INFOB(dump("RCA", &sd->addr, 1););
+
+ return 0;
+}
+
+#define SD_STATUS_APP_CMD BV(5)
+#define SD_STATUS_READY BV(8)
+#define SD_STATUS_CURR_MASK 0x1E00
+#define SD_STATUS_CURR_SHIFT 9
+
+#define SD_GET_STATE(status) (uint8_t)(((status) & SD_STATUS_CURR_MASK) >> SD_STATUS_CURR_SHIFT)
+
+int sd_appStatus(Sd *sd)
+{
+ ASSERT(sd);
+ LOG_INFO("Send to RCA: %lx\n", SD_ADDR_TO_RCA(sd->addr));
+ if (hsmci_sendCmd(13, SD_ADDR_TO_RCA(sd->addr), HSMCI_CMDR_RSPTYP_48_BIT))
+ {
+ LOG_ERR("STATUS: %lx\n", HSMCI_SR);
+ return -1;
+ }
+
+ hsmci_readResp(&(sd->status), 1);
+ LOG_INFOB(dump("STATUS", &(sd->status), 1););
+
+ LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
+
+ if (sd->status & SD_STATUS_READY)
+ return 0;
+
+ return -1;
+}
+
+
+INLINE int sd_cardSelection(Sd *sd, size_t rca)
+{
+ ASSERT(sd);
+ LOG_INFO("Select RCA: %lx\n", SD_ADDR_TO_RCA(sd->addr));
+ if (hsmci_sendCmd(7, rca, HSMCI_CMDR_RSPTYP_R1B))
+ {
+ LOG_ERR("SELECT_SD: %lx\n", HSMCI_SR);
+ return -1;
+ }
+
+ HSMCI_CHECK_BUSY();
+ hsmci_readResp(&(sd->status), 1);
+ LOG_INFOB(dump("SELECT_SD", &(sd->status), 1););
+
+ LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
+
+ if (sd->status & SD_STATUS_READY)
+ return 0;
+
+ return -1;
+}
+
+int sd_selectCard(Sd *sd)
+{
+ return sd_cardSelection(sd, SD_ADDR_TO_RCA(sd->addr));
+}
+
+int sd_deSelectCard(Sd *sd)
+{
+ uint32_t rca = 0;
+ if (!sd->addr)
+ rca = SD_ADDR_TO_RCA(sd->addr + 1);
+
+ return sd_cardSelection(sd, rca);
+}
+
+
+int sd_setBusWidth(Sd *sd, size_t len)
+{
+ ASSERT(sd);
+
+ if (hsmci_sendCmd(55, SD_ADDR_TO_RCA(sd->addr), HSMCI_CMDR_RSPTYP_48_BIT))
+ {
+ LOG_ERR("APP_CMD %lx\n", HSMCI_SR);
+ return -1;
+ }
+
+ uint32_t status = HSMCI_RSPR;
+ if (status & (SD_STATUS_APP_CMD | SD_STATUS_READY))
+ {
+ hsmci_setBusWidth(len);
+
+ uint8_t arg = 0;
+ if (len == 4)
+ arg = 2;
+
+ if (hsmci_sendCmd(6, arg, HSMCI_CMDR_RSPTYP_48_BIT))