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
 239 #define SD_READ_SINGLEBLOCK 0x51
 240
 241 static size_t sd_readDirect(struct KBlock *b, block_idx_t idx, void *buf, size_t offset, size_t size)
 242 {
 243
 244         Sd *sd = SD_CAST(b);
 245         LOG_INFO("reading from block %ld, offset %d, size %d\n", idx, offset, size);
 246
 247         if (sd->tranfer_len != size)
 248         {
 249                 if ((sd->r1 = sd_setBlockLen(sd, size)))
 250                 {
 251                         LOG_ERR("setBlockLen failed: %04X\n", sd->r1);
 252                         return 0;
 253                 }
 254                 sd->tranfer_len = size;
 255         }
 256
 257         SD_SELECT(sd);
 258
 259         sd->r1 = sd_sendCommand(sd, SD_READ_SINGLEBLOCK, idx * SD_DEFAULT_BLOCKLEN + offset, 0);
 260
 261         if (sd->r1)
 262         {
 263                 LOG_ERR("read single block failed: %04X\n", sd->r1);
 264                 sd_select(sd, false);
 265                 return 0;
 266         }
 267
 268         bool res = sd_getBlock(sd, buf, size);
 269         sd_select(sd, false);
 270         if (!res)
 271         {
 272                 LOG_ERR("read single block failed reading data\n");
 273                 return 0;
 274         }
 275         else
 276                 return size;
 277 }
 278
 279 #define SD_WRITE_SINGLEBLOCK 0x58
 280 #define SD_DATA_ACCEPTED     0x05
 281
 282 static size_t sd_writeDirect(KBlock *b, block_idx_t idx, const void *buf, size_t offset, size_t size)
 283 {
 284         Sd *sd = SD_CAST(b);
 285         KFile *fd = sd->ch;
 286         ASSERT(offset == 0);
 287         ASSERT(size == SD_DEFAULT_BLOCKLEN);
 288
 289         LOG_INFO("writing block %ld\n", idx);
 290         if (sd->tranfer_len != SD_DEFAULT_BLOCKLEN)
 291         {
 292                 if ((sd->r1 = sd_setBlockLen(sd, SD_DEFAULT_BLOCKLEN)))
 293                 {
 294                         LOG_ERR("setBlockLen failed: %04X\n", sd->r1);
 295                         return 0;
 296                 }
 297                 sd->tranfer_len = SD_DEFAULT_BLOCKLEN;
 298         }
 299
 300         SD_SELECT(sd);
 301
 302         sd->r1 = sd_sendCommand(sd, SD_WRITE_SINGLEBLOCK, idx * SD_DEFAULT_BLOCKLEN, 0);
 303
 304         if (sd->r1)
 305         {
 306                 LOG_ERR("write single block failed: %04X\n", sd->r1);
 307                 sd_select(sd, false);
 308                 return 0;
 309         }
 310
 311         kfile_putc(SD_STARTTOKEN, fd);
 312         kfile_write(fd, buf, SD_DEFAULT_BLOCKLEN);
 313         /* send fake crc */
 314         kfile_putc(0, fd);
 315         kfile_putc(0, fd);
 316
 317         uint8_t dataresp = kfile_getc(fd);
 318         sd_select(sd, false);
 319
 320         if ((dataresp & 0x1f) != SD_DATA_ACCEPTED)
 321         {
 322                 LOG_ERR("write block %ld failed: %02X\n", idx, dataresp);
 323                 return EOF;
 324         }
 325
 326         return SD_DEFAULT_BLOCKLEN;
 327 }
 328
 329 void sd_writeTest(Sd *sd)
 330 {
 331         uint8_t buf[SD_DEFAULT_BLOCKLEN];
 332         memset(buf, 0, sizeof(buf));
 333
 334         for (block_idx_t i = 0; i < sd->b.blk_cnt; i++)
 335         {
 336                 LOG_INFO("writing block %ld: %s\n", i, (sd_writeDirect(&sd->b, i, buf, 0, SD_DEFAULT_BLOCKLEN) == SD_DEFAULT_BLOCKLEN) ? "OK" : "FAIL");
 337         }
 338 }
 339
 340
 341 bool sd_test(Sd *sd)
 342 {
 343         uint8_t buf[SD_DEFAULT_BLOCKLEN];
 344
 345         if (sd_readDirect(&sd->b, 0, buf, 0, sd->b.blk_size) != sd->b.blk_size)
 346                 return false;
 347
 348         kputchar('\n');
 349         for (int i = 0; i < SD_DEFAULT_BLOCKLEN; i++)
 350         {
 351                 kprintf("%02X ", buf[i]);
 352                 buf[i] = i;
 353                 if (!((i+1) % 16))
 354                         kputchar('\n');
 355         }
 356
 357         if (sd_writeDirect(&sd->b, 0, buf, 0, SD_DEFAULT_BLOCKLEN) != SD_DEFAULT_BLOCKLEN)
 358                 return false;
 359
 360         memset(buf, 0, sizeof(buf));
 361         if (sd_readDirect(&sd->b, 0, buf, 0, sd->b.blk_size) != sd->b.blk_size)
 362                 return false;
 363
 364         kputchar('\n');
 365         for (block_idx_t i = 0; i < sd->b.blk_size; i++)
 366         {
 367                 kprintf("%02X ", buf[i]);
 368                 buf[i] = i;
 369                 if (!((i+1) % 16))
 370                         kputchar('\n');
 371         }
 372
 373         return true;
 374 }
 375
 376 static int sd_error(KBlock *b)
 377 {
 378         Sd *sd = SD_CAST(b);
 379         return sd->r1;
 380 }
 381
 382 static void sd_clearerr(KBlock *b)
 383 {
 384         Sd *sd = SD_CAST(b);
 385         sd->r1 = 0;
 386 }
 387
 388 static const KBlockVTable sd_unbuffered_vt =
 389 {
 390         .readDirect = sd_readDirect,
 391         .writeDirect = sd_writeDirect,
 392
 393         .error = sd_error,
 394         .clearerr = sd_clearerr,
 395 };
 396
 397 static const KBlockVTable sd_buffered_vt =
 398 {
 399         .readDirect = sd_readDirect,
 400         .writeDirect = sd_writeDirect,
 401
 402         .readBuf = kblock_swReadBuf,
 403         .writeBuf = kblock_swWriteBuf,
 404         .load = kblock_swLoad,
 405         .store = kblock_swStore,
 406
 407         .error = sd_error,
 408         .clearerr = sd_clearerr,
 409 };
 410
 411 #define SD_GO_IDLE_STATE     0x40
 412 #define SD_GO_IDLE_STATE_CRC 0x95
 413 #define SD_SEND_OP_COND      0x41
 414 #define SD_SEND_OP_COND_CRC  0xF9
 415
 416 #define SD_START_DELAY  10
 417 #define SD_INIT_TIMEOUT ms_to_ticks(2000)
 418 #define SD_IDLE_RETRIES 4
 419
 420 static bool sd_blockInit(Sd *sd, KFile *ch)
 421 {
 422         ASSERT(sd);
 423         ASSERT(ch);
 424         memset(sd, 0, sizeof(*sd));
 425         DB(sd->b.priv.type = KBT_SD);
 426         sd->ch = ch;
 427
 428
 429 #if CPU_CM3_SAM3X8
 430
 431         /* Wait a few moments for supply voltage to stabilize */
 432         timer_delay(SD_START_DELAY);
 433
 434         sd_sendInit();
 435         sd_goIdle();
 436
 437         sd_sendIfCond(sd);
 438
 439         ticks_t start = timer_clock();
 440         bool sd_power_on = false;
 441         do
 442         {
 443                 if (!sd_sendAppOpCond(sd))
 444                 {
 445                         sd_power_on = true;
 446                         break;
 447                 }
 448                 cpu_relax();
 449         }
 450         while (timer_clock() - start < SD_INIT_TIMEOUT);
 451
 452
 453         if (sd_power_on)
 454         {
 455
 456                 if(!sd_getCid(sd, 0, SD_SEND_ALL_CID))
 457                 {
 458                         sd_dumpCid(sd);
 459                 }
 460
 461                 if (!sd_getRelativeAddr(sd))
 462                 {
 463                         LOG_INFO("RCA: %0lx\n", sd->addr);
 464                 }
 465
 466
 467                 if (!sd_getCsd(sd))
 468                 {
 469                         sd_dumpCsd(sd);
 470                 }
 471
 472                 if (!sd_appStatus(sd))
 473                 {
 474                         LOG_INFO("STATUS: %ld\n", sd->status);
 475                 }
 476
 477                 if (sd->status & SD_CARD_IS_LOCKED)
 478                 {
 479                         LOG_INFO("SD is locked!\n");
 480                 }
 481                 else if (sd->status & SD_READY_FOR_DATA)
 482                 {
 483                         sd_selectCard(sd);
 484                         sd_set_BlockLen(sd, SD_DEFAULT_BLOCKLEN);
 485                         sd_setBus4bit(sd);
 486                         sd_setHightSpeed(sd);
 487                         sd_deSelectCard(sd);
 488                 }
 489
 490         }
 491 #else
 492         SD_CS_INIT();
 493         SD_CS_OFF();
 494
 495         /* Wait a few moments for supply voltage to stabilize */
 496         timer_delay(SD_START_DELAY);
 497
 498         /* Give 80 clk pulses to wake up the card */
 499         for (int i = 0; i < 10; i++)
 500                 kfile_putc(0xff, ch);
 501         kfile_flush(ch);
 502
 503         for (int i = 0; i < SD_IDLE_RETRIES; i++)
 504         {
 505                 SD_SELECT(sd);
 506                 sd->r1 = sd_sendCommand(sd, SD_GO_IDLE_STATE, 0, SD_GO_IDLE_STATE_CRC);
 507                 sd_select(sd, false);
 508
 509                 if (sd->r1 == SD_IN_IDLE)
 510                         break;
 511         }
 512
 513         if (sd->r1 != SD_IN_IDLE)
 514         {
 515                 LOG_ERR("go_idle_state failed: %04X\n", sd->r1);
 516                 return false;
 517         }
 518
 519         ticks_t start = timer_clock();
 520
 521         /* Wait for card to start */
 522         do
 523         {
 524                 SD_SELECT(sd);
 525                 sd->r1 = sd_sendCommand(sd, SD_SEND_OP_COND, 0, SD_SEND_OP_COND_CRC);
 526                 sd_select(sd, false);
 527                 cpu_relax();
 528         }
 529         while (sd->r1 != 0 && timer_clock() - start < SD_INIT_TIMEOUT);
 530
 531         if (sd->r1)
 532         {
 533                 LOG_ERR("send_op_cond failed: %04X\n", sd->r1);
 534                 return false;
 535         }
 536
 537         sd->r1 = sd_setBlockLen(sd, SD_DEFAULT_BLOCKLEN);
 538         sd->tranfer_len = SD_DEFAULT_BLOCKLEN;
 539
 540         if (sd->r1)
 541         {
 542                 LOG_ERR("setBlockLen failed: %04X\n", sd->r1);
 543                 return false;
 544         }
 545
 546         /* Avoid warning for uninitialized csd use (gcc bug?) */
 547         CardCSD csd = csd;
 548
 549         sd->r1 = sd_getCSD(sd, &csd);
 550
 551         if (sd->r1)
 552         {
 553                 LOG_ERR("getCSD failed: %04X\n", sd->r1);
 554                 return false;
 555         }
 556
 557         sd->b.blk_size = SD_DEFAULT_BLOCKLEN;
 558         sd->b.blk_cnt = csd.block_num * (csd.block_len / SD_DEFAULT_BLOCKLEN);
 559         LOG_INFO("blk_size %d, blk_cnt %ld\n", sd->b.blk_size, sd->b.blk_cnt);
 560 #endif
 561
 562 #if CONFIG_SD_AUTOASSIGN_FAT
 563         disk_assignDrive(&sd->b, 0);
 564 #endif
 565
 566         return true;
 567 }
 568
 569 #if CPU_CM3_SAM3X8
 570
 571 #include <drv/hsmci_sam3.h>
 572
 573 /* SD commands                           type  argument     response */
 574   /* class 0 */
 575 /* This is basically the same command as for MMC with some quirks. */
 576 #define SD_SEND_RELATIVE_ADDR     3   /* bcr                     R6  */
 577 #define SD_SEND_IF_COND           8   /* bcr  [11:0] See below   R7  */
 578 #define SD_SWITCH_VOLTAGE         11  /* ac                      R1  */
 579
 580   /* class 10 */
 581 #define SD_SWITCH                 6   /* adtc [31:0] See below   R1  */
 582
 583   /* class 5 */
 584 #define SD_ERASE_WR_BLK_START    32   /* ac   [31:0] data addr   R1  */
 585 #define SD_ERASE_WR_BLK_END      33   /* ac   [31:0] data addr   R1  */
 586
 587   /* Application commands */
 588 #define SD_APP_SET_BUS_WIDTH      6   /* ac   [1:0] bus width    R1  */
 589 #define SD_APP_SD_STATUS         13   /* adtc                    R1  */
 590 #define SD_APP_SEND_NUM_WR_BLKS  22   /* adtc                    R1  */
 591 #define SD_APP_OP_COND           41   /* bcr  [31:0] OCR         R3  */
 592 #define SD_APP_SEND_SCR          51   /* adtc                    R1  */
 593
 594 /* OCR bit definitions */
 595 #define SD_OCR_S18R     (1 << 24)    /* 1.8V switching request */
 596 #define SD_ROCR_S18A    SD_OCR_S18R  /* 1.8V switching accepted by card */
 597 #define SD_OCR_XPC      (1 << 28)    /* SDXC power control */
 598
 599 /*
 600  * SD_SWITCH argument format:
 601  *
 602  *      [31] Check (0) or switch (1)
 603  *      [30:24] Reserved (0)
 604  *      [23:20] Function group 6
 605  *      [19:16] Function group 5
 606  *      [15:12] Function group 4
 607  *      [11:8] Function group 3
 608  *      [7:4] Function group 2
 609  *      [3:0] Function group 1
 610  */
 611
 612 /*
 613  * SD_SEND_IF_COND argument format:
 614  *
 615  *  [31:12] Reserved (0)
 616  *  [11:8] Host Voltage Supply Flags
 617  *  [7:0] Check Pattern (0xAA)
 618  */
 619
 620 /*
 621  * SCR field definitions
 622  */
 623
 624 #define SCR_SPEC_VER_0      0   /* Implements system specification 1.0 - 1.01 */
 625 #define SCR_SPEC_VER_1      1   /* Implements system specification 1.10 */
 626 #define SCR_SPEC_VER_2      2   /* Implements system specification 2.00-3.0X */
 627
 628
 629 #define SD_ADDR_TO_RCA(addr)    (uint32_t)(((addr) << 16) & 0xFFFF0000)
 630 #define SD_GET_STATE(status)    (uint8_t)(((status) & SD_STATUS_CURR_MASK) >> SD_STATUS_CURR_SHIFT)
 631
 632 #define SD_STATUS_APP_CMD      BV(5)
 633 #define SD_STATUS_READY        BV(8)
 634 #define SD_STATUS_CURR_MASK    0x1E00
 635 #define SD_STATUS_CURR_SHIFT   9
 636
 637
 638 LOG_INFOB(
 639 static void dump(const char *label, uint32_t *r, size_t len)
 640 {
 641         ASSERT(r);
 642         size_t i;
 643         int j = 0;
 644         kprintf("\n%s [\n", label);
 645         for (i = 0; i < len; i++)
 646         {
 647                 if (j == 5)
 648                 {
 649                         kputs("\n");
 650                         j = 0;
 651                 }
 652                 kprintf("%08lx", r[i]);
 653                 j++;
 654         }
 655         kprintf("\n] len=%d\n\n", i);
 656 }
 657 )
 658
 659 static const uint32_t tran_exp[] = {
 660     10000,      100000,     1000000,    10000000,
 661     0,      0,      0,      0
 662 };
 663
 664 static const uint8_t tran_mant[] = {
 665     0,  10, 12, 13, 15, 20, 25, 30,
 666     35, 40, 45, 50, 55, 60, 70, 80,
 667 };
 668
 669 static int sd_decodeCsd(SDcsd *csd, uint32_t *resp, size_t len)
 670 {
 671         ASSERT(csd);
 672         ASSERT(resp);
 673         ASSERT(len >= 4);
 674
 675     csd->structure = UNSTUFF_BITS(resp, 126, 2);
 676         csd->ccc = UNSTUFF_BITS(resp, 84, 12);
 677
 678     csd->max_data_rate  = tran_exp[UNSTUFF_BITS(resp, 96, 3)] * tran_mant[UNSTUFF_BITS(resp, 99, 4)];
 679
 680         /*
 681          * CSD structure:
 682          * - 0:
 683          *              - Version 1.01-1.10
 684          *              - Version 2.00/Standard Capacity
 685          * - 1:
 686          *              - Version 2.00/High Capacity
 687          * - >1: not defined.
 688          */
 689
 690     if (csd->structure == 0)
 691         {
 692                 // (C_size + 1) x 2^(C_SIZE_MUL+2)
 693                 csd->blk_num = (1 + UNSTUFF_BITS(resp, 62, 12)) << (UNSTUFF_BITS(resp, 47, 3) + 2);
 694
 695                 csd->read_blk_bits = UNSTUFF_BITS(resp, 80, 4);
 696                 csd->write_blk_bits = UNSTUFF_BITS(resp, 22, 4);
 697
 698                 csd->blk_len = 1 << csd->read_blk_bits;
 699         csd->capacity  = csd->blk_num * csd->blk_len;
 700
 701         csd->read_partial = UNSTUFF_BITS(resp, 79, 1);
 702         csd->read_misalign = UNSTUFF_BITS(resp, 77, 1);
 703
 704         csd->write_misalign = UNSTUFF_BITS(resp, 78, 1);
 705         csd->write_partial = UNSTUFF_BITS(resp, 21, 1);
 706
 707         if (UNSTUFF_BITS(resp, 46, 1))
 708                 {
 709             csd->erase_size = 1;
 710         }
 711                 else if(csd->write_blk_bits >= 9)
 712                 {
 713             csd->erase_size = UNSTUFF_BITS(resp, 39, 7) + 1;
 714             csd->erase_size <<= csd->write_blk_bits - 9;
 715         }
 716
 717                 return 0;
 718         }
 719         else if (csd->structure == 1)
 720         {
 721                 kprintf("csize %ld\n", UNSTUFF_BITS(resp, 48, 22));
 722         csd->capacity  = (1 + UNSTUFF_BITS(resp, 48, 22)) << 10;
 723
 724                 csd->write_blk_bits = 9;
 725                 csd->write_partial = 0;
 726         csd->write_misalign = 0;
 727
 728                 csd->read_blk_bits = 9;
 729                 csd->read_partial = 0;
 730         csd->read_misalign = 0;
 731
 732         csd->erase_size = 1;
 733                 // the block size if fixed to 512kb
 734                 csd->blk_len = (1 << csd->write_blk_bits) << 10;
 735
 736         return 0;
 737         }
 738     else
 739         {
 740         kprintf("Unrecognised CSD structure version %d\n", csd->structure);
 741         return -1;
 742     }
 743
 744     return 0;
 745 }
 746
 747
 748 void sd_dumpCsd(Sd *sd)
 749 {
 750         ASSERT(sd);
 751
 752         LOG_INFO("VERSION: %d.0\n", sd->csd.structure ? 2 : 1);
 753     LOG_INFO("CARD COMMAND CLASS: %d\n", sd->csd.ccc);
 754         LOG_INFO("MAX DATA RATE: %ld\n", sd->csd.max_data_rate);
 755         LOG_INFO("WRITE BLK LEN BITS: %ld\n", sd->csd.write_blk_bits);
 756         LOG_INFO("READ BLK LEN BITS: %ld\n", sd->csd.read_blk_bits);
 757         LOG_INFO("ERASE SIZE: %ld\n", sd->csd.erase_size);
 758         LOG_INFO("BLK NUM: %ld\n", sd->csd.blk_num);
 759         LOG_INFO("BLK LEN: %ld\n", sd->csd.blk_len);
 760         LOG_INFO("CAPACITY %ld\n", sd->csd.capacity);
 761         LOG_INFO("FLAG Write: WP %d, W MISALIGN %d\n", sd->csd.write_partial, sd->csd.write_misalign);
 762         LOG_INFO("FLAG Read: RP %d, R MISALIGN %d\n", sd->csd.read_partial, sd->csd.read_misalign);
 763
 764 }
 765
 766 void sd_dumpCid(Sd *sd)
 767 {
 768         ASSERT(sd);
 769
 770         LOG_INFO("MANFID: %d\n", sd->cid.manfid);
 771     LOG_INFO("OEMID: %d\n", sd->cid.oemid);
 772         LOG_INFO("SERIAL: %ld\n", sd->cid.serial);
 773     LOG_INFO("PROD_NAME: %s\n", sd->cid.prod_name);
 774     LOG_INFO("REV: %d.%d\n", sd->cid.m_rev, sd->cid.l_rev);
 775     LOG_INFO("OFF,Y,M: %lx, %ld %ld\n", sd->cid.year_off, (BCD_TO_INT_32BIT(sd->cid.year_off) / 12) + 2000,
 776                                                                                                 (BCD_TO_INT_32BIT(sd->cid.year_off) % 12));
 777 }
 778
 779 void sd_dumpSsr(Sd *sd)
 780 {
 781         ASSERT(sd);
 782
 783         LOG_INFO("BUS_WIDTH: %d\n", sd->ssr.bus_width);
 784     LOG_INFO("TYPE: %d\n", sd->ssr.card_type);
 785         LOG_INFO("AU_TYPE: %d\n", sd->ssr.au_size);
 786         LOG_INFO("ERASE_SIZE: %d\n", sd->ssr.erase_size);
 787         LOG_INFO("SPEED_CLASS: %d\n", sd->ssr.speed_class);
 788 }
 789
 790
 791 void sd_sendInit(void)
 792 {
 793         hsmci_init(NULL); //TODO: REMOVE IT!
 794
 795         if (hsmci_sendCmd(0, 0, HSMCI_CMDR_SPCMD_INIT | HSMCI_CMDR_RSPTYP_NORESP))
 796                 LOG_ERR("INIT: %lx\n", HSMCI_SR);
 797 }
 798
 799
 800 void sd_goIdle(void)
 801 {
 802         hsmci_setSpeed(HSMCI_INIT_SPEED, false);
 803         if (hsmci_sendCmd(0, 0, HSMCI_CMDR_RSPTYP_NORESP))
 804                 LOG_ERR("GO_IDLE: %lx\n", HSMCI_SR);
 805 }
 806
 807 int sd_sendIfCond(Sd *sd)
 808 {
 809         if (hsmci_sendCmd(8, CMD8_V_RANGE_27V_36V, HSMCI_CMDR_RSPTYP_48_BIT))
 810         {
 811                 LOG_ERR("IF_COND %lx\n", HSMCI_SR);
 812                 return -1;
 813         }
 814         hsmci_readResp(&(sd->status), 1);
 815         if (((sd->status) & 0xFFF) == CMD8_V_RANGE_27V_36V)
 816         {
 817                 LOG_INFO("IF_COND: %lx\n", (sd->status));
 818                 return 0;
 819         }
 820         LOG_ERR("IF_COND: %lx\n", (sd->status));
 821
 822         return -1;
 823 }
 824
 825 int sd_sendAppOpCond(Sd *sd)
 826 {
 827         if (hsmci_sendCmd(55, 0, HSMCI_CMDR_RSPTYP_48_BIT))
 828         {
 829                 LOG_ERR("APP_CMD %lx\n", HSMCI_SR);
 830                 return -1;
 831         }
 832
 833         hsmci_readResp(&(sd->status), 1);
 834         if ((sd->status) & (SD_STATUS_APP_CMD | SD_STATUS_READY))
 835         {
 836                 if (hsmci_sendCmd(41, SD_HOST_VOLTAGE_RANGE | SD_OCR_CCS, HSMCI_CMDR_RSPTYP_48_BIT))// se cmd 8 va ok.
 837                 {
 838                         LOG_ERR("APP_OP_COND %lx\n", HSMCI_SR);
 839                         return -1;
 840                 }
 841                 else
 842                 {
 843                         hsmci_readResp(&(sd->status), 1);
 844                         if ((sd->status) & SD_OCR_BUSY)
 845                         {
 846                                 LOG_INFO("SD power up! Hight Capability [%d]\n", (bool)((sd->status) & SD_OCR_CCS));
 847                                 return 0;
 848                         }
 849
 850                         LOG_ERR("sd not ready.\n");
 851                 }
 852         }
 853
 854         return -1;
 855 }
 856
 857
 858 int sd_getCid(Sd *sd, uint32_t addr, uint8_t flag)
 859 {
 860         ASSERT(sd);
 861         memset(&(sd->cid), 0, sizeof(SDcid));
 862
 863         uint8_t idx = 9; // CMD9 get cid from gived sd address (RCA)
 864         if (flag & SD_SEND_ALL_CID)
 865                 idx = 2;
 866
 867
 868         if (hsmci_sendCmd(idx, SD_ADDR_TO_RCA(addr), HSMCI_CMDR_RSPTYP_136_BIT))
 869         {
 870                 LOG_ERR("GET_CID %lx\n", HSMCI_SR);
 871                 return -1;
 872         }
 873         else
 874         {
 875                 uint32_t resp[4];
 876                 hsmci_readResp(resp, 4);
 877                 LOG_INFOB(dump("CID", resp, 4););
 878
 879                 sd->cid.manfid        = UNSTUFF_BITS(resp, 120, 8);
 880                 sd->cid.oemid         = UNSTUFF_BITS(resp, 104, 16);
 881                 sd->cid.prod_name[0]      = UNSTUFF_BITS(resp, 96, 8);
 882                 sd->cid.prod_name[1]      = UNSTUFF_BITS(resp, 88, 8);
 883                 sd->cid.prod_name[2]      = UNSTUFF_BITS(resp, 80, 8);
 884                 sd->cid.prod_name[3]      = UNSTUFF_BITS(resp, 72, 8);
 885                 sd->cid.prod_name[4]      = UNSTUFF_BITS(resp, 64, 8);
 886                 sd->cid.m_rev         = UNSTUFF_BITS(resp, 60, 4);
 887                 sd->cid.l_rev         = UNSTUFF_BITS(resp, 56, 4);
 888                 sd->cid.serial        = (uint32_t)UNSTUFF_BITS(resp, 24, 32);
 889                 sd->cid.year_off      = UNSTUFF_BITS(resp, 8, 12);
 890         }
 891
 892         return 0;
 893 }
 894
 895 int sd_getCsd(Sd *sd)
 896 {
 897         ASSERT(sd);
 898         memset(&(sd->csd), 0, sizeof(SDcsd));
 899
 900         LOG_INFO("Send to RCA: %lx\n", SD_ADDR_TO_RCA(sd->addr));
 901         if (hsmci_sendCmd(9, SD_ADDR_TO_RCA(sd->addr), HSMCI_CMDR_RSPTYP_136_BIT))
 902         {
 903                 LOG_ERR("GET_CSD %lx\n", HSMCI_SR);
 904                 return -1;
 905         }
 906         else
 907         {
 908                 uint32_t resp[4];
 909                 hsmci_readResp(resp, 4);
 910                 LOG_INFOB(dump("CSD", resp, 4););
 911                 sd_decodeCsd(&(sd->csd), resp, 4);
 912         }
 913
 914         return 0;
 915 }
 916
 917 int sd_getRelativeAddr(Sd *sd)
 918 {
 919         ASSERT(sd);
 920         if (hsmci_sendCmd(3, 0, HSMCI_CMDR_RSPTYP_48_BIT))
 921         {
 922                 LOG_ERR("RCA: %lx\n", HSMCI_SR);
 923                 return -1;
 924         }
 925
 926         hsmci_readResp(&sd->addr, 1);
 927         sd->addr = sd->addr >> 16;
 928
 929         LOG_INFOB(dump("RCA", &sd->addr, 1););
 930
 931         return 0;
 932 }
 933
 934 int sd_appStatus(Sd *sd)
 935 {
 936         ASSERT(sd);
 937         LOG_INFO("Send to RCA: %lx\n", SD_ADDR_TO_RCA(sd->addr));
 938         if (hsmci_sendCmd(13, SD_ADDR_TO_RCA(sd->addr), HSMCI_CMDR_RSPTYP_48_BIT))
 939         {
 940                 LOG_ERR("STATUS: %lx\n", HSMCI_SR);
 941                 return -1;
 942         }
 943
 944         hsmci_readResp(&(sd->status), 1);
 945         LOG_INFOB(dump("STATUS", &(sd->status), 1););
 946
 947         LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
 948
 949         if (sd->status & SD_STATUS_READY)
 950                 return 0;
 951
 952         return -1;
 953 }
 954
 955
 956 INLINE int sd_cardSelection(Sd *sd, uint32_t rca)
 957 {
 958         ASSERT(sd);
 959         LOG_INFO("Select RCA: %lx\n", rca);
 960         if (hsmci_sendCmd(7, rca, HSMCI_CMDR_RSPTYP_R1B))
 961         {
 962                 LOG_ERR("SELECT_SD: %lx\n", HSMCI_SR);
 963                 return -1;
 964         }
 965
 966         HSMCI_CHECK_BUSY();
 967         hsmci_readResp(&(sd->status), 1);
 968         LOG_INFOB(dump("SELECT_SD", &(sd->status), 1););
 969
 970         LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
 971
 972         if (sd->status & SD_STATUS_READY)
 973                 return 0;
 974
 975         return -1;
 976 }
 977
 978 int sd_selectCard(Sd *sd)
 979 {
 980         ASSERT(sd);
 981         uint32_t rca = SD_ADDR_TO_RCA(sd->addr);
 982         LOG_INFO("Select RCA: %lx\n", rca);
 983         if (hsmci_sendCmd(7, rca, HSMCI_CMDR_RSPTYP_R1B))
 984         {
 985                 LOG_ERR("SELECT_SD: %lx\n", HSMCI_SR);
 986                 return -1;
 987         }
 988
 989         HSMCI_CHECK_BUSY();
 990         hsmci_readResp(&(sd->status), 1);
 991
 992         LOG_INFOB(dump("SELECT_SD", &(sd->status), 1););
 993         LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
 994
 995         if (sd->status & SD_STATUS_READY)
 996                 return 0;
 997
 998         return -1;
 999 }
