bertos/cpu/cortex-m3/drv/sd_sam3.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 "hw/hw_sd.h"
  39 #include "cfg/cfg_sd.h"
  40
  41 #include <drv/sd.h>
  42 #include <drv/timer.h>
  43 #include <drv/hsmci_sam3.h>
  44
  45 #include <io/kfile.h>
  46 #include <io/kblock.h>
  47
  48 #include <fs/fat.h>
  49
  50 #define LOG_LEVEL  SD_LOG_LEVEL
  51 #define LOG_FORMAT SD_LOG_FORMAT
  52 #include <cfg/log.h>
  53 #include <cpu/power.h>
  54
  55 #include <string.h> /* memset */
  56
  57
  58 #define SD_SEND_ALL_CID        BV(0)
  59 #define SD_STATUS_APP_CMD      BV(5)
  60 #define SD_STATUS_READY        BV(8)
  61 #define SD_CARD_IS_LOCKED      BV(25)
  62
  63 #define SD_OCR_CCS              BV(30)     /**< SD Card Capacity Status (CCS) */
  64 #define SD_OCR_BUSY             BV(31)     /**< SD/MMC Card power up status bit (busy) */
  65
  66 #define SD_OCR_VDD_27_28        BV(15)
  67 #define SD_OCR_VDD_28_29        BV(16)
  68 #define SD_OCR_VDD_29_30        BV(17)
  69 #define SD_OCR_VDD_30_31        BV(18)
  70 #define SD_OCR_VDD_31_32        BV(19)
  71 #define SD_OCR_VDD_32_33        BV(20)
  72
  73
  74 #define SD_HOST_VOLTAGE_RANGE     (SD_OCR_VDD_27_28 | \
  75                                    SD_OCR_VDD_28_29 | \
  76                                    SD_OCR_VDD_29_30 | \
  77                                    SD_OCR_VDD_30_31 | \
  78                                    SD_OCR_VDD_31_32 | \
  79                                    SD_OCR_VDD_32_33)
  80
  81
  82 #define CMD8_V_RANGE_CHECK_PAT    0xAA
  83 #define CMD8_V_RANGE_27V_36V      (0x100 | CMD8_V_RANGE_CHECK_PAT)
  84 #define CMD8_V_RANGE_LOW          (0x1000 | CMD8_V_RANGE_CHECK_PAT)
  85 #define CMD8_V_ECHO_REPLY         0xFF
  86 #define CMD8_SUPP_V_RANGE_REPLY   0xFF00
  87
  88
  89 #define SD_GET_ERRORS(status)   ((status) & 0xFFF80000)
  90 #define SD_ADDR_TO_RCA(addr)    (uint32_t)(((addr) << 16) & 0xFFFF0000)
  91 #define SD_GET_STATE(status)    (uint8_t)(((status) & 0x1E00) >> 9)
  92
  93 static const uint32_t tran_exp[] =
  94 {
  95         10000,      100000,     1000000,    10000000,
  96         0,      0,      0,      0
  97 };
  98
  99 static const uint8_t tran_mant[] =
 100 {
 101         0,  10, 12, 13, 15, 20, 25, 30,
 102         35, 40, 45, 50, 55, 60, 70, 80,
 103 };
 104
 105
 106 void sd_dumpCsd(SdCSD *csd);
 107 void sd_dumpCid(SdCID *cid);
 108 void sd_dumpSsr(SdSSR *ssr);
 109
 110 void sd_sendInit(void);
 111 void sd_goIdle(void);
 112 int sd_sendIfCond(Sd *sd);
 113 int sd_sendAppOpCond(Sd *sd);
 114
 115 int sd_getCid(Sd *sd, SdCID *cid, uint32_t addr, uint8_t flag);
 116 int sd_getCsd(Sd *sd, SdCSD *csd);
 117 int sd_getSrc(Sd *sd);
 118
 119 int sd_appStatus(Sd *sd);
 120 int sd_getRelativeAddr(Sd *sd);
 121 int sd_getStatus(Sd *sd, SdSSR *ssr, uint32_t *buf, size_t words);
 122
 123 int sd_selectCard(Sd *sd);
 124 int sd_deSelectCard(Sd *sd);
 125 int sd_setBusWidth(Sd *sd, size_t len);
 126 int sd_set_BlockLen(Sd *sd, size_t len);
 127 void sd_setHightSpeed(Sd *sd);
 128
 129
 130 INLINE int sd_setBus4bit(Sd *sd)
 131 {
 132         return sd_setBusWidth(sd, 4);
 133 }
 134
 135 INLINE int sd_setBus1bit(Sd *sd)
 136 {
 137         return sd_setBusWidth(sd, 1);
 138 }
 139
 140
 141 LOG_INFOB(
 142 static void dump(const char *label, uint32_t *r, size_t len)
 143 {
 144         ASSERT(r);
 145         size_t i;
 146         int j = 0;
 147         kprintf("\n%s [\n", label);
 148         for (i = 0; i < len; i++)
 149         {
 150                 if (j == 5)
 151                 {
 152                         kputs("\n");
 153                         j = 0;
 154                 }
 155                 kprintf("%08lx ", r[i]);
 156                 j++;
 157         }
 158         kprintf("\n] len=%d\n\n", i);
 159 }
 160 )
 161
 162 void sd_dumpCsd(SdCSD *csd)
 163 {
 164         ASSERT(csd);
 165
 166         LOG_INFO("VERSION: %d.0\n", csd->structure ? 2 : 1);
 167         LOG_INFO("CARD COMMAND CLASS: %d\n", csd->ccc);
 168         LOG_INFO("MAX DATA RATE: %ld\n", csd->max_data_rate);
 169         LOG_INFO("WRITE BLK LEN BITS: %ld\n", csd->write_blk_bits);
 170         LOG_INFO("READ BLK LEN BITS: %ld\n", csd->read_blk_bits);
 171         LOG_INFO("ERASE SIZE: %ld\n", csd->erase_size);
 172         LOG_INFO("BLK NUM: %ld\n", csd->block_num);
 173         LOG_INFO("BLK LEN: %ld\n", csd->block_len);
 174         LOG_INFO("CAPACITY %ld\n", csd->capacity);
 175         LOG_INFO("FLAG Write: WP %d, W MISALIGN %d\n", csd->write_partial, csd->write_misalign);
 176         LOG_INFO("FLAG Read: RP %d, R MISALIGN %d\n", csd->read_partial, csd->read_misalign);
 177
 178 }
 179
 180 void sd_dumpCid(SdCID *cid)
 181 {
 182         ASSERT(cid);
 183
 184         LOG_INFO("MANFID: %d\n", cid->manfid);
 185         LOG_INFO("OEMID: %d\n", cid->oemid);
 186         LOG_INFO("SERIAL: %ld\n", cid->serial);
 187         LOG_INFO("PROD_NAME: %s\n", cid->prod_name);
 188         LOG_INFO("REV: %d.%d\n", cid->m_rev, cid->l_rev);
 189         LOG_INFO("OFF,Y,M: %lx, %ld %ld\n", cid->year_off, (BCD_TO_INT_32BIT(cid->year_off) / 12) + 2000,
 190                                                                                                 (BCD_TO_INT_32BIT(cid->year_off) % 12));
 191 }
 192
 193 void sd_dumpSsr(SdSSR *ssr)
 194 {
 195         ASSERT(ssr);
 196
 197         LOG_INFO("BUS_WIDTH: %d\n", ssr->bus_width);
 198         LOG_INFO("TYPE: %d\n", ssr->card_type);
 199         LOG_INFO("AU_TYPE: %d\n", ssr->au_size);
 200         LOG_INFO("ERASE_SIZE: %d\n", ssr->erase_size);
 201         LOG_INFO("SPEED_CLASS: %d\n", ssr->speed_class);
 202 }
 203
 204
 205 static int sd_decodeCsd(SdCSD *csd, uint32_t *resp, size_t len)
 206 {
 207         ASSERT(csd);
 208         ASSERT(resp);
 209         ASSERT(len >= 4);
 210
 211         csd->structure = UNSTUFF_BITS(resp, 126, 2);
 212         csd->ccc = UNSTUFF_BITS(resp, 84, 12);
 213
 214         csd->max_data_rate  = tran_exp[UNSTUFF_BITS(resp, 96, 3)] * tran_mant[UNSTUFF_BITS(resp, 99, 4)];
 215
 216         /*
 217          * CSD structure:
 218          * - 0:
 219          *              - Version 1.01-1.10
 220          *              - Version 2.00/Standard Capacity
 221          * - 1:
 222          *              - Version 2.00/High Capacity
 223          * - >1: not defined.
 224          */
 225
 226         if (csd->structure == 0)
 227         {
 228                 // (C_size + 1) x 2^(C_SIZE_MUL+2)
 229                 csd->block_num = (1 + UNSTUFF_BITS(resp, 62, 12)) << (UNSTUFF_BITS(resp, 47, 3) + 2);
 230
 231                 csd->read_blk_bits = UNSTUFF_BITS(resp, 80, 4);
 232                 csd->write_blk_bits = UNSTUFF_BITS(resp, 22, 4);
 233
 234                 csd->block_len = 1 << csd->read_blk_bits;
 235                 csd->capacity  = csd->block_num * csd->block_len;
 236
 237                 csd->read_partial = UNSTUFF_BITS(resp, 79, 1);
 238                 csd->read_misalign = UNSTUFF_BITS(resp, 77, 1);
 239
 240                 csd->write_misalign = UNSTUFF_BITS(resp, 78, 1);
 241                 csd->write_partial = UNSTUFF_BITS(resp, 21, 1);
 242
 243                 if (UNSTUFF_BITS(resp, 46, 1))
 244                 {
 245                         csd->erase_size = 1;
 246                 }
 247                 else if(csd->write_blk_bits >= 9)
 248                 {
 249                         csd->erase_size = UNSTUFF_BITS(resp, 39, 7) + 1;
 250                         csd->erase_size <<= csd->write_blk_bits - 9;
 251                 }
 252
 253                 return 0;
 254         }
 255         else if (csd->structure == 1)
 256         {
 257                 kprintf("csize %ld\n", UNSTUFF_BITS(resp, 48, 22));
 258                 csd->capacity  = (1 + UNSTUFF_BITS(resp, 48, 22)) << 10;
 259
 260                 csd->write_blk_bits = 9;
 261                 csd->write_partial = 0;
 262                 csd->write_misalign = 0;
 263
 264                 csd->read_blk_bits = 9;
 265                 csd->read_partial = 0;
 266                 csd->read_misalign = 0;
 267
 268                 csd->erase_size = 1;
 269                 // the block size if fixed to 512kb
 270                 csd->block_len = (1 << csd->write_blk_bits) << 10;
 271
 272                 return 0;
 273         }
 274         else
 275         {
 276                 kprintf("Unrecognised CSD structure version %d\n", csd->structure);
 277                 return -1;
 278         }
 279
 280         return 0;
 281 }
 282
 283 void sd_sendInit(void)
 284 {
 285         hsmci_init(NULL); //TODO: REMOVE IT!
 286
 287         if (hsmci_sendCmd(0, 0, HSMCI_CMDR_SPCMD_INIT | HSMCI_CMDR_RSPTYP_NORESP))
 288                 LOG_ERR("INIT: %lx\n", HSMCI_SR);
 289 }
 290
 291
 292 void sd_goIdle(void)
 293 {
 294         hsmci_setSpeed(HSMCI_INIT_SPEED, false);
 295         if (hsmci_sendCmd(0, 0, HSMCI_CMDR_RSPTYP_NORESP))
 296                 LOG_ERR("GO_IDLE: %lx\n", HSMCI_SR);
 297 }
 298
 299 int sd_sendIfCond(Sd *sd)
 300 {
 301         if (hsmci_sendCmd(8, CMD8_V_RANGE_27V_36V, HSMCI_CMDR_RSPTYP_48_BIT))
 302         {
 303                 LOG_ERR("IF_COND %lx\n", HSMCI_SR);
 304                 return -1;
 305         }
 306         hsmci_readResp(&(sd->status), 1);
 307         if (((sd->status) & 0xFFF) == CMD8_V_RANGE_27V_36V)
 308         {
 309                 LOG_INFO("IF_COND: %lx\n", (sd->status));
 310                 return 0;
 311         }
 312         LOG_ERR("IF_COND: %lx\n", (sd->status));
 313
 314         return -1;
 315 }
 316
 317 int sd_sendAppOpCond(Sd *sd)
 318 {
 319         if (hsmci_sendCmd(55, 0, HSMCI_CMDR_RSPTYP_48_BIT))
 320         {
 321                 LOG_ERR("APP_CMD %lx\n", HSMCI_SR);
 322                 return -1;
 323         }
 324
 325         hsmci_readResp(&(sd->status), 1);
 326         if ((sd->status) & (SD_STATUS_APP_CMD | SD_STATUS_READY))
 327         {
 328                 if (hsmci_sendCmd(41, SD_HOST_VOLTAGE_RANGE | SD_OCR_CCS, HSMCI_CMDR_RSPTYP_48_BIT))// se cmd 8 va ok.
 329                 {
 330                         LOG_ERR("APP_OP_COND %lx\n", HSMCI_SR);
 331                         return -1;
 332                 }
 333                 else
 334                 {
 335                         hsmci_readResp(&(sd->status), 1);
 336                         if ((sd->status) & SD_OCR_BUSY)
 337                         {
 338                                 LOG_INFO("SD power up! Hight Capability [%d]\n", (bool)((sd->status) & SD_OCR_CCS));
 339                                 return 0;
 340                         }
 341                 }
 342         }
 343         return -1;
 344 }
 345
 346
 347 int sd_getCid(Sd *sd, SdCID *cid, uint32_t addr, uint8_t flag)
 348 {
 349         ASSERT(sd);
 350         ASSERT(cid);
 351         memset(cid, 0, sizeof(SdCID));
 352
 353         uint8_t idx = 9; // CMD9 get cid from gived sd address (RCA)
 354         if (flag & SD_SEND_ALL_CID)
 355                 idx = 2;
 356
 357
 358         if (hsmci_sendCmd(idx, SD_ADDR_TO_RCA(addr), HSMCI_CMDR_RSPTYP_136_BIT))
 359         {
 360                 LOG_ERR("GET_CID %lx\n", HSMCI_SR);
 361                 return -1;
 362         }
 363         else
 364         {
 365                 uint32_t resp[4];
 366                 hsmci_readResp(resp, 4);
 367                 LOG_INFOB(dump("CID", resp, 4););
 368
 369                 cid->manfid        = UNSTUFF_BITS(resp, 120, 8);
 370                 cid->oemid         = UNSTUFF_BITS(resp, 104, 16);
 371                 cid->prod_name[0]      = UNSTUFF_BITS(resp, 96, 8);
 372                 cid->prod_name[1]      = UNSTUFF_BITS(resp, 88, 8);
 373                 cid->prod_name[2]      = UNSTUFF_BITS(resp, 80, 8);
 374                 cid->prod_name[3]      = UNSTUFF_BITS(resp, 72, 8);
 375                 cid->prod_name[4]      = UNSTUFF_BITS(resp, 64, 8);
 376                 cid->m_rev         = UNSTUFF_BITS(resp, 60, 4);
 377                 cid->l_rev         = UNSTUFF_BITS(resp, 56, 4);
 378                 cid->serial        = (uint32_t)UNSTUFF_BITS(resp, 24, 32);
 379                 cid->year_off      = UNSTUFF_BITS(resp, 8, 12);
 380         }
 381
 382         return 0;
 383 }
 384
 385 int sd_getCsd(Sd *sd, SdCSD *csd)
 386 {
 387         ASSERT(sd);
 388         ASSERT(csd);
 389         memset(csd, 0, sizeof(SdCSD));
 390
 391         LOG_INFO("Send to RCA: %lx\n", SD_ADDR_TO_RCA(sd->addr));
 392         if (hsmci_sendCmd(9, SD_ADDR_TO_RCA(sd->addr), HSMCI_CMDR_RSPTYP_136_BIT))
 393         {
 394                 LOG_ERR("GET_CSD %lx\n", HSMCI_SR);
 395                 return -1;
 396         }
 397         else
 398         {
 399                 uint32_t resp[4];
 400                 hsmci_readResp(resp, 4);
 401                 LOG_INFOB(dump("CSD", resp, 4););
 402                 sd_decodeCsd(csd, resp, 4);
 403         }
 404
 405         return 0;
 406 }
 407
 408 int sd_getRelativeAddr(Sd *sd)
 409 {
 410         ASSERT(sd);
 411         if (hsmci_sendCmd(3, 0, HSMCI_CMDR_RSPTYP_48_BIT))
 412         {
 413                 LOG_ERR("RCA: %lx\n", HSMCI_SR);
 414                 return -1;
 415         }
 416
 417         hsmci_readResp(&sd->addr, 1);
 418         sd->addr = sd->addr >> 16;
 419
 420         LOG_INFOB(dump("RCA", &sd->addr, 1););
 421
 422         return 0;
 423 }
 424
 425 int sd_appStatus(Sd *sd)
 426 {
 427         ASSERT(sd);
 428         LOG_INFO("Send to RCA: %lx\n", SD_ADDR_TO_RCA(sd->addr));
 429         if (hsmci_sendCmd(13, SD_ADDR_TO_RCA(sd->addr), HSMCI_CMDR_RSPTYP_48_BIT))
 430         {
 431                 LOG_ERR("STATUS: %lx\n", HSMCI_SR);
 432                 return -1;
 433         }
 434
 435         hsmci_readResp(&(sd->status), 1);
 436         LOG_INFOB(dump("STATUS", &(sd->status), 1););
 437
 438         LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
 439
 440         if (sd->status & SD_STATUS_READY)
 441                 return 0;
 442
 443         return -1;
 444 }
 445
 446
 447 INLINE int sd_cardSelection(Sd *sd, uint32_t rca)
 448 {
 449         ASSERT(sd);
 450         LOG_INFO("Select RCA: %lx\n", rca);
 451         if (hsmci_sendCmd(7, rca, HSMCI_CMDR_RSPTYP_R1B))
 452         {
 453                 LOG_ERR("SELECT_SD: %lx\n", HSMCI_SR);
 454                 return -1;
 455         }
 456
 457         HSMCI_CHECK_BUSY();
 458         hsmci_readResp(&(sd->status), 1);
 459         LOG_INFOB(dump("SELECT_SD", &(sd->status), 1););
 460
 461         LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
 462
 463         if (sd->status & SD_STATUS_READY)
 464                 return 0;
 465
 466         return -1;
 467 }
 468
 469 int sd_selectCard(Sd *sd)
 470 {
 471         ASSERT(sd);
 472         uint32_t rca = SD_ADDR_TO_RCA(sd->addr);
 473         LOG_INFO("Select RCA: %lx\n", rca);
 474         if (hsmci_sendCmd(7, rca, HSMCI_CMDR_RSPTYP_R1B))
 475         {
 476                 LOG_ERR("SELECT_SD: %lx\n", HSMCI_SR);
 477                 return -1;
 478         }
 479
 480         HSMCI_CHECK_BUSY();
 481         hsmci_readResp(&(sd->status), 1);
 482
 483         LOG_INFOB(dump("SELECT_SD", &(sd->status), 1););
 484         LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
 485
 486         if (sd->status & SD_STATUS_READY)
 487                 return 0;
 488
 489         return -1;
 490 }
 491
 492 int sd_deSelectCard(Sd *sd)
 493 {
 494         ASSERT(sd);
 495
 496         uint32_t rca = 0;
 497         if (!sd->addr)
 498                 rca = SD_ADDR_TO_RCA(sd->addr + 1);
 499
 500         LOG_INFO("Select RCA: %lx\n", rca);
 501
 502         if (hsmci_sendCmd(7, rca, HSMCI_CMDR_RSPTYP_NORESP))
 503         {
 504                 LOG_ERR("DESELECT_SD: %lx\n", HSMCI_SR);
 505                 return -1;
 506         }
 507
 508         return 0;
 509 }
 510
 511 int sd_setBusWidth(Sd *sd, size_t len)
 512 {
 513         ASSERT(sd);
 514
 515         if (hsmci_sendCmd(55, SD_ADDR_TO_RCA(sd->addr), HSMCI_CMDR_RSPTYP_48_BIT))
 516         {
 517                 LOG_ERR("APP_CMD %lx\n", HSMCI_SR);
 518                 return -1;
 519         }
 520
 521         hsmci_readResp(&(sd->status), 1);
 522         if ((sd->status) & (SD_STATUS_APP_CMD | SD_STATUS_READY))
 523         {
 524                 hsmci_setBusWidth(len);
 525
 526                 uint8_t arg = 0;
 527                 if (len == 4)
 528                         arg = 2;
 529
 530                 if (hsmci_sendCmd(6, arg, HSMCI_CMDR_RSPTYP_48_BIT))
 531                 {
 532                         LOG_ERR("SET_BUS_WIDTH CMD: %lx\n", HSMCI_SR);
 533                         return -1;
 534                 }
 535
 536                 hsmci_readResp(&(sd->status), 1);
 537
 538                 LOG_INFOB(dump("SET_BUS_WIDTH", &(sd->status), 1););
 539                 LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
 540
 541                 if (sd->status & SD_STATUS_READY)
 542                         return 0;
 543         }
 544
 545         LOG_ERR("SET_BUS_WIDTH REP %lx\n", (sd->status));
 546         return -1;
 547 }
 548
 549
 550 int sd_set_BlockLen(Sd *sd, size_t len)
 551 {
 552         ASSERT(sd);
 553
 554         if (hsmci_sendCmd(16, len, HSMCI_CMDR_RSPTYP_48_BIT))
 555         {
 556                 LOG_ERR("SET_BLK_LEN: %lx\n", HSMCI_SR);
 557                 return -1;
 558         }
 559
 560         hsmci_readResp(&(sd->status), 1);
 561
 562         LOG_INFOB(dump("SET_BLK_LEN", &(sd->status), 1););
 563         LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
 564
 565         sd->b.blk_size = len;
 566
 567         if (sd->status & SD_STATUS_READY)
 568                 return 0;
 569
 570         return -1;
 571 }
 572
 573 int sd_getStatus(Sd *sd, SdSSR *ssr, uint32_t *buf, size_t words)
 574 {
 575         ASSERT(sd);
 576         ASSERT(ssr);
 577
 578         // Status reply with 512bit data, so the block size in byte is 64
 579         hsmci_read(buf, words, 64);
 580
 581         if (hsmci_sendCmd(55, SD_ADDR_TO_RCA(sd->addr), HSMCI_CMDR_RSPTYP_48_BIT))
 582         {
 583                 LOG_ERR("APP_CMD %lx\n", HSMCI_SR);
 584                 return -1;
 585         }
 586
 587         hsmci_readResp(&(sd->status), 1);
 588         if (sd->status & (SD_STATUS_APP_CMD | SD_STATUS_READY))
 589         {
 590                 if (hsmci_sendCmd(13, 0, HSMCI_CMDR_RSPTYP_48_BIT |
 591                                 BV(HSMCI_CMDR_TRDIR) | HSMCI_CMDR_TRCMD_START_DATA | HSMCI_CMDR_TRTYP_SINGLE))
 592                 {
 593                         LOG_ERR("STATUS CMD: %lx\n", HSMCI_SR);
 594                         return -1;
 595                 }
 596
 597                 hsmci_readResp(&(sd->status), 1);
 598                 LOG_INFOB(dump("STATUS", &(sd->status), 1););
 599                 LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
 600
 601                 if (sd->status & SD_STATUS_READY)
 602                 {
 603                         hsmci_waitTransfer();
 604
 605                         LOG_INFOB(dump("STATUS", buf, words););
 606                         memset(ssr, 0, sizeof(SdSSR));
 607                         ssr->bus_width  = UNSTUFF_BITS(buf, 510, 2);
 608                         ssr->card_type  = UNSTUFF_BITS(buf, 480, 16);
 609                         ssr->au_size  = UNSTUFF_BITS(buf, 432, 8);
 610                         ssr->speed_class  = UNSTUFF_BITS(buf, 440, 8);
 611                         ssr->erase_size = UNSTUFF_BITS(buf, 408, 24);
 612
 613                         return 0;
 614                 }
 615         }
 616
 617         return -1;
 618 }
 619
 620
 621 void sd_setHightSpeed(Sd *sd)
 622 {
 623         (void)sd;
 624         hsmci_setSpeed(HSMCI_HIGH_SPEED, HSMCI_HS_MODE);
 625 }
 626
 627
 628 static size_t sd_SdReadDirect(struct KBlock *b, block_idx_t idx, void *buf, size_t offset, size_t size)
 629 {
 630         ASSERT(buf);
 631         Sd *sd = SD_CAST(b);
 632         LOG_INFO("reading from block %ld, offset %d, size %d\n", idx, offset, size);
 633
 634         if (sd_selectCard(sd) < 0)
 635                 return -1;
 636
 637         hsmci_read(buf, size / 4, sd->b.blk_size);
 638
 639         if (hsmci_sendCmd(17, idx * sd->b.blk_size + offset, HSMCI_CMDR_RSPTYP_48_BIT |
 640                         BV(HSMCI_CMDR_TRDIR) | HSMCI_CMDR_TRCMD_START_DATA | HSMCI_CMDR_TRTYP_SINGLE))
 641         {
 642                 LOG_ERR("SIGLE_BLK_READ: %lx\n", HSMCI_SR);
 643                 sd_deSelectCard(sd);
 644                 return -1;
 645         }
 646
 647         hsmci_readResp(&(sd->status), 1);
 648
 649         LOG_INFOB(dump("SIGLE_BLK_READ", &(sd->status), 1););
 650         LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
 651
 652         if (sd->status & SD_STATUS_READY)
 653         {
 654                 hsmci_waitTransfer();
 655                 sd_deSelectCard(sd);
 656                 return size;
 657         }
 658
 659         sd_deSelectCard(sd);
 660         return -1;
 661 }
 662
 663 static size_t sd_SdWriteDirect(KBlock *b, block_idx_t idx, const void *buf, size_t offset, size_t size)
 664 {
 665         ASSERT(buf);
 666         Sd *sd = SD_CAST(b);
 667         const uint32_t *_buf = (const uint32_t *)buf;
 668         LOG_INFO("reading from block %ld, offset %d, size %d\n", idx, offset, size);
 669
 670         if (sd_selectCard(sd) < 0)
 671                 return 0;
 672
 673         hsmci_write(_buf, size / 4, sd->b.blk_size);
 674
 675         if (hsmci_sendCmd(24, idx * sd->b.blk_size + offset, HSMCI_CMDR_RSPTYP_48_BIT |
 676                                                 HSMCI_CMDR_TRCMD_START_DATA | HSMCI_CMDR_TRTYP_SINGLE))
 677         {
 678                 LOG_ERR("SIGLE_BLK_WRITE: %lx\n", HSMCI_SR);
 679                 sd_deSelectCard(sd);
 680                 return -1;
 681         }
 682
 683         hsmci_readResp(&(sd->status), 1);
 684
 685         LOG_INFOB(dump("SIGLE_BLK_WR", &(sd->status), 1););
 686         LOG_INFO("State[%d]\n", SD_GET_STATE(sd->status));
 687
 688         if (sd->status & SD_STATUS_READY)
 689         {
 690                 hsmci_waitTransfer();
 691                 sd_deSelectCard(sd);
 692                 return size;
 693         }
 694
 695         sd_deSelectCard(sd);
 696         return -1;
 697 }
 698
 699
 700 static int sd_SdError(KBlock *b)
 701 {
 702         Sd *sd = SD_CAST(b);
 703         return SD_GET_ERRORS(sd->status);
 704 }
 705
 706 static void sd_SdClearerr(KBlock *b)
 707 {
 708         Sd *sd = SD_CAST(b);
 709         sd->status = 0;
 710 }
 711
 712 static bool sd_blockInit(Sd *sd, KFile *ch)
 713 {
 714         (void)ch;
 715         ASSERT(sd);
 716         memset(sd, 0, sizeof(*sd));
 717         DB(sd->b.priv.type = KBT_SD);
 718
 719         /* Wait a few moments for supply voltage to stabilize */
 720         timer_delay(SD_START_DELAY);
 721
 722         sd_sendInit();
 723         sd_goIdle();
 724
 725         sd_sendIfCond(sd);
 726
 727         ticks_t start = timer_clock();
 728         bool sd_power_on = false;
 729         do
 730         {
 731                 if (!sd_sendAppOpCond(sd))
 732                 {
 733                         sd_power_on = true;
 734                         break;
 735                 }
 736                 cpu_relax();
 737         }
 738         while (timer_clock() - start < SD_INIT_TIMEOUT);
 739
 740
 741         if (sd_power_on)
 742         {
 743                 SdCID cid;
 744                 if(sd_getCid(sd, &cid, 0, SD_SEND_ALL_CID) < 0)
 745                         return false;
 746                 else
 747                 {
 748                         sd_dumpCid(&cid);
 749                 }
 750
 751                 if (sd_getRelativeAddr(sd) < 0)
 752                         return false;
 753                 else
 754                 {
 755                         LOG_INFO("RCA: %0lx\n", sd->addr);
 756                 }
 757
 758                 SdCSD csd;
 759                 if (sd_getCsd(sd, &csd) < 0)
 760                         return false;
 761                 else
 762                 {
 763                         sd->b.blk_cnt = csd.block_num * (csd.block_len / SD_DEFAULT_BLOCKLEN);
 764                         LOG_INFO("blk_size %d, blk_cnt %ld\n", sd->b.blk_size, sd->b.blk_cnt);
 765                         sd_dumpCsd(&csd);
 766                 }
 767
 768                 if (sd_appStatus(sd) < 0)
 769                 {
 770                         LOG_INFO("STATUS: %ld\n", sd->status);
 771                         return false;
 772                 }
 773
 774                 if (sd->status & SD_CARD_IS_LOCKED)
 775                 {
 776                         LOG_INFO("SD is locked!\n");
 777                         return false;
 778                 }
 779
 780                 if (sd->status & SD_STATUS_READY)
 781                 {
 782                         sd_selectCard(sd);
 783                         sd_set_BlockLen(sd, SD_DEFAULT_BLOCKLEN);
 784                         sd_setBus4bit(sd);
 785                         sd_setHightSpeed(sd);
 786                         sd_deSelectCard(sd);
 787
 788                         #if CONFIG_SD_AUTOASSIGN_FAT
 789                                 disk_assignDrive(&sd->b, 0);
 790                         #endif
 791
 792                         return true;
 793                 }
 794         }
 795         LOG_ERR("SD not ready.\n");
 796         return false;
 797 }
 798
 799 static const KBlockVTable sd_unbuffered_vt =
 800 {
 801         .readDirect = sd_SdReadDirect,
 802         .writeDirect = sd_SdWriteDirect,
 803
 804         .error = sd_SdError,
 805         .clearerr = sd_SdClearerr,
 806 };
 807
 808 static const KBlockVTable sd_buffered_vt =
 809 {
 810         .readDirect = sd_SdReadDirect,
 811         .writeDirect = sd_SdWriteDirect,
 812
 813         .readBuf = kblock_swReadBuf,
 814         .writeBuf = kblock_swWriteBuf,
 815         .load = kblock_swLoad,
 816         .store = kblock_swStore,
 817
 818         .error = sd_SdError,
 819         .clearerr = sd_SdClearerr,
 820 };
 821
 822 bool sd_hw_initUnbuf(Sd *sd, KFile *ch)
 823 {
 824         if (sd_blockInit(sd, ch))
 825         {
 826                 sd->b.priv.vt = &sd_unbuffered_vt;
 827                 return true;
 828         }
 829         else
 830                 return false;
 831 }
 832
 833 static uint8_t sd_buf[SD_DEFAULT_BLOCKLEN];
 834
 835 bool sd_hw_initBuf(Sd *sd, KFile *ch)
 836 {
 837         if (sd_blockInit(sd, ch))
 838         {
 839                 sd->b.priv.buf = sd_buf;
 840                 sd->b.priv.flags |= KB_BUFFERED | KB_PARTIAL_WRITE;
 841                 sd->b.priv.vt = &sd_buffered_vt;
 842                 sd->b.priv.vt->load(&sd->b, 0);
 843                 return true;
 844         }
 845         else
 846                 return false;
 847 }
 848
 849
 850