krishan prajapat / Mbed 2 deprecated adfHeadercombining

lele

Dependencies:   mbed

SDCard_initionalisation.h@1:90fd52655154, 2015-07-31 (annotated)

Committer:
krishanprajapat
Date:
Fri Jul 31 12:52:23 2015 +0000
Revision:
1:90fd52655154
Parent:
0:984643af7d81 
bro working fine and Sframe and EoS is also done , so put peace;

Who changed what in which revision?

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