Lucas Kierulff Balabram / Mbed 2 deprecated Telemetria_RX

RX

Dependencies:   mbed BufferedSerial SX1276GenericLib X_NUCLEO_IKS01A2

SDCard_Y.cpp@2:e7d7e80256cc, 2019-06-17 (annotated)

Committer:
LucasKB
Date:
Mon Jun 17 00:10:40 2019 +0000
Revision:
2:e7d7e80256cc
RX;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
LucasKB 2:e7d7e80256cc 1 #include "SDCard_Y.hh"
LucasKB 2:e7d7e80256cc 2
LucasKB 2:e7d7e80256cc 3
LucasKB 2:e7d7e80256cc 4
LucasKB 2:e7d7e80256cc 5 #define SD_COMMAND_TIMEOUT 5000
LucasKB 2:e7d7e80256cc 6
LucasKB 2:e7d7e80256cc 7 #define R1_IDLE_STATE (1 << 0)
LucasKB 2:e7d7e80256cc 8 #define R1_ERASE_RESET (1 << 1)
LucasKB 2:e7d7e80256cc 9 #define R1_ILLEGAL_COMMAND (1 << 2)
LucasKB 2:e7d7e80256cc 10 #define R1_COM_CRC_ERROR (1 << 3)
LucasKB 2:e7d7e80256cc 11 #define R1_ERASE_SEQUENCE_ERROR (1 << 4)
LucasKB 2:e7d7e80256cc 12 #define R1_ADDRESS_ERROR (1 << 5)
LucasKB 2:e7d7e80256cc 13 #define R1_PARAMETER_ERROR (1 << 6)
LucasKB 2:e7d7e80256cc 14
LucasKB 2:e7d7e80256cc 15
LucasKB 2:e7d7e80256cc 16
LucasKB 2:e7d7e80256cc 17
LucasKB 2:e7d7e80256cc 18 SDCard::SDCard(SPI *t_spi, PinName t_cs) : cs(t_cs)
LucasKB 2:e7d7e80256cc 19 {
LucasKB 2:e7d7e80256cc 20 spi = t_spi;
LucasKB 2:e7d7e80256cc 21 cs = 1;
LucasKB 2:e7d7e80256cc 22 }
LucasKB 2:e7d7e80256cc 23
LucasKB 2:e7d7e80256cc 24 SDCard::~SDCard()
LucasKB 2:e7d7e80256cc 25 {
LucasKB 2:e7d7e80256cc 26 delete spi;
LucasKB 2:e7d7e80256cc 27 }
LucasKB 2:e7d7e80256cc 28
LucasKB 2:e7d7e80256cc 29 int SDCard::init(void)
LucasKB 2:e7d7e80256cc 30 {
LucasKB 2:e7d7e80256cc 31 spi->frequency(100000);
LucasKB 2:e7d7e80256cc 32 cs = 1;
LucasKB 2:e7d7e80256cc 33
LucasKB 2:e7d7e80256cc 34 for( int i=0 ; i<16 ; i++)
LucasKB 2:e7d7e80256cc 35 spi->write(0xFF);
LucasKB 2:e7d7e80256cc 36
LucasKB 2:e7d7e80256cc 37 if(cmd(0,0) != R1_IDLE_STATE)
LucasKB 2:e7d7e80256cc 38 return -1;
LucasKB 2:e7d7e80256cc 39
LucasKB 2:e7d7e80256cc 40 int r = cmd8();
LucasKB 2:e7d7e80256cc 41
LucasKB 2:e7d7e80256cc 42 if(r == R1_IDLE_STATE){
LucasKB 2:e7d7e80256cc 43 return init_card_v2();
LucasKB 2:e7d7e80256cc 44 } else if(r == (R1_IDLE_STATE | R1_ILLEGAL_COMMAND)) {
LucasKB 2:e7d7e80256cc 45 return init_card_v1();
LucasKB 2:e7d7e80256cc 46 } else {
LucasKB 2:e7d7e80256cc 47 return -1;
LucasKB 2:e7d7e80256cc 48 }
LucasKB 2:e7d7e80256cc 49
LucasKB 2:e7d7e80256cc 50 return 0;
LucasKB 2:e7d7e80256cc 51 }
LucasKB 2:e7d7e80256cc 52
LucasKB 2:e7d7e80256cc 53 int SDCard::init_card_v1()
LucasKB 2:e7d7e80256cc 54 {
LucasKB 2:e7d7e80256cc 55 for (int i = 0; i < SD_COMMAND_TIMEOUT; i++)
LucasKB 2:e7d7e80256cc 56 {
LucasKB 2:e7d7e80256cc 57 cmd(55, 0);
LucasKB 2:e7d7e80256cc 58 if(cmd(41, 0) == 0)
LucasKB 2:e7d7e80256cc 59 {
LucasKB 2:e7d7e80256cc 60 cdv = 512;
LucasKB 2:e7d7e80256cc 61 return 1;
LucasKB 2:e7d7e80256cc 62 }
LucasKB 2:e7d7e80256cc 63 }
LucasKB 2:e7d7e80256cc 64
LucasKB 2:e7d7e80256cc 65 return -1;
LucasKB 2:e7d7e80256cc 66 }
LucasKB 2:e7d7e80256cc 67
LucasKB 2:e7d7e80256cc 68
LucasKB 2:e7d7e80256cc 69 int SDCard::init_card_v2()
LucasKB 2:e7d7e80256cc 70 {
LucasKB 2:e7d7e80256cc 71 for (int i = 0; i < SD_COMMAND_TIMEOUT; i++)
LucasKB 2:e7d7e80256cc 72 {
LucasKB 2:e7d7e80256cc 73 wait_ms(50);
LucasKB 2:e7d7e80256cc 74 cmd58();
LucasKB 2:e7d7e80256cc 75 cmd(55, 0);
LucasKB 2:e7d7e80256cc 76 if (cmd(41, 0x40000000) == 0)
LucasKB 2:e7d7e80256cc 77 {
LucasKB 2:e7d7e80256cc 78 cmd58();
LucasKB 2:e7d7e80256cc 79 cdv = 1;
LucasKB 2:e7d7e80256cc 80 return 2;
LucasKB 2:e7d7e80256cc 81 }
LucasKB 2:e7d7e80256cc 82 }
LucasKB 2:e7d7e80256cc 83
LucasKB 2:e7d7e80256cc 84 return -1;
LucasKB 2:e7d7e80256cc 85 }
LucasKB 2:e7d7e80256cc 86
LucasKB 2:e7d7e80256cc 87
LucasKB 2:e7d7e80256cc 88 int SDCard::cmd(int cmd, int arg)
LucasKB 2:e7d7e80256cc 89 {
LucasKB 2:e7d7e80256cc 90 cs = 0;
LucasKB 2:e7d7e80256cc 91 spi->write(0x40 | cmd);
LucasKB 2:e7d7e80256cc 92 spi->write(arg >> 24);
LucasKB 2:e7d7e80256cc 93 spi->write(arg >> 16);
LucasKB 2:e7d7e80256cc 94 spi->write(arg >> 8);
LucasKB 2:e7d7e80256cc 95 spi->write(arg >> 0);
LucasKB 2:e7d7e80256cc 96 spi->write(0x95);
LucasKB 2:e7d7e80256cc 97
LucasKB 2:e7d7e80256cc 98 for( int i=0 ; i<SD_COMMAND_TIMEOUT ; i++)
LucasKB 2:e7d7e80256cc 99 {
LucasKB 2:e7d7e80256cc 100 int respuesta = spi->write(0xFF);
LucasKB 2:e7d7e80256cc 101 if( !(respuesta & 0x80) )
LucasKB 2:e7d7e80256cc 102 {
LucasKB 2:e7d7e80256cc 103 cs = 1;
LucasKB 2:e7d7e80256cc 104 spi->write(0xFF);
LucasKB 2:e7d7e80256cc 105 return respuesta;
LucasKB 2:e7d7e80256cc 106 }
LucasKB 2:e7d7e80256cc 107 }
LucasKB 2:e7d7e80256cc 108
LucasKB 2:e7d7e80256cc 109 cs = 1;
LucasKB 2:e7d7e80256cc 110 spi->write(0xFF);
LucasKB 2:e7d7e80256cc 111 return -1;
LucasKB 2:e7d7e80256cc 112
LucasKB 2:e7d7e80256cc 113 }
LucasKB 2:e7d7e80256cc 114
LucasKB 2:e7d7e80256cc 115
LucasKB 2:e7d7e80256cc 116 int SDCard::cmd8()
LucasKB 2:e7d7e80256cc 117 {
LucasKB 2:e7d7e80256cc 118 cs = 0;
LucasKB 2:e7d7e80256cc 119
LucasKB 2:e7d7e80256cc 120 spi->write(0x40 | 8); // CMD8
LucasKB 2:e7d7e80256cc 121 spi->write(0x00); // reserved
LucasKB 2:e7d7e80256cc 122 spi->write(0x00); // reserved
LucasKB 2:e7d7e80256cc 123 spi->write(0x01); // 3.3v
LucasKB 2:e7d7e80256cc 124 spi->write(0xAA); // check pattern
LucasKB 2:e7d7e80256cc 125 spi->write(0x87); // crc
LucasKB 2:e7d7e80256cc 126
LucasKB 2:e7d7e80256cc 127 for( int i=0 ; i<SD_COMMAND_TIMEOUT * 1000 ; i++)
LucasKB 2:e7d7e80256cc 128 {
LucasKB 2:e7d7e80256cc 129 char respuesta[5];
LucasKB 2:e7d7e80256cc 130 respuesta[0] = spi->write(0xFF);
LucasKB 2:e7d7e80256cc 131
LucasKB 2:e7d7e80256cc 132 if( !(respuesta[0] & 0x80))
LucasKB 2:e7d7e80256cc 133 {
LucasKB 2:e7d7e80256cc 134 for( int j=1; j<5 ; j++)
LucasKB 2:e7d7e80256cc 135 respuesta[i] = spi->write(0xFF);
LucasKB 2:e7d7e80256cc 136
LucasKB 2:e7d7e80256cc 137 cs = 1;
LucasKB 2:e7d7e80256cc 138 spi->write(0xFF);
LucasKB 2:e7d7e80256cc 139 return respuesta[0];
LucasKB 2:e7d7e80256cc 140 }
LucasKB 2:e7d7e80256cc 141 }
LucasKB 2:e7d7e80256cc 142
LucasKB 2:e7d7e80256cc 143 cs = 1;
LucasKB 2:e7d7e80256cc 144 spi->write(0xFF);
LucasKB 2:e7d7e80256cc 145 return -1;
LucasKB 2:e7d7e80256cc 146
LucasKB 2:e7d7e80256cc 147 }
LucasKB 2:e7d7e80256cc 148
LucasKB 2:e7d7e80256cc 149
LucasKB 2:e7d7e80256cc 150
LucasKB 2:e7d7e80256cc 151 int SDCard::cmd58()
LucasKB 2:e7d7e80256cc 152 {
LucasKB 2:e7d7e80256cc 153 cs = 0;
LucasKB 2:e7d7e80256cc 154
LucasKB 2:e7d7e80256cc 155 int arg = 0;
LucasKB 2:e7d7e80256cc 156
LucasKB 2:e7d7e80256cc 157 spi->write(0x40 | 58);
LucasKB 2:e7d7e80256cc 158 spi->write(arg >> 24);
LucasKB 2:e7d7e80256cc 159 spi->write(arg >> 16);
LucasKB 2:e7d7e80256cc 160 spi->write(arg >> 8);
LucasKB 2:e7d7e80256cc 161 spi->write(arg >> 0);
LucasKB 2:e7d7e80256cc 162 spi->write(0x95);
LucasKB 2:e7d7e80256cc 163
LucasKB 2:e7d7e80256cc 164 // wait for the repsonse (response[7] == 0)
LucasKB 2:e7d7e80256cc 165 for(int i = 0; i < SD_COMMAND_TIMEOUT; i++)
LucasKB 2:e7d7e80256cc 166 {
LucasKB 2:e7d7e80256cc 167 int respuesta = spi->write(0xFF);
LucasKB 2:e7d7e80256cc 168
LucasKB 2:e7d7e80256cc 169 if( !(respuesta & 0x80) )
LucasKB 2:e7d7e80256cc 170 {
LucasKB 2:e7d7e80256cc 171 int ocr = spi->write(0xFF) << 24;
LucasKB 2:e7d7e80256cc 172 ocr |= spi->write(0xFF) << 16;
LucasKB 2:e7d7e80256cc 173 ocr |= spi->write(0xFF) << 8;
LucasKB 2:e7d7e80256cc 174 ocr |= spi->write(0xFF) << 0;
LucasKB 2:e7d7e80256cc 175 cs = 1;
LucasKB 2:e7d7e80256cc 176 spi->write(0xFF);
LucasKB 2:e7d7e80256cc 177 return respuesta;
LucasKB 2:e7d7e80256cc 178 }
LucasKB 2:e7d7e80256cc 179 }
LucasKB 2:e7d7e80256cc 180 cs = 1;
LucasKB 2:e7d7e80256cc 181 spi->write(0xFF);
LucasKB 2:e7d7e80256cc 182
LucasKB 2:e7d7e80256cc 183 return -1; // timeout
LucasKB 2:e7d7e80256cc 184 }
LucasKB 2:e7d7e80256cc 185
LucasKB 2:e7d7e80256cc 186
LucasKB 2:e7d7e80256cc 187
LucasKB 2:e7d7e80256cc 188 bool SDCard::read(uint8_t *vect, int post)
LucasKB 2:e7d7e80256cc 189 {
LucasKB 2:e7d7e80256cc 190 while( cmd(17,post*512) == -1);
LucasKB 2:e7d7e80256cc 191
LucasKB 2:e7d7e80256cc 192 cs = 0;
LucasKB 2:e7d7e80256cc 193
LucasKB 2:e7d7e80256cc 194 while (spi->write(0xFF) != 0xFE);
LucasKB 2:e7d7e80256cc 195
LucasKB 2:e7d7e80256cc 196 for (uint32_t i = 0; i < 512; i++)
LucasKB 2:e7d7e80256cc 197 *(vect+i) = spi->write(0xFF);
LucasKB 2:e7d7e80256cc 198
LucasKB 2:e7d7e80256cc 199 spi->write(0xFF); // checksum
LucasKB 2:e7d7e80256cc 200 spi->write(0xFF);
LucasKB 2:e7d7e80256cc 201
LucasKB 2:e7d7e80256cc 202 cs = 1;
LucasKB 2:e7d7e80256cc 203 spi->write(0xFF);
LucasKB 2:e7d7e80256cc 204
LucasKB 2:e7d7e80256cc 205 while(cmd(12,512) == -1);
LucasKB 2:e7d7e80256cc 206
LucasKB 2:e7d7e80256cc 207 return 1;
LucasKB 2:e7d7e80256cc 208 }
LucasKB 2:e7d7e80256cc 209
LucasKB 2:e7d7e80256cc 210
LucasKB 2:e7d7e80256cc 211
LucasKB 2:e7d7e80256cc 212 bool SDCard::write(uint8_t *vect, int post)
LucasKB 2:e7d7e80256cc 213 {
LucasKB 2:e7d7e80256cc 214
LucasKB 2:e7d7e80256cc 215 while( cmd(24,post*512) == -1 );
LucasKB 2:e7d7e80256cc 216
LucasKB 2:e7d7e80256cc 217 cs = 0;
LucasKB 2:e7d7e80256cc 218
LucasKB 2:e7d7e80256cc 219 spi->write(0xFE);
LucasKB 2:e7d7e80256cc 220
LucasKB 2:e7d7e80256cc 221 for (uint32_t i = 0; i < 512; i++)
LucasKB 2:e7d7e80256cc 222 spi->write(*(vect+i));
LucasKB 2:e7d7e80256cc 223
LucasKB 2:e7d7e80256cc 224 spi->write(0xFF);
LucasKB 2:e7d7e80256cc 225 spi->write(0xFF);
LucasKB 2:e7d7e80256cc 226
LucasKB 2:e7d7e80256cc 227 if( (spi->write(0xFF) & 0x1F) != 0x05 )
LucasKB 2:e7d7e80256cc 228 {
LucasKB 2:e7d7e80256cc 229 cs = 1;
LucasKB 2:e7d7e80256cc 230 spi->write(0xFF);
LucasKB 2:e7d7e80256cc 231 return 0;
LucasKB 2:e7d7e80256cc 232 }
LucasKB 2:e7d7e80256cc 233
LucasKB 2:e7d7e80256cc 234 while(spi->write(0xFF) == 0);
LucasKB 2:e7d7e80256cc 235
LucasKB 2:e7d7e80256cc 236 cs = 1;
LucasKB 2:e7d7e80256cc 237 spi->write(0xFF);
LucasKB 2:e7d7e80256cc 238
LucasKB 2:e7d7e80256cc 239 while(cmd(12,512) == -1);
LucasKB 2:e7d7e80256cc 240
LucasKB 2:e7d7e80256cc 241 return 1;
LucasKB 2:e7d7e80256cc 242
LucasKB 2:e7d7e80256cc 243 }