Shreesha S / Mbed 2 deprecated MNG_TC_working

Dummy program to demonstrate problems: working code

Dependencies:   SLCD mbed-rtos mbed

Fork of MNG_TC by Shreesha S

SDCard_initionalisation.h@17:2b04e53f3b1d, 2015-09-17 (annotated)

Committer:
shreeshas95
Date:
Thu Sep 17 14:15:00 2015 +0000
Revision:
17:2b04e53f3b1d
Parent:
13:7b27a8e9cbb4 
DUMMP program to demonstrate the problems : working

Who changed what in which revision?

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