sdmmc_cmd.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571
  1. /*
  2. * Copyright (c) 2006 Uwe Stuehler <uwe@openbsd.org>
  3. * Adaptations to ESP-IDF Copyright (c) 2016 Espressif Systems (Shanghai) PTE LTD
  4. *
  5. * Permission to use, copy, modify, and distribute this software for any
  6. * purpose with or without fee is hereby granted, provided that the above
  7. * copyright notice and this permission notice appear in all copies.
  8. *
  9. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  10. * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  11. * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  12. * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  13. * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  14. * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  15. * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  16. */
  17. #include <string.h>
  18. #include "esp_log.h"
  19. #include "esp_heap_alloc_caps.h"
  20. #include "freertos/FreeRTOS.h"
  21. #include "freertos/task.h"
  22. #include "driver/sdmmc_defs.h"
  23. #include "driver/sdmmc_types.h"
  24. #include "sdmmc_cmd.h"
  25. #define MIN(a,b) (((a)<(b))?(a):(b))
  26. static const char* TAG = "sdmmc_cmd";
  27. static esp_err_t sdmmc_send_cmd(sdmmc_card_t* card, sdmmc_command_t* cmd);
  28. static esp_err_t sdmmc_send_app_cmd(sdmmc_card_t* card, sdmmc_command_t* cmd);
  29. static esp_err_t sdmmc_send_cmd_go_idle_state(sdmmc_card_t* card);
  30. static esp_err_t sdmmc_send_cmd_send_if_cond(sdmmc_card_t* card, uint32_t ocr);
  31. static esp_err_t sdmmc_send_cmd_send_op_cond(sdmmc_card_t* card, uint32_t ocr, uint32_t *ocrp);
  32. static esp_err_t sdmmc_decode_cid(sdmmc_response_t resp, sdmmc_cid_t* out_cid);
  33. static esp_err_t sddmc_send_cmd_all_send_cid(sdmmc_card_t* card, sdmmc_cid_t* out_cid);
  34. static esp_err_t sdmmc_send_cmd_set_relative_addr(sdmmc_card_t* card, uint16_t* out_rca);
  35. static esp_err_t sdmmc_send_cmd_set_blocklen(sdmmc_card_t* card, sdmmc_csd_t* csd);
  36. static esp_err_t sdmmc_decode_csd(sdmmc_response_t response, sdmmc_csd_t* out_csd);
  37. static esp_err_t sdmmc_send_cmd_send_csd(sdmmc_card_t* card, sdmmc_csd_t* out_csd);
  38. static esp_err_t sdmmc_send_cmd_select_card(sdmmc_card_t* card);
  39. static esp_err_t sdmmc_decode_scr(uint32_t *raw_scr, sdmmc_scr_t* out_scr);
  40. static esp_err_t sdmmc_send_cmd_send_scr(sdmmc_card_t* card, sdmmc_scr_t *out_scr);
  41. static esp_err_t sdmmc_send_cmd_set_bus_width(sdmmc_card_t* card, int width);
  42. static esp_err_t sdmmc_send_cmd_stop_transmission(sdmmc_card_t* card, uint32_t* status);
  43. static esp_err_t sdmmc_send_cmd_send_status(sdmmc_card_t* card, uint32_t* out_status);
  44. static uint32_t get_host_ocr(float voltage);
  45. esp_err_t sdmmc_card_init(const sdmmc_host_t* config,
  46. sdmmc_card_t* card)
  47. {
  48. ESP_LOGD(TAG, "%s", __func__);
  49. memset(card, 0, sizeof(*card));
  50. memcpy(&card->host, config, sizeof(*config));
  51. esp_err_t err = sdmmc_send_cmd_go_idle_state(card);
  52. if (err != ESP_OK) {
  53. ESP_LOGE(TAG, "%s: go_idle_state (1) returned 0x%x", __func__, err);
  54. return err;
  55. }
  56. ets_delay_us(10000);
  57. uint32_t host_ocr = get_host_ocr(config->io_voltage);
  58. err = sdmmc_send_cmd_send_if_cond(card, host_ocr);
  59. if (err == ESP_OK) {
  60. ESP_LOGD(TAG, "SDHC/SDXC card");
  61. host_ocr |= SD_OCR_SDHC_CAP;
  62. } else if (err == ESP_ERR_TIMEOUT) {
  63. ESP_LOGD(TAG, "CMD8 timeout; not an SDHC/SDXC card");
  64. } else {
  65. ESP_LOGE(TAG, "%s: send_if_cond (1) returned 0x%x", __func__, err);
  66. return err;
  67. }
  68. err = sdmmc_send_cmd_send_op_cond(card, host_ocr, &card->ocr);
  69. if (err != ESP_OK) {
  70. ESP_LOGE(TAG, "%s: send_op_cond (1) returned 0x%x", __func__, err);
  71. return err;
  72. }
  73. host_ocr &= card->ocr;
  74. ESP_LOGD(TAG, "sdmmc_card_init: host_ocr=%08x, card_ocr=%08x", host_ocr, card->ocr);
  75. err = sddmc_send_cmd_all_send_cid(card, &card->cid);
  76. if (err != ESP_OK) {
  77. ESP_LOGE(TAG, "%s: all_send_cid returned 0x%x", __func__, err);
  78. return err;
  79. }
  80. err = sdmmc_send_cmd_set_relative_addr(card, &card->rca);
  81. if (err != ESP_OK) {
  82. ESP_LOGE(TAG, "%s: set_relative_addr returned 0x%x", __func__, err);
  83. return err;
  84. }
  85. err = sdmmc_send_cmd_send_csd(card, &card->csd);
  86. if (err != ESP_OK) {
  87. ESP_LOGE(TAG, "%s: send_csd returned 0x%x", __func__, err);
  88. return err;
  89. }
  90. const size_t max_sdsc_capacity = UINT32_MAX / card->csd.sector_size + 1;
  91. if (!(card->ocr & SD_OCR_SDHC_CAP) &&
  92. card->csd.capacity > max_sdsc_capacity) {
  93. ESP_LOGW(TAG, "%s: SDSC card reports capacity=%u. Limiting to %u.",
  94. __func__, card->csd.capacity, max_sdsc_capacity);
  95. card->csd.capacity = max_sdsc_capacity;
  96. }
  97. err = sdmmc_send_cmd_select_card(card);
  98. if (err != ESP_OK) {
  99. ESP_LOGE(TAG, "%s: select_card returned 0x%x", __func__, err);
  100. return err;
  101. }
  102. if ((card->ocr & SD_OCR_SDHC_CAP) == 0) {
  103. err = sdmmc_send_cmd_set_blocklen(card, &card->csd);
  104. if (err != ESP_OK) {
  105. ESP_LOGE(TAG, "%s: set_blocklen returned 0x%x", __func__, err);
  106. return err;
  107. }
  108. }
  109. err = sdmmc_send_cmd_send_scr(card, &card->scr);
  110. if (err != ESP_OK) {
  111. ESP_LOGE(TAG, "%s: send_scr returned 0x%x", __func__, err);
  112. return err;
  113. }
  114. if ((config->flags & SDMMC_HOST_FLAG_4BIT) &&
  115. (card->scr.bus_width & SCR_SD_BUS_WIDTHS_4BIT)) {
  116. ESP_LOGD(TAG, "switching to 4-bit bus mode");
  117. err = sdmmc_send_cmd_set_bus_width(card, 4);
  118. if (err != ESP_OK) {
  119. ESP_LOGE(TAG, "set_bus_width failed");
  120. return err;
  121. }
  122. err = (*config->set_bus_width)(config->slot, 4);
  123. if (err != ESP_OK) {
  124. ESP_LOGE(TAG, "slot->set_bus_width failed");
  125. return err;
  126. }
  127. uint32_t status;
  128. err = sdmmc_send_cmd_stop_transmission(card, &status);
  129. if (err != ESP_OK) {
  130. ESP_LOGE(TAG, "stop_transmission failed (0x%x)", err);
  131. return err;
  132. }
  133. }
  134. uint32_t status = 0;
  135. while (!(status & MMC_R1_READY_FOR_DATA)) {
  136. // TODO: add some timeout here
  137. uint32_t count = 0;
  138. err = sdmmc_send_cmd_send_status(card, &status);
  139. if (err != ESP_OK) {
  140. return err;
  141. }
  142. if (++count % 10 == 0) {
  143. ESP_LOGV(TAG, "waiting for card to become ready (%d)", count);
  144. }
  145. }
  146. if (config->max_freq_khz >= SDMMC_FREQ_HIGHSPEED &&
  147. card->csd.tr_speed / 1000 >= SDMMC_FREQ_HIGHSPEED) {
  148. ESP_LOGD(TAG, "switching to HS bus mode");
  149. err = (*config->set_card_clk)(config->slot, SDMMC_FREQ_HIGHSPEED);
  150. if (err != ESP_OK) {
  151. ESP_LOGE(TAG, "failed to switch peripheral to HS bus mode");
  152. return err;
  153. }
  154. } else if (config->max_freq_khz >= SDMMC_FREQ_DEFAULT &&
  155. card->csd.tr_speed / 1000 >= SDMMC_FREQ_DEFAULT) {
  156. ESP_LOGD(TAG, "switching to DS bus mode");
  157. err = (*config->set_card_clk)(config->slot, SDMMC_FREQ_DEFAULT);
  158. if (err != ESP_OK) {
  159. ESP_LOGE(TAG, "failed to switch peripheral to HS bus mode");
  160. return err;
  161. }
  162. }
  163. sdmmc_scr_t scr_tmp;
  164. err = sdmmc_send_cmd_send_scr(card, &scr_tmp);
  165. if (err != ESP_OK) {
  166. ESP_LOGE(TAG, "%s: send_scr returned 0x%x", __func__, err);
  167. return err;
  168. }
  169. if (memcmp(&card->scr, &scr_tmp, sizeof(scr_tmp)) != 0) {
  170. ESP_LOGE(TAG, "data check fail!");
  171. return ESP_ERR_INVALID_RESPONSE;
  172. }
  173. return ESP_OK;
  174. }
  175. void sdmmc_card_print_info(FILE* stream, const sdmmc_card_t* card)
  176. {
  177. fprintf(stream, "Name: %s\n", card->cid.name);
  178. fprintf(stream, "Type: %s\n", (card->ocr & SD_OCR_SDHC_CAP)?"SDHC/SDXC":"SDSC");
  179. fprintf(stream, "Speed: %s\n", (card->csd.tr_speed > 25000000)?"high speed":"default speed");
  180. fprintf(stream, "Size: %lluMB\n", ((uint64_t) card->csd.capacity) * card->csd.sector_size / (1024 * 1024));
  181. fprintf(stream, "CSD: ver=%d, sector_size=%d, capacity=%d read_bl_len=%d\n",
  182. card->csd.csd_ver,
  183. card->csd.sector_size, card->csd.capacity, card->csd.read_block_len);
  184. fprintf(stream, "SCR: sd_spec=%d, bus_width=%d\n", card->scr.sd_spec, card->scr.bus_width);
  185. }
  186. static esp_err_t sdmmc_send_cmd(sdmmc_card_t* card, sdmmc_command_t* cmd)
  187. {
  188. int slot = card->host.slot;
  189. ESP_LOGV(TAG, "sending cmd slot=%d op=%d arg=%x flags=%x data=%p blklen=%d datalen=%d",
  190. slot, cmd->opcode, cmd->arg, cmd->flags, cmd->data, cmd->blklen, cmd->datalen);
  191. esp_err_t err = (*card->host.do_transaction)(slot, cmd);
  192. if (err != 0) {
  193. ESP_LOGD(TAG, "sdmmc_req_run returned 0x%x", err);
  194. return err;
  195. }
  196. int state = MMC_R1_CURRENT_STATE(cmd->response);
  197. ESP_LOGV(TAG, "cmd response %08x %08x %08x %08x err=0x%x state=%d",
  198. cmd->response[0],
  199. cmd->response[1],
  200. cmd->response[2],
  201. cmd->response[3],
  202. cmd->error,
  203. state);
  204. return cmd->error;
  205. }
  206. static esp_err_t sdmmc_send_app_cmd(sdmmc_card_t* card, sdmmc_command_t* cmd)
  207. {
  208. sdmmc_command_t app_cmd = {
  209. .opcode = MMC_APP_CMD,
  210. .flags = SCF_CMD_AC | SCF_RSP_R1,
  211. .arg = MMC_ARG_RCA(card->rca),
  212. };
  213. esp_err_t err = sdmmc_send_cmd(card, &app_cmd);
  214. if (err != ESP_OK) {
  215. return err;
  216. }
  217. if (!(MMC_R1(app_cmd.response) & MMC_R1_APP_CMD)) {
  218. ESP_LOGW(TAG, "card doesn't support APP_CMD");
  219. return ESP_ERR_NOT_SUPPORTED;
  220. }
  221. return sdmmc_send_cmd(card, cmd);
  222. }
  223. static esp_err_t sdmmc_send_cmd_go_idle_state(sdmmc_card_t* card)
  224. {
  225. sdmmc_command_t cmd = {
  226. .opcode = MMC_GO_IDLE_STATE,
  227. .flags = SCF_CMD_BC | SCF_RSP_R0,
  228. };
  229. return sdmmc_send_cmd(card, &cmd);
  230. }
  231. static esp_err_t sdmmc_send_cmd_send_if_cond(sdmmc_card_t* card, uint32_t ocr)
  232. {
  233. const uint8_t pattern = 0xaa; /* any pattern will do here */
  234. sdmmc_command_t cmd = {
  235. .opcode = SD_SEND_IF_COND,
  236. .arg = (((ocr & SD_OCR_VOL_MASK) != 0) << 8) | pattern,
  237. .flags = SCF_CMD_BCR | SCF_RSP_R7,
  238. };
  239. esp_err_t err = sdmmc_send_cmd(card, &cmd);
  240. if (err != ESP_OK) {
  241. return err;
  242. }
  243. uint8_t response = cmd.response[0] & 0xff;
  244. if (response != pattern) {
  245. return ESP_ERR_INVALID_RESPONSE;
  246. }
  247. return ESP_OK;
  248. }
  249. static esp_err_t sdmmc_send_cmd_send_op_cond(sdmmc_card_t* card, uint32_t ocr, uint32_t *ocrp)
  250. {
  251. sdmmc_command_t cmd = {
  252. .arg = ocr,
  253. .flags = SCF_CMD_BCR | SCF_RSP_R3,
  254. .opcode = SD_APP_OP_COND
  255. };
  256. int nretries = 100; // arbitrary, BSD driver uses this value
  257. for (; nretries != 0; --nretries) {
  258. esp_err_t err = sdmmc_send_app_cmd(card, &cmd);
  259. if (err != ESP_OK) {
  260. return err;
  261. }
  262. if ((MMC_R3(cmd.response) & MMC_OCR_MEM_READY) ||
  263. ocr == 0) {
  264. break;
  265. }
  266. vTaskDelay(10 / portTICK_PERIOD_MS);
  267. }
  268. if (nretries == 0) {
  269. return ESP_ERR_TIMEOUT;
  270. }
  271. if (ocrp) {
  272. *ocrp = MMC_R3(cmd.response);
  273. }
  274. return ESP_OK;
  275. }
  276. static esp_err_t sdmmc_decode_cid(sdmmc_response_t resp, sdmmc_cid_t* out_cid)
  277. {
  278. out_cid->mfg_id = SD_CID_MID(resp);
  279. out_cid->oem_id = SD_CID_OID(resp);
  280. SD_CID_PNM_CPY(resp, out_cid->name);
  281. out_cid->revision = SD_CID_REV(resp);
  282. out_cid->serial = SD_CID_PSN(resp);
  283. out_cid->date = SD_CID_MDT(resp);
  284. return ESP_OK;
  285. }
  286. static esp_err_t sddmc_send_cmd_all_send_cid(sdmmc_card_t* card, sdmmc_cid_t* out_cid)
  287. {
  288. assert(out_cid);
  289. sdmmc_command_t cmd = {
  290. .opcode = MMC_ALL_SEND_CID,
  291. .flags = SCF_CMD_BCR | SCF_RSP_R2
  292. };
  293. esp_err_t err = sdmmc_send_cmd(card, &cmd);
  294. if (err != ESP_OK) {
  295. return err;
  296. }
  297. return sdmmc_decode_cid(cmd.response, out_cid);
  298. }
  299. static esp_err_t sdmmc_send_cmd_set_relative_addr(sdmmc_card_t* card, uint16_t* out_rca)
  300. {
  301. assert(out_rca);
  302. sdmmc_command_t cmd = {
  303. .opcode = SD_SEND_RELATIVE_ADDR,
  304. .flags = SCF_CMD_BCR | SCF_RSP_R6
  305. };
  306. esp_err_t err = sdmmc_send_cmd(card, &cmd);
  307. if (err != ESP_OK) {
  308. return err;
  309. }
  310. *out_rca = SD_R6_RCA(cmd.response);
  311. return ESP_OK;
  312. }
  313. static esp_err_t sdmmc_send_cmd_set_blocklen(sdmmc_card_t* card, sdmmc_csd_t* csd)
  314. {
  315. sdmmc_command_t cmd = {
  316. .opcode = MMC_SET_BLOCKLEN,
  317. .arg = csd->sector_size,
  318. .flags = SCF_CMD_AC | SCF_RSP_R1
  319. };
  320. return sdmmc_send_cmd(card, &cmd);
  321. }
  322. static esp_err_t sdmmc_decode_csd(sdmmc_response_t response, sdmmc_csd_t* out_csd)
  323. {
  324. out_csd->csd_ver = SD_CSD_CSDVER(response);
  325. switch (out_csd->csd_ver) {
  326. case SD_CSD_CSDVER_2_0:
  327. out_csd->capacity = SD_CSD_V2_CAPACITY(response);
  328. out_csd->read_block_len = SD_CSD_V2_BL_LEN;
  329. break;
  330. case SD_CSD_CSDVER_1_0:
  331. out_csd->capacity = SD_CSD_CAPACITY(response);
  332. out_csd->read_block_len = SD_CSD_READ_BL_LEN(response);
  333. break;
  334. default:
  335. ESP_LOGE(TAG, "unknown SD CSD structure version 0x%x", out_csd->csd_ver);
  336. return ESP_ERR_NOT_SUPPORTED;
  337. }
  338. out_csd->card_command_class = SD_CSD_CCC(response);
  339. int read_bl_size = 1 << out_csd->read_block_len;
  340. out_csd->sector_size = MIN(read_bl_size, 512);
  341. if (out_csd->sector_size < read_bl_size) {
  342. out_csd->capacity *= read_bl_size / out_csd->sector_size;
  343. }
  344. int speed = SD_CSD_SPEED(response);
  345. if (speed == SD_CSD_SPEED_50_MHZ) {
  346. out_csd->tr_speed = 50000000;
  347. } else {
  348. out_csd->tr_speed = 25000000;
  349. }
  350. return ESP_OK;
  351. }
  352. static esp_err_t sdmmc_send_cmd_send_csd(sdmmc_card_t* card, sdmmc_csd_t* out_csd)
  353. {
  354. sdmmc_command_t cmd = {
  355. .opcode = MMC_SEND_CSD,
  356. .arg = MMC_ARG_RCA(card->rca),
  357. .flags = SCF_CMD_AC | SCF_RSP_R2
  358. };
  359. esp_err_t err = sdmmc_send_cmd(card, &cmd);
  360. if (err != ESP_OK) {
  361. return err;
  362. }
  363. return sdmmc_decode_csd(cmd.response, out_csd);
  364. }
  365. static esp_err_t sdmmc_send_cmd_select_card(sdmmc_card_t* card)
  366. {
  367. sdmmc_command_t cmd = {
  368. .opcode = MMC_SELECT_CARD,
  369. .arg = MMC_ARG_RCA(card->rca),
  370. .flags = SCF_CMD_AC | SCF_RSP_R1
  371. };
  372. return sdmmc_send_cmd(card, &cmd);
  373. }
  374. static esp_err_t sdmmc_decode_scr(uint32_t *raw_scr, sdmmc_scr_t* out_scr)
  375. {
  376. sdmmc_response_t resp = {0xabababab, 0xabababab, 0x12345678, 0x09abcdef};
  377. resp[2] = __builtin_bswap32(raw_scr[0]);
  378. resp[3] = __builtin_bswap32(raw_scr[1]);
  379. int ver = SCR_STRUCTURE(resp);
  380. if (ver != 0) {
  381. return ESP_ERR_NOT_SUPPORTED;
  382. }
  383. out_scr->sd_spec = SCR_SD_SPEC(resp);
  384. out_scr->bus_width = SCR_SD_BUS_WIDTHS(resp);
  385. return ESP_OK;
  386. }
  387. static esp_err_t sdmmc_send_cmd_send_scr(sdmmc_card_t* card, sdmmc_scr_t *out_scr)
  388. {
  389. size_t datalen = 8;
  390. uint32_t* buf = (uint32_t*) pvPortMallocCaps(datalen, MALLOC_CAP_DMA);
  391. if (buf == NULL) {
  392. return ESP_ERR_NO_MEM;
  393. }
  394. sdmmc_command_t cmd = {
  395. .data = buf,
  396. .datalen = datalen,
  397. .blklen = datalen,
  398. .flags = SCF_CMD_ADTC | SCF_CMD_READ | SCF_RSP_R1,
  399. .opcode = SD_APP_SEND_SCR
  400. };
  401. esp_err_t err = sdmmc_send_app_cmd(card, &cmd);
  402. if (err == ESP_OK) {
  403. buf[0] = (buf[0]);
  404. buf[1] = (buf[1]);
  405. err = sdmmc_decode_scr(buf, out_scr);
  406. }
  407. free(buf);
  408. return err;
  409. }
  410. static esp_err_t sdmmc_send_cmd_set_bus_width(sdmmc_card_t* card, int width)
  411. {
  412. sdmmc_command_t cmd = {
  413. .opcode = SD_APP_SET_BUS_WIDTH,
  414. .flags = SCF_RSP_R1 | SCF_CMD_AC,
  415. .arg = (width == 4) ? SD_ARG_BUS_WIDTH_4 : SD_ARG_BUS_WIDTH_1
  416. };
  417. return sdmmc_send_app_cmd(card, &cmd);
  418. }
  419. static esp_err_t sdmmc_send_cmd_stop_transmission(sdmmc_card_t* card, uint32_t* status)
  420. {
  421. sdmmc_command_t cmd = {
  422. .opcode = MMC_STOP_TRANSMISSION,
  423. .arg = 0,
  424. .flags = SCF_RSP_R1B | SCF_CMD_AC
  425. };
  426. esp_err_t err = sdmmc_send_cmd(card, &cmd);
  427. if (err == 0) {
  428. *status = MMC_R1(cmd.response);
  429. }
  430. return err;
  431. }
  432. static uint32_t get_host_ocr(float voltage)
  433. {
  434. // TODO: report exact voltage to the card
  435. // For now tell that the host has 2.8-3.6V voltage range
  436. (void) voltage;
  437. return SD_OCR_VOL_MASK;
  438. }
  439. static esp_err_t sdmmc_send_cmd_send_status(sdmmc_card_t* card, uint32_t* out_status)
  440. {
  441. sdmmc_command_t cmd = {
  442. .opcode = MMC_SEND_STATUS,
  443. .arg = MMC_ARG_RCA(card->rca),
  444. .flags = SCF_CMD_AC | SCF_RSP_R1
  445. };
  446. esp_err_t err = sdmmc_send_cmd(card, &cmd);
  447. if (err != ESP_OK) {
  448. return err;
  449. }
  450. if (out_status) {
  451. *out_status = MMC_R1(cmd.response);
  452. }
  453. return ESP_OK;
  454. }
  455. esp_err_t sdmmc_write_sectors(sdmmc_card_t* card, const void* src,
  456. size_t start_block, size_t block_count)
  457. {
  458. if (start_block + block_count > card->csd.capacity) {
  459. return ESP_ERR_INVALID_SIZE;
  460. }
  461. size_t block_size = card->csd.sector_size;
  462. sdmmc_command_t cmd = {
  463. .flags = SCF_CMD_ADTC | SCF_RSP_R1,
  464. .blklen = block_size,
  465. .data = (void*) src,
  466. .datalen = block_count * block_size
  467. };
  468. if (block_count == 1) {
  469. cmd.opcode = MMC_WRITE_BLOCK_SINGLE;
  470. } else {
  471. cmd.opcode = MMC_WRITE_BLOCK_MULTIPLE;
  472. }
  473. if (card->ocr & SD_OCR_SDHC_CAP) {
  474. cmd.arg = start_block;
  475. } else {
  476. cmd.arg = start_block * block_size;
  477. }
  478. esp_err_t err = sdmmc_send_cmd(card, &cmd);
  479. if (err != ESP_OK) {
  480. ESP_LOGE(TAG, "%s: sdmmc_send_cmd returned 0x%x", __func__, err);
  481. return err;
  482. }
  483. uint32_t status = 0;
  484. size_t count = 0;
  485. while (!(status & MMC_R1_READY_FOR_DATA)) {
  486. // TODO: add some timeout here
  487. err = sdmmc_send_cmd_send_status(card, &status);
  488. if (err != ESP_OK) {
  489. return err;
  490. }
  491. if (++count % 10 == 0) {
  492. ESP_LOGV(TAG, "waiting for card to become ready (%d)", count);
  493. }
  494. }
  495. return ESP_OK;
  496. }
  497. esp_err_t sdmmc_read_sectors(sdmmc_card_t* card, void* dst,
  498. size_t start_block, size_t block_count)
  499. {
  500. if (start_block + block_count > card->csd.capacity) {
  501. return ESP_ERR_INVALID_SIZE;
  502. }
  503. size_t block_size = card->csd.sector_size;
  504. sdmmc_command_t cmd = {
  505. .flags = SCF_CMD_ADTC | SCF_CMD_READ | SCF_RSP_R1,
  506. .blklen = block_size,
  507. .data = (void*) dst,
  508. .datalen = block_count * block_size
  509. };
  510. if (block_count == 1) {
  511. cmd.opcode = MMC_READ_BLOCK_SINGLE;
  512. } else {
  513. cmd.opcode = MMC_READ_BLOCK_MULTIPLE;
  514. }
  515. if (card->ocr & SD_OCR_SDHC_CAP) {
  516. cmd.arg = start_block;
  517. } else {
  518. cmd.arg = start_block * block_size;
  519. }
  520. esp_err_t err = sdmmc_send_cmd(card, &cmd);
  521. if (err != ESP_OK) {
  522. ESP_LOGE(TAG, "%s: sdmmc_send_cmd returned 0x%x", __func__, err);
  523. return err;
  524. }
  525. uint32_t status = 0;
  526. size_t count = 0;
  527. while (!(status & MMC_R1_READY_FOR_DATA)) {
  528. // TODO: add some timeout here
  529. err = sdmmc_send_cmd_send_status(card, &status);
  530. if (err != ESP_OK) {
  531. return err;
  532. }
  533. if (++count % 10 == 0) {
  534. ESP_LOGV(TAG, "waiting for card to become ready (%d)", count);
  535. }
  536. }
  537. return ESP_OK;
  538. }