4 * This file is part of BeRTOS.
6 * Bertos is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
20 * As a special exception, you may use this file as part of a free software
21 * library without restriction. Specifically, if other files instantiate
22 * templates or use macros or inline functions from this file, or you compile
23 * this file and link it with other files to produce an executable, this
24 * file does not by itself cause the resulting executable to be covered by
25 * the GNU General Public License. This exception does not however
26 * invalidate any other reasons why the executable file might be covered by
27 * the GNU General Public License.
29 * Copyright 2007 Develer S.r.l. (http://www.develer.com/)
32 * \brief Function library for secure digital memory.
34 * \author Francesco Sacchi <batt@develer.com>
41 #include <io/kblock.h>
42 #include <drv/timer.h>
46 #include "cfg/cfg_sd.h"
48 #define LOG_LEVEL SD_LOG_LEVEL
49 #define LOG_FORMAT SD_LOG_FORMAT
51 #include <cpu/power.h>
53 #include <string.h> /* memset */
57 * read directly from the card.
59 typedef struct CardCSD
61 uint16_t block_len; ///< Length of a block
62 uint32_t block_num; ///< Number of block on the card
63 uint16_t capacity; ///< Card capacity in MB
66 #define SD_IN_IDLE 0x01
67 #define SD_STARTTOKEN 0xFE
69 #define TIMEOUT_NAC 16384
70 #define SD_DEFAULT_BLOCKLEN 512
72 #define SD_BUSY_TIMEOUT ms_to_ticks(200)
74 static bool sd_select(Sd *sd, bool state)
82 ticks_t start = timer_clock();
85 if (kfile_getc(fd) == 0xff)
90 while (timer_clock() - start < SD_BUSY_TIMEOUT);
93 LOG_ERR("sd_select timeout\n");
105 static int16_t sd_waitR1(Sd *sd)
109 for (int i = 0; i < TIMEOUT_NAC; i++)
111 datain = kfile_getc(sd->ch);
113 return (int16_t)datain;
115 LOG_ERR("Timeout waiting R1\n");
119 static int16_t sd_sendCommand(Sd *sd, uint8_t cmd, uint32_t param, uint8_t crc)
122 /* The 7th bit of command must be a 1 */
123 kfile_putc(cmd | 0x40, fd);
126 kfile_putc((param >> 24) & 0xFF, fd);
127 kfile_putc((param >> 16) & 0xFF, fd);
128 kfile_putc((param >> 8) & 0xFF, fd);
129 kfile_putc((param) & 0xFF, fd);
133 return sd_waitR1(sd);
136 static bool sd_getBlock(Sd *sd, void *buf, size_t len)
143 for (int i = 0; i < TIMEOUT_NAC; i++)
145 token = kfile_getc(fd);
148 if (token == SD_STARTTOKEN)
150 if (kfile_read(fd, buf, len) == len)
152 if (kfile_read(fd, &crc, sizeof(crc)) == sizeof(crc))
153 /* check CRC here if needed */
156 LOG_ERR("get_block error getting crc\n");
159 LOG_ERR("get_block len error: %d\n", (int)len);
162 LOG_ERR("get_block token error: %02X\n", token);
168 LOG_ERR("get_block timeout waiting token\n");
172 #define SD_SELECT(sd) \
175 if (!sd_select((sd), true)) \
177 LOG_ERR("%s failed, card busy\n", __func__); \
183 #define SD_SETBLOCKLEN 0x50
185 static int16_t sd_setBlockLen(Sd *sd, uint32_t newlen)
189 sd->r1 = sd_sendCommand(sd, SD_SETBLOCKLEN, newlen, 0);
191 sd_select(sd, false);
195 #define SD_SEND_CSD 0x49
197 static int16_t sd_getCSD(Sd *sd, CardCSD *csd)
201 int16_t r1 = sd_sendCommand(sd, SD_SEND_CSD, 0, 0);
205 LOG_ERR("send_csd failed: %04X\n", sd->r1);
206 sd_select(sd, false);
211 bool res = sd_getBlock(sd, buf, sizeof(buf));
212 sd_select(sd, false);
216 #if LOG_LEVEL >= LOG_LVL_INFO
218 for (int i = 0; i < 16; i++)
219 kprintf("%02X ", buf[i]);
223 uint16_t mult = (1L << ((((buf[9] & 0x03) << 1) | ((buf[10] & 0x80) >> 7)) + 2));
224 uint16_t c_size = (((uint16_t)(buf[6] & 0x03)) << 10) | (((uint16_t)buf[7]) << 2) |
225 (((uint16_t)(buf[8] & 0xC0)) >> 6);
227 csd->block_len = (1L << (buf[5] & 0x0F));
228 csd->block_num = (c_size + 1) * mult;
229 csd->capacity = (csd->block_len * csd->block_num) >> 20; // in MB
231 LOG_INFO("block_len %d bytes, block_num %ld, total capacity %dMB\n", csd->block_len, csd->block_num, csd->capacity);
240 #include <drv/hsmci_sam3.h>
242 #define SD_ADDR_TO_RCA(addr) (uint32_t)(((addr) << 16) & 0xFFFF0000)
243 #define SD_GET_STATE(status) (uint8_t)(((status) & SD_STATUS_CURR_MASK) >> SD_STATUS_CURR_SHIFT)
245 #define SD_STATUS_APP_CMD BV(5)
246 #define SD_STATUS_READY BV(8)
247 #define SD_STATUS_CURR_MASK 0x1E00
248 #define SD_STATUS_CURR_SHIFT 9
252 static void dump(const char *label, uint32_t *r, size_t len)
257 kprintf("\n%s [\n", label);
258 for (i = 0; i < len; i++)
265 kprintf("%08lx ", r[i]);
268 kprintf("\n] len=%d\n\n", i);
272 static const uint32_t tran_exp[] =
274 10000, 100000, 1000000, 10000000,
278 static const uint8_t tran_mant[] =
280 0, 10, 12, 13, 15, 20, 25, 30,
281 35, 40, 45, 50, 55, 60, 70, 80,
284 static int sd_decodeCsd(SDcsd *csd, uint32_t *resp, size_t len)
290 csd->structure = UNSTUFF_BITS(resp, 126, 2);
291 csd->ccc = UNSTUFF_BITS(resp, 84, 12);
293 csd->max_data_rate = tran_exp[UNSTUFF_BITS(resp, 96, 3)] * tran_mant[UNSTUFF_BITS(resp, 99, 4)];
298 * - Version 1.01-1.10
299 * - Version 2.00/Standard Capacity
301 * - Version 2.00/High Capacity
305 if (csd->structure == 0)
307 // (C_size + 1) x 2^(C_SIZE_MUL+2)
308 csd->blk_num = (1 + UNSTUFF_BITS(resp, 62, 12)) << (UNSTUFF_BITS(resp, 47, 3) + 2);
310 csd->read_blk_bits = UNSTUFF_BITS(resp, 80, 4);
311 csd->write_blk_bits = UNSTUFF_BITS(resp, 22, 4);
313 csd->blk_len = 1 << csd->read_blk_bits;
314 csd->capacity = csd->blk_num * csd->blk_len;
316 csd->read_partial = UNSTUFF_BITS(resp, 79, 1);
317 csd->read_misalign = UNSTUFF_BITS(resp, 77, 1);
319 csd->write_misalign = UNSTUFF_BITS(resp, 78, 1);
320 csd->write_partial = UNSTUFF_BITS(resp, 21, 1);
322 if (UNSTUFF_BITS(resp, 46, 1))
326 else if(csd->write_blk_bits >= 9)
328 csd->erase_size = UNSTUFF_BITS(resp, 39, 7) + 1;
329 csd->erase_size <<= csd->write_blk_bits - 9;
334 else if (csd->structure == 1)
336 kprintf("csize %ld\n", UNSTUFF_BITS(resp, 48, 22));
337 csd->capacity = (1 + UNSTUFF_BITS(resp, 48, 22)) << 10;
339 csd->write_blk_bits = 9;
340 csd->write_partial = 0;
341 csd->write_misalign = 0;
343 csd->read_blk_bits = 9;
344 csd->read_partial = 0;
345 csd->read_misalign = 0;
348 // the block size if fixed to 512kb
349 csd->blk_len = (1 << csd->write_blk_bits) << 10;
355 kprintf("Unrecognised CSD structure version %d\n", csd->structure);
363 void sd_dumpCsd(Sd *sd)
367 LOG_INFO("VERSION: %d.0\n", sd->csd.structure ? 2 : 1);
368 LOG_INFO("CARD COMMAND CLASS: %d\n", sd->csd.ccc);
369 LOG_INFO("MAX DATA RATE: %ld\n", sd->csd.max_data_rate);
370 LOG_INFO("WRITE BLK LEN BITS: %ld\n", sd->csd.write_blk_bits);
371 LOG_INFO("READ BLK LEN BITS: %ld\n", sd->csd.read_blk_bits);
372 LOG_INFO("ERASE SIZE: %ld\n", sd->csd.erase_size);
373 LOG_INFO("BLK NUM: %ld\n", sd->csd.blk_num);
374 LOG_INFO("BLK LEN: %ld\n", sd->csd.blk_len);
375 LOG_INFO("CAPACITY %ld\n", sd->csd.capacity);
376 LOG_INFO("FLAG Write: WP %d, W MISALIGN %d\n", sd->csd.write_partial, sd->csd.write_misalign);
377 LOG_INFO("FLAG Read: RP %d, R MISALIGN %d\n", sd->csd.read_partial, sd->csd.read_misalign);
381 void sd_dumpCid(Sd *sd)
385 LOG_INFO("MANFID: %d\n", sd->cid.manfid);
386 LOG_INFO("OEMID: %d\n", sd->cid.oemid);
387 LOG_INFO("SERIAL: %ld\n", sd->cid.serial);
388 LOG_INFO("PROD_NAME: %s\n", sd->cid.prod_name);
389 LOG_INFO("REV: %d.%d\n", sd->cid.m_rev, sd->cid.l_rev);
390 LOG_INFO("OFF,Y,M: %lx, %ld %ld\n", sd->cid.year_off, (BCD_TO_INT_32BIT(sd->cid.year_off) / 12) + 2000,
391 (BCD_TO_INT_32BIT(sd->cid.year_off) % 12));
394 void sd_dumpSsr(Sd *sd)
398 LOG_INFO("BUS_WIDTH: %d\n", sd->ssr.bus_width);
399 LOG_INFO("TYPE: %d\n", sd->ssr.card_type);
400 LOG_INFO("AU_TYPE: %d\n", sd->ssr.au_size);
401 LOG_INFO("ERASE_SIZE: %d\n", sd->ssr.erase_size);
402 LOG_INFO("SPEED_CLASS: %d\n", sd->ssr.speed_class);
406 void sd_sendInit(void)
408 hsmci_init(NULL); //TODO: REMOVE IT!
410 if (hsmci_sendCmd(0, 0, HSMCI_CMDR_SPCMD_INIT | HSMCI_CMDR_RSPTYP_NORESP))
411 LOG_ERR("INIT: %lx\n", HSMCI_SR);
417 hsmci_setSpeed(HSMCI_INIT_SPEED, false);
418 if (hsmci_sendCmd(0, 0, HSMCI_CMDR_RSPTYP_NORESP))
419 LOG_ERR("GO_IDLE: %lx\n", HSMCI_SR);
422 int sd_sendIfCond(Sd *sd)
424 if (hsmci_sendCmd(8, CMD8_V_RANGE_27V_36V, HSMCI_CMDR_RSPTYP_48_BIT))
426 LOG_ERR("IF_COND %lx\n", HSMCI_SR);
429 hsmci_readResp(&(sd->status), 1);
430 if (((sd->status) & 0xFFF) == CMD8_V_RANGE_27V_36V)
432 LOG_INFO("IF_COND: %lx\n", (sd->status));
435 LOG_ERR("IF_COND: %lx\n", (sd->status));
440 int sd_sendAppOpCond(Sd *sd)
442 if (hsmci_sendCmd(55, 0, HSMCI_CMDR_RSPTYP_48_BIT))
444 LOG_ERR("APP_CMD %lx\n", HSMCI_SR);
448 hsmci_readResp(&(sd->status), 1);
449 if ((sd->status) & (SD_STATUS_APP_CMD | SD_STATUS_READY))
451 if (hsmci_sendCmd(41, SD_HOST_VOLTAGE_RANGE | SD_OCR_CCS, HSMCI_CMDR_RSPTYP_48_BIT))// se cmd 8 va ok.
453 LOG_ERR("APP_OP_COND %lx\n", HSMCI_SR);
458 hsmci_readResp(&(sd->status), 1);
459 if ((sd->status) & SD_OCR_BUSY)
461 LOG_INFO("SD power up! Hight Capability [%d]\n", (bool)((sd->status) & SD_OCR_CCS));
465 LOG_ERR("sd not ready.\n");
473 int sd_getCid(Sd *sd, uint32_t addr, uint8_t flag)
476 memset(&(sd->cid), 0, sizeof(SDcid));
478 uint8_t idx = 9; // CMD9 get cid from gived sd address (RCA)
479 if (flag & SD_SEND_ALL_CID)
483 if (hsmci_sendCmd(idx, SD_ADDR_TO_RCA(addr), HSMCI_CMDR_RSPTYP_136_BIT))
485 LOG_ERR("GET_CID %lx\n", HSMCI_SR);
491 hsmci_readResp(resp, 4);
492 LOG_INFOB(dump("CID", resp, 4););
494 sd->cid.manfid = UNSTUFF_BITS(resp, 120, 8);
495 sd->cid.oemid = UNSTUFF_BITS(resp, 104, 16);
496 sd->cid.prod_name[0] = UNSTUFF_BITS(resp, 96, 8);
497 sd->cid.prod_name[1] = UNSTUFF_BITS(resp, 88, 8);
498 sd->cid.prod_name[2] = UNSTUFF_BITS(resp, 80, 8);
499 sd->cid.prod_name[3] = UNSTUFF_BITS(resp, 72, 8);
500 sd->cid.prod_name[4] = UNSTUFF_BITS(resp, 64, 8);
501 sd->cid.m_rev = UNSTUFF_BITS(resp, 60, 4);
502 sd->cid.l_rev = UNSTUFF_BITS(resp, 56, 4);
503 sd->cid.serial = (uint32_t)UNSTUFF_BITS(resp, 24, 32);
504 sd->cid.year_off = UNSTUFF_BITS(resp, 8, 12);
510 int sd_getCsd(Sd *sd)
513 memset(&(sd->csd), 0, sizeof(SDcsd));
515 LOG_INFO("Send to RCA: %lx\n", SD_ADDR_TO_RCA(sd->addr));
516 if (hsmci_sendCmd(9, SD_ADDR_TO_RCA(sd->addr), HSMCI_CMDR_RSPTYP_136_BIT))
518 LOG_ERR("GET_CSD %lx\n", HSMCI_SR);
524 hsmci_readResp(resp, 4);
525 LOG_INFOB(dump("CSD", resp, 4););
526 sd_decodeCsd(&(sd->csd), resp, 4);
532 int sd_getRelativeAddr(Sd *sd)
535 if (hsmci_sendCmd(3, 0, HSMCI_CMDR_RSPTYP_48_BIT))
537 LOG_ERR("RCA: %lx\n", HSMCI_SR);
541 hsmci_readResp(&sd->addr, 1);
542 sd->addr = sd->addr >> 16;
544 LOG_INFOB(dump("RCA", &sd->addr, 1););
549 int sd_appStatus(Sd *sd)
552 LOG_INFO("Send to RCA: %lx\n", SD_ADDR_TO_RCA(sd->addr));
553 if (hsmci_sendCmd(13, SD_ADDR_TO_RCA(sd->addr), HSMCI_CMDR_RSPTYP_48_BIT))
555 LOG_ERR("STATUS: %lx\n", HSMCI_SR);
559 hsmci_readResp(&(sd->status), 1);
560 LOG_INFOB(dump("STATUS", &(sd->status), 1););
562 LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
564 if (sd->status & SD_STATUS_READY)
571 INLINE int sd_cardSelection(Sd *sd, uint32_t rca)
574 LOG_INFO("Select RCA: %lx\n", rca);
575 if (hsmci_sendCmd(7, rca, HSMCI_CMDR_RSPTYP_R1B))
577 LOG_ERR("SELECT_SD: %lx\n", HSMCI_SR);
582 hsmci_readResp(&(sd->status), 1);
583 LOG_INFOB(dump("SELECT_SD", &(sd->status), 1););
585 LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
587 if (sd->status & SD_STATUS_READY)
593 int sd_selectCard(Sd *sd)
596 uint32_t rca = SD_ADDR_TO_RCA(sd->addr);
597 LOG_INFO("Select RCA: %lx\n", rca);
598 if (hsmci_sendCmd(7, rca, HSMCI_CMDR_RSPTYP_R1B))
600 LOG_ERR("SELECT_SD: %lx\n", HSMCI_SR);
605 hsmci_readResp(&(sd->status), 1);
607 LOG_INFOB(dump("SELECT_SD", &(sd->status), 1););
608 LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
610 if (sd->status & SD_STATUS_READY)
616 int sd_deSelectCard(Sd *sd)
622 rca = SD_ADDR_TO_RCA(sd->addr + 1);
624 LOG_INFO("Select RCA: %lx\n", rca);
626 if (hsmci_sendCmd(7, rca, HSMCI_CMDR_RSPTYP_NORESP))
628 LOG_ERR("DESELECT_SD: %lx\n", HSMCI_SR);
636 int sd_setBusWidth(Sd *sd, size_t len)
640 if (hsmci_sendCmd(55, SD_ADDR_TO_RCA(sd->addr), HSMCI_CMDR_RSPTYP_48_BIT))
642 LOG_ERR("APP_CMD %lx\n", HSMCI_SR);
646 hsmci_readResp(&(sd->status), 1);
647 if ((sd->status) & (SD_STATUS_APP_CMD | SD_STATUS_READY))
649 hsmci_setBusWidth(len);
655 if (hsmci_sendCmd(6, arg, HSMCI_CMDR_RSPTYP_48_BIT))
657 LOG_ERR("SET_BUS_WIDTH CMD: %lx\n", HSMCI_SR);
661 hsmci_readResp(&(sd->status), 1);
663 LOG_INFOB(dump("SET_BUS_WIDTH", &(sd->status), 1););
664 LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
666 if (sd->status & SD_STATUS_READY)
670 LOG_ERR("SET_BUS_WIDTH REP %lx\n", (sd->status));
675 int sd_set_BlockLen(Sd *sd, size_t len)
679 if (hsmci_sendCmd(16, len, HSMCI_CMDR_RSPTYP_48_BIT))
681 LOG_ERR("SET_BLK_LEN: %lx\n", HSMCI_SR);
685 hsmci_readResp(&(sd->status), 1);
687 LOG_INFOB(dump("SET_BLK_LEN", &(sd->status), 1););
688 LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
690 sd->csd.blk_len = len;
692 if (sd->status & SD_STATUS_READY)
698 int sd_getStatus(Sd *sd, uint32_t *buf, size_t words)
702 // Status reply with 512bit data, so the block size in byte is 64
703 hsmci_prgRxDMA(buf, words, 64);
705 if (hsmci_sendCmd(55, SD_ADDR_TO_RCA(sd->addr), HSMCI_CMDR_RSPTYP_48_BIT))
707 LOG_ERR("APP_CMD %lx\n", HSMCI_SR);
711 uint32_t status = HSMCI_RSPR;
712 if (status & (SD_STATUS_APP_CMD | SD_STATUS_READY))
714 if (hsmci_sendCmd(13, 0, HSMCI_CMDR_RSPTYP_48_BIT |
715 BV(HSMCI_CMDR_TRDIR) | HSMCI_CMDR_TRCMD_START_DATA | HSMCI_CMDR_TRTYP_SINGLE))
717 LOG_ERR("STATUS CMD: %lx\n", HSMCI_SR);
721 hsmci_readResp(&(sd->status), 1);
722 LOG_INFOB(dump("STATUS", &(sd->status), 1););
723 LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
725 if (sd->status & SD_STATUS_READY)
727 hsmci_waitTransfer();
729 LOG_INFOB(dump("STATUS", buf, words););
730 memset(&(sd->ssr), 0, sizeof(SDssr));
732 sd->ssr.bus_width = UNSTUFF_BITS(buf, 510, 2);
733 sd->ssr.card_type = UNSTUFF_BITS(buf, 480, 16);
734 sd->ssr.au_size = UNSTUFF_BITS(buf, 432, 8);
735 sd->ssr.speed_class = UNSTUFF_BITS(buf, 440, 8);
736 sd->ssr.erase_size = UNSTUFF_BITS(buf, 408, 24);
746 void sd_setHightSpeed(Sd *sd)
749 hsmci_setSpeed(2100000, true);
755 #define SD_START_DELAY 10
756 #define SD_INIT_TIMEOUT ms_to_ticks(2000)
757 #define SD_IDLE_RETRIES 4
761 static size_t sd_SdReadDirect(struct KBlock *b, block_idx_t idx, void *buf, size_t offset, size_t size)
765 LOG_INFO("reading from block %ld, offset %d, size %d\n", idx, offset, size);
767 if (sd_selectCard(sd) < 0)
770 hsmci_prgRxDMA(buf, size / 4, sd->csd.blk_len);
772 if (hsmci_sendCmd(17, idx * sd->csd.blk_len + offset, HSMCI_CMDR_RSPTYP_48_BIT |
773 BV(HSMCI_CMDR_TRDIR) | HSMCI_CMDR_TRCMD_START_DATA | HSMCI_CMDR_TRTYP_SINGLE))
775 LOG_ERR("SIGLE_BLK_READ: %lx\n", HSMCI_SR);
780 hsmci_readResp(&(sd->status), 1);
782 LOG_INFOB(dump("SIGLE_BLK_READ", &(sd->status), 1););
783 LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
785 if (sd->status & SD_STATUS_READY)
787 hsmci_waitTransfer();
796 static size_t sd_SdWriteDirect(KBlock *b, block_idx_t idx, const void *buf, size_t offset, size_t size)
800 const uint32_t *_buf = (const uint32_t *)buf;
801 LOG_INFO("reading from block %ld, offset %d, size %d\n", idx, offset, size);
803 if (sd_selectCard(sd) < 0)
806 hsmci_prgTxDMA(_buf, size / 4, sd->csd.blk_len);
808 if (hsmci_sendCmd(24, idx * sd->csd.blk_len + offset, HSMCI_CMDR_RSPTYP_48_BIT |
809 HSMCI_CMDR_TRCMD_START_DATA | HSMCI_CMDR_TRTYP_SINGLE))
811 LOG_ERR("SIGLE_BLK_WRITE: %lx\n", HSMCI_SR);
816 hsmci_readResp(&(sd->status), 1);
818 LOG_INFOB(dump("SIGLE_BLK_WR", &(sd->status), 1););
819 LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
821 if (sd->status & SD_STATUS_READY)
823 hsmci_waitTransfer();
833 static int sd_SdError(KBlock *b)
836 return 0;//sd->status;
839 static void sd_SdClearerr(KBlock *b)
847 static bool sd_SdBlockInit(Sd *sd)
849 /* Wait a few moments for supply voltage to stabilize */
850 timer_delay(SD_START_DELAY);
857 ticks_t start = timer_clock();
858 bool sd_power_on = false;
861 if (!sd_sendAppOpCond(sd))
868 while (timer_clock() - start < SD_INIT_TIMEOUT);
874 if(sd_getCid(sd, 0, SD_SEND_ALL_CID) < 0)
881 if (sd_getRelativeAddr(sd) < 0)
885 LOG_INFO("RCA: %0lx\n", sd->addr);
889 if (sd_getCsd(sd) < 0)
896 if (sd_appStatus(sd) < 0)
898 LOG_INFO("STATUS: %ld\n", sd->status);
902 if (sd->status & SD_CARD_IS_LOCKED)
904 LOG_INFO("SD is locked!\n");
908 if (sd->status & SD_READY_FOR_DATA)
911 sd_set_BlockLen(sd, SD_DEFAULT_BLOCKLEN);
913 sd_setHightSpeed(sd);
916 sd->b.blk_size = SD_DEFAULT_BLOCKLEN;
917 sd->b.blk_cnt = sd->csd.blk_num * (sd->csd.blk_len / SD_DEFAULT_BLOCKLEN);
918 LOG_INFO("blk_size %d, blk_cnt %ld\n", sd->b.blk_size, sd->b.blk_cnt);
929 #define SD_READ_SINGLEBLOCK 0x51
931 static size_t sd_SpiReadDirect(struct KBlock *b, block_idx_t idx, void *buf, size_t offset, size_t size)
935 LOG_INFO("reading from block %ld, offset %d, size %d\n", idx, offset, size);
937 if (sd->tranfer_len != size)
939 if ((sd->r1 = sd_setBlockLen(sd, size)))
941 LOG_ERR("setBlockLen failed: %04X\n", sd->r1);
944 sd->tranfer_len = size;
949 sd->r1 = sd_sendCommand(sd, SD_READ_SINGLEBLOCK, idx * SD_DEFAULT_BLOCKLEN + offset, 0);
953 LOG_ERR("read single block failed: %04X\n", sd->r1);
954 sd_select(sd, false);
958 bool res = sd_getBlock(sd, buf, size);
959 sd_select(sd, false);
962 LOG_ERR("read single block failed reading data\n");
969 #define SD_WRITE_SINGLEBLOCK 0x58
970 #define SD_DATA_ACCEPTED 0x05
972 static size_t sd_SpiWriteDirect(KBlock *b, block_idx_t idx, const void *buf, size_t offset, size_t size)
977 ASSERT(size == SD_DEFAULT_BLOCKLEN);
979 LOG_INFO("writing block %ld\n", idx);
980 if (sd->tranfer_len != SD_DEFAULT_BLOCKLEN)
982 if ((sd->r1 = sd_setBlockLen(sd, SD_DEFAULT_BLOCKLEN)))
984 LOG_ERR("setBlockLen failed: %04X\n", sd->r1);
987 sd->tranfer_len = SD_DEFAULT_BLOCKLEN;
992 sd->r1 = sd_sendCommand(sd, SD_WRITE_SINGLEBLOCK, idx * SD_DEFAULT_BLOCKLEN, 0);
996 LOG_ERR("write single block failed: %04X\n", sd->r1);
997 sd_select(sd, false);
1001 kfile_putc(SD_STARTTOKEN, fd);
1002 kfile_write(fd, buf, SD_DEFAULT_BLOCKLEN);
1007 uint8_t dataresp = kfile_getc(fd);
1008 sd_select(sd, false);
1010 if ((dataresp & 0x1f) != SD_DATA_ACCEPTED)
1012 LOG_ERR("write block %ld failed: %02X\n", idx, dataresp);
1016 return SD_DEFAULT_BLOCKLEN;
1019 static int sd_SpiError(KBlock *b)
1021 Sd *sd = SD_CAST(b);
1025 static void sd_SpiClearerr(KBlock *b)
1027 Sd *sd = SD_CAST(b);
1033 #define SD_GO_IDLE_STATE 0x40
1034 #define SD_GO_IDLE_STATE_CRC 0x95
1035 #define SD_SEND_OP_COND 0x41
1036 #define SD_SEND_OP_COND_CRC 0xF9
1038 static bool sd_SpiBlockInit(Sd *sd, KFile *ch)
1045 /* Wait a few moments for supply voltage to stabilize */
1046 timer_delay(SD_START_DELAY);
1048 /* Give 80 clk pulses to wake up the card */
1049 for (int i = 0; i < 10; i++)
1050 kfile_putc(0xff, ch);
1053 for (int i = 0; i < SD_IDLE_RETRIES; i++)
1056 sd->r1 = sd_sendCommand(sd, SD_GO_IDLE_STATE, 0, SD_GO_IDLE_STATE_CRC);
1057 sd_select(sd, false);
1059 if (sd->r1 == SD_IN_IDLE)
1063 if (sd->r1 != SD_IN_IDLE)
1065 LOG_ERR("go_idle_state failed: %04X\n", sd->r1);
1069 ticks_t start = timer_clock();
1071 /* Wait for card to start */
1075 sd->r1 = sd_sendCommand(sd, SD_SEND_OP_COND, 0, SD_SEND_OP_COND_CRC);
1076 sd_select(sd, false);
1079 while (sd->r1 != 0 && timer_clock() - start < SD_INIT_TIMEOUT);
1083 LOG_ERR("send_op_cond failed: %04X\n", sd->r1);
1087 sd->r1 = sd_setBlockLen(sd, SD_DEFAULT_BLOCKLEN);
1088 sd->tranfer_len = SD_DEFAULT_BLOCKLEN;
1092 LOG_ERR("setBlockLen failed: %04X\n", sd->r1);
1096 /* Avoid warning for uninitialized csd use (gcc bug?) */
1099 sd->r1 = sd_getCSD(sd, &csd);
1103 LOG_ERR("getCSD failed: %04X\n", sd->r1);
1107 sd->b.blk_size = SD_DEFAULT_BLOCKLEN;
1108 sd->b.blk_cnt = csd.block_num * (csd.block_len / SD_DEFAULT_BLOCKLEN);
1109 LOG_INFO("blk_size %d, blk_cnt %ld\n", sd->b.blk_size, sd->b.blk_cnt);
1115 static bool sd_blockInit(Sd *sd, KFile *ch)
1119 memset(sd, 0, sizeof(*sd));
1120 DB(sd->b.priv.type = KBT_SD);
1123 if (!sd_SdBlockInit(sd))
1126 if (!sd_SpiBlockInit(sd, ch))
1130 #if CONFIG_SD_AUTOASSIGN_FAT
1131 disk_assignDrive(&sd->b, 0);
1138 #define sd_writeDirect sd_SdWriteDirect
1139 #define sd_readDirect sd_SdReadDirect
1140 #define sd_error sd_SdError
1141 #define sd_clearerr sd_SdClearerr
1144 #define sd_writeDirect sd_SpiWriteDirect
1145 #define sd_readDirect sd_SpiReadDirect
1146 #define sd_error sd_SpiError
1147 #define sd_clearerr sd_SpiClearerr
1151 static const KBlockVTable sd_unbuffered_vt =
1153 .readDirect = sd_readDirect,
1154 .writeDirect = sd_writeDirect,
1157 .clearerr = sd_clearerr,
1160 static const KBlockVTable sd_buffered_vt =
1162 .readDirect = sd_readDirect,
1163 .writeDirect = sd_writeDirect,
1165 .readBuf = kblock_swReadBuf,
1166 .writeBuf = kblock_swWriteBuf,
1167 .load = kblock_swLoad,
1168 .store = kblock_swStore,
1171 .clearerr = sd_clearerr,
1174 bool sd_initUnbuf(Sd *sd, KFile *ch)
1176 if (sd_blockInit(sd, ch))
1178 sd->b.priv.vt = &sd_unbuffered_vt;
1185 static uint8_t sd_buf[SD_DEFAULT_BLOCKLEN];
1187 bool sd_initBuf(Sd *sd, KFile *ch)
1189 if (sd_blockInit(sd, ch))
1191 sd->b.priv.buf = sd_buf;
1192 sd->b.priv.flags |= KB_BUFFERED | KB_PARTIAL_WRITE;
1193 sd->b.priv.vt = &sd_buffered_vt;
1194 sd->b.priv.vt->load(&sd->b, 0);
1202 void sd_writeTest(Sd *sd)
1204 uint8_t buf[SD_DEFAULT_BLOCKLEN];
1205 memset(buf, 0, sizeof(buf));
1207 for (block_idx_t i = 0; i < sd->b.blk_cnt; i++)
1209 LOG_INFO("writing block %ld: %s\n", i, (sd_writeDirect(&sd->b, i, buf, 0, SD_DEFAULT_BLOCKLEN) == SD_DEFAULT_BLOCKLEN) ? "OK" : "FAIL");
1214 bool sd_test(Sd *sd)
1216 uint8_t buf[SD_DEFAULT_BLOCKLEN];
1218 if (sd_readDirect(&sd->b, 0, buf, 0, sd->b.blk_size) != sd->b.blk_size)
1222 for (int i = 0; i < SD_DEFAULT_BLOCKLEN; i++)
1224 kprintf("%02X ", buf[i]);
1230 if (sd_writeDirect(&sd->b, 0, buf, 0, SD_DEFAULT_BLOCKLEN) != SD_DEFAULT_BLOCKLEN)
1233 memset(buf, 0, sizeof(buf));
1234 if (sd_readDirect(&sd->b, 0, buf, 0, sd->b.blk_size) != sd->b.blk_size)
1238 for (block_idx_t i = 0; i < sd->b.blk_size; i++)
1240 kprintf("%02X ", buf[i]);