1000
1001 int sd_deSelectCard(Sd *sd)
1002 {
1003         ASSERT(sd);
1004
1005         uint32_t rca = 0;
1006         if (!sd->addr)
1007                 rca = SD_ADDR_TO_RCA(sd->addr + 1);
1008
1009         LOG_INFO("Select RCA: %lx\n", rca);
1010
1011         if (hsmci_sendCmd(7, rca, HSMCI_CMDR_RSPTYP_NORESP))
1012         {
1013                 LOG_ERR("DESELECT_SD: %lx\n", HSMCI_SR);
1014                 return -1;
1015         }
1016
1017         return 0;
1018
1019 }
1020
1021
1022 int sd_setBusWidth(Sd *sd, size_t len)
1023 {
1024         ASSERT(sd);
1025
1026         if (hsmci_sendCmd(55, SD_ADDR_TO_RCA(sd->addr), HSMCI_CMDR_RSPTYP_48_BIT))
1027         {
1028                 LOG_ERR("APP_CMD %lx\n", HSMCI_SR);
1029                 return -1;
1030         }
1031
1032         hsmci_readResp(&(sd->status), 1);
1033         if ((sd->status) & (SD_STATUS_APP_CMD | SD_STATUS_READY))
1034         {
1035                 hsmci_setBusWidth(len);
1036
1037                 uint8_t arg = 0;
1038                 if (len == 4)
1039                         arg = 2;
1040
1041                 if (hsmci_sendCmd(6, arg, HSMCI_CMDR_RSPTYP_48_BIT))
1042                 {
1043                         LOG_ERR("SET_BUS_WIDTH CMD: %lx\n", HSMCI_SR);
1044                         return -1;
1045                 }
1046
1047                 hsmci_readResp(&(sd->status), 1);
1048
1049                 LOG_INFOB(dump("SET_BUS_WIDTH", &(sd->status), 1););
1050                 LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
1051
1052                 if (sd->status & SD_STATUS_READY)
1053                         return 0;
1054         }
1055
1056         LOG_ERR("SET_BUS_WIDTH REP %lx\n", (sd->status));
1057         return -1;
1058 }
1059
1060
1061 int sd_set_BlockLen(Sd *sd, size_t len)
1062 {
1063         ASSERT(sd);
1064
1065         if (hsmci_sendCmd(16, len, HSMCI_CMDR_RSPTYP_48_BIT))
1066         {
1067                 LOG_ERR("SET_BLK_LEN: %lx\n", HSMCI_SR);
1068                 return -1;
1069         }
1070
1071         hsmci_readResp(&(sd->status), 1);
1072
1073         LOG_INFOB(dump("SET_BLK_LEN", &(sd->status), 1););
1074         LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
1075
1076         sd->csd.blk_len = len;
1077
1078         if (sd->status & SD_STATUS_READY)
1079                 return 0;
1080
1081         return -1;
1082 }
1083
1084 int sd_getStatus(Sd *sd, uint32_t *buf, size_t words)
1085 {
1086         ASSERT(sd);
1087
1088         // Status reply with 512bit data, so the block size in byte is 64
1089         hsmci_prgRxDMA(buf, words, 64);
1090
1091         if (hsmci_sendCmd(55, SD_ADDR_TO_RCA(sd->addr), HSMCI_CMDR_RSPTYP_48_BIT))
1092         {
1093                 LOG_ERR("APP_CMD %lx\n", HSMCI_SR);
1094                 return -1;
1095         }
1096
1097         uint32_t status = HSMCI_RSPR;
1098         if (status & (SD_STATUS_APP_CMD | SD_STATUS_READY))
1099         {
1100                 if (hsmci_sendCmd(13, 0, HSMCI_CMDR_RSPTYP_48_BIT |
1101                                 BV(HSMCI_CMDR_TRDIR) | HSMCI_CMDR_TRCMD_START_DATA | HSMCI_CMDR_TRTYP_SINGLE))
1102                 {
1103                         LOG_ERR("STATUS CMD: %lx\n", HSMCI_SR);
1104                         return -1;
1105                 }
1106
1107                 hsmci_readResp(&(sd->status), 1);
1108                 LOG_INFOB(dump("STATUS", &(sd->status), 1););
1109                 LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
1110
1111                 if (sd->status & SD_STATUS_READY)
1112                 {
1113                         hsmci_waitTransfer();
1114
1115                         LOG_INFOB(dump("STATUS", buf, words););
1116                         memset(&(sd->ssr), 0, sizeof(SDssr));
1117
1118                         sd->ssr.bus_width  = UNSTUFF_BITS(buf, 510, 2);
1119                         sd->ssr.card_type  = UNSTUFF_BITS(buf, 480, 16);
1120                         sd->ssr.au_size  = UNSTUFF_BITS(buf, 432, 8);
1121                         sd->ssr.speed_class  = UNSTUFF_BITS(buf, 440, 8);
1122                         sd->ssr.erase_size = UNSTUFF_BITS(buf, 408, 24);
1123
1124                         return 0;
1125                 }
1126         }
1127
1128         return -1;
1129 }
1130
1131
1132
1133 int sd_readSingleBlock(Sd *sd, size_t index, uint32_t *buf, size_t words)
1134 {
1135         ASSERT(sd);
1136         ASSERT(buf);
1137
1138         hsmci_prgRxDMA(buf, words, sd->csd.blk_len);
1139
1140         if (hsmci_sendCmd(17, index * sd->csd.blk_len, HSMCI_CMDR_RSPTYP_48_BIT |
1141                         BV(HSMCI_CMDR_TRDIR) | HSMCI_CMDR_TRCMD_START_DATA | HSMCI_CMDR_TRTYP_SINGLE))
1142         {
1143                 LOG_ERR("SIGLE_BLK_READ: %lx\n", HSMCI_SR);
1144                 return -1;
1145         }
1146         hsmci_readResp(&(sd->status), 1);
1147
1148         LOG_INFOB(dump("SIGLE_BLK_READ", &(sd->status), 1););
1149         LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
1150
1151         if (sd->status & SD_STATUS_READY)
1152         {
1153                 hsmci_waitTransfer();
1154                 return words;
1155         }
1156
1157         return -1;
1158 }
1159
1160
1161 int sd_writeSingleBlock(Sd *sd, size_t index, uint32_t *buf, size_t words)
1162 {
1163         ASSERT(sd);
1164         ASSERT(buf);
1165
1166         hsmci_prgTxDMA(buf, words, sd->csd.blk_len);
1167
1168         if (hsmci_sendCmd(24, index * sd->csd.blk_len, HSMCI_CMDR_RSPTYP_48_BIT |
1169                                                 HSMCI_CMDR_TRCMD_START_DATA | HSMCI_CMDR_TRTYP_SINGLE))
1170         {
1171                 LOG_ERR("SIGLE_BLK_WRITE: %lx\n", HSMCI_SR);
1172                 return -1;
1173         }
1174         hsmci_readResp(&(sd->status), 1);
1175
1176         LOG_INFOB(dump("SIGLE_BLK_WR", &(sd->status), 1););
1177         LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
1178
1179         if (sd->status & SD_STATUS_READY)
1180         {
1181                 hsmci_waitTransfer();
1182                 return words;
1183         }
1184
1185         return -1;
1186 }
1187
1188
1189
1190 void sd_setHightSpeed(Sd *sd)
1191 {
1192         (void)sd;
1193         hsmci_setSpeed(2100000, true);
1194 }
1195
1196
1197 #endif
1198
1199
1200 bool sd_initUnbuf(Sd *sd, KFile *ch)
1201 {
1202         if (sd_blockInit(sd, ch))
1203         {
1204                 sd->b.priv.vt = &sd_unbuffered_vt;
1205                 return true;
1206         }
1207         else
1208                 return false;
1209 }
1210
1211 static uint8_t sd_buf[SD_DEFAULT_BLOCKLEN];
1212
1213 bool sd_initBuf(Sd *sd, KFile *ch)
1214 {
1215         if (sd_blockInit(sd, ch))
1216         {
1217                 sd->b.priv.buf = sd_buf;
1218                 sd->b.priv.flags |= KB_BUFFERED | KB_PARTIAL_WRITE;
1219                 sd->b.priv.vt = &sd_buffered_vt;
1220                 sd->b.priv.vt->load(&sd->b, 0);
1221                 return true;
1222         }
1223         else
1224                 return false;
1225 }
1226
1227
1228