X-Git-Url: https://codewiz.org/gitweb?a=blobdiff_plain;f=bertos%2Fdrv%2Fsd.c;h=820873eda9478a27cf6fcbcf1b1fbe6804c8655e;hb=41718ab2098bd5640da265c34f1ecb79a4123d39;hp=0c15156301ea1e41d6598a5c00f238d3647aad08;hpb=1fb9b95e56d03933e5b38709a497b5f5f892ea23;p=bertos.git diff --git a/bertos/drv/sd.c b/bertos/drv/sd.c index 0c151563..820873ed 100644 --- a/bertos/drv/sd.c +++ b/bertos/drv/sd.c @@ -31,276 +31,43 @@ * * \brief Function library for secure digital memory. * - * \version $Id$ * \author Francesco Sacchi */ #include "sd.h" #include "hw/hw_sd.h" -#include -#include - -#include +#include "cfg/cfg_sd.h" +#define LOG_LEVEL SD_LOG_LEVEL +#define LOG_FORMAT SD_LOG_FORMAT #include -#include - -#include /* memset */ - -/** - * Card Specific Data - * read directly from the card. - */ -typedef struct CardCSD -{ - uint16_t block_len; ///< Length of a block - uint32_t block_num; ///< Number of block on the card - uint16_t capacity; ///< Card capacity in MB -} CardCSD; - -#define SD_IN_IDLE 0x01 -#define SD_STARTTOKEN 0xFE - -#define TIMEOUT_NAC 256 - -#define SD_DEFAULT_BLOCKLEN 512 - -/** - * SPI communication channel. - */ -static KFile *fd; - -/** - * Current SD status. - */ -static bool sd_status; - -#define SD_BUSY_TIMEOUT ms_to_ticks(200) - -static bool sd_select(bool state) -{ - if (state) - { - ticks_t start = timer_clock(); - do - { - SD_CS_ON(); - if (kfile_getc(fd) == 0xff) - return true; - SD_CS_OFF(); - kfile_putc(0xff, fd); - kfile_flush(fd); - cpu_relax(); - } - while (timer_clock() - start < SD_BUSY_TIMEOUT); - LOG_ERR("sd_select timeout\n"); - return false; - } - else - { - kfile_putc(0xff, fd); - kfile_flush(fd); - SD_CS_OFF(); - return true; - } -} +#include -static int16_t sd_waitR1(void) -{ - uint8_t datain; - - for (int i = 0; i < TIMEOUT_NAC; i++) - { - datain = kfile_getc(fd); - if (datain != 0xff) - return (int16_t)datain; - } - LOG_ERR("Timeout waiting R1\n"); - return EOF; -} - -static int16_t sd_sendCommand(uint8_t cmd, uint32_t param, uint8_t crc) -{ - /* The 7th bit of command must be a 1 */ - kfile_putc(cmd | 0x40, fd); - - /* send parameter */ - kfile_putc((param >> 24) & 0xFF, fd); - kfile_putc((param >> 16) & 0xFF, fd); - kfile_putc((param >> 8) & 0xFF, fd); - kfile_putc((param) & 0xFF, fd); - - kfile_putc(crc, fd); - - return sd_waitR1(); -} - - -static bool sd_getBlock(void *buf, size_t len) -{ - uint8_t token; - uint16_t crc; +#include - for (int i = 0; i < TIMEOUT_NAC; i++) - { - token = kfile_getc(fd); - if (token != 0xff) - { - if (token == SD_STARTTOKEN) - { - if (kfile_read(fd, buf, len) == len) - { - if (kfile_read(fd, &crc, sizeof(crc)) == sizeof(crc)) - /* check CRC here if needed */ - return true; - else - LOG_ERR("get_block error getting crc\n"); - } - else - LOG_ERR("get_block len error: %d\n", (int)len); - } - else - LOG_ERR("get_block token error: %02X\n", token); - - return false; - } - } - - LOG_ERR("get_block timeout waiting token\n"); - return false; -} - -#define SD_SELECT() \ -do \ -{ \ - if (!sd_select(true)) \ - { \ - LOG_ERR("%s failed, card busy\n", __func__); \ - return EOF; \ - } \ -} \ -while (0) - -#define SD_SETBLOCKLEN 0x50 - -static int16_t sd_setBlockLen(uint32_t newlen) -{ - SD_SELECT(); - - int16_t r1 = sd_sendCommand(SD_SETBLOCKLEN, newlen, 0); - - sd_select(false); - return r1; -} - -#define SD_SEND_CSD 0x49 - -static int16_t sd_getCSD(CardCSD *csd) -{ - SD_SELECT(); - - int16_t r1 = sd_sendCommand(SD_SEND_CSD, 0, 0); - - if (r1) - { - LOG_ERR("send_csd failed: %04X\n", r1); - sd_select(false); - return r1; - } - - uint8_t buf[16]; - bool res = sd_getBlock(buf, sizeof(buf)); - sd_select(false); - - if (res) - { - uint16_t mult = (1L << ((((buf[9] & 0x03) << 1) | ((buf[10] & 0x80) >> 7)) + 2)); - uint16_t c_size = (((uint16_t)(buf[6] & 0x03)) << 10) | (((uint16_t)buf[7]) << 2) | - (((uint16_t)(buf[8] & 0xC0)) >> 6); - - csd->block_len = (1L << (buf[5] & 0x0F)); - csd->block_num = (c_size + 1) * mult; - csd->capacity = (csd->block_len * csd->block_num) >> 20; // in MB - - LOG_INFO("block_len %d bytes, block_num %ld, total capacity %dMB\n", csd->block_len, csd->block_num, csd->capacity); - return 0; - } - else - return EOF; -} - - -#define SD_READ_SINGLEBLOCK 0x51 - -static int16_t sd_readBlock(void *buf, uint32_t addr) -{ - SD_SELECT(); - - int16_t r1 = sd_sendCommand(SD_READ_SINGLEBLOCK, addr, 0); - - if (r1) - { - LOG_ERR("read single block failed: %04X\n", r1); - sd_select(false); - return r1; - } - - bool res = sd_getBlock(buf, SD_DEFAULT_BLOCKLEN); - sd_select(false); - if (!res) - { - LOG_ERR("read single block failed reading data\n"); - return EOF; - } - else - return 0; -} -#define SD_WRITE_SINGLEBLOCK 0x58 -#define SD_DATA_ACCEPTED 0x05 +#ifdef SD_INCLUDE_SPI_SOURCE + #include +#endif -static int16_t sd_writeBlock(const void *buf, uint32_t addr) +void sd_writeTest(Sd *sd) { - SD_SELECT(); - - int16_t r1 = sd_sendCommand(SD_WRITE_SINGLEBLOCK, addr, 0); - - if (r1) - { - LOG_ERR("write single block failed: %04X\n", r1); - sd_select(false); - return r1; - } - - kfile_putc(SD_STARTTOKEN, fd); - kfile_write(fd, buf, SD_DEFAULT_BLOCKLEN); - /* send fake crc */ - kfile_putc(0, fd); - kfile_putc(0, fd); - uint8_t dataresp = (kfile_getc(fd) & 0x1F); - sd_select(false); + uint8_t buf[SD_DEFAULT_BLOCKLEN]; + memset(buf, 0, sizeof(buf)); - // FIXME: sometimes dataresp is 0, find out why. - if (dataresp != SD_DATA_ACCEPTED) + for (block_idx_t i = 0; i < sd->b.blk_cnt; i++) { - LOG_ERR("write single block failed: %02X\n", dataresp); - return EOF; + LOG_INFO("writing block %ld: %s\n", i, (kblock_read(&sd->b, i, buf, 0, SD_DEFAULT_BLOCKLEN) == SD_DEFAULT_BLOCKLEN) ? "OK" : "FAIL"); } - else - return 0; } - -bool sd_test(void) +bool sd_test(Sd *sd) { - CardCSD csd; - sd_getCSD(&csd); - uint8_t buf[SD_DEFAULT_BLOCKLEN]; - if (sd_readBlock(buf, 0) != 0) + if (kblock_read(&sd->b, 0, buf, 0, sd->b.blk_size) != sd->b.blk_size) return false; kputchar('\n'); @@ -312,15 +79,15 @@ bool sd_test(void) kputchar('\n'); } - if (sd_writeBlock(buf, 0) != 0) + if (kblock_write(&sd->b, 0, buf, 0, SD_DEFAULT_BLOCKLEN) != SD_DEFAULT_BLOCKLEN) return false; memset(buf, 0, sizeof(buf)); - if (sd_readBlock(buf, 0) != 0) + if (kblock_read(&sd->b, 0, buf, 0, sd->b.blk_size) != sd->b.blk_size) return false; kputchar('\n'); - for (int i = 0; i < SD_DEFAULT_BLOCKLEN; i++) + for (block_idx_t i = 0; i < sd->b.blk_size; i++) { kprintf("%02X ", buf[i]); buf[i] = i; @@ -331,168 +98,5 @@ bool sd_test(void) return true; } -#define SD_GO_IDLE_STATE 0x40 -#define SD_GO_IDLE_STATE_CRC 0x95 -#define SD_SEND_OP_COND 0x41 -#define SD_SEND_OP_COND_CRC 0xF9 - -#define SD_START_DELAY ms_to_ticks(10) -#define SD_INIT_TIMEOUT ms_to_ticks(1000) -#define SD_IDLE_RETRIES 4 - -bool sd_init(KFile *_fd) -{ - uint16_t r1; - - ASSERT(_fd); - fd = _fd; - - SD_CS_INIT(); - SD_CS_OFF(); - - /* Wait a few moments for supply voltage to stabilize */ - timer_delay(SD_START_DELAY); - - /* Give 80 clk pulses to wake up the card */ - for (int i = 0; i < 10; i++) - kfile_putc(0xff, fd); - kfile_flush(fd); - - for (int i = 0; i < SD_IDLE_RETRIES; i++) - { - SD_SELECT(); - r1 = sd_sendCommand(SD_GO_IDLE_STATE, 0, SD_GO_IDLE_STATE_CRC); - sd_select(false); - - if (r1 == SD_IN_IDLE) - break; - } - - if (r1 != SD_IN_IDLE) - { - LOG_ERR("go_idle_state failed: %04X\n", r1); - return false; - } - - ticks_t start = timer_clock(); - /* Wait for card to start */ - do - { - SD_SELECT(); - r1 = sd_sendCommand(SD_SEND_OP_COND, 0, SD_SEND_OP_COND_CRC); - sd_select(false); - cpu_relax(); - } - while (r1 != 0 && timer_clock() - start < SD_INIT_TIMEOUT); - - if (r1) - { - LOG_ERR("send_op_cond failed: %04X\n", r1); - return false; - } - - r1 = sd_setBlockLen(SD_DEFAULT_BLOCKLEN); - - if (r1) - { - LOG_ERR("setBlockLen failed: %04X\n", r1); - return false; - } - sd_status = !r1; - return sd_status; -} - -DSTATUS sd_disk_initialize(BYTE drv) -{ - return sd_disk_status(drv); -} - -DSTATUS sd_disk_status(BYTE drv) -{ - ASSERT(!drv); - - if (sd_status) - return RES_OK; - else - return STA_NOINIT; -} - -DRESULT sd_disk_read(BYTE drv, BYTE* buf, DWORD sector, BYTE count) -{ - ASSERT(!drv); - - if (!sd_status) - return RES_NOTRDY; - - while (count--) - { - if (sd_readBlock(buf, sector * SD_DEFAULT_BLOCKLEN)) - return RES_ERROR; - buf += SD_DEFAULT_BLOCKLEN; - sector++; - } - return RES_OK; -} - -DRESULT sd_disk_write(BYTE drv, const BYTE* buf, DWORD sector, BYTE count) -{ - ASSERT(!drv); - - if (!sd_status) - return RES_NOTRDY; - - while (count--) - { - if (sd_writeBlock(buf, sector * SD_DEFAULT_BLOCKLEN)) - return RES_ERROR; - buf += SD_DEFAULT_BLOCKLEN; - sector++; - } - return RES_OK; -} - -DRESULT sd_disk_ioctl(BYTE drv, BYTE cmd, void* buf) -{ - ASSERT(!drv); - - if (!sd_status) - return RES_NOTRDY; - - switch (cmd) - { - case CTRL_SYNC: - return RES_OK; - - case GET_SECTOR_SIZE: - *(WORD *)buf = SD_DEFAULT_BLOCKLEN; - return RES_OK; - - case GET_SECTOR_COUNT: - { - CardCSD csd; - if (sd_getCSD(&csd)) - return RES_ERROR; - else - { - *(DWORD *)buf = csd.block_num; - return RES_OK; - } - - } - - case GET_BLOCK_SIZE: - *(DWORD *)buf = 1; - return RES_OK; - - default: - LOG_ERR("unknown command: [%d]\n", cmd); - return RES_PARERR; - } -} - -DWORD get_fattime(void) -{ - return 0; -}