Mercurial > public > ostc4
annotate Discovery/Src/externLogbookFlash.c @ 239:e4207f0aaa4b div-fixes-5
cleanup: factor out dataSendToSlaveStopEval
The global dataSendToSlaveStopEval was set all over the place, but never
tested, so useless to set it. And remove an unused piece of code. Trivial
cleanup.
Signed-off-by: Jan Mulder <jlmulder@xs4all.nl>
| author | Jan Mulder <jlmulder@xs4all.nl> |
|---|---|
| date | Mon, 08 Apr 2019 10:35:29 +0200 |
| parents | 2bb1db22b5f5 |
| children | 1b9847d40e81 |
| rev | line source |
|---|---|
| 38 | 1 /** |
| 2 ****************************************************************************** | |
| 3 * @copyright heinrichs weikamp | |
| 4 * @file externLogbookFlash.c | |
| 5 * @author heinrichs weikamp gmbh | |
| 6 * @date 07-Aug-2014 | |
| 7 * @version V0.0.4 | |
| 8 * @since 29-Sept-2015 | |
| 9 * @brief Main File to access the new 1.8 Volt Spansion S25FS256S 256 Mbit (32 Mbyte) | |
| 10 * @bug | |
| 11 * @warning | |
| 12 * | |
| 13 @verbatim | |
| 14 ============================================================================== | |
| 15 ##### Logbook Header (TOC) ##### | |
| 16 ============================================================================== | |
| 17 [..] Memory useage: | |
| 18 NEW: Spansion S25FS-S256S | |
| 19 | |
| 20 only 8x 4KB and 1x 32KB, remaining is 64KB or 256KB | |
| 21 Sector Size (kbyte) Sector Count Sector Range Address Range (Byte Address) Notes | |
| 22 4 8 SA00 00000000h-00000FFFh | |
| 23 : : | |
| 24 SA07 00007000h-00007FFFh | |
| 25 | |
| 26 32 1 SA08 00008000h-0000FFFFh | |
| 27 | |
| 28 64 511 SA09 00010000h-0001FFFFh | |
| 29 : : | |
| 30 SA519 01FF0000h-01FFFFFFh | |
| 31 OLD: | |
| 32 1kB each header | |
| 33 with predive header at beginning | |
| 34 and postdive header with 0x400 HEADER2OFFSET | |
| 35 4kB (one erase) has two dives with 4 headers total | |
| 36 total of 512 kB (with 256 header ids (8 bit)) | |
| 37 Size is 280 Byte (as of 25.Nov. 2014) | |
| 38 | |
| 39 [..] Output to PC / UART is postdive header | |
| 40 | |
| 41 [..] Block Protection Lock-Down is to erase logbook only | |
| 42 | |
| 43 [..] Timing (see page 137 of LOGBOOK_V3_S25FS-S_00-271247.pdf | |
| 44 bulk erase is 2 minutes typ., 6 minutes max. | |
| 45 | |
| 46 ============================================================================== | |
| 47 ##### DEMOMODE ##### | |
| 48 ============================================================================== | |
| 49 151215: ext_flash_write_settings() is DISABLED! | |
| 50 | |
| 51 ============================================================================== | |
| 52 ##### bug fixes ##### | |
| 53 ============================================================================== | |
| 54 150917: end in header and length of sample was one byte too long | |
| 55 as stated by Jef Driesen email 15.09.2015 | |
| 56 | |
| 57 @endverbatim | |
| 58 ****************************************************************************** | |
| 59 * @attention | |
| 60 * | |
| 61 * <h2><center>© COPYRIGHT(c) 2015 heinrichs weikamp</center></h2> | |
| 62 * | |
| 63 ****************************************************************************** | |
| 64 */ | |
| 65 | |
| 66 /* Includes ------------------------------------------------------------------*/ | |
| 67 #include "stm32f4xx_hal.h" | |
| 68 #include "externLogbookFlash.h" | |
| 69 #include "ostc.h" | |
| 70 #include "settings.h" | |
| 71 #include "gfx_engine.h" | |
| 72 | |
| 73 #ifndef BOOTLOADER_STANDALONE | |
| 74 #include "logbook.h" | |
| 75 #endif | |
| 76 | |
| 77 /* Private types -------------------------------------------------------------*/ | |
| 78 #define FLASHSTART 0x000000 | |
| 79 //#define FLASHSTOP 0x01FFFFFF all 32 MB with 4byte addressing | |
| 80 #define FLASHSTOP 0x00FFFFFF | |
| 81 //#define FLASHSTOP 0x3FFFFF | |
| 82 #define RELEASE 1 | |
| 83 #define HOLDCS 0 | |
| 84 | |
| 85 #define HEADER2OFFSET 0x400 | |
| 86 | |
| 87 typedef enum{ | |
| 88 EF_HEADER, | |
| 89 EF_SAMPLE, | |
| 90 EF_DEVICEDATA, | |
| 91 EF_VPMDATA, | |
| 92 EF_SETTINGS, | |
| 93 EF_FIRMWARE, | |
| 94 EF_FIRMWARE2, | |
| 95 }which_ring_enum; | |
| 96 | |
| 97 | |
| 98 typedef struct{ | |
| 99 uint8_t IsBusy:1; | |
| 100 uint8_t IsWriteEnabled:1; | |
| 101 uint8_t BlockProtect0:1; | |
| 102 uint8_t BlockProtect1:1; | |
| 103 uint8_t BlockProtect2:1; | |
| 104 uint8_t BlockProtect3:1; | |
| 105 uint8_t IsAutoAddressIncMode:1; | |
| 106 uint8_t BlockProtectL:1; | |
| 107 } extFlashStatusUbit8_t; | |
| 108 | |
| 109 typedef union{ | |
| 110 extFlashStatusUbit8_t ub; | |
| 111 uint8_t uw; | |
| 112 } extFlashStatusBit8_Type; | |
| 113 | |
| 114 | |
| 115 /* Exported variables --------------------------------------------------------*/ | |
| 116 | |
| 117 /* Private variables ---------------------------------------------------------*/ | |
| 118 uint32_t actualAddress = 0; | |
| 119 uint32_t entryPoint = 0; | |
| 120 | |
| 121 uint32_t actualPointerHeader = 0; | |
| 122 uint32_t actualPointerSample = 0; | |
| 123 uint32_t LengthLeftSampleRead = 0; | |
| 124 uint32_t actualPointerDevicedata = 0; | |
| 125 uint32_t actualPointerVPM = 0; | |
| 126 uint32_t actualPointerSettings = 0; | |
| 127 uint32_t actualPointerFirmware = 0; | |
| 128 uint32_t actualPointerFirmware2 = 0; | |
| 129 | |
| 130 /* Private function prototypes -----------------------------------------------*/ | |
| 131 void chip_unselect(void); | |
| 132 void chip_select(void); | |
| 133 void error_led_on(void); | |
| 134 void error_led_off(void); | |
| 135 | |
| 136 void write_spi(uint8_t data, uint8_t unselect_CS_afterwards); | |
| 137 uint8_t read_spi(uint8_t unselect_CS_afterwards); | |
| 138 void write_address(uint8_t unselect_CS_afterwards); | |
| 139 static void Error_Handler_extflash(void); | |
| 140 static void wait_chip_not_busy(void); | |
| 141 void ext_flash_incf_address(uint8_t type); | |
| 142 //void ext_flash_incf_address_ring(void); | |
| 143 void ext_flash_decf_address_ring(uint8_t type); | |
| 144 | |
| 145 void ext_flash_erase4kB(void); | |
| 146 void ext_flash_erase32kB(void); | |
| 147 void ext_flash_erase64kB(void); | |
| 148 uint8_t ext_flash_erase_if_on_page_start(void); | |
| 149 | |
| 150 void ef_write_block(uint8_t * sendByte, uint32_t length, uint8_t type, uint8_t do_not_erase); | |
| 151 | |
| 152 void ext_flash_read_block(uint8_t *getByte, uint8_t type); | |
| 153 void ext_flash_read_block_multi(void *getByte, uint32_t size, uint8_t type); | |
| 154 void ext_flash_read_block_stop(void); | |
| 155 | |
| 156 static void ef_hw_rough_delay_us(uint32_t delayUs); | |
| 157 static void ef_erase_64K(uint32_t blocks); | |
| 158 | |
| 159 void ext_flash_overwrite_sample_without_erase(uint8_t *pSample, uint16_t length); | |
| 160 | |
| 161 void ext_flash_disable_protection(void); | |
| 162 | |
| 163 _Bool ext_flash_test_remaining_space_of_page_empty(uint32_t pointer, uint16_t length); | |
| 164 void ext_flash_set_to_begin_of_next_page(uint32_t *pointer, uint8_t type); | |
| 165 | |
| 166 | |
| 167 /* Exported functions --------------------------------------------------------*/ | |
| 168 | |
| 169 void ext_flash_write_firmware(uint8_t *pSample1, uint32_t length1)//, uint8_t *pSample2, uint32_t length2) | |
| 170 { | |
| 171 general32to8_Type lengthTransform; | |
| 172 | |
| 173 lengthTransform.u32 = length1; | |
| 174 | |
| 175 actualPointerFirmware = FWSTART; | |
| 176 ef_write_block(lengthTransform.u8,4, EF_FIRMWARE, 1); | |
| 177 ef_write_block(pSample1,length1, EF_FIRMWARE, 1); | |
| 178 | |
| 179 // if(length2) | |
| 180 // ef_write_block(pSample2,length2, EF_FIRMWARE, 1); | |
| 181 } | |
| 182 | |
| 183 uint8_t ext_flash_read_firmware_version(char *text) | |
| 184 { | |
| 185 uint32_t backup = actualAddress; | |
| 186 uint8_t buffer[4]; | |
| 187 | |
| 188 // + 4 for length data, see ext_flash_write_firmware | |
| 189 actualAddress = FWSTART + 4 + 0x10000; | |
| 190 ext_flash_read_block_start(); | |
| 191 ext_flash_read_block(&buffer[0], EF_FIRMWARE); | |
| 192 ext_flash_read_block(&buffer[1], EF_FIRMWARE); | |
| 193 ext_flash_read_block(&buffer[2], EF_FIRMWARE); | |
| 194 ext_flash_read_block(&buffer[3], EF_FIRMWARE); | |
| 195 | |
| 196 ext_flash_read_block_stop(); | |
| 197 actualAddress = backup; | |
| 198 | |
| 199 uint8_t ptr = 0; | |
| 200 text[ptr++] = 'V'; | |
| 201 ptr += gfx_number_to_string(2,0,&text[ptr],buffer[0] & 0x3F); | |
| 202 text[ptr++] = '.'; | |
| 203 ptr += gfx_number_to_string(2,0,&text[ptr],buffer[1] & 0x3F); | |
| 204 text[ptr++] = '.'; | |
| 205 ptr += gfx_number_to_string(2,0,&text[ptr],buffer[2] & 0x3F); | |
| 206 text[ptr++] = ' '; | |
| 207 if(buffer[3]) | |
| 208 { | |
| 209 text[ptr++] = 'b'; | |
| 210 text[ptr++] = 'e'; | |
| 211 text[ptr++] = 't'; | |
| 212 text[ptr++] = 'a'; | |
| 213 text[ptr++] = ' '; | |
| 214 } | |
| 215 return ptr; | |
| 216 } | |
| 217 | |
| 218 | |
| 219 uint32_t ext_flash_read_firmware(uint8_t *pSample1, uint32_t max_length, uint8_t *magicByte) | |
| 220 { | |
| 221 uint32_t backup = actualAddress; | |
| 222 general32to8_Type lengthTransform; | |
| 223 | |
| 224 actualAddress = FWSTART; | |
| 225 ext_flash_read_block_start(); | |
| 226 | |
| 227 ext_flash_read_block(&lengthTransform.u8[0], EF_FIRMWARE); | |
| 228 ext_flash_read_block(&lengthTransform.u8[1], EF_FIRMWARE); | |
| 229 ext_flash_read_block(&lengthTransform.u8[2], EF_FIRMWARE); | |
| 230 ext_flash_read_block(&lengthTransform.u8[3], EF_FIRMWARE); | |
| 231 | |
| 232 | |
| 233 if(lengthTransform.u32 == 0xFFFFFFFF) | |
| 234 { | |
| 235 lengthTransform.u32 = 0xFFFFFFFF; | |
| 236 } | |
| 237 else | |
| 238 if(lengthTransform.u32 > max_length) | |
| 239 { | |
| 240 lengthTransform.u32 = 0xFF000000; | |
| 241 } | |
| 242 else | |
| 243 { | |
| 244 for(uint32_t i = 0; i<lengthTransform.u32; i++) | |
| 245 { | |
| 246 ext_flash_read_block(&pSample1[i], EF_FIRMWARE); | |
| 247 } | |
| 248 | |
| 249 } | |
| 250 | |
| 251 ext_flash_read_block_stop(); | |
| 252 | |
| 253 if(magicByte) | |
| 254 { | |
| 255 *magicByte = pSample1[0x10000 + 0x3E]; // 0x3E == 62 | |
| 256 } | |
| 257 | |
| 258 actualAddress = backup; | |
| 259 return lengthTransform.u32; | |
| 260 } | |
| 261 | |
| 262 | |
| 263 void ext_flash_write_firmware2(uint32_t offset, uint8_t *pSample1, uint32_t length1, uint8_t *pSample2, uint32_t length2) | |
| 264 { | |
| 265 general32to8_Type lengthTransform, offsetTransform; | |
| 266 | |
| 267 lengthTransform.u32 = length1 + length2; | |
| 268 offsetTransform.u32 = offset; | |
| 269 | |
| 270 actualPointerFirmware2 = FWSTART2; | |
| 271 ef_write_block(lengthTransform.u8,4, EF_FIRMWARE2, 1); | |
| 272 ef_write_block(offsetTransform.u8,4, EF_FIRMWARE2, 1); | |
| 273 ef_write_block(pSample1,length1, EF_FIRMWARE2, 1); | |
| 274 if(length2) | |
| 275 ef_write_block(pSample2,length2, EF_FIRMWARE2, 1); | |
| 276 } | |
| 277 | |
| 278 | |
| 279 uint32_t ext_flash_read_firmware2(uint32_t *offset, uint8_t *pSample1, uint32_t max_length1, uint8_t *pSample2, uint32_t max_length2) | |
| 280 { | |
| 281 uint32_t backup = actualAddress; | |
| 282 uint32_t length1, length2; | |
| 283 general32to8_Type lengthTransform, offsetTransform; | |
| 284 | |
| 285 actualAddress = FWSTART2; | |
| 286 ext_flash_read_block_start(); | |
| 287 | |
| 288 ext_flash_read_block(&lengthTransform.u8[0], EF_FIRMWARE2); | |
| 289 ext_flash_read_block(&lengthTransform.u8[1], EF_FIRMWARE2); | |
| 290 ext_flash_read_block(&lengthTransform.u8[2], EF_FIRMWARE2); | |
| 291 ext_flash_read_block(&lengthTransform.u8[3], EF_FIRMWARE2); | |
| 292 | |
| 293 ext_flash_read_block(&offsetTransform.u8[0], EF_FIRMWARE2); | |
| 294 ext_flash_read_block(&offsetTransform.u8[1], EF_FIRMWARE2); | |
| 295 ext_flash_read_block(&offsetTransform.u8[2], EF_FIRMWARE2); | |
| 296 ext_flash_read_block(&offsetTransform.u8[3], EF_FIRMWARE2); | |
| 297 | |
| 298 *offset = offsetTransform.u32; | |
| 299 | |
| 300 if(lengthTransform.u32 == 0xFFFFFFFF) | |
| 301 { | |
| 302 lengthTransform.u32 = 0xFFFFFFFF; | |
| 303 } | |
| 304 else | |
| 305 if(lengthTransform.u32 > max_length1 + max_length2) | |
| 306 { | |
| 307 lengthTransform.u32 = 0xFF000000; | |
| 308 } | |
| 309 else | |
| 310 { | |
| 311 if(lengthTransform.u32 < max_length1) | |
| 312 { | |
| 313 length1 = lengthTransform.u32; | |
| 314 length2 = 0; | |
| 315 } | |
| 316 else | |
| 317 { | |
| 318 length1 = max_length1; | |
| 319 length2 = lengthTransform.u32 - max_length1; | |
| 320 } | |
| 321 | |
| 322 if(pSample1) | |
| 323 { | |
| 324 for(uint32_t i = 0; i<length1; i++) | |
| 325 { | |
| 326 ext_flash_read_block(&pSample1[i], EF_FIRMWARE2); | |
| 327 } | |
| 328 if(pSample2) | |
| 329 { | |
| 330 for(uint32_t i = 0; i<length2; i++) | |
| 331 { | |
| 332 ext_flash_read_block(&pSample2[i], EF_FIRMWARE2); | |
| 333 } | |
| 334 } | |
| 335 } | |
| 336 else if(pSample2) | |
| 337 { | |
| 338 actualAddress += length1; | |
| 339 for(uint32_t i = 0; i<length2; i++) | |
| 340 { | |
| 341 ext_flash_read_block(&pSample2[i], EF_FIRMWARE2); | |
| 342 } | |
| 343 } | |
| 344 } | |
| 345 ext_flash_read_block_stop(); | |
| 346 actualAddress = backup; | |
| 347 return lengthTransform.u32; | |
| 348 } | |
| 349 | |
| 350 | |
| 351 void ext_flash_read_fixed_16_devicedata_blocks_formated_128byte_total(uint8_t *buffer) | |
| 352 { | |
| 353 SDeviceLine data[16]; | |
| 354 uint8_t tempLengthIngnore; | |
| 355 uint16_t count; | |
| 356 uint8_t transfer; | |
| 357 | |
| 358 RTC_DateTypeDef Sdate; | |
| 359 RTC_TimeTypeDef Stime; | |
| 360 | |
| 361 actualAddress = DDSTART; | |
| 362 | |
| 363 ext_flash_read_block_start(); | |
| 364 ext_flash_read_block(&tempLengthIngnore, EF_DEVICEDATA); | |
| 365 ext_flash_read_block(&tempLengthIngnore, EF_DEVICEDATA); | |
| 366 | |
| 367 ext_flash_read_block_multi((uint8_t *)data,16*3*4, EF_DEVICEDATA); | |
| 368 ext_flash_read_block_stop(); | |
| 369 | |
| 370 count = 0; | |
| 371 for(int i=0;i<16;i++) | |
| 372 { | |
| 373 transfer = (data[i].value_int32 >> 24) & 0xFF; | |
| 374 buffer[count++] = transfer; | |
| 375 transfer = (data[i].value_int32 >> 16) & 0xFF; | |
| 376 buffer[count++] = transfer; | |
| 377 transfer = (data[i].value_int32 >> 8) & 0xFF; | |
| 378 buffer[count++] = transfer; | |
| 379 transfer = (data[i].value_int32) & 0xFF; | |
| 380 buffer[count++] = transfer; | |
| 381 | |
| 382 translateDate(data[i].date_rtc_dr, &Sdate); | |
| 383 translateTime(data[i].time_rtc_tr, &Stime); | |
| 384 buffer[count++] = Sdate.Year; | |
| 385 buffer[count++] = Sdate.Month; | |
| 386 buffer[count++] = Sdate.Date; | |
| 387 buffer[count++] = Stime.Hours; | |
| 388 } | |
| 389 } | |
| 390 | |
| 391 | |
| 392 #ifndef BOOTLOADER_STANDALONE | |
| 393 | |
| 394 void ext_flash_write_devicedata(void) | |
| 395 { | |
| 396 uint8_t *pData; | |
| 397 const uint16_t length = sizeof(SDevice); | |
| 398 uint8_t length_lo, length_hi; | |
| 399 uint8_t dataLength[2] = { 0 }; | |
| 400 | |
| 401 ext_flash_disable_protection(); | |
| 402 | |
| 403 pData = (uint8_t *)stateDeviceGetPointer(); | |
| 404 | |
| 405 actualPointerDevicedata = DDSTART; | |
| 406 | |
| 407 length_lo = (uint8_t)(length & 0xFF); | |
| 408 length_hi = (uint8_t)(length >> 8); | |
| 409 dataLength[0] = length_lo; | |
| 410 dataLength[1] = length_hi; | |
| 411 | |
| 412 ef_write_block(dataLength,2, EF_DEVICEDATA, 0); | |
| 413 ef_write_block(pData,length, EF_DEVICEDATA, 0); | |
| 414 } | |
| 415 | |
| 416 | |
| 417 uint16_t ext_flash_read_devicedata(uint8_t *buffer, uint16_t max_length) | |
| 418 { | |
| 419 uint16_t length; | |
| 420 uint8_t length_lo, length_hi; | |
| 421 | |
| 422 actualAddress = DDSTART; | |
| 423 | |
| 424 ext_flash_read_block_start(); | |
| 425 ext_flash_read_block(&length_lo, EF_DEVICEDATA); | |
| 426 ext_flash_read_block(&length_hi, EF_DEVICEDATA); | |
| 427 | |
| 428 length = (length_hi * 256) + length_lo; | |
| 429 | |
| 430 if(length > max_length) | |
| 431 return 0; | |
| 432 | |
| 433 ext_flash_read_block_multi(buffer,length,EF_DEVICEDATA); | |
| 434 ext_flash_read_block_stop(); | |
| 435 | |
| 436 return length; | |
| 437 } | |
| 438 | |
| 439 | |
| 440 void ext_flash_write_vpm(SVpm *vpmInput) | |
| 441 { | |
| 442 uint8_t *pData; | |
| 443 const uint16_t length = sizeof(SVpm); | |
| 444 | |
| 445 uint8_t length_lo, length_hi; | |
| 446 uint8_t dataLength[2] = { 0 }; | |
| 447 | |
| 448 pData = (uint8_t *)vpmInput; | |
| 449 | |
| 450 actualPointerVPM = VPMSTART; | |
| 451 | |
| 452 length_lo = (uint8_t)(length & 0xFF); | |
| 453 length_hi = (uint8_t)(length >> 8); | |
| 454 dataLength[0] = length_lo; | |
| 455 dataLength[1] = length_hi; | |
| 456 | |
| 457 ef_write_block(dataLength,2, EF_VPMDATA, 0); | |
| 458 ef_write_block(pData,length, EF_VPMDATA, 0); | |
| 459 } | |
| 460 | |
| 461 | |
| 462 int ext_flash_read_vpm(SVpm *vpmOutput) | |
| 463 { | |
| 464 uint8_t *pData; | |
| 465 const uint16_t length = sizeof(SVpm); | |
| 466 uint8_t length_lo, length_hi; | |
| 467 int output; | |
| 468 | |
| 469 actualAddress = VPMSTART; | |
| 470 | |
| 471 ext_flash_read_block_start(); | |
| 472 ext_flash_read_block(&length_lo, EF_VPMDATA); | |
| 473 ext_flash_read_block(&length_hi, EF_VPMDATA); | |
| 474 if((length_lo == (uint8_t)(length & 0xFF)) | |
| 475 &&(length_hi == (uint8_t)(length >> 8))) | |
| 476 { | |
| 477 pData = (uint8_t *)vpmOutput; | |
| 478 for(uint16_t i = 0; i < length; i++) | |
| 479 ext_flash_read_block(&pData[i], EF_VPMDATA); | |
| 480 output = length; | |
| 481 } | |
| 482 else | |
| 483 output = 0; | |
| 484 | |
| 485 ext_flash_read_block_stop(); | |
| 486 return output; | |
| 487 } | |
| 488 | |
| 489 #ifdef DEMOMODE | |
| 490 void ext_flash_write_settings(void) | |
| 491 { | |
| 492 return; | |
| 493 } | |
| 494 #else | |
| 495 void ext_flash_write_settings(void) | |
| 496 { | |
| 497 uint8_t *pData; | |
| 498 const uint16_t length = sizeof(SSettings); | |
| 499 uint8_t length_lo, length_hi; | |
| 500 uint8_t dataLength[2] = { 0 }; | |
| 501 | |
| 502 ext_flash_disable_protection(); | |
| 503 | |
| 504 if(stateRealGetPointer()->lastKnownBatteryPercentage) | |
| 505 { | |
| 506 settingsGetPointer()->lastKnownBatteryPercentage = stateRealGetPointer()->lastKnownBatteryPercentage; | |
| 507 } | |
| 508 settingsGetPointer()->backup_localtime_rtc_tr = stateRealGetPointer()->lifeData.timeBinaryFormat; | |
| 509 settingsGetPointer()->backup_localtime_rtc_dr = stateRealGetPointer()->lifeData.dateBinaryFormat; | |
| 510 | |
| 511 pData = (uint8_t *)settingsGetPointer(); | |
| 512 | |
| 513 actualPointerSettings = SETTINGSSTART; | |
| 514 | |
| 515 length_lo = (uint8_t)(length & 0xFF); | |
| 516 length_hi = (uint8_t)(length >> 8); | |
| 517 dataLength[0] = length_lo; | |
| 518 dataLength[1] = length_hi; | |
| 519 | |
| 520 ef_write_block(dataLength,2, EF_SETTINGS, 0); | |
| 521 ef_write_block(pData,length, EF_SETTINGS, 0); | |
| 522 // ext_flash_enable_protection(); | |
| 523 } | |
| 524 #endif | |
| 525 | |
| 526 | |
| 527 /* CHANGES 150929 hw | |
| 528 * this now allows to read old settings too | |
| 529 * but make sure that everything is fixed in | |
| 530 * set_new_settings_missing_in_ext_flash | |
| 531 * new settings should be fine as they are added | |
| 532 * and loaded before calling this function | |
| 533 */ | |
| 534 uint8_t ext_flash_read_settings(void) | |
| 535 { | |
| 536 uint8_t returnValue = HAL_BUSY; | |
| 537 uint8_t *pData; | |
| 538 const uint16_t lengthStandardNow = sizeof(SSettings); | |
| 539 uint8_t length_lo, length_hi; | |
| 540 uint16_t lengthOnEEPROM; | |
| 541 uint32_t header; | |
| 542 SSettings *pSettings = settingsGetPointer(); | |
| 543 | |
| 544 actualAddress = SETTINGSSTART; | |
| 545 | |
| 546 ext_flash_read_block_start(); | |
| 547 ext_flash_read_block(&length_lo, EF_SETTINGS); | |
| 548 ext_flash_read_block(&length_hi, EF_SETTINGS); | |
| 549 | |
| 550 lengthOnEEPROM = length_hi * 256; | |
| 551 lengthOnEEPROM += length_lo; | |
| 552 if(lengthOnEEPROM <= lengthStandardNow) | |
| 553 { | |
| 554 ext_flash_read_block_multi(&header, 4, EF_SETTINGS); | |
| 555 if((header <= pSettings->header) && (header >= pSettings->updateSettingsAllowedFromHeader)) | |
| 556 { | |
| 557 returnValue = HAL_OK; | |
| 558 pSettings->header = header; | |
| 559 pData = (uint8_t *)pSettings + 4; /* header */ | |
| 560 for(uint16_t i = 0; i < (lengthOnEEPROM-4); i++) | |
| 561 ext_flash_read_block(&pData[i], EF_SETTINGS); | |
| 562 } | |
| 563 else | |
| 564 { | |
| 565 returnValue = HAL_ERROR; | |
| 566 } | |
| 567 } | |
| 568 ext_flash_read_block_stop(); | |
| 569 return returnValue; | |
| 570 } | |
| 571 | |
| 572 | |
| 573 | |
| 574 | |
| 575 /* ext_flash_start_new_dive_log_and_set_actualPointerSample | |
| 576 * prepares the write sample pointer | |
| 577 * to be used by ext_flash_write_sample() | |
| 578 * to be set in the * pHeaderPreDive | |
| 579 * for write with ext_flash_create_new_dive_log() and ext_flash_close_new_dive_log() | |
| 580 */ | |
| 581 void ext_flash_start_new_dive_log_and_set_actualPointerSample(uint8_t *pHeaderPreDive) | |
| 582 { | |
| 583 convert_Type data; | |
| 584 SSettings *settings = settingsGetPointer(); | |
| 585 | |
| 586 /* new 5. Jan. 2015 */ | |
| 587 actualPointerSample = settings->logFlashNextSampleStartAddress; | |
| 588 | |
| 589 if(!ext_flash_test_remaining_space_of_page_empty(actualPointerSample, 4)) | |
| 590 ext_flash_set_to_begin_of_next_page(&actualPointerSample, EF_SAMPLE); | |
| 591 | |
| 592 if((actualPointerSample < SAMPLESTART) || (actualPointerSample > SAMPLESTOP)) | |
| 593 actualPointerSample = SAMPLESTART; | |
| 594 | |
| 595 data.u32bit = actualPointerSample; | |
| 596 pHeaderPreDive[2] = data.u8bit.byteLow; | |
| 597 pHeaderPreDive[3] = data.u8bit.byteMidLow; | |
| 598 pHeaderPreDive[4] = data.u8bit.byteMidHigh; | |
| 599 /* to start sample writing and header etc. pp. */ | |
| 600 ext_flash_disable_protection_for_logbook(); | |
| 601 } | |
| 602 | |
| 603 | |
| 604 /* ext_flash_create_new_dive_log | |
| 605 * uses the first header without HEADER2OFFSET | |
| 606 * for the header it is not important to be complete | |
| 607 * and can be reconstructed | |
| 608 * ext_flash_start_new_dive_log_and_set_actualPointerSample() | |
| 609 * has to be called before to set the actualPointerSample | |
| 610 * in the header | |
| 611 * the following func writes to header to the ext_flash | |
| 612 */ | |
| 613 void ext_flash_create_new_dive_log(uint8_t *pHeaderPreDive) | |
| 614 { | |
| 615 SSettings *settings; | |
| 616 uint8_t id, id_next; | |
| 617 uint8_t header1, header2; | |
| 618 | |
| 619 settings = settingsGetPointer(); | |
| 620 id = settings->lastDiveLogId; | |
| 621 | |
| 622 actualAddress = HEADERSTART + (0x800 * id); | |
| 623 ext_flash_read_block_start(); | |
| 624 ext_flash_read_block(&header1, EF_SAMPLE); | |
| 625 ext_flash_read_block(&header2, EF_SAMPLE); | |
| 626 ext_flash_read_block_stop(); | |
| 627 | |
| 628 if((header1 == 0xFA) && (header2 == 0xFA)) | |
| 629 { | |
| 630 id += 1; /* 0-255, auto rollover */ | |
| 631 if(id & 1) | |
| 632 { | |
| 633 actualAddress = HEADERSTART + (0x800 * id); | |
| 634 ext_flash_read_block_start(); | |
| 635 ext_flash_read_block(&header1, EF_SAMPLE); | |
| 636 ext_flash_read_block(&header2, EF_SAMPLE); | |
| 637 ext_flash_read_block_stop(); | |
| 638 if((header1 == 0xFA) && (header2 == 0xFA)) | |
| 639 id += 1; | |
| 640 } | |
| 641 } | |
| 642 else | |
| 643 { | |
| 644 id = 0; | |
| 645 } | |
| 646 | |
| 647 /* delete next header */ | |
| 648 id_next = id + 1; | |
| 649 actualPointerHeader = HEADERSTART + (0x800 * id_next); | |
| 650 ef_write_block(0,0, EF_HEADER, 0); | |
| 651 | |
| 652 settings->lastDiveLogId = id; | |
| 653 actualPointerHeader = HEADERSTART + (0x800 * id); | |
| 654 | |
| 655 if(pHeaderPreDive != 0) | |
| 656 ef_write_block(pHeaderPreDive,HEADERSIZE, EF_HEADER, 0); | |
| 657 } | |
| 658 | |
| 659 | |
| 660 void ext_flash_close_new_dive_log(uint8_t *pHeaderPostDive ) | |
| 661 { | |
| 662 SSettings * settings = settingsGetPointer(); | |
| 663 uint8_t id; | |
| 664 convert_Type startAddress; | |
| 665 convert_Type data; | |
| 666 uint32_t backup; | |
| 667 | |
| 668 uint8_t sampleData[3]; | |
| 669 actualAddress = actualPointerSample; | |
| 670 sampleData[0] = 0xFD; | |
| 671 sampleData[1] = 0xFD; | |
| 672 ext_flash_write_sample(sampleData, 2); | |
| 673 | |
| 674 /* end of sample data, pointing to the last sample 0xFD | |
| 675 */ | |
| 676 actualAddress = actualPointerSample; // change hw 17.09.2015 | |
| 677 ext_flash_decf_address_ring(EF_SAMPLE); // 17.09.2015: this decf actualAddress only!! | |
| 678 actualPointerSample = actualAddress; // change hw 17.09.2015 | |
| 679 data.u32bit = actualPointerSample; | |
| 680 | |
| 681 pHeaderPostDive[5] = data.u8bit.byteLow; | |
| 682 pHeaderPostDive[6] = data.u8bit.byteMidLow; | |
| 683 pHeaderPostDive[7] = data.u8bit.byteMidHigh; | |
| 684 | |
| 685 /* take data written before, calculate length and write | |
| 686 SLogbookHeader has different order: length (byte# 8,9,10) prior to profile version (byte# 11) | |
| 687 */ | |
| 688 startAddress.u8bit.byteLow = pHeaderPostDive[2]; | |
| 689 startAddress.u8bit.byteMidLow = pHeaderPostDive[3]; | |
| 690 startAddress.u8bit.byteMidHigh = pHeaderPostDive[4]; | |
| 691 startAddress.u8bit.byteHigh = 0; | |
| 692 | |
| 693 if(startAddress.u32bit < actualPointerSample) | |
| 694 data.u32bit = 1 + actualPointerSample - startAddress.u32bit; | |
| 695 else | |
| 696 data.u32bit = 2 + (actualPointerSample - SAMPLESTART) + (SAMPLESTOP - startAddress.u32bit); | |
| 697 | |
| 698 pHeaderPostDive[8] = data.u8bit.byteLow; | |
| 699 pHeaderPostDive[9] = data.u8bit.byteMidLow; | |
| 700 pHeaderPostDive[10] = data.u8bit.byteMidHigh; | |
| 701 | |
| 702 /* set id and write post-dive-header | |
| 703 */ | |
| 704 id = settings->lastDiveLogId; | |
| 705 actualPointerHeader = HEADERSTART + (0x800 * id) + HEADER2OFFSET; | |
| 706 | |
| 707 ef_write_block(pHeaderPostDive,HEADERSIZE, EF_HEADER, 0); | |
| 708 | |
| 709 /* write length at beginning of sample | |
| 710 and write proper beginning for next dive to actualPointerSample | |
| 711 */ | |
| 712 backup = actualPointerSample; | |
| 713 actualPointerSample = startAddress.u32bit; // is still 0xFF | |
| 714 sampleData[0] = data.u8bit.byteLow; | |
| 715 sampleData[1] = data.u8bit.byteMidLow; | |
| 716 sampleData[2] = data.u8bit.byteMidHigh; | |
| 717 ext_flash_overwrite_sample_without_erase(sampleData, 3); | |
| 718 | |
| 719 actualAddress = backup; | |
| 720 ext_flash_incf_address(EF_SAMPLE); | |
| 721 actualPointerSample = actualAddress; | |
| 722 ext_flash_enable_protection(); | |
| 723 } | |
| 724 | |
| 725 | |
| 726 void ext_flash_write_sample(uint8_t *pSample, uint16_t length) | |
| 727 { | |
| 728 ef_write_block(pSample,length, EF_SAMPLE, 0); | |
| 729 | |
| 730 SSettings *settings = settingsGetPointer(); | |
| 731 settings->logFlashNextSampleStartAddress = actualPointerSample; | |
| 732 } | |
| 733 | |
| 734 void ext_flash_overwrite_sample_without_erase(uint8_t *pSample, uint16_t length) | |
| 735 { | |
| 736 ef_write_block(pSample,length, EF_SAMPLE, 1); | |
| 737 } | |
| 738 | |
| 739 | |
| 740 uint8_t ext_flash_count_dive_headers(void) | |
| 741 { | |
| 742 uint8_t id = 0; | |
| 743 uint8_t counter = 0; | |
| 744 uint16_t headerStartData = 0x0000; | |
| 745 | |
| 746 id = settingsGetPointer()->lastDiveLogId; | |
| 747 | |
| 748 do | |
| 749 { | |
| 750 actualAddress = HEADERSTART + (0x800 * id) + HEADER2OFFSET; | |
| 751 ext_flash_read_block_start(); | |
| 752 ext_flash_read_block_multi((uint8_t *)&headerStartData, 2, EF_HEADER); | |
| 753 ext_flash_read_block_stop(); | |
| 754 counter++; | |
| 755 id -=1; | |
| 756 } while((headerStartData == 0xFAFA) && (counter < 255)); | |
| 757 return (counter - 1); | |
| 758 } | |
| 759 | |
| 760 | |
| 761 void ext_flash_read_dive_header(uint8_t *pHeaderToFill, uint8_t StepBackwards) | |
| 762 { | |
| 763 SSettings *settings; | |
| 764 uint8_t id; | |
| 765 uint16_t i; | |
| 766 | |
| 767 settings = settingsGetPointer(); | |
| 768 id = settings->lastDiveLogId; | |
| 769 id -= StepBackwards; /* 0-255, auto rollover */ | |
| 770 | |
| 771 actualAddress = HEADERSTART + (0x800 * id) + HEADER2OFFSET; | |
| 772 ext_flash_read_block_start(); | |
| 773 for(i = 0; i < HEADERSIZE; i++) | |
| 774 ext_flash_read_block(&pHeaderToFill[i], EF_HEADER); | |
| 775 ext_flash_read_block_stop(); | |
| 776 | |
| 777 } | |
| 778 | |
| 779 void ext_flash_read_dive_header2(uint8_t *pHeaderToFill, uint8_t id, _Bool bOffset) | |
| 780 { | |
| 781 | |
| 782 uint16_t i; | |
| 783 actualAddress = HEADERSTART + (0x800 * id) ; | |
| 784 | |
| 785 if(bOffset) | |
| 786 actualAddress += HEADER2OFFSET; | |
| 787 ext_flash_read_block_start(); | |
| 788 for(i = 0; i < HEADERSIZE; i++) | |
| 789 ext_flash_read_block(&pHeaderToFill[i], EF_HEADER); | |
| 790 ext_flash_read_block_stop(); | |
| 791 } | |
| 792 | |
| 793 | |
| 794 uint32_t ext_flash_read_dive_raw_with_double_header_1K(uint8_t *data, uint32_t max_size, uint8_t StepBackwards) | |
| 795 { | |
| 796 if(max_size < 0x800) | |
| 797 return 0; | |
| 798 | |
| 799 uint8_t id; | |
| 800 convert_Type dataStart, dataEnd; | |
| 801 uint32_t LengthAll = 0; | |
| 802 | |
| 803 id = settingsGetPointer()->lastDiveLogId; | |
| 804 id -= StepBackwards; /* 0-255, auto rollover */ | |
| 805 | |
| 806 // clear data | |
| 807 for(int i=0;i<0x800;i++) | |
| 808 data[i] = 0xFF; | |
| 809 | |
| 810 // copy primary/pre-dive | |
| 811 actualAddress = HEADERSTART + (0x800 * id); | |
| 812 ext_flash_read_block_start(); | |
| 813 for(int i = 0; i < HEADERSIZE; i++) | |
| 814 ext_flash_read_block(&data[i], EF_HEADER); | |
| 815 ext_flash_read_block_stop(); | |
| 816 | |
| 817 // copy main/secondary/post-dive | |
| 818 actualAddress = HEADERSTART + (0x800 * id) + HEADER2OFFSET; | |
| 819 ext_flash_read_block_start(); | |
| 820 for(int i = 0x400; i < HEADERSIZE+0x400; i++) | |
| 821 ext_flash_read_block(&data[i], EF_HEADER); | |
| 822 ext_flash_read_block_stop(); | |
| 823 | |
| 824 // data | |
| 825 | |
| 826 dataStart.u8bit.byteHigh = 0; | |
| 827 dataStart.u8bit.byteLow = data[0x402]; | |
| 828 dataStart.u8bit.byteMidLow = data[0x403]; | |
| 829 dataStart.u8bit.byteMidHigh = data[0x404]; | |
| 830 | |
| 831 dataEnd.u8bit.byteHigh = 0; | |
| 832 dataEnd.u8bit.byteLow = data[0x405]; | |
| 833 dataEnd.u8bit.byteMidLow = data[0x406]; | |
| 834 dataEnd.u8bit.byteMidHigh = data[0x407]; | |
| 835 | |
| 836 actualPointerSample = dataStart.u32bit; | |
| 837 if(dataEnd.u32bit >= dataStart.u32bit) | |
| 838 LengthAll = 1 + dataEnd.u32bit - dataStart.u32bit; | |
| 839 else | |
| 840 LengthAll = 2 + (dataStart.u32bit - SAMPLESTART) + (SAMPLESTOP - dataEnd.u32bit); | |
| 841 | |
| 842 LengthAll += 0x800; | |
| 843 | |
| 844 if(LengthAll > max_size) | |
| 845 return 0x800; | |
| 846 | |
| 847 actualAddress = actualPointerSample; | |
| 848 ext_flash_read_block_start(); | |
| 849 for(uint32_t i = 0x800; i < LengthAll; i++) | |
| 850 ext_flash_read_block(&data[i], EF_SAMPLE); | |
| 851 ext_flash_read_block_stop(); | |
| 852 return LengthAll; | |
| 853 } | |
| 854 | |
| 855 void ext_flash_write_dive_raw_with_double_header_1K(uint8_t *data, uint32_t length) | |
| 856 { | |
| 857 convert_Type dataStart, dataEnd; | |
| 858 SLogbookHeader headerTemp; | |
| 859 | |
| 860 // set actualPointerSample and get pointer to sample storage and disable flash write protect | |
| 861 ext_flash_start_new_dive_log_and_set_actualPointerSample((uint8_t *)&headerTemp); | |
| 862 | |
| 863 dataStart.u8bit.byteHigh = 0; | |
| 864 dataStart.u8bit.byteLow = headerTemp.pBeginProfileData[0]; | |
| 865 dataStart.u8bit.byteMidLow = headerTemp.pBeginProfileData[1]; | |
| 866 dataStart.u8bit.byteMidHigh = headerTemp.pBeginProfileData[2]; | |
| 867 | |
| 868 dataEnd.u32bit = dataStart.u32bit + length - 0x801; | |
| 869 if(dataEnd.u32bit > SAMPLESTOP) | |
| 870 dataEnd.u32bit -= SAMPLESTOP + SAMPLESTART - 1; | |
| 871 | |
| 872 data[0x002] = data[0x402] = dataStart.u8bit.byteLow; | |
| 873 data[0x003] = data[0x403] = dataStart.u8bit.byteMidLow; | |
| 874 data[0x004] = data[0x404] = dataStart.u8bit.byteMidHigh; | |
| 875 data[0x005] = data[0x405] = dataEnd.u8bit.byteLow; | |
| 876 data[0x006] = data[0x406] = dataEnd.u8bit.byteMidLow; | |
| 877 data[0x007] = data[0x407] = dataEnd.u8bit.byteMidHigh; | |
| 878 | |
| 879 // set actualPointerHeader to next free header and update lastDiveLogId | |
| 880 ext_flash_create_new_dive_log(0); | |
| 881 | |
| 882 // copy header data | |
| 883 ef_write_block(data,0x800,EF_HEADER, 1); | |
| 884 | |
| 885 // copy sample data | |
| 886 ef_write_block(&data[0x800], length-0x800, EF_SAMPLE, 1); | |
| 887 | |
| 888 // update logFlashNextSampleStartAddress | |
| 889 settingsGetPointer()->logFlashNextSampleStartAddress = actualPointerSample; | |
| 890 } | |
| 891 | |
| 892 | |
| 893 // =============================================================================== | |
| 894 // ext_flash_read_header_memory | |
| 895 /// @brief This function returns the entire header space 1:1 | |
| 896 /// @date 04-April-2016 | |
| 897 /// | |
| 898 /// @param *data 256KB output | |
| 899 // =============================================================================== | |
| 900 void ext_flash_read_header_memory(uint8_t *data) | |
| 901 { | |
| 902 actualAddress = HEADERSTART; | |
| 903 actualPointerHeader = actualAddress; | |
| 904 ext_flash_read_block_start(); | |
| 905 for(int i=0;i<8;i++) | |
| 906 ext_flash_read_block_multi(&data[0x8000 * i], 0x8000, EF_HEADER); | |
| 907 ext_flash_read_block_stop(); | |
| 908 } | |
| 909 | |
| 910 | |
| 911 // =============================================================================== | |
| 912 // ext_flash_read_header_memory | |
| 913 /// @brief This function erases and overwrites the entire logbook header block | |
| 914 /// @date 04-April-2016 | |
| 915 /// | |
| 916 /// @param *data 256KB input of header memory 1:1 | |
| 917 // =============================================================================== | |
| 918 void ext_flash_write_header_memory(uint8_t *data) | |
| 919 { | |
| 920 actualAddress = HEADERSTART; | |
| 921 actualPointerHeader = actualAddress; | |
| 922 ef_write_block(data, 0x40000, EF_HEADER, 0); | |
| 923 } | |
| 924 | |
| 925 | |
| 926 void ext_flash_open_read_sample(uint8_t StepBackwards, uint32_t *totalNumberOfBytes) | |
| 927 { | |
| 928 SSettings *settings = settingsGetPointer(); | |
| 929 uint8_t id; | |
| 930 convert_Type dataStart, dataEnd; | |
| 931 uint8_t header1, header2; | |
| 932 | |
| 933 id = settings->lastDiveLogId; | |
| 934 id -= StepBackwards; /* 0-255, auto rollover */ | |
| 935 # | |
| 936 actualAddress = HEADERSTART + (0x800 * id) + HEADER2OFFSET; | |
| 937 actualPointerHeader = actualAddress; | |
| 938 | |
| 939 ext_flash_read_block_start(); | |
| 940 /* little endian */ | |
| 941 ext_flash_read_block(&header1, EF_HEADER); | |
| 942 ext_flash_read_block(&header2, EF_HEADER); | |
| 943 dataStart.u8bit.byteHigh = 0; | |
| 944 ext_flash_read_block(&dataStart.u8bit.byteLow, EF_HEADER); | |
| 945 ext_flash_read_block(&dataStart.u8bit.byteMidLow, EF_HEADER); | |
| 946 ext_flash_read_block(&dataStart.u8bit.byteMidHigh, EF_HEADER); | |
| 947 dataEnd.u8bit.byteHigh = 0; | |
| 948 ext_flash_read_block(&dataEnd.u8bit.byteLow, EF_HEADER); | |
| 949 ext_flash_read_block(&dataEnd.u8bit.byteMidLow, EF_HEADER); | |
| 950 ext_flash_read_block(&dataEnd.u8bit.byteMidHigh, EF_HEADER); | |
| 951 ext_flash_read_block_stop(); | |
| 952 | |
| 953 actualPointerSample = dataStart.u32bit; | |
| 954 if(dataEnd.u32bit >= dataStart.u32bit) | |
| 955 LengthLeftSampleRead = 1 + dataEnd.u32bit - dataStart.u32bit; | |
| 956 else | |
| 957 LengthLeftSampleRead = 2 + (dataStart.u32bit - SAMPLESTART) + (SAMPLESTOP - dataEnd.u32bit); | |
| 958 *totalNumberOfBytes = LengthLeftSampleRead; | |
| 959 | |
| 960 actualAddress = actualPointerSample; | |
| 961 ext_flash_read_block_start(); | |
| 962 } | |
| 963 | |
| 964 | |
| 965 void ext_flash_read_next_sample_part(uint8_t *pSample, uint8_t length) | |
| 966 { | |
| 967 for(uint16_t i = 0; i < length; i++) | |
| 968 ext_flash_read_block(&pSample[i], EF_SAMPLE); | |
| 969 } | |
| 970 | |
| 971 | |
| 972 void ext_flash_close_read_sample(void) | |
| 973 { | |
| 974 actualPointerSample = actualAddress; | |
| 975 ext_flash_read_block_stop(); | |
| 976 } | |
| 977 | |
| 978 | |
| 979 void ext_flash_set_entry_point(void) | |
| 980 { | |
| 981 entryPoint = actualAddress; | |
| 982 } | |
| 983 | |
| 984 | |
| 985 void ext_flash_reopen_read_sample_at_entry_point(void) | |
| 986 { | |
| 987 error_led_on(); | |
| 988 chip_unselect(); | |
| 989 wait_chip_not_busy(); | |
| 990 | |
| 991 actualAddress = entryPoint; | |
| 992 ext_flash_read_block_start(); | |
| 993 error_led_off(); | |
| 994 } | |
| 995 | |
| 996 /* | |
| 997 uint8_t ext_flash_point_to_64k_block_in_headerSpace(uint8_t logId) | |
| 998 { | |
| 999 uint32_t pointerToData = logId * 0x800; | |
| 1000 | |
| 1001 return pointerToData / 0x10000; | |
| 1002 } | |
| 1003 */ | |
| 1004 | |
| 1005 | |
| 1006 // =============================================================================== | |
| 1007 // ext_flash_repair_dive_numbers_starting_count_helper | |
| 1008 /// @brief | |
| 1009 /// @date 22-June-2016 | |
| 1010 | |
| 1011 // =============================================================================== | |
| 1012 uint16_t ext_flash_repair_dive_numbers_starting_count_helper(uint8_t *data, uint8_t *change64k, uint16_t startNumber, uint8_t lastLogId) | |
| 1013 { | |
| 1014 const uint32_t headerStep = 0x800; | |
| 1015 uint8_t actualLogId = 0; | |
| 1016 uint16_t oldNumber = 0; | |
| 1017 uint16_t actualNumber = 0; | |
| 1018 SLogbookHeader *ptrLogbookHeader = 0; | |
| 1019 | |
| 1020 if(startNumber == 0) | |
| 1021 return 0; | |
| 1022 | |
| 1023 actualNumber = startNumber - 1; | |
| 1024 | |
| 1025 // wo ist der �lteste Tauchgang (der, der startNumber bekommt) | |
| 1026 // use first header for ease (without HEADER2OFFSET for end of dive header) | |
| 1027 // compare for lastLogId to prevent endless loop | |
| 1028 | |
| 1029 if(*(uint16_t*)&data[lastLogId * headerStep] != 0xFAFA) | |
| 1030 return 0; | |
| 1031 | |
| 1032 actualLogId = lastLogId - 1; | |
| 1033 while((*(uint16_t*)&data[actualLogId * headerStep] == 0xFAFA) && (actualLogId != lastLogId)) | |
| 1034 { | |
| 1035 actualLogId--; | |
| 1036 } | |
| 1037 | |
| 1038 // now pointing to one behind the last | |
| 1039 while(actualLogId != lastLogId) | |
| 1040 { | |
| 1041 actualLogId++; | |
| 1042 actualNumber++; | |
| 1043 ptrLogbookHeader = (SLogbookHeader *)&data[actualLogId * headerStep]; | |
| 1044 | |
| 1045 oldNumber = ptrLogbookHeader->diveNumber; | |
| 1046 if(oldNumber != actualNumber) | |
| 1047 { | |
| 1048 // change64k[ext_flash_point_to_64k_block_in_headerSpace(actualLogId )] = 1; | |
| 1049 change64k[(actualLogId * 0x800)/0x10000] = 1; | |
| 1050 ptrLogbookHeader->diveNumber = actualNumber; | |
| 1051 ptrLogbookHeader = (SLogbookHeader *)(&data[actualLogId * headerStep] + HEADER2OFFSET); | |
| 1052 ptrLogbookHeader->diveNumber = actualNumber; | |
| 1053 } | |
| 1054 } | |
| 1055 | |
| 1056 return actualNumber; | |
| 1057 } | |
| 1058 | |
| 1059 // =============================================================================== | |
| 1060 // ext_flash_repair_SPECIAL_dive_numbers_starting_count_with | |
| 1061 /// @brief This function | |
| 1062 /// @date 04-April-2016 | |
| 1063 /// problem (160621): 64K Bl�cke (32 Tauchg�nge) weil neuer Flash Chip. | |
| 1064 /// Dieser Bereich muss auf einmal gel�scht werden. | |
| 1065 /// Vorher waren es 4K Bl�cke. | |
| 1066 /// @output endCount, last diveNumber | |
| 1067 | |
| 1068 // =============================================================================== | |
| 1069 uint16_t ext_flash_repair_SPECIAL_dive_numbers_starting_count_with(uint16_t startCount) | |
| 1070 { | |
| 1071 uint32_t logCopyDataPtr = 0; | |
| 1072 uint8_t *data; | |
| 1073 uint16_t lastCount; | |
| 1074 uint8_t listOfChanged64kBlocks[8]; // 32 Tauchg�nge pro 64K | |
| 1075 | |
| 1076 logCopyDataPtr = getFrame(97); | |
| 1077 data = (uint8_t *)logCopyDataPtr; | |
| 1078 | |
| 1079 for(int i=0;i<8;i++) | |
| 1080 listOfChanged64kBlocks[i] = 0; | |
| 1081 | |
| 1082 actualAddress = HEADERSTART; | |
| 1083 ext_flash_read_block_start(); | |
| 1084 ext_flash_read_block_multi(data,0x100000,EF_HEADER); | |
| 1085 ext_flash_read_block_stop(); | |
| 1086 | |
| 1087 lastCount = ext_flash_repair_dive_numbers_starting_count_helper(data, listOfChanged64kBlocks, startCount, settingsGetPointer()->lastDiveLogId); | |
| 1088 | |
| 1089 for(int i=0;i<8;i++) | |
| 1090 { | |
| 1091 if(listOfChanged64kBlocks[i] != 0) | |
| 1092 { | |
| 1093 actualPointerHeader = HEADERSTART + (i * 0x10000); | |
| 1094 ef_write_block(&data[i * 0x10000], 0x10000, EF_HEADER, 0); | |
| 1095 } | |
| 1096 } | |
| 1097 | |
| 1098 releaseFrame(97,logCopyDataPtr); | |
| 1099 if(settingsGetPointer()->totalDiveCounter < lastCount) | |
| 1100 { | |
| 1101 settingsGetPointer()->totalDiveCounter = lastCount; | |
| 1102 } | |
| 1103 return lastCount; | |
| 1104 } | |
| 1105 | |
| 1106 | |
| 1107 void OLD_ext_flash_repair_SPECIAL_dive_numbers_starting_count_with(uint16_t startCount) | |
| 1108 { | |
| 1109 uint16_t counterStorage[256]; | |
| 1110 uint8_t start = 0xFF; | |
| 1111 uint32_t logCopyDataPtr = 0; | |
| 1112 uint8_t *data; | |
| 1113 uint8_t startAbsolute = 0; | |
| 1114 int16_t count = 0; | |
| 1115 _Bool repair = 0; | |
| 1116 uint8_t startBackup = 0; | |
| 1117 | |
| 1118 SLogbookHeader tempLogbookHeader; | |
| 1119 SLogbookHeader *ptrHeaderInData1a; | |
| 1120 SLogbookHeader *ptrHeaderInData1b; | |
| 1121 SLogbookHeader *ptrHeaderInData2a; | |
| 1122 SLogbookHeader *ptrHeaderInData2b; | |
| 1123 | |
| 1124 logCopyDataPtr = getFrame(97); | |
| 1125 data = (uint8_t *)logCopyDataPtr; | |
| 1126 ptrHeaderInData1a = (SLogbookHeader *)logCopyDataPtr; | |
| 1127 ptrHeaderInData1b = (SLogbookHeader *)(logCopyDataPtr + HEADER2OFFSET); | |
| 1128 ptrHeaderInData2a = (SLogbookHeader *)(logCopyDataPtr + 0x800); | |
| 1129 ptrHeaderInData2b = (SLogbookHeader *)(logCopyDataPtr + 0x800 + HEADER2OFFSET); | |
| 1130 | |
| 1131 // get data | |
| 1132 for(int StepBackwards = 0; StepBackwards < 255; StepBackwards++) | |
| 1133 { | |
| 1134 logbook_getHeader(StepBackwards, &tempLogbookHeader); | |
| 1135 counterStorage[StepBackwards+1] = tempLogbookHeader.diveNumber; | |
| 1136 if(tempLogbookHeader.diveHeaderStart == 0xFAFA) | |
| 1137 start = StepBackwards; | |
| 1138 else | |
| 1139 break; | |
| 1140 } | |
| 1141 | |
| 1142 if(start == 0xFF) | |
| 1143 return; | |
| 1144 | |
| 1145 count = start + 1; | |
| 1146 startAbsolute = settingsGetPointer()->lastDiveLogId; | |
| 1147 | |
| 1148 | |
| 1149 /* | |
| 1150 if(start%2) | |
| 1151 { | |
| 1152 if(counterStorage[start] != startCount) | |
| 1153 { | |
| 1154 // clear data | |
| 1155 for(int i=0;i<0x800*2;i++) | |
| 1156 data[i] = 0xFF; | |
| 1157 | |
| 1158 uint8_t id = settingsGetPointer()->lastDiveLogId; | |
| 1159 id -= start; // 0-255, auto rollover | |
| 1160 | |
| 1161 // copy primary/pre-dive | |
| 1162 actualAddress = HEADERSTART + (0x800 * id); | |
| 1163 ext_flash_read_block_start(); | |
| 1164 for(int i = 0; i < HEADERSIZE; i++) | |
| 1165 ext_flash_read_block(&data[i], EF_HEADER); | |
| 1166 ext_flash_read_block_stop(); | |
| 1167 | |
| 1168 // copy main/secondary/post-dive | |
| 1169 actualAddress = HEADERSTART + (0x800 * id) + HEADER2OFFSET; | |
| 1170 ext_flash_read_block_start(); | |
| 1171 for(int i = 0x400; i < HEADERSIZE+0x400; i++) | |
| 1172 ext_flash_read_block(&data[i], EF_HEADER); | |
| 1173 ext_flash_read_block_stop(); | |
| 1174 | |
| 1175 // repair | |
| 1176 ptrHeaderInData2a->diveNumber = startCount; | |
| 1177 ptrHeaderInData2b->diveNumber = startCount; | |
| 1178 startCount++; | |
| 1179 | |
| 1180 // write | |
| 1181 actualAddress = HEADERSTART + (0x800 * (id-1)); | |
| 1182 ef_write_block(data,0x800*2,EF_HEADER, 0); | |
| 1183 } | |
| 1184 start--; | |
| 1185 } | |
| 1186 */ | |
| 1187 // for(int count = start; count > -1; count -= 2) | |
| 1188 | |
| 1189 while(count > 0) | |
| 1190 { | |
| 1191 // clear data | |
| 1192 for(int i=0;i<0x1000;i++) | |
| 1193 data[i] = 0xFF; | |
| 1194 | |
| 1195 repair = 0; | |
| 1196 | |
| 1197 startBackup = startAbsolute; | |
| 1198 | |
| 1199 if(startAbsolute%2) // 0x800 to 0x1000 | |
| 1200 { | |
| 1201 // copy second pre-dive | |
| 1202 actualAddress = HEADERSTART + (0x800 * startAbsolute); | |
| 1203 ext_flash_read_block_start(); | |
| 1204 for(int i = 0x800; i < HEADERSIZE+0x800; i++) | |
| 1205 ext_flash_read_block(&data[i], EF_HEADER); | |
| 1206 ext_flash_read_block_stop(); | |
| 1207 | |
| 1208 // copy second post-dive | |
| 1209 actualAddress = HEADERSTART + HEADER2OFFSET + (0x800 * startAbsolute); | |
| 1210 ext_flash_read_block_start(); | |
| 1211 for(int i = 0xC00; i < HEADERSIZE+0xC00; i++) | |
| 1212 ext_flash_read_block(&data[i], EF_HEADER); | |
| 1213 ext_flash_read_block_stop(); | |
| 1214 | |
| 1215 if(counterStorage[count] != startCount) | |
| 1216 { | |
| 1217 ptrHeaderInData2a->diveNumber = startCount; | |
| 1218 ptrHeaderInData2b->diveNumber = startCount; | |
| 1219 repair = 1; | |
| 1220 } | |
| 1221 startCount += 1; | |
| 1222 | |
| 1223 startAbsolute -= 1; | |
| 1224 count -= 1; | |
| 1225 | |
| 1226 if(count > 0) | |
| 1227 { | |
| 1228 // copy first pre-dive | |
| 1229 actualAddress = HEADERSTART + (0x800 * startAbsolute); | |
| 1230 ext_flash_read_block_start(); | |
| 1231 for(int i = 0; i < HEADERSIZE; i++) | |
| 1232 ext_flash_read_block(&data[i], EF_HEADER); | |
| 1233 ext_flash_read_block_stop(); | |
| 1234 | |
| 1235 // copy first post-dive | |
| 1236 actualAddress = HEADERSTART + (0x800 * startAbsolute); | |
| 1237 ext_flash_read_block_start(); | |
| 1238 for(int i = 0x400; i < HEADERSIZE+0x400; i++) | |
| 1239 ext_flash_read_block(&data[i], EF_HEADER); | |
| 1240 ext_flash_read_block_stop(); | |
| 1241 | |
| 1242 if(counterStorage[count] != startCount) | |
| 1243 { | |
| 1244 ptrHeaderInData1a->diveNumber = startCount; | |
| 1245 ptrHeaderInData1b->diveNumber = startCount; | |
| 1246 repair = 1; | |
| 1247 } | |
| 1248 startCount += 1; | |
| 1249 | |
| 1250 startAbsolute -= 1; | |
| 1251 count -= 1; | |
| 1252 } | |
| 1253 } | |
| 1254 else | |
| 1255 { | |
| 1256 // copy first pre-dive | |
| 1257 actualAddress = HEADERSTART + (0x800 * startAbsolute); | |
| 1258 ext_flash_read_block_start(); | |
| 1259 for(int i = 0; i < HEADERSIZE; i++) | |
| 1260 ext_flash_read_block(&data[i], EF_HEADER); | |
| 1261 ext_flash_read_block_stop(); | |
| 1262 | |
| 1263 // copy first post-dive | |
| 1264 actualAddress = HEADERSTART + (0x800 * startAbsolute); | |
| 1265 ext_flash_read_block_start(); | |
| 1266 for(int i = 0x400; i < HEADERSIZE+0x400; i++) | |
| 1267 ext_flash_read_block(&data[i], EF_HEADER); | |
| 1268 ext_flash_read_block_stop(); | |
| 1269 | |
| 1270 if(counterStorage[count] != startCount) | |
| 1271 { | |
| 1272 ptrHeaderInData1a->diveNumber = startCount; | |
| 1273 ptrHeaderInData1b->diveNumber = startCount; | |
| 1274 repair = 1; | |
| 1275 } | |
| 1276 startCount += 1; | |
| 1277 | |
| 1278 startAbsolute -= 1; | |
| 1279 count -= 1; | |
| 1280 } | |
| 1281 | |
| 1282 // write | |
| 1283 if(repair) | |
| 1284 { | |
| 1285 actualPointerHeader = HEADERSTART + (0x1000 * startBackup%2); | |
| 1286 ef_write_block(data,0x1000,EF_HEADER, 0); | |
| 1287 } | |
| 1288 } | |
| 1289 releaseFrame(97,logCopyDataPtr); | |
| 1290 settingsGetPointer()->totalDiveCounter = startCount; | |
| 1291 } | |
| 1292 | |
| 1293 | |
| 1294 // =============================================================================== | |
| 1295 // ext_flash_repair_dive_log | |
| 1296 /// @brief This function | |
| 1297 /// does set | |
| 1298 /// logFlashNextSampleStartAddress | |
| 1299 /// and | |
| 1300 /// lastDiveLogId | |
| 1301 /// | |
| 1302 void ext_flash_repair_dive_log(void) | |
| 1303 { | |
| 1304 uint8_t header1, header2; | |
| 1305 convert_Type dataStart; | |
| 1306 | |
| 1307 for(int id = 0; id < 255;id++) | |
| 1308 { | |
| 1309 actualAddress = HEADERSTART + (0x800 * id); | |
| 1310 ext_flash_read_block_start(); | |
| 1311 ext_flash_read_block(&header1, EF_HEADER); | |
| 1312 ext_flash_read_block(&header2, EF_HEADER); | |
| 1313 dataStart.u8bit.byteHigh = 0; | |
| 1314 ext_flash_read_block(&dataStart.u8bit.byteLow, EF_HEADER); | |
| 1315 ext_flash_read_block(&dataStart.u8bit.byteMidLow, EF_HEADER); | |
| 1316 ext_flash_read_block(&dataStart.u8bit.byteMidHigh, EF_HEADER); | |
| 1317 ext_flash_read_block_stop(); | |
| 1318 if((header1 == 0xFA) && (header2 == 0xFA)) | |
| 1319 { | |
| 1320 actualAddress = HEADERSTART + (0x800 * id) + HEADER2OFFSET; | |
| 1321 ext_flash_read_block_start(); | |
| 1322 ext_flash_read_block(&header1, EF_HEADER); | |
| 1323 ext_flash_read_block(&header2, EF_HEADER); | |
| 1324 ext_flash_read_block_stop(); | |
| 1325 if((header1 != 0xFA) || (header2 != 0xFA)) | |
| 1326 { | |
| 1327 actualPointerSample = dataStart.u32bit; | |
| 1328 actualAddress = actualPointerSample; | |
| 1329 logbook_recover_brokenlog(id); | |
| 1330 SSettings *settings = settingsGetPointer(); | |
| 1331 settings->logFlashNextSampleStartAddress = actualPointerSample; | |
| 1332 } | |
| 1333 } | |
| 1334 } | |
| 1335 ext_flash_find_start(); | |
| 1336 } | |
| 1337 | |
| 1338 | |
| 1339 void ext_flash_find_start(void) | |
| 1340 { | |
| 1341 uint8_t id; | |
| 1342 uint8_t header1, header2; | |
| 1343 convert_Type dataStart, dataEnd; | |
| 1344 | |
| 1345 for(id = 0; id < 255;id++) | |
| 1346 { | |
| 1347 actualAddress = HEADERSTART + (0x800 * id) + HEADER2OFFSET; | |
| 1348 ext_flash_read_block_start(); | |
| 1349 ext_flash_read_block(&header1, EF_HEADER); | |
| 1350 ext_flash_read_block(&header2, EF_HEADER); | |
| 1351 dataStart.u8bit.byteHigh = 0; | |
| 1352 ext_flash_read_block(&dataStart.u8bit.byteLow, EF_HEADER); | |
| 1353 ext_flash_read_block(&dataStart.u8bit.byteMidLow, EF_HEADER); | |
| 1354 ext_flash_read_block(&dataStart.u8bit.byteMidHigh, EF_HEADER); | |
| 1355 ext_flash_read_block_stop(); | |
| 1356 if((header1 == 0xFF) && (header2 == 0xFF)) | |
| 1357 { | |
| 1358 break; | |
| 1359 } | |
| 1360 } | |
| 1361 id--; | |
| 1362 SSettings *settings = settingsGetPointer(); | |
| 1363 settings->lastDiveLogId = id; | |
| 1364 | |
| 1365 actualAddress = HEADERSTART + (0x800 * id) + HEADER2OFFSET; | |
| 1366 actualPointerHeader = actualAddress; | |
| 1367 | |
| 1368 ext_flash_read_block_start(); | |
| 1369 | |
| 1370 ext_flash_read_block(&header1, EF_HEADER); | |
| 1371 ext_flash_read_block(&header2, EF_HEADER); | |
| 1372 dataStart.u8bit.byteHigh = 0; | |
| 1373 ext_flash_read_block(&dataStart.u8bit.byteLow, EF_HEADER); | |
| 1374 ext_flash_read_block(&dataStart.u8bit.byteMidLow, EF_HEADER); | |
| 1375 ext_flash_read_block(&dataStart.u8bit.byteMidHigh, EF_HEADER); | |
| 1376 dataEnd.u8bit.byteHigh = 0; | |
| 1377 ext_flash_read_block(&dataEnd.u8bit.byteLow, EF_HEADER); | |
| 1378 ext_flash_read_block(&dataEnd.u8bit.byteMidLow, EF_HEADER); | |
| 1379 ext_flash_read_block(&dataEnd.u8bit.byteMidHigh, EF_HEADER); | |
| 1380 ext_flash_read_block_stop(); | |
| 1381 | |
| 1382 //Find free space | |
| 1383 if((header1 == 0xFA) && (header2 == 0xFA)) | |
| 1384 { | |
| 1385 uint8_t uiRead = 0; | |
| 1386 int countFF = 0; | |
| 1387 //End of last complete dive | |
| 1388 actualPointerSample = dataEnd.u32bit ; | |
| 1389 actualAddress = actualPointerSample; | |
| 1390 //Check if there are samples of dives with less than half a minute | |
| 1391 while(true) | |
| 1392 { | |
| 1393 ext_flash_read_block_start(); | |
| 1394 ext_flash_read_block(&uiRead, EF_SAMPLE); | |
| 1395 if(uiRead == 0xFF) | |
| 1396 countFF++; | |
| 1397 else | |
| 1398 countFF = 0; | |
| 1399 | |
| 1400 | |
| 1401 | |
| 1402 if(countFF == 10) | |
| 1403 { | |
| 1404 actualAddress -= 10; | |
| 1405 break; | |
| 1406 } | |
| 1407 | |
| 1408 //New page: clear | |
| 1409 if(ext_flash_erase_if_on_page_start()) | |
| 1410 break; | |
| 1411 } | |
| 1412 // Set new start address | |
| 1413 actualPointerSample = actualAddress; | |
| 1414 settings->logFlashNextSampleStartAddress = actualPointerSample; | |
| 1415 } | |
| 1416 else | |
| 1417 { | |
| 1418 settings->logFlashNextSampleStartAddress = SAMPLESTART; | |
| 1419 } | |
| 1420 } | |
| 1421 | |
| 1422 | |
| 1423 #endif | |
| 1424 | |
| 1425 void ext_flash_disable_protection(void) | |
| 1426 { | |
| 1427 /* | |
| 1428 extFlashStatusBit8_Type status; | |
| 1429 | |
| 1430 status.uw = 0; | |
| 1431 | |
| 1432 wait_chip_not_busy(); | |
| 1433 write_spi(0x50,RELEASE); // EWSR | |
| 1434 write_spi(0x01,HOLDCS); // WRSR | |
| 1435 write_spi(status.uw,RELEASE); // new status | |
| 1436 */ | |
| 1437 } | |
| 1438 | |
| 1439 | |
| 1440 void ext_flash_disable_protection_for_logbook(void) | |
| 1441 { | |
| 1442 /* | |
| 1443 extFlashStatusBit8_Type status; | |
| 1444 | |
| 1445 status.uw = 0; | |
| 1446 status.ub.BlockProtect0 = 1; | |
| 1447 status.ub.BlockProtect1 = 0; | |
| 1448 status.ub.BlockProtect2 = 1; | |
| 1449 status.ub.BlockProtect3 = 0; // not set in OSTC3. Why? | |
| 1450 | |
| 1451 wait_chip_not_busy(); | |
| 1452 write_spi(0x50,RELEASE); // EWSR | |
| 1453 write_spi(0x01,HOLDCS); // WRSR | |
| 1454 write_spi(status.uw,RELEASE); // new status | |
| 1455 */ | |
| 1456 } | |
| 1457 | |
| 1458 | |
| 1459 void ext_flash_enable_protection(void) | |
| 1460 { | |
| 1461 /* | |
| 1462 extFlashStatusBit8_Type status; | |
| 1463 | |
| 1464 status.uw = 0; | |
| 1465 status.ub.BlockProtect0 = 1; | |
| 1466 status.ub.BlockProtect1 = 1; | |
| 1467 status.ub.BlockProtect2 = 1; | |
| 1468 status.ub.BlockProtect3 = 1; // not set in OSTC3. Why? | |
| 1469 | |
| 1470 wait_chip_not_busy(); | |
| 1471 write_spi(0x50,RELEASE); // EWSR | |
| 1472 write_spi(0x01,HOLDCS); // WRSR | |
| 1473 write_spi(status.uw,RELEASE); // new status | |
| 1474 */ | |
| 1475 } | |
| 1476 | |
| 1477 | |
| 1478 void ext_flash_erase_chip(void) | |
| 1479 { | |
| 1480 wait_chip_not_busy(); | |
| 1481 write_spi(0x06,RELEASE); | |
| 1482 write_spi(0x60,RELEASE); | |
| 1483 wait_chip_not_busy(); | |
| 1484 } | |
| 1485 | |
| 1486 void ext_flash_erase_firmware(void) | |
| 1487 { | |
| 1488 uint32_t size, blocks_64k; | |
| 1489 | |
| 1490 actualAddress = FWSTART; | |
| 1491 size = 1 + FWSTOP - FWSTART; | |
| 1492 blocks_64k = size / 0x10000; | |
| 1493 ef_erase_64K(blocks_64k); | |
| 1494 } | |
| 1495 | |
| 1496 void ext_flash_erase_firmware2(void) | |
| 1497 { | |
| 1498 uint32_t size, blocks_64k; | |
| 1499 | |
| 1500 actualAddress = FWSTART2; | |
| 1501 size = 1 + FWSTOP2 - FWSTART2; | |
| 1502 blocks_64k = size / 0x10000; | |
| 1503 ef_erase_64K(blocks_64k); | |
| 1504 } | |
| 1505 | |
| 1506 | |
| 1507 | |
| 1508 void ext_flash_erase_logbook(void) | |
| 1509 { | |
| 1510 uint32_t size, blocks_64k; | |
| 1511 | |
| 1512 ext_flash_disable_protection_for_logbook(); | |
| 1513 | |
| 1514 actualAddress = SAMPLESTART; | |
| 1515 size = 1 + SAMPLESTOP - SAMPLESTART; | |
| 1516 blocks_64k = size / 0x10000; | |
| 1517 ef_erase_64K(blocks_64k); | |
| 1518 | |
| 1519 actualAddress = HEADERSTART; | |
| 1520 size = 1 + HEADERSTOP - HEADERSTART; | |
| 1521 blocks_64k = size / 0x10000; | |
| 1522 ef_erase_64K(blocks_64k); | |
| 1523 | |
| 1524 ext_flash_enable_protection(); | |
| 1525 } | |
| 1526 | |
| 1527 | |
| 1528 void ext_flash_erase4kB(void) | |
| 1529 { | |
| 1530 wait_chip_not_busy(); | |
| 1531 write_spi(0x06,RELEASE);/* WREN */ | |
| 1532 write_spi(0x20,HOLDCS);/* sector erase cmd */ | |
| 1533 write_address(RELEASE); | |
| 1534 } | |
| 1535 | |
| 1536 /* be carefull - might not work with entire family and other products | |
| 1537 * see page 14 of LOGBOOK_V3_S25FS-S_00-271247.pdf | |
| 1538 */ | |
| 1539 void ext_flash_erase32kB(void) | |
| 1540 { | |
| 1541 uint32_t actualAddress_backup; | |
| 1542 | |
| 1543 actualAddress_backup = actualAddress; | |
| 1544 actualAddress = 0; | |
| 1545 wait_chip_not_busy(); | |
| 1546 write_spi(0x06,RELEASE);/* WREN */ | |
| 1547 write_spi(0xD8,HOLDCS);/* sector erase cmd */ | |
| 1548 write_address(RELEASE); | |
| 1549 actualAddress = actualAddress_backup; | |
| 1550 } | |
| 1551 | |
| 1552 | |
| 1553 void ext_flash_erase64kB(void) | |
| 1554 { | |
| 1555 wait_chip_not_busy(); | |
| 1556 write_spi(0x06,RELEASE);/* WREN */ | |
| 1557 write_spi(0xD8,HOLDCS);/* sector erase cmd */ | |
| 1558 write_address(RELEASE); | |
| 1559 } | |
| 1560 | |
| 1561 | |
| 1562 void ext_flash_read_block_start(void) | |
| 1563 { | |
| 1564 wait_chip_not_busy(); | |
| 1565 write_spi(0x03,HOLDCS); /* WREN */ | |
| 1566 write_address(HOLDCS); | |
| 1567 } | |
| 1568 | |
| 1569 /* 4KB, 32KB, 64 KB, not the upper 16 MB with 4 Byte address at the moment */ | |
| 1570 uint8_t ext_flash_erase_if_on_page_start(void) | |
| 1571 { | |
| 1572 if(actualAddress < 0x00008000) | |
| 1573 { | |
| 1574 /* 4K Byte is 0x1000 */ | |
| 1575 if((actualAddress & 0xFFF) == 0) | |
| 1576 { | |
| 1577 ext_flash_erase4kB(); | |
| 1578 return 1; | |
| 1579 } | |
| 1580 } | |
| 1581 else | |
| 1582 if(actualAddress < 0x00010000) | |
| 1583 { | |
| 1584 /* 32K Byte is only one page */ | |
| 1585 if(actualAddress == 0x00010000) | |
| 1586 { | |
| 1587 ext_flash_erase32kB(); | |
| 1588 return 1; | |
| 1589 } | |
| 1590 } | |
| 1591 else | |
| 1592 { | |
| 1593 /* 64K Byte is 0x10000 */ | |
| 1594 if((actualAddress & 0xFFFF) == 0) | |
| 1595 { | |
| 1596 ext_flash_erase64kB(); | |
| 1597 return 1; | |
| 1598 } | |
| 1599 } | |
| 1600 return 0; | |
| 1601 } | |
| 1602 | |
| 1603 | |
| 1604 void ext_flash_read_block(uint8_t *getByte, uint8_t type) | |
| 1605 { | |
| 1606 *getByte = read_spi(HOLDCS);/* read data */ | |
| 1607 ext_flash_incf_address(type); | |
| 1608 } | |
| 1609 | |
| 1610 | |
| 1611 void ext_flash_read_block_multi(void *getByte, uint32_t size, uint8_t type) | |
| 1612 { | |
| 1613 uint8_t *data; | |
| 1614 data = getByte; | |
| 1615 | |
| 1616 for(uint32_t i=0;i<size;i++) | |
| 1617 { | |
| 1618 data[i] = read_spi(HOLDCS);/* read data */ | |
| 1619 ext_flash_incf_address(type); | |
| 1620 } | |
| 1621 } | |
| 1622 | |
| 1623 | |
| 1624 void ext_flash_read_block_stop(void) | |
| 1625 { | |
| 1626 chip_unselect(); | |
| 1627 } | |
| 1628 | |
| 1629 | |
| 1630 /* Private functions ---------------------------------------------------------*/ | |
| 1631 | |
| 1632 void ef_write_block(uint8_t * sendByte, uint32_t length, uint8_t type, uint8_t do_not_erase) | |
| 1633 { | |
| 1634 uint32_t remaining_page_size, remaining_length, remaining_space_to_ring_end; | |
| 1635 | |
| 1636 if(!length) | |
| 1637 return; | |
| 1638 | |
| 1639 uint32_t ringStart, ringStop; | |
| 1640 | |
| 1641 switch(type) | |
| 1642 { | |
| 1643 case EF_HEADER: | |
| 1644 actualAddress = actualPointerHeader; | |
| 1645 ringStart = HEADERSTART; | |
| 1646 ringStop = HEADERSTOP; | |
| 1647 break; | |
| 1648 case EF_SAMPLE: | |
| 1649 actualAddress = actualPointerSample; | |
| 1650 ringStart = SAMPLESTART; | |
| 1651 ringStop = SAMPLESTOP; | |
| 1652 break; | |
| 1653 case EF_DEVICEDATA: | |
| 1654 actualAddress = actualPointerDevicedata; | |
| 1655 ringStart = DDSTART; | |
| 1656 ringStop = DDSTOP; | |
| 1657 break; | |
| 1658 case EF_VPMDATA: | |
| 1659 actualAddress = actualPointerVPM; | |
| 1660 ringStart = VPMSTART; | |
| 1661 ringStop = VPMSTOP; | |
| 1662 break; | |
| 1663 case EF_SETTINGS: | |
| 1664 actualAddress = actualPointerSettings; | |
| 1665 ringStart = SETTINGSSTART; | |
| 1666 ringStop = SETTINGSSTOP; | |
| 1667 break; | |
| 1668 case EF_FIRMWARE: | |
| 1669 actualAddress = actualPointerFirmware; | |
| 1670 ringStart = FWSTART; | |
| 1671 ringStop = FWSTOP; | |
| 1672 break; | |
| 1673 case EF_FIRMWARE2: | |
| 1674 actualAddress = actualPointerFirmware2; | |
| 1675 ringStart = FWSTART2; | |
| 1676 ringStop = FWSTOP2; | |
| 1677 break; | |
| 1678 default: | |
| 1679 ringStart = FLASHSTART; | |
| 1680 ringStop = FLASHSTOP; | |
| 1681 break; | |
| 1682 } | |
| 1683 /* safety */ | |
| 1684 if(actualAddress < ringStart) | |
| 1685 actualAddress = ringStart; | |
| 1686 | |
| 1687 if(do_not_erase == 0) | |
| 1688 ext_flash_erase_if_on_page_start(); | |
| 1689 | |
| 1690 for(uint32_t i=0;i<length;i++) | |
| 1691 { | |
| 1692 ef_hw_rough_delay_us(5); | |
| 1693 wait_chip_not_busy(); | |
| 1694 write_spi(0x06,RELEASE); /* WREN */ | |
| 1695 write_spi(0x02,HOLDCS); /* write cmd */ | |
| 1696 write_address(HOLDCS); | |
| 1697 | |
| 1698 remaining_length = length - i; | |
| 1699 remaining_page_size = actualAddress & 0xFF; | |
| 1700 remaining_space_to_ring_end = ringStop - actualAddress; | |
| 1701 | |
| 1702 if((remaining_page_size == 0) && (remaining_length >= 256) && (remaining_space_to_ring_end >= 256)) | |
| 1703 { | |
| 1704 for(int j=0; j<255; j++) | |
| 1705 { | |
| 1706 write_spi(sendByte[i],HOLDCS);/* write data */ | |
| 1707 actualAddress++; | |
| 1708 i++; | |
| 1709 } | |
| 1710 } | |
| 1711 /* byte with RELEASE */ | |
| 1712 write_spi(sendByte[i],RELEASE);/* write data */ | |
| 1713 actualAddress++; | |
| 1714 if(actualAddress > ringStop) | |
| 1715 actualAddress = ringStart; | |
| 1716 if(do_not_erase == 0) | |
| 1717 ext_flash_erase_if_on_page_start(); | |
| 1718 } | |
| 1719 switch(type) | |
| 1720 { | |
| 1721 case EF_HEADER: | |
| 1722 actualPointerHeader = actualAddress; | |
| 1723 break; | |
| 1724 case EF_SAMPLE: | |
| 1725 actualPointerSample = actualAddress; | |
| 1726 break; | |
| 1727 case EF_DEVICEDATA: | |
| 1728 actualPointerDevicedata = actualAddress; | |
| 1729 break; | |
| 1730 case EF_VPMDATA: | |
| 1731 actualPointerVPM = actualAddress; | |
| 1732 break; | |
| 1733 case EF_SETTINGS: | |
| 1734 actualPointerSettings = actualAddress; | |
| 1735 break; | |
| 1736 case EF_FIRMWARE: | |
| 1737 actualPointerFirmware = actualAddress; | |
| 1738 break; | |
| 1739 case EF_FIRMWARE2: | |
| 1740 actualPointerFirmware2 = actualAddress; | |
| 1741 break; | |
| 1742 default: | |
| 1743 break; | |
| 1744 } | |
| 1745 } | |
| 1746 | |
| 1747 | |
| 1748 _Bool ext_flash_test_remaining_space_of_page_empty(uint32_t pointer, uint16_t length) | |
| 1749 { | |
| 1750 if((pointer & 0xFFF) == 0) | |
| 1751 return 1; | |
| 1752 | |
| 1753 uint32_t backup = actualAddress; | |
| 1754 uint8_t data; | |
| 1755 uint32_t size_to_page_end; | |
| 1756 | |
| 1757 size_to_page_end = 0x1000 - (pointer & 0xFFF); | |
| 1758 if(length > size_to_page_end) | |
| 1759 length = size_to_page_end; | |
| 1760 | |
| 1761 actualAddress = pointer; | |
| 1762 ext_flash_read_block_start(); | |
| 1763 | |
| 1764 for(uint16_t i = 0; i<length; i++) | |
| 1765 { | |
| 1766 ext_flash_read_block(&data, 255); // 255 = ENTIRE FLASH | |
| 1767 if(data != 0xFF) | |
| 1768 { | |
| 1769 ext_flash_read_block_stop(); | |
| 1770 actualAddress = backup; | |
| 1771 return 0; | |
| 1772 } | |
| 1773 } | |
| 1774 ext_flash_read_block_stop(); | |
| 1775 actualAddress = backup; | |
| 1776 return 1; | |
| 1777 } | |
| 1778 | |
| 1779 | |
| 1780 void ext_flash_set_to_begin_of_next_page(uint32_t *pointer, uint8_t type) | |
| 1781 { | |
| 1782 uint32_t ringStart, ringStop; | |
| 1783 | |
| 1784 switch(type) | |
| 1785 { | |
| 1786 case EF_HEADER: | |
| 1787 ringStart = HEADERSTART; | |
| 1788 ringStop = HEADERSTOP; | |
| 1789 break; | |
| 1790 case EF_SAMPLE: | |
| 1791 ringStart = SAMPLESTART; | |
| 1792 ringStop = SAMPLESTOP; | |
| 1793 break; | |
| 1794 case EF_DEVICEDATA: | |
| 1795 ringStart = DDSTART; | |
| 1796 ringStop = DDSTOP; | |
| 1797 break; | |
| 1798 case EF_VPMDATA: | |
| 1799 ringStart = VPMSTART; | |
| 1800 ringStop = VPMSTOP; | |
| 1801 break; | |
| 1802 case EF_SETTINGS: | |
| 1803 ringStart = SETTINGSSTART; | |
| 1804 ringStop = SETTINGSSTOP; | |
| 1805 break; | |
| 1806 default: | |
| 1807 ringStart = FLASHSTART; | |
| 1808 ringStop = FLASHSTOP; | |
| 1809 break; | |
| 1810 } | |
| 1811 | |
| 1812 *pointer = (*pointer & 0xFFF) + 0x1000; | |
| 1813 | |
| 1814 if((*pointer < ringStart) || (*pointer >= ringStop)) | |
| 1815 *pointer = ringStart; | |
| 1816 } | |
| 1817 | |
| 1818 | |
| 1819 static void ef_erase_64K(uint32_t blocks) | |
| 1820 { | |
| 1821 for(uint32_t i = 0; i < blocks; i++) | |
| 1822 { | |
| 1823 wait_chip_not_busy(); | |
| 1824 write_spi(0x06,RELEASE);/* WREN */ | |
| 1825 write_spi(0xD8,HOLDCS);/* 64k erase cmd */ | |
| 1826 write_address(RELEASE); | |
| 1827 actualAddress += 0x10000; | |
| 1828 HAL_Delay(25); | |
| 1829 } | |
| 1830 } | |
| 1831 | |
| 1832 | |
| 1833 void chip_unselect(void) | |
| 1834 { | |
| 1835 HAL_GPIO_WritePin(EXTFLASH_CSB_GPIO_PORT,EXTFLASH_CSB_PIN,GPIO_PIN_SET); // chip select | |
| 1836 } | |
| 1837 | |
| 1838 void chip_select(void) | |
| 1839 { | |
| 1840 HAL_GPIO_WritePin(EXTFLASH_CSB_GPIO_PORT,EXTFLASH_CSB_PIN,GPIO_PIN_RESET); // chip select | |
| 1841 } | |
| 1842 | |
| 1843 void error_led_on(void) | |
| 1844 { | |
| 1845 HAL_GPIO_WritePin(OSCILLOSCOPE_GPIO_PORT,OSCILLOSCOPE_PIN,GPIO_PIN_SET); | |
| 1846 } | |
| 1847 | |
| 1848 void error_led_off(void) | |
| 1849 { | |
| 1850 HAL_GPIO_WritePin(OSCILLOSCOPE_GPIO_PORT,OSCILLOSCOPE_PIN,GPIO_PIN_RESET); | |
| 1851 } | |
| 1852 | |
| 1853 | |
| 1854 uint8_t read_spi(uint8_t unselect_CS_afterwards) | |
| 1855 { | |
| 1856 uint8_t byte; | |
| 1857 | |
| 1858 chip_select(); | |
| 1859 | |
| 1860 if(HAL_SPI_Receive(&hspiDisplay, &byte, 1, 10000) != HAL_OK) | |
| 1861 Error_Handler_extflash(); | |
| 1862 | |
| 1863 while (HAL_SPI_GetState(&hspiDisplay) != HAL_SPI_STATE_READY) | |
| 1864 { | |
| 1865 } | |
| 1866 if(unselect_CS_afterwards) | |
| 1867 chip_unselect(); | |
| 1868 | |
| 1869 return byte; | |
| 1870 } | |
| 1871 | |
| 1872 | |
| 1873 void write_spi(uint8_t data, uint8_t unselect_CS_afterwards) | |
| 1874 { | |
| 1875 chip_select(); | |
| 1876 | |
| 1877 if(HAL_SPI_Transmit(&hspiDisplay, &data, 1, 10000) != HAL_OK) | |
| 1878 Error_Handler_extflash(); | |
| 1879 | |
| 1880 while (HAL_SPI_GetState(&hspiDisplay) != HAL_SPI_STATE_READY) | |
| 1881 { | |
| 1882 } | |
| 1883 if(unselect_CS_afterwards) | |
| 1884 chip_unselect(); | |
| 1885 } | |
| 1886 | |
| 1887 | |
| 1888 void write_address(uint8_t unselect_CS_afterwards) | |
| 1889 { | |
| 1890 uint8_t hi, med ,lo; | |
| 1891 | |
| 1892 hi = (actualAddress >> 16) & 0xFF; | |
| 1893 med = (actualAddress >> 8) & 0xFF; | |
| 1894 lo = actualAddress & 0xFF; | |
| 1895 | |
| 1896 write_spi(hi, HOLDCS); | |
| 1897 write_spi(med, HOLDCS); | |
| 1898 write_spi(lo, unselect_CS_afterwards); | |
| 1899 } | |
| 1900 | |
| 1901 | |
| 1902 static void wait_chip_not_busy(void) | |
| 1903 { | |
| 1904 uint8_t status; | |
| 1905 | |
| 1906 chip_unselect(); | |
| 1907 | |
| 1908 write_spi(0x05,HOLDCS); /* RDSR */ | |
| 1909 status = read_spi(HOLDCS);/* read status */ | |
| 1910 while(status & 0x01) | |
| 1911 { | |
| 1912 HAL_Delay(1); | |
| 1913 status = read_spi(HOLDCS);/* read status */ | |
| 1914 } | |
| 1915 chip_unselect(); | |
| 1916 } | |
| 1917 | |
| 1918 | |
| 1919 void ext_flash_incf_address(uint8_t type) | |
| 1920 { | |
| 1921 uint32_t ringStart, ringStop; | |
| 1922 | |
| 1923 actualAddress += 1; | |
| 1924 | |
| 1925 switch(type) | |
| 1926 { | |
| 1927 case EF_HEADER: | |
| 1928 ringStart = HEADERSTART; | |
| 1929 ringStop = HEADERSTOP; | |
| 1930 break; | |
| 1931 case EF_SAMPLE: | |
| 1932 ringStart = SAMPLESTART; | |
| 1933 ringStop = SAMPLESTOP; | |
| 1934 break; | |
| 1935 case EF_DEVICEDATA: | |
| 1936 ringStart = DDSTART; | |
| 1937 ringStop = DDSTOP; | |
| 1938 break; | |
| 1939 case EF_VPMDATA: | |
| 1940 ringStart = VPMSTART; | |
| 1941 ringStop = VPMSTOP; | |
| 1942 break; | |
| 1943 case EF_SETTINGS: | |
| 1944 ringStart = SETTINGSSTART; | |
| 1945 ringStop = SETTINGSSTOP; | |
| 1946 break; | |
| 1947 case EF_FIRMWARE: | |
| 1948 ringStart = FWSTART; | |
| 1949 ringStop = FWSTOP; | |
| 1950 break; | |
| 1951 case EF_FIRMWARE2: | |
| 1952 ringStart = FWSTART2; | |
| 1953 ringStop = FWSTOP2; | |
| 1954 break; | |
| 1955 default: | |
| 1956 ringStart = FLASHSTART; | |
| 1957 ringStop = FLASHSTOP; | |
| 1958 break; | |
| 1959 } | |
| 1960 | |
| 1961 if((actualAddress < ringStart) || (actualAddress > ringStop)) | |
| 1962 actualAddress = ringStart; | |
| 1963 } | |
| 1964 | |
| 1965 | |
| 1966 void ext_flash_decf_address_ring(uint8_t type) | |
| 1967 { | |
| 1968 uint32_t ringStart, ringStop; | |
| 1969 | |
| 1970 switch(type) | |
| 1971 { | |
| 1972 case EF_HEADER: | |
| 1973 ringStart = HEADERSTART; | |
| 1974 ringStop = HEADERSTOP; | |
| 1975 break; | |
| 1976 case EF_SAMPLE: | |
| 1977 ringStart = SAMPLESTART; | |
| 1978 ringStop = SAMPLESTOP; | |
| 1979 break; | |
| 1980 case EF_DEVICEDATA: | |
| 1981 ringStart = DDSTART; | |
| 1982 ringStop = DDSTOP; | |
| 1983 break; | |
| 1984 case EF_VPMDATA: | |
| 1985 ringStart = VPMSTART; | |
| 1986 ringStop = VPMSTOP; | |
| 1987 break; | |
| 1988 case EF_SETTINGS: | |
| 1989 ringStart = SETTINGSSTART; | |
| 1990 ringStop = SETTINGSSTOP; | |
| 1991 break; | |
| 1992 case EF_FIRMWARE: | |
| 1993 ringStart = FWSTART; | |
| 1994 ringStop = FWSTOP; | |
| 1995 break; | |
| 1996 case EF_FIRMWARE2: | |
| 1997 ringStart = FWSTART2; | |
| 1998 ringStop = FWSTOP2; | |
| 1999 break; | |
| 2000 default: | |
| 2001 ringStart = FLASHSTART; | |
| 2002 ringStop = FLASHSTOP; | |
| 2003 break; | |
| 2004 } | |
| 2005 | |
| 2006 if((actualAddress <= ringStart) || (actualAddress > ringStop)) | |
| 2007 actualAddress = ringStop; | |
| 2008 else | |
| 2009 actualAddress -= 1; | |
| 2010 } | |
| 2011 | |
| 2012 | |
| 2013 static void ef_hw_rough_delay_us(uint32_t delayUs) | |
| 2014 { | |
| 2015 if(!delayUs) | |
| 2016 return; | |
| 2017 delayUs*= 12; | |
| 2018 while(delayUs--); | |
| 2019 return; | |
| 2020 } | |
| 2021 | |
| 2022 static void Error_Handler_extflash(void) | |
| 2023 { | |
| 2024 while(1) | |
| 2025 { | |
| 2026 } | |
| 2027 } | |
|
225
2bb1db22b5f5
cleanup: random set of cleanups
Jan Mulder <jlmulder@xs4all.nl>
parents:
38
diff
changeset
|
2028 /* |
| 38 | 2029 uint8_t ext_flash_erase_firmware_if_not_empty(void) |
| 2030 { | |
| 2031 const uint8_t TESTSIZE_FW = 4; | |
| 2032 | |
| 2033 uint8_t data[TESTSIZE_FW]; | |
| 2034 uint8_t notEmpty = 0; | |
| 2035 | |
| 2036 actualAddress = FWSTART; | |
| 2037 ext_flash_read_block_start(); | |
| 2038 for(int i = 0; i < TESTSIZE_FW; i++) | |
| 2039 { | |
| 2040 ext_flash_read_block(&data[i], EF_FIRMWARE); | |
| 2041 if(data[i] != 0xFF) | |
| 2042 notEmpty = 1; | |
| 2043 } | |
| 2044 ext_flash_read_block_stop(); | |
| 2045 | |
| 2046 if(notEmpty) | |
| 2047 { | |
| 2048 ext_flash_erase_firmware(); | |
| 2049 return 1; | |
| 2050 } | |
| 2051 else | |
| 2052 return 0; | |
| 2053 } | |
| 2054 | |
| 2055 uint8_t ext_flash_erase_firmware2_if_not_empty(void) | |
| 2056 { | |
| 2057 const uint8_t TESTSIZE_FW = 4; | |
| 2058 | |
| 2059 uint8_t data[TESTSIZE_FW]; | |
| 2060 uint8_t notEmpty = 0; | |
| 2061 | |
| 2062 actualAddress = FWSTART2; | |
| 2063 ext_flash_read_block_start(); | |
| 2064 for(int i = 0; i < TESTSIZE_FW; i++) | |
| 2065 { | |
| 2066 ext_flash_read_block(&data[i], EF_FIRMWARE2); | |
| 2067 if(data[i] != 0xFF) | |
| 2068 notEmpty = 1; | |
| 2069 } | |
| 2070 ext_flash_read_block_stop(); | |
| 2071 | |
| 2072 if(notEmpty) | |
| 2073 { | |
| 2074 ext_flash_erase_firmware2(); | |
| 2075 return 1; | |
| 2076 } | |
| 2077 else | |
| 2078 return 0; | |
|
225
2bb1db22b5f5
cleanup: random set of cleanups
Jan Mulder <jlmulder@xs4all.nl>
parents:
38
diff
changeset
|
2079 }*/ |