krishan prajapat / Mbed 2 deprecated sd_card_making_header_sss2

v2.0 working

Dependencies:   mbed

SDCard_initionalisation.h@2:2b08032d9678, 2015-07-30 (annotated)

Committer:
krishanprajapat
Date:
Thu Jul 30 12:39:50 2015 +0000
Revision:
2:2b08032d9678
Parent:
0:8ed3ad791ca2 
read from sd card and send to adf working;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
krishanprajapat 0:8ed3ad791ca2 1
krishanprajapat 0:8ed3ad791ca2 2 Serial PC(USBTX, USBRX);
krishanprajapat 2:2b08032d9678 3 DigitalOut cs_SDCard(D9);
krishanprajapat 0:8ed3ad791ca2 4
krishanprajapat 0:8ed3ad791ca2 5 #define SD_COMMAND_TIMEOUT 5000
krishanprajapat 0:8ed3ad791ca2 6
krishanprajapat 0:8ed3ad791ca2 7 #define SD_DBG 0
krishanprajapat 0:8ed3ad791ca2 8
krishanprajapat 0:8ed3ad791ca2 9 #define R1_IDLE_STATE (1 << 0)
krishanprajapat 0:8ed3ad791ca2 10 #define R1_ERASE_RESET (1 << 1)
krishanprajapat 0:8ed3ad791ca2 11 #define R1_ILLEGAL_COMMAND (1 << 2)
krishanprajapat 0:8ed3ad791ca2 12 #define R1_COM_CRC_ERROR (1 << 3)
krishanprajapat 0:8ed3ad791ca2 13 #define R1_ERASE_SEQUENCE_ERROR (1 << 4)
krishanprajapat 0:8ed3ad791ca2 14 #define R1_ADDRESS_ERROR (1 << 5)
krishanprajapat 0:8ed3ad791ca2 15 #define R1_PARAMETER_ERROR (1 << 6)
krishanprajapat 0:8ed3ad791ca2 16 SPI spi(PTA16, PTA17, PTA15); // mosi, miso, sclk
krishanprajapat 0:8ed3ad791ca2 17
krishanprajapat 0:8ed3ad791ca2 18
krishanprajapat 0:8ed3ad791ca2 19 int initialise_card();
krishanprajapat 0:8ed3ad791ca2 20 int initialise_card_v1();
krishanprajapat 0:8ed3ad791ca2 21 int initialise_card_v2();
krishanprajapat 0:8ed3ad791ca2 22 int disk_initialize();
krishanprajapat 0:8ed3ad791ca2 23 int disk_write(const uint8_t *, uint64_t);
krishanprajapat 0:8ed3ad791ca2 24
krishanprajapat 0:8ed3ad791ca2 25 int disk_erase(int,int);
krishanprajapat 0:8ed3ad791ca2 26
krishanprajapat 0:8ed3ad791ca2 27 uint64_t sd_sectors();
krishanprajapat 0:8ed3ad791ca2 28 uint64_t sectors;
krishanprajapat 0:8ed3ad791ca2 29
krishanprajapat 0:8ed3ad791ca2 30 int cmd(int, int);
krishanprajapat 0:8ed3ad791ca2 31 int cmd58();
krishanprajapat 0:8ed3ad791ca2 32 int cmdx(int, int);
krishanprajapat 0:8ed3ad791ca2 33 int cmd8();
krishanprajapat 0:8ed3ad791ca2 34 int read(uint8_t*, uint32_t );
krishanprajapat 0:8ed3ad791ca2 35 int write(const uint8_t*, uint32_t );
krishanprajapat 0:8ed3ad791ca2 36 static uint32_t ext_bits(unsigned char *, int , int );
krishanprajapat 0:8ed3ad791ca2 37
krishanprajapat 0:8ed3ad791ca2 38 int cdv;
krishanprajapat 0:8ed3ad791ca2 39
krishanprajapat 0:8ed3ad791ca2 40 #define SDCARD_FAIL 0
krishanprajapat 0:8ed3ad791ca2 41 #define SDCARD_V1 1
krishanprajapat 0:8ed3ad791ca2 42 #define SDCARD_V2 2
krishanprajapat 0:8ed3ad791ca2 43 #define SDCARD_V2HC 3
krishanprajapat 0:8ed3ad791ca2 44
krishanprajapat 0:8ed3ad791ca2 45 int count_bro;
krishanprajapat 0:8ed3ad791ca2 46 int i;
krishanprajapat 0:8ed3ad791ca2 47 int random[1000];
krishanprajapat 0:8ed3ad791ca2 48
krishanprajapat 0:8ed3ad791ca2 49
krishanprajapat 0:8ed3ad791ca2 50 void initialisation_SDCard(){
krishanprajapat 2:2b08032d9678 51 cs_adf =1;
krishanprajapat 0:8ed3ad791ca2 52 // start_block_num =10 ; // Read from TC
krishanprajapat 0:8ed3ad791ca2 53 // end_block_num =Science_TMframe::SDC_address ; // Read from TC
krishanprajapat 0:8ed3ad791ca2 54 printf("welcome\n");
krishanprajapat 0:8ed3ad791ca2 55 initialise_card();
krishanprajapat 0:8ed3ad791ca2 56 int result= initialise_card();
krishanprajapat 0:8ed3ad791ca2 57 printf("initialise card result=%d\n",result);
krishanprajapat 0:8ed3ad791ca2 58 disk_initialize();
krishanprajapat 0:8ed3ad791ca2 59
krishanprajapat 0:8ed3ad791ca2 60 }
krishanprajapat 0:8ed3ad791ca2 61
krishanprajapat 0:8ed3ad791ca2 62
krishanprajapat 0:8ed3ad791ca2 63
krishanprajapat 0:8ed3ad791ca2 64
krishanprajapat 0:8ed3ad791ca2 65 int initialise_card()
krishanprajapat 0:8ed3ad791ca2 66 {
krishanprajapat 2:2b08032d9678 67 // Set to 100kHz for initialisation, and clock card with cs_SDCard = 1
krishanprajapat 0:8ed3ad791ca2 68 spi.frequency(100000);
krishanprajapat 2:2b08032d9678 69 cs_SDCard = 1;
krishanprajapat 0:8ed3ad791ca2 70 for (int i = 0; i < 16; i++) {
krishanprajapat 0:8ed3ad791ca2 71 spi.write(0xFF);
krishanprajapat 0:8ed3ad791ca2 72 }
krishanprajapat 0:8ed3ad791ca2 73
krishanprajapat 0:8ed3ad791ca2 74 // send CMD0, should return with all zeros except IDLE STATE set (bit 0)
krishanprajapat 0:8ed3ad791ca2 75 if (cmd(0, 0) != R1_IDLE_STATE) {
krishanprajapat 0:8ed3ad791ca2 76 debug("No disk, or could not put SD card in to SPI idle state\n");
krishanprajapat 0:8ed3ad791ca2 77 return SDCARD_FAIL;
krishanprajapat 0:8ed3ad791ca2 78 }
krishanprajapat 0:8ed3ad791ca2 79
krishanprajapat 0:8ed3ad791ca2 80 // send CMD8 to determine whther it is ver 2.x
krishanprajapat 0:8ed3ad791ca2 81 int r = cmd8();
krishanprajapat 0:8ed3ad791ca2 82 if (r == R1_IDLE_STATE) {
krishanprajapat 0:8ed3ad791ca2 83 printf("Entering v2 bro\n");
krishanprajapat 0:8ed3ad791ca2 84 return initialise_card_v2();
krishanprajapat 0:8ed3ad791ca2 85
krishanprajapat 0:8ed3ad791ca2 86 } else if (r == (R1_IDLE_STATE | R1_ILLEGAL_COMMAND)) {
krishanprajapat 0:8ed3ad791ca2 87 printf("Entering v1 bro\n");
krishanprajapat 0:8ed3ad791ca2 88 return initialise_card_v1();
krishanprajapat 0:8ed3ad791ca2 89
krishanprajapat 0:8ed3ad791ca2 90 } else {
krishanprajapat 0:8ed3ad791ca2 91 debug("Not in idle state after sending CMD8 (not an SD card?)\n");
krishanprajapat 0:8ed3ad791ca2 92 return SDCARD_FAIL;
krishanprajapat 0:8ed3ad791ca2 93 }
krishanprajapat 0:8ed3ad791ca2 94 }
krishanprajapat 0:8ed3ad791ca2 95
krishanprajapat 0:8ed3ad791ca2 96 int initialise_card_v1()
krishanprajapat 0:8ed3ad791ca2 97 {
krishanprajapat 0:8ed3ad791ca2 98 for (int i = 0; i < SD_COMMAND_TIMEOUT; i++) {
krishanprajapat 0:8ed3ad791ca2 99 cmd(55, 0);
krishanprajapat 0:8ed3ad791ca2 100 if (cmd(41, 0) == 0) {
krishanprajapat 0:8ed3ad791ca2 101 printf("Yuppie v1 successful\n");
krishanprajapat 0:8ed3ad791ca2 102 cdv = 512;
krishanprajapat 0:8ed3ad791ca2 103 debug_if(SD_DBG, "\n\rInit: SEDCARD_V1\n\r");
krishanprajapat 0:8ed3ad791ca2 104
krishanprajapat 0:8ed3ad791ca2 105 return SDCARD_V1;
krishanprajapat 0:8ed3ad791ca2 106 }
krishanprajapat 0:8ed3ad791ca2 107 }
krishanprajapat 0:8ed3ad791ca2 108
krishanprajapat 0:8ed3ad791ca2 109 debug("Timeout waiting for v1.x card\n");
krishanprajapat 0:8ed3ad791ca2 110 return SDCARD_FAIL;
krishanprajapat 0:8ed3ad791ca2 111 }
krishanprajapat 0:8ed3ad791ca2 112
krishanprajapat 0:8ed3ad791ca2 113
krishanprajapat 0:8ed3ad791ca2 114 int initialise_card_v2()
krishanprajapat 0:8ed3ad791ca2 115 {
krishanprajapat 0:8ed3ad791ca2 116 for (int i = 0; i < SD_COMMAND_TIMEOUT; i++) {
krishanprajapat 0:8ed3ad791ca2 117 wait_ms(50);
krishanprajapat 0:8ed3ad791ca2 118 cmd58();
krishanprajapat 0:8ed3ad791ca2 119 cmd(55, 0);
krishanprajapat 0:8ed3ad791ca2 120 if (cmd(41, 0x40000000) == 0) {
krishanprajapat 0:8ed3ad791ca2 121 printf("Yuppie,v2 successful\n");
krishanprajapat 0:8ed3ad791ca2 122 cmd58();
krishanprajapat 0:8ed3ad791ca2 123 debug_if(SD_DBG, "\n\rInit: SDCARD_V2\n\r");
krishanprajapat 0:8ed3ad791ca2 124 cdv = 1;
krishanprajapat 0:8ed3ad791ca2 125
krishanprajapat 0:8ed3ad791ca2 126 return SDCARD_V2;
krishanprajapat 0:8ed3ad791ca2 127 }
krishanprajapat 0:8ed3ad791ca2 128 }
krishanprajapat 0:8ed3ad791ca2 129
krishanprajapat 0:8ed3ad791ca2 130 debug("Timeout waiting for v2.x card\n");
krishanprajapat 0:8ed3ad791ca2 131 return SDCARD_FAIL;
krishanprajapat 0:8ed3ad791ca2 132 }
krishanprajapat 0:8ed3ad791ca2 133
krishanprajapat 0:8ed3ad791ca2 134 int cmd(int cmd, int arg)
krishanprajapat 0:8ed3ad791ca2 135 {
krishanprajapat 2:2b08032d9678 136 cs_SDCard = 0;
krishanprajapat 0:8ed3ad791ca2 137
krishanprajapat 0:8ed3ad791ca2 138 // send a command
krishanprajapat 0:8ed3ad791ca2 139 spi.write(0x40 | cmd);
krishanprajapat 0:8ed3ad791ca2 140 spi.write(arg >> 24);
krishanprajapat 0:8ed3ad791ca2 141 spi.write(arg >> 16);
krishanprajapat 0:8ed3ad791ca2 142 spi.write(arg >> 8);
krishanprajapat 0:8ed3ad791ca2 143 spi.write(arg >> 0);
krishanprajapat 0:8ed3ad791ca2 144 spi.write(0x95);
krishanprajapat 0:8ed3ad791ca2 145
krishanprajapat 0:8ed3ad791ca2 146 // wait for the repsonse (response[7] == 0)
krishanprajapat 0:8ed3ad791ca2 147 for (int i = 0; i < SD_COMMAND_TIMEOUT; i++) {
krishanprajapat 0:8ed3ad791ca2 148 int response = spi.write(0xFF);
krishanprajapat 0:8ed3ad791ca2 149 if (!(response & 0x80)) {
krishanprajapat 2:2b08032d9678 150 cs_SDCard = 1;
krishanprajapat 0:8ed3ad791ca2 151 spi.write(0xFF);
krishanprajapat 0:8ed3ad791ca2 152 return response;
krishanprajapat 0:8ed3ad791ca2 153 }
krishanprajapat 0:8ed3ad791ca2 154 }
krishanprajapat 2:2b08032d9678 155 cs_SDCard = 1;
krishanprajapat 0:8ed3ad791ca2 156 spi.write(0xFF);
krishanprajapat 0:8ed3ad791ca2 157 return -1; // timeout
krishanprajapat 0:8ed3ad791ca2 158 }
krishanprajapat 0:8ed3ad791ca2 159
krishanprajapat 0:8ed3ad791ca2 160
krishanprajapat 0:8ed3ad791ca2 161 int cmd58()
krishanprajapat 0:8ed3ad791ca2 162 {
krishanprajapat 2:2b08032d9678 163 cs_SDCard = 0;
krishanprajapat 0:8ed3ad791ca2 164 int arg = 0;
krishanprajapat 0:8ed3ad791ca2 165
krishanprajapat 0:8ed3ad791ca2 166 // send a command
krishanprajapat 0:8ed3ad791ca2 167 spi.write(0x40 | 58);
krishanprajapat 0:8ed3ad791ca2 168 spi.write(arg >> 24);
krishanprajapat 0:8ed3ad791ca2 169 spi.write(arg >> 16);
krishanprajapat 0:8ed3ad791ca2 170 spi.write(arg >> 8);
krishanprajapat 0:8ed3ad791ca2 171 spi.write(arg >> 0);
krishanprajapat 0:8ed3ad791ca2 172 spi.write(0x95);
krishanprajapat 0:8ed3ad791ca2 173
krishanprajapat 0:8ed3ad791ca2 174 // wait for the repsonse (response[7] == 0)
krishanprajapat 0:8ed3ad791ca2 175 for (int i = 0; i < SD_COMMAND_TIMEOUT; i++) {
krishanprajapat 0:8ed3ad791ca2 176 int response = spi.write(0xFF);
krishanprajapat 0:8ed3ad791ca2 177 if (!(response & 0x80)) {
krishanprajapat 0:8ed3ad791ca2 178 int ocr = spi.write(0xFF) << 24;
krishanprajapat 0:8ed3ad791ca2 179 ocr |= spi.write(0xFF) << 16;
krishanprajapat 0:8ed3ad791ca2 180 ocr |= spi.write(0xFF) << 8;
krishanprajapat 0:8ed3ad791ca2 181 ocr |= spi.write(0xFF) << 0;
krishanprajapat 2:2b08032d9678 182 cs_SDCard = 1;
krishanprajapat 0:8ed3ad791ca2 183 spi.write(0xFF);
krishanprajapat 0:8ed3ad791ca2 184 return response;
krishanprajapat 0:8ed3ad791ca2 185 }
krishanprajapat 0:8ed3ad791ca2 186 }
krishanprajapat 2:2b08032d9678 187 cs_SDCard = 1;
krishanprajapat 0:8ed3ad791ca2 188 spi.write(0xFF);
krishanprajapat 0:8ed3ad791ca2 189 return -1; // timeout
krishanprajapat 0:8ed3ad791ca2 190 }
krishanprajapat 0:8ed3ad791ca2 191
krishanprajapat 0:8ed3ad791ca2 192
krishanprajapat 0:8ed3ad791ca2 193 int cmd8()
krishanprajapat 0:8ed3ad791ca2 194 {
krishanprajapat 2:2b08032d9678 195 cs_SDCard = 0;
krishanprajapat 0:8ed3ad791ca2 196
krishanprajapat 0:8ed3ad791ca2 197 // send a command
krishanprajapat 0:8ed3ad791ca2 198 spi.write(0x40 | 8); // CMD8
krishanprajapat 0:8ed3ad791ca2 199 spi.write(0x00); // reserved
krishanprajapat 0:8ed3ad791ca2 200 spi.write(0x00); // reserved
krishanprajapat 0:8ed3ad791ca2 201 spi.write(0x01); // 3.3v
krishanprajapat 0:8ed3ad791ca2 202 spi.write(0xAA); // check pattern
krishanprajapat 0:8ed3ad791ca2 203 spi.write(0x87); // crc
krishanprajapat 0:8ed3ad791ca2 204
krishanprajapat 0:8ed3ad791ca2 205 // wait for the repsonse (response[7] == 0)
krishanprajapat 0:8ed3ad791ca2 206 for (int i = 0; i < SD_COMMAND_TIMEOUT * 1000; i++) {
krishanprajapat 0:8ed3ad791ca2 207 char response[5];
krishanprajapat 0:8ed3ad791ca2 208 response[0] = spi.write(0xFF);
krishanprajapat 0:8ed3ad791ca2 209 if (!(response[0] & 0x80)) {
krishanprajapat 0:8ed3ad791ca2 210 for (int j = 1; j < 5; j++) {
krishanprajapat 0:8ed3ad791ca2 211 response[i] = spi.write(0xFF);
krishanprajapat 0:8ed3ad791ca2 212 }
krishanprajapat 2:2b08032d9678 213 cs_SDCard = 1;
krishanprajapat 0:8ed3ad791ca2 214 spi.write(0xFF);
krishanprajapat 0:8ed3ad791ca2 215 return response[0];
krishanprajapat 0:8ed3ad791ca2 216 }
krishanprajapat 0:8ed3ad791ca2 217 }
krishanprajapat 2:2b08032d9678 218 cs_SDCard = 1;
krishanprajapat 0:8ed3ad791ca2 219 spi.write(0xFF);
krishanprajapat 0:8ed3ad791ca2 220 return -1; // timeout
krishanprajapat 0:8ed3ad791ca2 221 }
krishanprajapat 0:8ed3ad791ca2 222
krishanprajapat 0:8ed3ad791ca2 223 uint64_t sd_sectors()
krishanprajapat 0:8ed3ad791ca2 224 {
krishanprajapat 0:8ed3ad791ca2 225 uint32_t c_size, c_size_mult, read_bl_len;
krishanprajapat 0:8ed3ad791ca2 226 uint32_t block_len, mult, blocknr, capacity;
krishanprajapat 0:8ed3ad791ca2 227 uint32_t hc_c_size;
krishanprajapat 0:8ed3ad791ca2 228 uint64_t blocks;
krishanprajapat 0:8ed3ad791ca2 229
krishanprajapat 0:8ed3ad791ca2 230 // CMD9, Response R2 (R1 byte + 16-byte block read)
krishanprajapat 0:8ed3ad791ca2 231 if (cmdx(9, 0) != 0) {
krishanprajapat 0:8ed3ad791ca2 232 debug("Didn't get a response from the disk\n");
krishanprajapat 0:8ed3ad791ca2 233 return 0;
krishanprajapat 0:8ed3ad791ca2 234 }
krishanprajapat 0:8ed3ad791ca2 235
krishanprajapat 0:8ed3ad791ca2 236 uint8_t csd[16];
krishanprajapat 0:8ed3ad791ca2 237 if (read(csd, 16) != 0) {
krishanprajapat 0:8ed3ad791ca2 238 debug("Couldn't read csd response from disk\n");
krishanprajapat 0:8ed3ad791ca2 239 return 0;
krishanprajapat 0:8ed3ad791ca2 240 }
krishanprajapat 0:8ed3ad791ca2 241
krishanprajapat 0:8ed3ad791ca2 242 // csd_structure : csd[127:126]
krishanprajapat 0:8ed3ad791ca2 243 // c_size : csd[73:62]
krishanprajapat 0:8ed3ad791ca2 244 // c_size_mult : csd[49:47]
krishanprajapat 0:8ed3ad791ca2 245 // read_bl_len : csd[83:80] - the *maximum* read block length
krishanprajapat 0:8ed3ad791ca2 246
krishanprajapat 0:8ed3ad791ca2 247 int csd_structure = ext_bits(csd, 127, 126);
krishanprajapat 0:8ed3ad791ca2 248
krishanprajapat 0:8ed3ad791ca2 249 switch (csd_structure) {
krishanprajapat 0:8ed3ad791ca2 250 case 0:
krishanprajapat 0:8ed3ad791ca2 251 cdv = 512;
krishanprajapat 0:8ed3ad791ca2 252 c_size = ext_bits(csd, 73, 62);
krishanprajapat 0:8ed3ad791ca2 253 c_size_mult = ext_bits(csd, 49, 47);
krishanprajapat 0:8ed3ad791ca2 254 read_bl_len = ext_bits(csd, 83, 80);
krishanprajapat 0:8ed3ad791ca2 255
krishanprajapat 0:8ed3ad791ca2 256 block_len = 1 << read_bl_len;
krishanprajapat 0:8ed3ad791ca2 257 mult = 1 << (c_size_mult + 2);
krishanprajapat 0:8ed3ad791ca2 258 blocknr = (c_size + 1) * mult;
krishanprajapat 0:8ed3ad791ca2 259 capacity = blocknr * block_len;
krishanprajapat 0:8ed3ad791ca2 260 blocks = capacity / 512;
krishanprajapat 0:8ed3ad791ca2 261 debug_if(SD_DBG, "\n\rSDCard\n\rc_size: %d \n\rcapacity: %ld \n\rsectors: %lld\n\r", c_size, capacity, blocks);
krishanprajapat 0:8ed3ad791ca2 262 break;
krishanprajapat 0:8ed3ad791ca2 263
krishanprajapat 0:8ed3ad791ca2 264 case 1:
krishanprajapat 0:8ed3ad791ca2 265 cdv = 1;
krishanprajapat 0:8ed3ad791ca2 266 hc_c_size = ext_bits(csd, 63, 48);
krishanprajapat 0:8ed3ad791ca2 267 blocks = (hc_c_size+1)*1024;
krishanprajapat 0:8ed3ad791ca2 268 debug_if(SD_DBG, "\n\rSDHC Card \n\rhc_c_size: %d\n\rcapacity: %lld \n\rsectors: %lld\n\r", hc_c_size, blocks*512, blocks);
krishanprajapat 0:8ed3ad791ca2 269 break;
krishanprajapat 0:8ed3ad791ca2 270
krishanprajapat 0:8ed3ad791ca2 271 default:
krishanprajapat 0:8ed3ad791ca2 272 debug("CSD struct unsupported\r\n");
krishanprajapat 0:8ed3ad791ca2 273 return 0;
krishanprajapat 0:8ed3ad791ca2 274 };
krishanprajapat 0:8ed3ad791ca2 275 return blocks;
krishanprajapat 0:8ed3ad791ca2 276 }
krishanprajapat 0:8ed3ad791ca2 277
krishanprajapat 0:8ed3ad791ca2 278 int cmdx(int cmd, int arg)
krishanprajapat 0:8ed3ad791ca2 279 {
krishanprajapat 2:2b08032d9678 280 cs_SDCard = 0;
krishanprajapat 0:8ed3ad791ca2 281
krishanprajapat 0:8ed3ad791ca2 282 // send a command
krishanprajapat 0:8ed3ad791ca2 283 spi.write(0x40 | cmd);
krishanprajapat 0:8ed3ad791ca2 284 spi.write(arg >> 24);
krishanprajapat 0:8ed3ad791ca2 285 spi.write(arg >> 16);
krishanprajapat 0:8ed3ad791ca2 286 spi.write(arg >> 8);
krishanprajapat 0:8ed3ad791ca2 287 spi.write(arg >> 0);
krishanprajapat 0:8ed3ad791ca2 288 spi.write(0x95);
krishanprajapat 0:8ed3ad791ca2 289
krishanprajapat 0:8ed3ad791ca2 290 // wait for the repsonse (response[7] == 0)
krishanprajapat 0:8ed3ad791ca2 291 for (int i = 0; i < SD_COMMAND_TIMEOUT; i++) {
krishanprajapat 0:8ed3ad791ca2 292 int response = spi.write(0xFF);
krishanprajapat 0:8ed3ad791ca2 293 if (!(response & 0x80)) {
krishanprajapat 0:8ed3ad791ca2 294 return response;
krishanprajapat 0:8ed3ad791ca2 295 }
krishanprajapat 0:8ed3ad791ca2 296 }
krishanprajapat 2:2b08032d9678 297 cs_SDCard = 1;
krishanprajapat 0:8ed3ad791ca2 298 spi.write(0xFF);
krishanprajapat 0:8ed3ad791ca2 299 return -1; // timeout
krishanprajapat 0:8ed3ad791ca2 300 }
krishanprajapat 0:8ed3ad791ca2 301
krishanprajapat 0:8ed3ad791ca2 302 static uint32_t ext_bits(unsigned char *data, int msb, int lsb)
krishanprajapat 0:8ed3ad791ca2 303 {
krishanprajapat 0:8ed3ad791ca2 304 uint32_t bits = 0;
krishanprajapat 0:8ed3ad791ca2 305 uint32_t size = 1 + msb - lsb;
krishanprajapat 0:8ed3ad791ca2 306 for (int i = 0; i < size; i++) {
krishanprajapat 0:8ed3ad791ca2 307 uint32_t position = lsb + i;
krishanprajapat 0:8ed3ad791ca2 308 uint32_t byte = 15 - (position >> 3);
krishanprajapat 0:8ed3ad791ca2 309 uint32_t bit = position & 0x7;
krishanprajapat 0:8ed3ad791ca2 310 uint32_t value = (data[byte] >> bit) & 1;
krishanprajapat 0:8ed3ad791ca2 311 bits |= value << i;
krishanprajapat 0:8ed3ad791ca2 312 }
krishanprajapat 0:8ed3ad791ca2 313 return bits;
krishanprajapat 0:8ed3ad791ca2 314 }
krishanprajapat 0:8ed3ad791ca2 315
krishanprajapat 0:8ed3ad791ca2 316 int disk_initialize()
krishanprajapat 0:8ed3ad791ca2 317 {
krishanprajapat 0:8ed3ad791ca2 318 int i = initialise_card();
krishanprajapat 0:8ed3ad791ca2 319 debug_if(SD_DBG, "init card = %d\n", i);
krishanprajapat 0:8ed3ad791ca2 320 sectors = sd_sectors();
krishanprajapat 0:8ed3ad791ca2 321
krishanprajapat 0:8ed3ad791ca2 322 // Set block length to 512 (CMD16)
krishanprajapat 0:8ed3ad791ca2 323 if (cmd(16, 512) != 0) {
krishanprajapat 0:8ed3ad791ca2 324 debug("Set 512-byte block timed out\n");
krishanprajapat 0:8ed3ad791ca2 325 return 1;
krishanprajapat 0:8ed3ad791ca2 326 } else {
krishanprajapat 0:8ed3ad791ca2 327 printf("Hey,block init succesful\n");
krishanprajapat 0:8ed3ad791ca2 328 }
krishanprajapat 0:8ed3ad791ca2 329
krishanprajapat 0:8ed3ad791ca2 330 spi.frequency(1000000); // Set to 1MHz for data transfer
krishanprajapat 0:8ed3ad791ca2 331 return 0;
krishanprajapat 0:8ed3ad791ca2 332 }
krishanprajapat 0:8ed3ad791ca2 333
krishanprajapat 0:8ed3ad791ca2 334 int disk_write(const uint8_t *buffer, uint64_t block_number)
krishanprajapat 0:8ed3ad791ca2 335
krishanprajapat 0:8ed3ad791ca2 336 {
krishanprajapat 0:8ed3ad791ca2 337 // set write address for single block (CMD24)
krishanprajapat 0:8ed3ad791ca2 338 if (cmd(24, block_number * cdv) != 0) {
krishanprajapat 0:8ed3ad791ca2 339 return 1;
krishanprajapat 0:8ed3ad791ca2 340 }
krishanprajapat 0:8ed3ad791ca2 341
krishanprajapat 0:8ed3ad791ca2 342 // send the data block
krishanprajapat 0:8ed3ad791ca2 343 write(buffer, 512);
krishanprajapat 0:8ed3ad791ca2 344 //printf("Written Successfully bro \n");
krishanprajapat 0:8ed3ad791ca2 345 return 0;
krishanprajapat 0:8ed3ad791ca2 346 }
krishanprajapat 0:8ed3ad791ca2 347
krishanprajapat 0:8ed3ad791ca2 348 int write(const uint8_t*buffer, uint32_t length)
krishanprajapat 0:8ed3ad791ca2 349 {
krishanprajapat 2:2b08032d9678 350 cs_SDCard = 0;
krishanprajapat 0:8ed3ad791ca2 351
krishanprajapat 0:8ed3ad791ca2 352 // indicate start of block
krishanprajapat 0:8ed3ad791ca2 353 spi.write(0xFE);
krishanprajapat 0:8ed3ad791ca2 354
krishanprajapat 0:8ed3ad791ca2 355 // write the data
krishanprajapat 0:8ed3ad791ca2 356 for (int i = 0; i < length; i++) {
krishanprajapat 0:8ed3ad791ca2 357 spi.write(buffer[i]);
krishanprajapat 0:8ed3ad791ca2 358 }
krishanprajapat 0:8ed3ad791ca2 359
krishanprajapat 0:8ed3ad791ca2 360 // write the checksum
krishanprajapat 0:8ed3ad791ca2 361 spi.write(0xFF);
krishanprajapat 0:8ed3ad791ca2 362 spi.write(0xFF);
krishanprajapat 0:8ed3ad791ca2 363
krishanprajapat 0:8ed3ad791ca2 364 // check the response token
krishanprajapat 0:8ed3ad791ca2 365 if ((spi.write(0xFF) & 0x1F) != 0x05) {
krishanprajapat 2:2b08032d9678 366 cs_SDCard = 1;
krishanprajapat 0:8ed3ad791ca2 367 spi.write(0xFF);
krishanprajapat 0:8ed3ad791ca2 368 return 1;
krishanprajapat 0:8ed3ad791ca2 369 }
krishanprajapat 0:8ed3ad791ca2 370
krishanprajapat 0:8ed3ad791ca2 371 // wait for write to finish
krishanprajapat 0:8ed3ad791ca2 372 while (spi.write(0xFF) == 0);
krishanprajapat 0:8ed3ad791ca2 373
krishanprajapat 2:2b08032d9678 374 cs_SDCard = 1;
krishanprajapat 0:8ed3ad791ca2 375 spi.write(0xFF);
krishanprajapat 0:8ed3ad791ca2 376 return 0;
krishanprajapat 0:8ed3ad791ca2 377 }
krishanprajapat 0:8ed3ad791ca2 378
krishanprajapat 0:8ed3ad791ca2 379 int disk_read(uint8_t *buffer, uint64_t block_number)
krishanprajapat 0:8ed3ad791ca2 380 {
krishanprajapat 0:8ed3ad791ca2 381 // set read address for single block (CMD17)
krishanprajapat 0:8ed3ad791ca2 382 if (cmd(17, block_number * cdv) != 0) {
krishanprajapat 0:8ed3ad791ca2 383 return 1;
krishanprajapat 0:8ed3ad791ca2 384 }
krishanprajapat 0:8ed3ad791ca2 385
krishanprajapat 0:8ed3ad791ca2 386 // receive the data
krishanprajapat 0:8ed3ad791ca2 387 read(buffer, 512);
krishanprajapat 0:8ed3ad791ca2 388 return 0;
krishanprajapat 0:8ed3ad791ca2 389 }
krishanprajapat 0:8ed3ad791ca2 390
krishanprajapat 0:8ed3ad791ca2 391 int read(uint8_t *buffer, uint32_t length)
krishanprajapat 0:8ed3ad791ca2 392 {
krishanprajapat 2:2b08032d9678 393 cs_SDCard = 0;
krishanprajapat 0:8ed3ad791ca2 394
krishanprajapat 0:8ed3ad791ca2 395 // read until start byte (0xFF)
krishanprajapat 0:8ed3ad791ca2 396 while (spi.write(0xFF) != 0xFE);
krishanprajapat 0:8ed3ad791ca2 397
krishanprajapat 0:8ed3ad791ca2 398 // read data
krishanprajapat 0:8ed3ad791ca2 399 for (int i = 0; i < length; i++) {
krishanprajapat 0:8ed3ad791ca2 400 buffer[i] = spi.write(0xFF);
krishanprajapat 0:8ed3ad791ca2 401 }
krishanprajapat 0:8ed3ad791ca2 402 spi.write(0xFF); // checksum
krishanprajapat 0:8ed3ad791ca2 403 spi.write(0xFF);
krishanprajapat 0:8ed3ad791ca2 404
krishanprajapat 2:2b08032d9678 405 cs_SDCard = 1;
krishanprajapat 0:8ed3ad791ca2 406 spi.write(0xFF);
krishanprajapat 0:8ed3ad791ca2 407 return 0;
krishanprajapat 0:8ed3ad791ca2 408 }
krishanprajapat 0:8ed3ad791ca2 409
krishanprajapat 0:8ed3ad791ca2 410 int disk_erase(int startBlock, int totalBlocks)
krishanprajapat 0:8ed3ad791ca2 411 {
krishanprajapat 0:8ed3ad791ca2 412 if(cmd(32, startBlock * cdv) != 0) {
krishanprajapat 0:8ed3ad791ca2 413 return 1;
krishanprajapat 0:8ed3ad791ca2 414 }
krishanprajapat 0:8ed3ad791ca2 415 if (cmd(33, (startBlock+totalBlocks-1) * cdv) != 0) {
krishanprajapat 0:8ed3ad791ca2 416 return 1;
krishanprajapat 0:8ed3ad791ca2 417 }
krishanprajapat 0:8ed3ad791ca2 418 if (cmd(38,0) != 0) {
krishanprajapat 0:8ed3ad791ca2 419 return 1;
krishanprajapat 0:8ed3ad791ca2 420 }
krishanprajapat 0:8ed3ad791ca2 421
krishanprajapat 0:8ed3ad791ca2 422 return 0; //normal return
krishanprajapat 0:8ed3ad791ca2 423 }