bertos/drv/sd.c

   1 /**
   2  * \file
   3  * <!--
   4  * This file is part of BeRTOS.
   5  *
   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.
  10  *
  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.
  15  *
  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
  19  *
  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.
  28  *
  29  * Copyright 2007 Develer S.r.l. (http://www.develer.com/)
  30  * -->
  31  *
  32  * \brief Function library for secure digital memory.
  33  *
  34  * \author Francesco Sacchi <batt@develer.com>
  35  */
  36
  37
  38 #include "sd.h"
  39 #include "hw/hw_sd.h"
  40 #include <io/kfile.h>
  41 #include <io/kblock.h>
  42 #include <drv/timer.h>
  43
  44 #include <fs/fat.h>
  45
  46 #include "cfg/cfg_sd.h"
  47
  48 #define LOG_LEVEL  SD_LOG_LEVEL
  49 #define LOG_FORMAT SD_LOG_FORMAT
  50 #include <cfg/log.h>
  51 #include <cpu/power.h>
  52
  53 #include <string.h> /* memset */
  54
  55 /**
  56  * Card Specific Data
  57  * read directly from the card.
  58  */
  59 typedef struct CardCSD
  60 {
  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
  64 } CardCSD;
  65
  66 #define SD_IN_IDLE    0x01
  67 #define SD_STARTTOKEN 0xFE
  68
  69 #define TIMEOUT_NAC   16384
  70 #define SD_DEFAULT_BLOCKLEN 512
  71
  72 #define SD_BUSY_TIMEOUT ms_to_ticks(200)
  73
  74 static bool sd_select(Sd *sd, bool state)
  75 {
  76         KFile *fd = sd->ch;
  77
  78         if (state)
  79         {
  80                 SD_CS_ON();
  81
  82                 ticks_t start = timer_clock();
  83                 do
  84                 {
  85                         if (kfile_getc(fd) == 0xff)
  86                                 return true;
  87
  88                         cpu_relax();
  89                 }
  90                 while (timer_clock() - start < SD_BUSY_TIMEOUT);
  91
  92                 SD_CS_OFF();
  93                 LOG_ERR("sd_select timeout\n");
  94                 return false;
  95         }
  96         else
  97         {
  98                 kfile_putc(0xff, fd);
  99                 kfile_flush(fd);
 100                 SD_CS_OFF();
 101                 return true;
 102         }
 103 }
 104
 105 static int16_t sd_waitR1(Sd *sd)
 106 {
 107         uint8_t datain;
 108
 109         for (int i = 0; i < TIMEOUT_NAC; i++)
 110         {
 111                 datain = kfile_getc(sd->ch);
 112                 if (datain != 0xff)
 113                         return (int16_t)datain;
 114         }
 115         LOG_ERR("Timeout waiting R1\n");
 116         return EOF;
 117 }
 118
 119 static int16_t sd_sendCommand(Sd *sd, uint8_t cmd, uint32_t param, uint8_t crc)
 120 {
 121         KFile *fd = sd->ch;
 122         /* The 7th bit of command must be a 1 */
 123         kfile_putc(cmd | 0x40, fd);
 124
 125         /* send parameter */
 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);
 130
 131         kfile_putc(crc, fd);
 132
 133         return sd_waitR1(sd);
 134 }
 135
 136 static bool sd_getBlock(Sd *sd, void *buf, size_t len)
 137 {
 138         uint8_t token;
 139         uint16_t crc;
 140
 141         KFile *fd = sd->ch;
 142
 143         for (int i = 0; i < TIMEOUT_NAC; i++)
 144         {
 145                 token = kfile_getc(fd);
 146                 if (token != 0xff)
 147                 {
 148                         if (token == SD_STARTTOKEN)
 149                         {
 150                                 if (kfile_read(fd, buf, len) == len)
 151                                 {
 152                                         if (kfile_read(fd, &crc, sizeof(crc)) == sizeof(crc))
 153                                                 /* check CRC here if needed */
 154                                                 return true;
 155                                         else
 156                                                 LOG_ERR("get_block error getting crc\n");
 157                                 }
 158                                 else
 159                                         LOG_ERR("get_block len error: %d\n", (int)len);
 160                         }
 161                         else
 162                                 LOG_ERR("get_block token error: %02X\n", token);
 163
 164                         return false;
 165                 }
 166         }
 167
 168         LOG_ERR("get_block timeout waiting token\n");
 169         return false;
 170 }
 171
 172 #define SD_SELECT(sd) \
 173 do \
 174 { \
 175         if (!sd_select((sd), true)) \
 176         { \
 177                 LOG_ERR("%s failed, card busy\n", __func__); \
 178                 return EOF; \
 179         } \
 180 } \
 181 while (0)
 182
 183 #define SD_SETBLOCKLEN 0x50
 184
 185 static int16_t sd_setBlockLen(Sd *sd, uint32_t newlen)
 186 {
 187         SD_SELECT(sd);
 188
 189         sd->r1 = sd_sendCommand(sd, SD_SETBLOCKLEN, newlen, 0);
 190
 191         sd_select(sd, false);
 192         return sd->r1;
 193 }
 194
 195 #define SD_SEND_CSD 0x49
 196
 197 static int16_t sd_getCSD(Sd *sd, CardCSD *csd)
 198 {
 199         SD_SELECT(sd);
 200
 201         int16_t r1 = sd_sendCommand(sd, SD_SEND_CSD, 0, 0);
 202
 203         if (r1)
 204         {
 205                 LOG_ERR("send_csd failed: %04X\n", sd->r1);
 206                 sd_select(sd, false);
 207                 return r1;
 208         }
 209
 210         uint8_t buf[16];
 211         bool res = sd_getBlock(sd, buf, sizeof(buf));
 212         sd_select(sd, false);
 213
 214         if (res)
 215         {
 216                 #if LOG_LEVEL >= LOG_LVL_INFO
 217                         LOG_INFO("CSD: [");
 218                         for (int i = 0; i < 16; i++)
 219                                 kprintf("%02X ", buf[i]);
 220                         kprintf("]\n");
 221                 #endif
 222
 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);
 226
 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
 230
 231                 LOG_INFO("block_len %d bytes, block_num %ld, total capacity %dMB\n", csd->block_len, csd->block_num, csd->capacity);
 232                 return 0;
 233         }
 234         else
 235                 return EOF;
 236 }
 237
 238 #if CPU_CM3_SAM3X8
 239
 240 #include <drv/hsmci_sam3.h>
 241
 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)
 244
 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
 249
 250
 251 LOG_INFOB(
 252 static void dump(const char *label, uint32_t *r, size_t len)
 253 {
 254         ASSERT(r);
 255         size_t i;
 256         int j = 0;
 257         kprintf("\n%s [\n", label);
 258         for (i = 0; i < len; i++)
 259         {
 260                 if (j == 5)
 261                 {
 262                         kputs("\n");
 263                         j = 0;
 264                 }
 265                 kprintf("%08lx ", r[i]);
 266                 j++;
 267         }
 268         kprintf("\n] len=%d\n\n", i);
 269 }
 270 )
 271
 272 static const uint32_t tran_exp[] =
 273 {
 274     10000,      100000,     1000000,    10000000,
 275     0,      0,      0,      0
 276 };
 277
 278 static const uint8_t tran_mant[] =
 279 {
 280     0,  10, 12, 13, 15, 20, 25, 30,
 281     35, 40, 45, 50, 55, 60, 70, 80,
 282 };
 283
 284 static int sd_decodeCsd(SDcsd *csd, uint32_t *resp, size_t len)
 285 {
 286         ASSERT(csd);
 287         ASSERT(resp);
 288         ASSERT(len >= 4);
 289
 290     csd->structure = UNSTUFF_BITS(resp, 126, 2);
 291         csd->ccc = UNSTUFF_BITS(resp, 84, 12);
 292
 293     csd->max_data_rate  = tran_exp[UNSTUFF_BITS(resp, 96, 3)] * tran_mant[UNSTUFF_BITS(resp, 99, 4)];
 294
 295         /*
 296          * CSD structure:
 297          * - 0:
 298          *              - Version 1.01-1.10
 299          *              - Version 2.00/Standard Capacity
 300          * - 1:
 301          *              - Version 2.00/High Capacity
 302          * - >1: not defined.
 303          */
 304
 305     if (csd->structure == 0)
 306         {
 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);
 309
 310                 csd->read_blk_bits = UNSTUFF_BITS(resp, 80, 4);
 311                 csd->write_blk_bits = UNSTUFF_BITS(resp, 22, 4);
 312
 313                 csd->blk_len = 1 << csd->read_blk_bits;
 314         csd->capacity  = csd->blk_num * csd->blk_len;
 315
 316         csd->read_partial = UNSTUFF_BITS(resp, 79, 1);
 317         csd->read_misalign = UNSTUFF_BITS(resp, 77, 1);
 318
 319         csd->write_misalign = UNSTUFF_BITS(resp, 78, 1);
 320         csd->write_partial = UNSTUFF_BITS(resp, 21, 1);
 321
 322         if (UNSTUFF_BITS(resp, 46, 1))
 323                 {
 324             csd->erase_size = 1;
 325         }
 326                 else if(csd->write_blk_bits >= 9)
 327                 {
 328             csd->erase_size = UNSTUFF_BITS(resp, 39, 7) + 1;
 329             csd->erase_size <<= csd->write_blk_bits - 9;
 330         }
 331
 332                 return 0;
 333         }
 334         else if (csd->structure == 1)
 335         {
 336                 kprintf("csize %ld\n", UNSTUFF_BITS(resp, 48, 22));
 337         csd->capacity  = (1 + UNSTUFF_BITS(resp, 48, 22)) << 10;
 338
 339                 csd->write_blk_bits = 9;
 340                 csd->write_partial = 0;
 341         csd->write_misalign = 0;
 342
 343                 csd->read_blk_bits = 9;
 344                 csd->read_partial = 0;
 345         csd->read_misalign = 0;
 346
 347         csd->erase_size = 1;
 348                 // the block size if fixed to 512kb
 349                 csd->blk_len = (1 << csd->write_blk_bits) << 10;
 350
 351         return 0;
 352         }
 353     else
 354         {
 355         kprintf("Unrecognised CSD structure version %d\n", csd->structure);
 356         return -1;
 357     }
 358
 359     return 0;
 360 }
 361
 362
 363 void sd_dumpCsd(Sd *sd)
 364 {
 365         ASSERT(sd);
 366
 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);
 378
 379 }
 380
 381 void sd_dumpCid(Sd *sd)
 382 {
 383         ASSERT(sd);
 384
 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));
 392 }
 393
 394 void sd_dumpSsr(Sd *sd)
 395 {
 396         ASSERT(sd);
 397
 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);
 403 }
 404
 405
 406 void sd_sendInit(void)
 407 {
 408         hsmci_init(NULL); //TODO: REMOVE IT!
 409
 410         if (hsmci_sendCmd(0, 0, HSMCI_CMDR_SPCMD_INIT | HSMCI_CMDR_RSPTYP_NORESP))
 411                 LOG_ERR("INIT: %lx\n", HSMCI_SR);
 412 }
 413
 414
 415 void sd_goIdle(void)
 416 {
 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);
 420 }
 421
 422 int sd_sendIfCond(Sd *sd)
 423 {
 424         if (hsmci_sendCmd(8, CMD8_V_RANGE_27V_36V, HSMCI_CMDR_RSPTYP_48_BIT))
 425         {
 426                 LOG_ERR("IF_COND %lx\n", HSMCI_SR);
 427                 return -1;
 428         }
 429         hsmci_readResp(&(sd->status), 1);
 430         if (((sd->status) & 0xFFF) == CMD8_V_RANGE_27V_36V)
 431         {
 432                 LOG_INFO("IF_COND: %lx\n", (sd->status));
 433                 return 0;
 434         }
 435         LOG_ERR("IF_COND: %lx\n", (sd->status));
 436
 437         return -1;
 438 }
 439
 440 int sd_sendAppOpCond(Sd *sd)
 441 {
 442         if (hsmci_sendCmd(55, 0, HSMCI_CMDR_RSPTYP_48_BIT))
 443         {
 444                 LOG_ERR("APP_CMD %lx\n", HSMCI_SR);
 445                 return -1;
 446         }
 447
 448         hsmci_readResp(&(sd->status), 1);
 449         if ((sd->status) & (SD_STATUS_APP_CMD | SD_STATUS_READY))
 450         {
 451                 if (hsmci_sendCmd(41, SD_HOST_VOLTAGE_RANGE | SD_OCR_CCS, HSMCI_CMDR_RSPTYP_48_BIT))// se cmd 8 va ok.
 452                 {
 453                         LOG_ERR("APP_OP_COND %lx\n", HSMCI_SR);
 454                         return -1;
 455                 }
 456                 else
 457                 {
 458                         hsmci_readResp(&(sd->status), 1);
 459                         if ((sd->status) & SD_OCR_BUSY)
 460                         {
 461                                 LOG_INFO("SD power up! Hight Capability [%d]\n", (bool)((sd->status) & SD_OCR_CCS));
 462                                 return 0;
 463                         }
 464
 465                         LOG_ERR("sd not ready.\n");
 466                 }
 467         }
 468
 469         return -1;
 470 }
 471
 472
 473 int sd_getCid(Sd *sd, uint32_t addr, uint8_t flag)
 474 {
 475         ASSERT(sd);
 476         memset(&(sd->cid), 0, sizeof(SDcid));
 477
 478         uint8_t idx = 9; // CMD9 get cid from gived sd address (RCA)
 479         if (flag & SD_SEND_ALL_CID)
 480                 idx = 2;
 481
 482
 483         if (hsmci_sendCmd(idx, SD_ADDR_TO_RCA(addr), HSMCI_CMDR_RSPTYP_136_BIT))
 484         {
 485                 LOG_ERR("GET_CID %lx\n", HSMCI_SR);
 486                 return -1;
 487         }
 488         else
 489         {
 490                 uint32_t resp[4];
 491                 hsmci_readResp(resp, 4);
 492                 LOG_INFOB(dump("CID", resp, 4););
 493
 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);
 505         }
 506
 507         return 0;
 508 }
 509
 510 int sd_getCsd(Sd *sd)
 511 {
 512         ASSERT(sd);
 513         memset(&(sd->csd), 0, sizeof(SDcsd));
 514
 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))
 517         {
 518                 LOG_ERR("GET_CSD %lx\n", HSMCI_SR);
 519                 return -1;
 520         }
 521         else
 522         {
 523                 uint32_t resp[4];
 524                 hsmci_readResp(resp, 4);
 525                 LOG_INFOB(dump("CSD", resp, 4););
 526                 sd_decodeCsd(&(sd->csd), resp, 4);
 527         }
 528
 529         return 0;
 530 }
 531
 532 int sd_getRelativeAddr(Sd *sd)
 533 {
 534         ASSERT(sd);
 535         if (hsmci_sendCmd(3, 0, HSMCI_CMDR_RSPTYP_48_BIT))
 536         {
 537                 LOG_ERR("RCA: %lx\n", HSMCI_SR);
 538                 return -1;
 539         }
 540
 541         hsmci_readResp(&sd->addr, 1);
 542         sd->addr = sd->addr >> 16;
 543
 544         LOG_INFOB(dump("RCA", &sd->addr, 1););
 545
 546         return 0;
 547 }
 548
 549 int sd_appStatus(Sd *sd)
 550 {
 551         ASSERT(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))
 554         {
 555                 LOG_ERR("STATUS: %lx\n", HSMCI_SR);
 556                 return -1;
 557         }
 558
 559         hsmci_readResp(&(sd->status), 1);
 560         LOG_INFOB(dump("STATUS", &(sd->status), 1););
 561
 562         LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
 563
 564         if (sd->status & SD_STATUS_READY)
 565                 return 0;
 566
 567         return -1;
 568 }
 569
 570
 571 INLINE int sd_cardSelection(Sd *sd, uint32_t rca)
 572 {
 573         ASSERT(sd);
 574         LOG_INFO("Select RCA: %lx\n", rca);
 575         if (hsmci_sendCmd(7, rca, HSMCI_CMDR_RSPTYP_R1B))
 576         {
 577                 LOG_ERR("SELECT_SD: %lx\n", HSMCI_SR);
 578                 return -1;
 579         }
 580
 581         HSMCI_CHECK_BUSY();
 582         hsmci_readResp(&(sd->status), 1);
 583         LOG_INFOB(dump("SELECT_SD", &(sd->status), 1););
 584
 585         LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
 586
 587         if (sd->status & SD_STATUS_READY)
 588                 return 0;
 589
 590         return -1;
 591 }
 592
 593 int sd_selectCard(Sd *sd)
 594 {
 595         ASSERT(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))
 599         {
 600                 LOG_ERR("SELECT_SD: %lx\n", HSMCI_SR);
 601                 return -1;
 602         }
 603
 604         HSMCI_CHECK_BUSY();
 605         hsmci_readResp(&(sd->status), 1);
 606
 607         LOG_INFOB(dump("SELECT_SD", &(sd->status), 1););
 608         LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
 609
 610         if (sd->status & SD_STATUS_READY)
 611                 return 0;
 612
 613         return -1;
 614 }
 615
 616 int sd_deSelectCard(Sd *sd)
 617 {
 618         ASSERT(sd);
 619
 620         uint32_t rca = 0;
 621         if (!sd->addr)
 622                 rca = SD_ADDR_TO_RCA(sd->addr + 1);
 623
 624         LOG_INFO("Select RCA: %lx\n", rca);
 625
 626         if (hsmci_sendCmd(7, rca, HSMCI_CMDR_RSPTYP_NORESP))
 627         {
 628                 LOG_ERR("DESELECT_SD: %lx\n", HSMCI_SR);
 629                 return -1;
 630         }
 631
 632         return 0;
 633
 634 }
 635
 636 int sd_setBusWidth(Sd *sd, size_t len)
 637 {
 638         ASSERT(sd);
 639
 640         if (hsmci_sendCmd(55, SD_ADDR_TO_RCA(sd->addr), HSMCI_CMDR_RSPTYP_48_BIT))
 641         {
 642                 LOG_ERR("APP_CMD %lx\n", HSMCI_SR);
 643                 return -1;
 644         }
 645
 646         hsmci_readResp(&(sd->status), 1);
 647         if ((sd->status) & (SD_STATUS_APP_CMD | SD_STATUS_READY))
 648         {
 649                 hsmci_setBusWidth(len);
 650
 651                 uint8_t arg = 0;
 652                 if (len == 4)
 653                         arg = 2;
 654
 655                 if (hsmci_sendCmd(6, arg, HSMCI_CMDR_RSPTYP_48_BIT))
 656                 {
 657                         LOG_ERR("SET_BUS_WIDTH CMD: %lx\n", HSMCI_SR);
 658                         return -1;
 659                 }
 660
 661                 hsmci_readResp(&(sd->status), 1);
 662
 663                 LOG_INFOB(dump("SET_BUS_WIDTH", &(sd->status), 1););
 664                 LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
 665
 666                 if (sd->status & SD_STATUS_READY)
 667                         return 0;
 668         }
 669
 670         LOG_ERR("SET_BUS_WIDTH REP %lx\n", (sd->status));
 671         return -1;
 672 }
 673
 674
 675 int sd_set_BlockLen(Sd *sd, size_t len)
 676 {
 677         ASSERT(sd);
 678
 679         if (hsmci_sendCmd(16, len, HSMCI_CMDR_RSPTYP_48_BIT))
 680         {
 681                 LOG_ERR("SET_BLK_LEN: %lx\n", HSMCI_SR);
 682                 return -1;
 683         }
 684
 685         hsmci_readResp(&(sd->status), 1);
 686
 687         LOG_INFOB(dump("SET_BLK_LEN", &(sd->status), 1););
 688         LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
 689
 690         sd->csd.blk_len = len;
 691
 692         if (sd->status & SD_STATUS_READY)
 693                 return 0;
 694
 695         return -1;
 696 }
 697
 698 int sd_getStatus(Sd *sd, uint32_t *buf, size_t words)
 699 {
 700         ASSERT(sd);
 701
 702         // Status reply with 512bit data, so the block size in byte is 64
 703         hsmci_prgRxDMA(buf, words, 64);
 704
 705         if (hsmci_sendCmd(55, SD_ADDR_TO_RCA(sd->addr), HSMCI_CMDR_RSPTYP_48_BIT))
 706         {
 707                 LOG_ERR("APP_CMD %lx\n", HSMCI_SR);
 708                 return -1;
 709         }
 710
 711         uint32_t status = HSMCI_RSPR;
 712         if (status & (SD_STATUS_APP_CMD | SD_STATUS_READY))
 713         {
 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))
 716                 {
 717                         LOG_ERR("STATUS CMD: %lx\n", HSMCI_SR);
 718                         return -1;
 719                 }
 720
 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));
 724
 725                 if (sd->status & SD_STATUS_READY)
 726                 {
 727                         hsmci_waitTransfer();
 728
 729                         LOG_INFOB(dump("STATUS", buf, words););
 730                         memset(&(sd->ssr), 0, sizeof(SDssr));
 731
 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);
 737
 738                         return 0;
 739                 }
 740         }
 741
 742         return -1;
 743 }
 744
 745
 746 void sd_setHightSpeed(Sd *sd)
 747 {
 748         (void)sd;
 749         hsmci_setSpeed(2100000, true);
 750 }
 751
 752 #endif
 753
 754
 755 #define SD_START_DELAY  10
 756 #define SD_INIT_TIMEOUT ms_to_ticks(2000)
 757 #define SD_IDLE_RETRIES 4
 758
 759 #if CPU_CM3_SAM3X8
 760
 761 static size_t sd_SdReadDirect(struct KBlock *b, block_idx_t idx, void *buf, size_t offset, size_t size)
 762 {
 763         ASSERT(buf);
 764         Sd *sd = SD_CAST(b);
 765         LOG_INFO("reading from block %ld, offset %d, size %d\n", idx, offset, size);
 766
 767         if (sd_selectCard(sd) < 0)
 768                 return -1;
 769
 770         hsmci_prgRxDMA(buf, size / 4, sd->csd.blk_len);
 771
 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))
 774         {
 775                 LOG_ERR("SIGLE_BLK_READ: %lx\n", HSMCI_SR);
 776                 sd_deSelectCard(sd);
 777                 return -1;
 778         }
 779
 780         hsmci_readResp(&(sd->status), 1);
 781
 782         LOG_INFOB(dump("SIGLE_BLK_READ", &(sd->status), 1););
 783         LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
 784
 785         if (sd->status & SD_STATUS_READY)
 786         {
 787                 hsmci_waitTransfer();
 788                 sd_deSelectCard(sd);
 789                 return size;
 790         }
 791
 792         sd_deSelectCard(sd);
 793         return -1;
 794 }
 795
 796 static size_t sd_SdWriteDirect(KBlock *b, block_idx_t idx, const void *buf, size_t offset, size_t size)
 797 {
 798         ASSERT(buf);
 799         Sd *sd = SD_CAST(b);
 800         const uint32_t *_buf = (const uint32_t *)buf;
 801         LOG_INFO("reading from block %ld, offset %d, size %d\n", idx, offset, size);
 802
 803         if (sd_selectCard(sd) < 0)
 804                 return 0;
 805
 806         hsmci_prgTxDMA(_buf, size / 4, sd->csd.blk_len);
 807
 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))
 810         {
 811                 LOG_ERR("SIGLE_BLK_WRITE: %lx\n", HSMCI_SR);
 812                 sd_deSelectCard(sd);
 813                 return -1;
 814         }
 815
 816         hsmci_readResp(&(sd->status), 1);
 817
 818         LOG_INFOB(dump("SIGLE_BLK_WR", &(sd->status), 1););
 819         LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
 820
 821         if (sd->status & SD_STATUS_READY)
 822         {
 823                 hsmci_waitTransfer();
 824                 sd_deSelectCard(sd);
 825                 return size;
 826         }
 827
 828         sd_deSelectCard(sd);
 829         return -1;
 830 }
 831
 832
 833 static int sd_SdError(KBlock *b)
 834 {
 835         Sd *sd = SD_CAST(b);
 836         return 0;//sd->status;
 837 }
 838
 839 static void sd_SdClearerr(KBlock *b)
 840 {
 841         Sd *sd = SD_CAST(b);
 842         sd->status = 0;
 843 }
 844
 845
 846
 847 static bool sd_SdBlockInit(Sd *sd)
 848 {
 849         /* Wait a few moments for supply voltage to stabilize */
 850         timer_delay(SD_START_DELAY);
 851
 852         sd_sendInit();
 853         sd_goIdle();
 854
 855         sd_sendIfCond(sd);
 856
 857         ticks_t start = timer_clock();
 858         bool sd_power_on = false;
 859         do
 860         {
 861                 if (!sd_sendAppOpCond(sd))
 862                 {
 863                         sd_power_on = true;
 864                         break;
 865                 }
 866                 cpu_relax();
 867         }
 868         while (timer_clock() - start < SD_INIT_TIMEOUT);
 869
 870
 871         if (sd_power_on)
 872         {
 873
 874                 if(sd_getCid(sd, 0, SD_SEND_ALL_CID) < 0)
 875                         return false;
 876                 else
 877                 {
 878                         sd_dumpCid(sd);
 879                 }
 880
 881                 if (sd_getRelativeAddr(sd) < 0)
 882                         return false;
 883                 else
 884                 {
 885                         LOG_INFO("RCA: %0lx\n", sd->addr);
 886                 }
 887
 888
 889                 if (sd_getCsd(sd) < 0)
 890                         return false;
 891                 else
 892                 {
 893                         sd_dumpCsd(sd);
 894                 }
 895
 896                 if (sd_appStatus(sd) < 0)
 897                 {
 898                         LOG_INFO("STATUS: %ld\n", sd->status);
 899                         return false;
 900                 }
 901
 902                 if (sd->status & SD_CARD_IS_LOCKED)
 903                 {
 904                         LOG_INFO("SD is locked!\n");
 905                         return false;
 906                 }
 907
 908                 if (sd->status & SD_READY_FOR_DATA)
 909                 {
 910                         sd_selectCard(sd);
 911                         sd_set_BlockLen(sd, SD_DEFAULT_BLOCKLEN);
 912                         sd_setBus4bit(sd);
 913                         sd_setHightSpeed(sd);
 914                         sd_deSelectCard(sd);
 915
 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);
 919
 920                         return true;
 921                 }
 922         }
 923
 924         return false;
 925 }
 926
 927 #else
 928
 929 #define SD_READ_SINGLEBLOCK 0x51
 930
 931 static size_t sd_SpiReadDirect(struct KBlock *b, block_idx_t idx, void *buf, size_t offset, size_t size)
 932 {
 933
 934         Sd *sd = SD_CAST(b);
 935         LOG_INFO("reading from block %ld, offset %d, size %d\n", idx, offset, size);
 936
 937         if (sd->tranfer_len != size)
 938         {
 939                 if ((sd->r1 = sd_setBlockLen(sd, size)))
 940                 {
 941                         LOG_ERR("setBlockLen failed: %04X\n", sd->r1);
 942                         return 0;
 943                 }
 944                 sd->tranfer_len = size;
 945         }
 946
 947         SD_SELECT(sd);
 948
 949         sd->r1 = sd_sendCommand(sd, SD_READ_SINGLEBLOCK, idx * SD_DEFAULT_BLOCKLEN + offset, 0);
 950
 951         if (sd->r1)
 952         {
 953                 LOG_ERR("read single block failed: %04X\n", sd->r1);
 954                 sd_select(sd, false);
 955                 return 0;
 956         }
 957
 958         bool res = sd_getBlock(sd, buf, size);
 959         sd_select(sd, false);
 960         if (!res)
 961         {
 962                 LOG_ERR("read single block failed reading data\n");
 963                 return 0;
 964         }
 965         else
 966                 return size;
 967 }
 968
 969 #define SD_WRITE_SINGLEBLOCK 0x58
 970 #define SD_DATA_ACCEPTED     0x05
 971
 972 static size_t sd_SpiWriteDirect(KBlock *b, block_idx_t idx, const void *buf, size_t offset, size_t size)
 973 {
 974         Sd *sd = SD_CAST(b);
 975         KFile *fd = sd->ch;
 976         ASSERT(offset == 0);
 977         ASSERT(size == SD_DEFAULT_BLOCKLEN);
 978
 979         LOG_INFO("writing block %ld\n", idx);
 980         if (sd->tranfer_len != SD_DEFAULT_BLOCKLEN)
 981         {
 982                 if ((sd->r1 = sd_setBlockLen(sd, SD_DEFAULT_BLOCKLEN)))
 983                 {
 984                         LOG_ERR("setBlockLen failed: %04X\n", sd->r1);
 985                         return 0;
 986                 }
 987                 sd->tranfer_len = SD_DEFAULT_BLOCKLEN;
 988         }
 989
 990         SD_SELECT(sd);
 991
 992         sd->r1 = sd_sendCommand(sd, SD_WRITE_SINGLEBLOCK, idx * SD_DEFAULT_BLOCKLEN, 0);
 993
 994         if (sd->r1)
 995         {
 996                 LOG_ERR("write single block failed: %04X\n", sd->r1);
 997                 sd_select(sd, false);
 998                 return 0;
 999         }
1000
1001         kfile_putc(SD_STARTTOKEN, fd);
1002         kfile_write(fd, buf, SD_DEFAULT_BLOCKLEN);
1003         /* send fake crc */
1004         kfile_putc(0, fd);
1005         kfile_putc(0, fd);
1006
1007         uint8_t dataresp = kfile_getc(fd);
1008         sd_select(sd, false);
1009
1010         if ((dataresp & 0x1f) != SD_DATA_ACCEPTED)
1011         {
1012                 LOG_ERR("write block %ld failed: %02X\n", idx, dataresp);
1013                 return EOF;
1014         }
1015
1016         return SD_DEFAULT_BLOCKLEN;
1017 }
1018
1019 static int sd_SpiError(KBlock *b)
1020 {
1021         Sd *sd = SD_CAST(b);
1022         return sd->r1;
1023 }
1024
1025 static void sd_SpiClearerr(KBlock *b)
1026 {
1027         Sd *sd = SD_CAST(b);
1028         sd->r1 = 0;
1029 }
1030
1031
1032
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
1037
1038 static bool sd_SpiBlockInit(Sd *sd, KFile *ch)
1039 {
1040         sd->ch = ch;
1041
1042         SD_CS_INIT();
1043         SD_CS_OFF();
1044
1045         /* Wait a few moments for supply voltage to stabilize */
1046         timer_delay(SD_START_DELAY);
1047
1048         /* Give 80 clk pulses to wake up the card */
1049         for (int i = 0; i < 10; i++)
1050                 kfile_putc(0xff, ch);
1051         kfile_flush(ch);
1052
1053         for (int i = 0; i < SD_IDLE_RETRIES; i++)
1054         {
1055                 SD_SELECT(sd);
1056                 sd->r1 = sd_sendCommand(sd, SD_GO_IDLE_STATE, 0, SD_GO_IDLE_STATE_CRC);
1057                 sd_select(sd, false);
1058
1059                 if (sd->r1 == SD_IN_IDLE)
1060                         break;
1061         }
1062
1063         if (sd->r1 != SD_IN_IDLE)
1064         {
1065                 LOG_ERR("go_idle_state failed: %04X\n", sd->r1);
1066                 return false;
1067         }
1068
1069         ticks_t start = timer_clock();
1070
1071         /* Wait for card to start */
1072         do
1073         {
1074                 SD_SELECT(sd);
1075                 sd->r1 = sd_sendCommand(sd, SD_SEND_OP_COND, 0, SD_SEND_OP_COND_CRC);
1076                 sd_select(sd, false);
1077                 cpu_relax();
1078         }
1079         while (sd->r1 != 0 && timer_clock() - start < SD_INIT_TIMEOUT);
1080
1081         if (sd->r1)
1082         {
1083                 LOG_ERR("send_op_cond failed: %04X\n", sd->r1);
1084                 return false;
1085         }
1086
1087         sd->r1 = sd_setBlockLen(sd, SD_DEFAULT_BLOCKLEN);
1088         sd->tranfer_len = SD_DEFAULT_BLOCKLEN;
1089
1090         if (sd->r1)
1091         {
1092                 LOG_ERR("setBlockLen failed: %04X\n", sd->r1);
1093                 return false;
1094         }
1095
1096         /* Avoid warning for uninitialized csd use (gcc bug?) */
1097         CardCSD csd = csd;
1098
1099         sd->r1 = sd_getCSD(sd, &csd);
1100
1101         if (sd->r1)
1102         {
1103                 LOG_ERR("getCSD failed: %04X\n", sd->r1);
1104                 return false;
1105         }
1106
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);
1110         return true;
1111 }
1112 #endif
1113
1114
1115 static bool sd_blockInit(Sd *sd, KFile *ch)
1116 {
1117         ASSERT(sd);
1118         ASSERT(ch);
1119         memset(sd, 0, sizeof(*sd));
1120         DB(sd->b.priv.type = KBT_SD);
1121
1122 #if CPU_CM3_SAM3X8
1123         if (!sd_SdBlockInit(sd))
1124                 return false;
1125 #else
1126         if (!sd_SpiBlockInit(sd, ch))
1127                 return false;
1128 #endif
1129
1130 #if CONFIG_SD_AUTOASSIGN_FAT
1131         disk_assignDrive(&sd->b, 0);
1132 #endif
1133
1134         return true;
1135 }
1136
1137 #if CPU_CM3_SAM3X8
1138 #define sd_writeDirect     sd_SdWriteDirect
1139 #define sd_readDirect      sd_SdReadDirect
1140 #define sd_error           sd_SdError
1141 #define sd_clearerr        sd_SdClearerr
1142
1143 #else
1144 #define sd_writeDirect     sd_SpiWriteDirect
1145 #define sd_readDirect      sd_SpiReadDirect
1146 #define sd_error           sd_SpiError
1147 #define sd_clearerr        sd_SpiClearerr
1148
1149 #endif
1150
1151 static const KBlockVTable sd_unbuffered_vt =
1152 {
1153         .readDirect = sd_readDirect,
1154         .writeDirect = sd_writeDirect,
1155
1156         .error = sd_error,
1157         .clearerr = sd_clearerr,
1158 };
1159
1160 static const KBlockVTable sd_buffered_vt =
1161 {
1162         .readDirect = sd_readDirect,
1163         .writeDirect = sd_writeDirect,
1164
1165         .readBuf = kblock_swReadBuf,
1166         .writeBuf = kblock_swWriteBuf,
1167         .load = kblock_swLoad,
1168         .store = kblock_swStore,
1169
1170         .error = sd_error,
1171         .clearerr = sd_clearerr,
1172 };
1173
1174 bool sd_initUnbuf(Sd *sd, KFile *ch)
1175 {
1176         if (sd_blockInit(sd, ch))
1177         {
1178                 sd->b.priv.vt = &sd_unbuffered_vt;
1179                 return true;
1180         }
1181         else
1182                 return false;
1183 }
1184
1185 static uint8_t sd_buf[SD_DEFAULT_BLOCKLEN];
1186
1187 bool sd_initBuf(Sd *sd, KFile *ch)
1188 {
1189         if (sd_blockInit(sd, ch))
1190         {
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);
1195                 return true;
1196         }
1197         else
1198                 return false;
1199 }
1200
1201
1202 void sd_writeTest(Sd *sd)
1203 {
1204         uint8_t buf[SD_DEFAULT_BLOCKLEN];
1205         memset(buf, 0, sizeof(buf));
1206
1207         for (block_idx_t i = 0; i < sd->b.blk_cnt; i++)
1208         {
1209                 LOG_INFO("writing block %ld: %s\n", i, (sd_writeDirect(&sd->b, i, buf, 0, SD_DEFAULT_BLOCKLEN) == SD_DEFAULT_BLOCKLEN) ? "OK" : "FAIL");
1210         }
1211 }
1212
1213
1214 bool sd_test(Sd *sd)
1215 {
1216         uint8_t buf[SD_DEFAULT_BLOCKLEN];
1217
1218         if (sd_readDirect(&sd->b, 0, buf, 0, sd->b.blk_size) != sd->b.blk_size)
1219                 return false;
1220
1221         kputchar('\n');
1222         for (int i = 0; i < SD_DEFAULT_BLOCKLEN; i++)
1223         {
1224                 kprintf("%02X ", buf[i]);
1225                 buf[i] = i;
1226                 if (!((i+1) % 16))
1227                         kputchar('\n');
1228         }
1229
1230         if (sd_writeDirect(&sd->b, 0, buf, 0, SD_DEFAULT_BLOCKLEN) != SD_DEFAULT_BLOCKLEN)
1231                 return false;
1232
1233         memset(buf, 0, sizeof(buf));
1234         if (sd_readDirect(&sd->b, 0, buf, 0, sd->b.blk_size) != sd->b.blk_size)
1235                 return false;
1236
1237         kputchar('\n');
1238         for (block_idx_t i = 0; i < sd->b.blk_size; i++)
1239         {
1240                 kprintf("%02X ", buf[i]);
1241                 buf[i] = i;
1242                 if (!((i+1) % 16))
1243                         kputchar('\n');
1244         }
1245
1246         return true;
1247 }
1248
1249
1250