igor Apu / Mbed 2 deprecated LG Featured

123

Dependencies:   mbed

Fork of LG by igor Apu

DeviceFlash.c@149:abbf7663d27d, 2016-05-03 (annotated)

Committer:
Diletant
Date:
Tue May 03 05:12:26 2016 +0000
Revision:
149:abbf7663d27d
Child:
156:e68ee0bcdcda
Device & ... update. Not final!!!

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Diletant 149:abbf7663d27d 1 #include "Device.h"
Diletant 149:abbf7663d27d 2 #include <stdio.h>
Diletant 149:abbf7663d27d 3
Diletant 149:abbf7663d27d 4 extern Device device;
Diletant 149:abbf7663d27d 5 extern HashParam hashParamTable[HASH_PARAM_COUNT];
Diletant 149:abbf7663d27d 6 char tmp[256];
Diletant 149:abbf7663d27d 7
Diletant 149:abbf7663d27d 8 //Flash memory sectors
Diletant 149:abbf7663d27d 9 #define FLASH_SECTOR0_SIZE 0x1000
Diletant 149:abbf7663d27d 10 #define FLASH_SECTOR0_START 0x00000000
Diletant 149:abbf7663d27d 11 #define FLASH_SECTOR0_END 0x00000FFF
Diletant 149:abbf7663d27d 12
Diletant 149:abbf7663d27d 13 #define FLASH_SECTOR1_SIZE 0x1000
Diletant 149:abbf7663d27d 14 #define FLASH_SECTOR1_START 0X00001000
Diletant 149:abbf7663d27d 15 #define FLASH_SECTOR1_END 0X00001FFF
Diletant 149:abbf7663d27d 16
Diletant 149:abbf7663d27d 17 #define FLASH_SECTOR2_SIZE 0x1000
Diletant 149:abbf7663d27d 18 #define FLASH_SECTOR2_START 0X00002000
Diletant 149:abbf7663d27d 19 #define FLASH_SECTOR2_END 0X00002FFF
Diletant 149:abbf7663d27d 20
Diletant 149:abbf7663d27d 21 #define FLASH_SECTOR3_SIZE 0x1000
Diletant 149:abbf7663d27d 22 #define FLASH_SECTOR3_START 0X00003000
Diletant 149:abbf7663d27d 23 #define FLASH_SECTOR3_END 0X00003FFF
Diletant 149:abbf7663d27d 24
Diletant 149:abbf7663d27d 25 #define FLASH_SECTOR4_SIZE 0x1000
Diletant 149:abbf7663d27d 26 #define FLASH_SECTOR4_START 0X00004000
Diletant 149:abbf7663d27d 27 #define FLASH_SECTOR4_END 0X00004FFF
Diletant 149:abbf7663d27d 28
Diletant 149:abbf7663d27d 29 #define FLASH_SECTOR5_SIZE 0x1000
Diletant 149:abbf7663d27d 30 #define FLASH_SECTOR5_START 0X00005000
Diletant 149:abbf7663d27d 31 #define FLASH_SECTOR5_END 0X00005FFF
Diletant 149:abbf7663d27d 32
Diletant 149:abbf7663d27d 33 #define FLASH_SECTOR6_SIZE 0x1000
Diletant 149:abbf7663d27d 34 #define FLASH_SECTOR6_START 0X00006000
Diletant 149:abbf7663d27d 35 #define FLASH_SECTOR6_END 0X00006FFF
Diletant 149:abbf7663d27d 36
Diletant 149:abbf7663d27d 37 #define FLASH_SECTOR7_SIZE 0x1000
Diletant 149:abbf7663d27d 38 #define FLASH_SECTOR7_START 0X00007000
Diletant 149:abbf7663d27d 39 #define FLASH_SECTOR7_END 0X00007FFF
Diletant 149:abbf7663d27d 40
Diletant 149:abbf7663d27d 41 #define FLASH_SECTOR8_SIZE 0x1000
Diletant 149:abbf7663d27d 42 #define FLASH_SECTOR8_START 0x00008000
Diletant 149:abbf7663d27d 43 #define FLASH_SECTOR8_END 0X00008FFF
Diletant 149:abbf7663d27d 44
Diletant 149:abbf7663d27d 45 #define FLASH_SECTOR9_SIZE 0x1000
Diletant 149:abbf7663d27d 46 #define FLASH_SECTOR9_START 0x00009000
Diletant 149:abbf7663d27d 47 #define FLASH_SECTOR9_END 0X00009FFF
Diletant 149:abbf7663d27d 48
Diletant 149:abbf7663d27d 49 #define FLASH_SECTOR10_SIZE 0x1000
Diletant 149:abbf7663d27d 50 #define FLASH_SECTOR10_START 0x0000A000
Diletant 149:abbf7663d27d 51 #define FLASH_SECTOR10_END 0X0000AFFF
Diletant 149:abbf7663d27d 52
Diletant 149:abbf7663d27d 53 #define FLASH_SECTOR11_SIZE 0x1000
Diletant 149:abbf7663d27d 54 #define FLASH_SECTOR11_START 0x0000B000
Diletant 149:abbf7663d27d 55 #define FLASH_SECTOR11_END 0X0000BFFF
Diletant 149:abbf7663d27d 56
Diletant 149:abbf7663d27d 57 #define FLASH_SECTOR12_SIZE 0x1000
Diletant 149:abbf7663d27d 58 #define FLASH_SECTOR12_START 0x0000C000
Diletant 149:abbf7663d27d 59 #define FLASH_SECTOR12_END 0X0000CFFF
Diletant 149:abbf7663d27d 60
Diletant 149:abbf7663d27d 61 #define FLASH_SECTOR13_SIZE 0x1000
Diletant 149:abbf7663d27d 62 #define FLASH_SECTOR13_START 0x0000D000
Diletant 149:abbf7663d27d 63 #define FLASH_SECTOR13_END 0X0000DFFF
Diletant 149:abbf7663d27d 64
Diletant 149:abbf7663d27d 65 #define FLASH_SECTOR14_SIZE 0x1000
Diletant 149:abbf7663d27d 66 #define FLASH_SECTOR14_START 0x0000E000
Diletant 149:abbf7663d27d 67 #define FLASH_SECTOR14_END 0X0000EFFF
Diletant 149:abbf7663d27d 68
Diletant 149:abbf7663d27d 69 #define FLASH_SECTOR15_SIZE 0x1000
Diletant 149:abbf7663d27d 70 #define FLASH_SECTOR15_START 0x0000F000
Diletant 149:abbf7663d27d 71 #define FLASH_SECTOR15_END 0X0000FFFF
Diletant 149:abbf7663d27d 72
Diletant 149:abbf7663d27d 73 #define FLASH_SECTOR16_SIZE 0x8000
Diletant 149:abbf7663d27d 74 #define FLASH_SECTOR16_START 0x00010000
Diletant 149:abbf7663d27d 75 #define FLASH_SECTOR16_END 0x00017FFF
Diletant 149:abbf7663d27d 76
Diletant 149:abbf7663d27d 77 #define FLASH_SECTOR17_SIZE 0x8000
Diletant 149:abbf7663d27d 78 #define FLASH_SECTOR17_START 0x00018000
Diletant 149:abbf7663d27d 79 #define FLASH_SECTOR17_END 0x0001FFFF
Diletant 149:abbf7663d27d 80
Diletant 149:abbf7663d27d 81 #define FLASH_SECTOR18_SIZE 0x8000
Diletant 149:abbf7663d27d 82 #define FLASH_SECTOR18_START 0x00020000
Diletant 149:abbf7663d27d 83 #define FLASH_SECTOR18_END 0x00027FFF
Diletant 149:abbf7663d27d 84
Diletant 149:abbf7663d27d 85 #define FLASH_SECTOR19_SIZE 0x8000
Diletant 149:abbf7663d27d 86 #define FLASH_SECTOR19_START 0x00028000
Diletant 149:abbf7663d27d 87 #define FLASH_SECTOR19_END 0x0002FFFF
Diletant 149:abbf7663d27d 88
Diletant 149:abbf7663d27d 89 #define FLASH_SECTOR20_SIZE 0x8000
Diletant 149:abbf7663d27d 90 #define FLASH_SECTOR20_START 0x00030000
Diletant 149:abbf7663d27d 91 #define FLASH_SECTOR20_END 0x00037FFF
Diletant 149:abbf7663d27d 92
Diletant 149:abbf7663d27d 93 #define FLASH_SECTOR21_SIZE 0x8000
Diletant 149:abbf7663d27d 94 #define FLASH_SECTOR21_START 0x00038000
Diletant 149:abbf7663d27d 95 #define FLASH_SECTOR21_END 0x0003FFFF
Diletant 149:abbf7663d27d 96
Diletant 149:abbf7663d27d 97 #define FLASH_SECTOR22_SIZE 0x8000
Diletant 149:abbf7663d27d 98 #define FLASH_SECTOR22_START 0x00040000
Diletant 149:abbf7663d27d 99 #define FLASH_SECTOR22_END 0x00047FFF
Diletant 149:abbf7663d27d 100
Diletant 149:abbf7663d27d 101 #define FLASH_SECTOR23_SIZE 0x8000
Diletant 149:abbf7663d27d 102 #define FLASH_SECTOR23_START 0x00048000
Diletant 149:abbf7663d27d 103 #define FLASH_SECTOR23_END 0x0004FFFF
Diletant 149:abbf7663d27d 104
Diletant 149:abbf7663d27d 105 #define FLASH_SECTOR24_SIZE 0x8000
Diletant 149:abbf7663d27d 106 #define FLASH_SECTOR24_START 0x00050000
Diletant 149:abbf7663d27d 107 #define FLASH_SECTOR24_END 0x00057FFF
Diletant 149:abbf7663d27d 108
Diletant 149:abbf7663d27d 109 #define FLASH_SECTOR25_SIZE 0x8000
Diletant 149:abbf7663d27d 110 #define FLASH_SECTOR25_START 0x00058000
Diletant 149:abbf7663d27d 111 #define FLASH_SECTOR25_END 0x0005FFFF
Diletant 149:abbf7663d27d 112
Diletant 149:abbf7663d27d 113 #define FLASH_SECTOR26_SIZE 0x8000
Diletant 149:abbf7663d27d 114 #define FLASH_SECTOR26_START 0x00060000
Diletant 149:abbf7663d27d 115 #define FLASH_SECTOR26_END 0x00067FFF
Diletant 149:abbf7663d27d 116
Diletant 149:abbf7663d27d 117 #define FLASH_SECTOR27_SIZE 0x8000
Diletant 149:abbf7663d27d 118 #define FLASH_SECTOR27_START 0x00068000
Diletant 149:abbf7663d27d 119 #define FLASH_SECTOR27_END 0x0006FFFF
Diletant 149:abbf7663d27d 120
Diletant 149:abbf7663d27d 121 #define FLASH_SECTOR28_SIZE 0x8000
Diletant 149:abbf7663d27d 122 #define FLASH_SECTOR28_START 0x00070000
Diletant 149:abbf7663d27d 123 #define FLASH_SECTOR28_END 0x00077FFF
Diletant 149:abbf7663d27d 124
Diletant 149:abbf7663d27d 125 #define FLASH_SECTOR29_SIZE 0x8000
Diletant 149:abbf7663d27d 126 #define FLASH_SECTOR29_START 0x00078000
Diletant 149:abbf7663d27d 127 #define FLASH_SECTOR29_END 0x0007FFFF
Diletant 149:abbf7663d27d 128
Diletant 149:abbf7663d27d 129 void InitFlashWithDefaults(void){
Diletant 149:abbf7663d27d 130 device.flash.settings.hashSector = 22;
Diletant 149:abbf7663d27d 131 //device.flash.settings.hashPageLength = 256;
Diletant 149:abbf7663d27d 132
Diletant 149:abbf7663d27d 133 device.flash.settings.dataSector = 23;
Diletant 149:abbf7663d27d 134 //device.flash.settings.dataPageLength = 256;
Diletant 149:abbf7663d27d 135 }
Diletant 149:abbf7663d27d 136
Diletant 149:abbf7663d27d 137 void InitFlash(void){
Diletant 149:abbf7663d27d 138 }
Diletant 149:abbf7663d27d 139
Diletant 149:abbf7663d27d 140 uint32_t AddressFromSector(uint8_t sector){
Diletant 149:abbf7663d27d 141 switch (sector){
Diletant 149:abbf7663d27d 142 case 0: return FLASH_SECTOR0_START;
Diletant 149:abbf7663d27d 143 case 1: return FLASH_SECTOR1_START;
Diletant 149:abbf7663d27d 144 case 2: return FLASH_SECTOR2_START;
Diletant 149:abbf7663d27d 145 case 3: return FLASH_SECTOR3_START;
Diletant 149:abbf7663d27d 146 case 4: return FLASH_SECTOR4_START;
Diletant 149:abbf7663d27d 147 case 5: return FLASH_SECTOR5_START;
Diletant 149:abbf7663d27d 148 case 6: return FLASH_SECTOR6_START;
Diletant 149:abbf7663d27d 149 case 7: return FLASH_SECTOR7_START;
Diletant 149:abbf7663d27d 150 case 8: return FLASH_SECTOR8_START;
Diletant 149:abbf7663d27d 151 case 9: return FLASH_SECTOR9_START;
Diletant 149:abbf7663d27d 152 case 10: return FLASH_SECTOR10_START;
Diletant 149:abbf7663d27d 153 case 11: return FLASH_SECTOR11_START;
Diletant 149:abbf7663d27d 154 case 12: return FLASH_SECTOR12_START;
Diletant 149:abbf7663d27d 155 case 13: return FLASH_SECTOR13_START;
Diletant 149:abbf7663d27d 156 case 14: return FLASH_SECTOR14_START;
Diletant 149:abbf7663d27d 157 case 15: return FLASH_SECTOR15_START;
Diletant 149:abbf7663d27d 158 case 16: return FLASH_SECTOR16_START;
Diletant 149:abbf7663d27d 159 case 17: return FLASH_SECTOR17_START;
Diletant 149:abbf7663d27d 160 case 18: return FLASH_SECTOR18_START;
Diletant 149:abbf7663d27d 161 case 19: return FLASH_SECTOR19_START;
Diletant 149:abbf7663d27d 162 case 20: return FLASH_SECTOR20_START;
Diletant 149:abbf7663d27d 163 case 21: return FLASH_SECTOR21_START;
Diletant 149:abbf7663d27d 164 case 22: return FLASH_SECTOR22_START;
Diletant 149:abbf7663d27d 165 case 23: return FLASH_SECTOR23_START;
Diletant 149:abbf7663d27d 166 case 24: return FLASH_SECTOR24_START;
Diletant 149:abbf7663d27d 167 case 25: return FLASH_SECTOR25_START;
Diletant 149:abbf7663d27d 168 case 26: return FLASH_SECTOR26_START;
Diletant 149:abbf7663d27d 169 case 27: return FLASH_SECTOR27_START;
Diletant 149:abbf7663d27d 170 case 28: return FLASH_SECTOR28_START;
Diletant 149:abbf7663d27d 171 case 29: return FLASH_SECTOR29_START;
Diletant 149:abbf7663d27d 172 default: return 0;
Diletant 149:abbf7663d27d 173 }
Diletant 149:abbf7663d27d 174 }
Diletant 149:abbf7663d27d 175
Diletant 149:abbf7663d27d 176 uint16_t LengthFromSector(uint8_t sector){
Diletant 149:abbf7663d27d 177 switch (sector){
Diletant 149:abbf7663d27d 178 case 0: return FLASH_SECTOR0_SIZE;
Diletant 149:abbf7663d27d 179 case 1: return FLASH_SECTOR1_SIZE;
Diletant 149:abbf7663d27d 180 case 2: return FLASH_SECTOR2_SIZE;
Diletant 149:abbf7663d27d 181 case 3: return FLASH_SECTOR3_SIZE;
Diletant 149:abbf7663d27d 182 case 4: return FLASH_SECTOR4_SIZE;
Diletant 149:abbf7663d27d 183 case 5: return FLASH_SECTOR5_SIZE;
Diletant 149:abbf7663d27d 184 case 6: return FLASH_SECTOR6_SIZE;
Diletant 149:abbf7663d27d 185 case 7: return FLASH_SECTOR7_SIZE;
Diletant 149:abbf7663d27d 186 case 8: return FLASH_SECTOR8_SIZE;
Diletant 149:abbf7663d27d 187 case 9: return FLASH_SECTOR9_SIZE;
Diletant 149:abbf7663d27d 188 case 10: return FLASH_SECTOR10_SIZE;
Diletant 149:abbf7663d27d 189 case 11: return FLASH_SECTOR11_SIZE;
Diletant 149:abbf7663d27d 190 case 12: return FLASH_SECTOR12_SIZE;
Diletant 149:abbf7663d27d 191 case 13: return FLASH_SECTOR13_SIZE;
Diletant 149:abbf7663d27d 192 case 14: return FLASH_SECTOR14_SIZE;
Diletant 149:abbf7663d27d 193 case 15: return FLASH_SECTOR15_SIZE;
Diletant 149:abbf7663d27d 194 case 16: return FLASH_SECTOR16_SIZE;
Diletant 149:abbf7663d27d 195 case 17: return FLASH_SECTOR17_SIZE;
Diletant 149:abbf7663d27d 196 case 18: return FLASH_SECTOR18_SIZE;
Diletant 149:abbf7663d27d 197 case 19: return FLASH_SECTOR19_SIZE;
Diletant 149:abbf7663d27d 198 case 20: return FLASH_SECTOR20_SIZE;
Diletant 149:abbf7663d27d 199 case 21: return FLASH_SECTOR21_SIZE;
Diletant 149:abbf7663d27d 200 case 22: return FLASH_SECTOR22_SIZE;
Diletant 149:abbf7663d27d 201 case 23: return FLASH_SECTOR23_SIZE;
Diletant 149:abbf7663d27d 202 case 24: return FLASH_SECTOR24_SIZE;
Diletant 149:abbf7663d27d 203 case 25: return FLASH_SECTOR25_SIZE;
Diletant 149:abbf7663d27d 204 case 26: return FLASH_SECTOR26_SIZE;
Diletant 149:abbf7663d27d 205 case 27: return FLASH_SECTOR27_SIZE;
Diletant 149:abbf7663d27d 206 case 28: return FLASH_SECTOR28_SIZE;
Diletant 149:abbf7663d27d 207 case 29: return FLASH_SECTOR29_SIZE;
Diletant 149:abbf7663d27d 208 default: return 0;
Diletant 149:abbf7663d27d 209 }
Diletant 149:abbf7663d27d 210 }
Diletant 149:abbf7663d27d 211 /*
Diletant 149:abbf7663d27d 212 uint8_t sectorFromAddress(uint32_t address){
Diletant 149:abbf7663d27d 213 if (address >= FLASH_SECTOR29_START) return 29;
Diletant 149:abbf7663d27d 214 else if (address >= FLASH_SECTOR28_START) return 28;
Diletant 149:abbf7663d27d 215 else if (address >= FLASH_SECTOR27_START) return 27;
Diletant 149:abbf7663d27d 216 else if (address >= FLASH_SECTOR26_START) return 26;
Diletant 149:abbf7663d27d 217 else if (address >= FLASH_SECTOR25_START) return 25;
Diletant 149:abbf7663d27d 218 else if (address >= FLASH_SECTOR24_START) return 24;
Diletant 149:abbf7663d27d 219 else if (address >= FLASH_SECTOR23_START) return 23;
Diletant 149:abbf7663d27d 220 else if (address >= FLASH_SECTOR22_START) return 22;
Diletant 149:abbf7663d27d 221 else if (address >= FLASH_SECTOR21_START) return 21;
Diletant 149:abbf7663d27d 222 else if (address >= FLASH_SECTOR20_START) return 20;
Diletant 149:abbf7663d27d 223 else if (address >= FLASH_SECTOR19_START) return 19;
Diletant 149:abbf7663d27d 224 else if (address >= FLASH_SECTOR18_START) return 18;
Diletant 149:abbf7663d27d 225 else if (address >= FLASH_SECTOR17_START) return 17;
Diletant 149:abbf7663d27d 226 else if (address >= FLASH_SECTOR16_START) return 16;
Diletant 149:abbf7663d27d 227 else if (address >= FLASH_SECTOR15_START) return 15;
Diletant 149:abbf7663d27d 228 else if (address >= FLASH_SECTOR14_START) return 14;
Diletant 149:abbf7663d27d 229 else if (address >= FLASH_SECTOR13_START) return 13;
Diletant 149:abbf7663d27d 230 else if (address >= FLASH_SECTOR12_START) return 12;
Diletant 149:abbf7663d27d 231 else if (address >= FLASH_SECTOR11_START) return 11;
Diletant 149:abbf7663d27d 232 else if (address >= FLASH_SECTOR10_START) return 10;
Diletant 149:abbf7663d27d 233 else if (address >= FLASH_SECTOR9_START) return 9;
Diletant 149:abbf7663d27d 234 else if (address >= FLASH_SECTOR8_START) return 8;
Diletant 149:abbf7663d27d 235 else if (address >= FLASH_SECTOR7_START) return 7;
Diletant 149:abbf7663d27d 236 else if (address >= FLASH_SECTOR6_START) return 6;
Diletant 149:abbf7663d27d 237 else if (address >= FLASH_SECTOR5_START) return 5;
Diletant 149:abbf7663d27d 238 else if (address >= FLASH_SECTOR4_START) return 4;
Diletant 149:abbf7663d27d 239 else if (address >= FLASH_SECTOR3_START) return 3;
Diletant 149:abbf7663d27d 240 else if (address >= FLASH_SECTOR2_START) return 2;
Diletant 149:abbf7663d27d 241 else if (address >= FLASH_SECTOR1_START) return 1;
Diletant 149:abbf7663d27d 242 else return 0;
Diletant 149:abbf7663d27d 243 }
Diletant 149:abbf7663d27d 244 */
Diletant 149:abbf7663d27d 245
Diletant 149:abbf7663d27d 246 DeviceFlashHash * FlashFindByHash(uint32_t hash){
Diletant 149:abbf7663d27d 247 uint16_t sectorLength = LengthFromSector(device.flash.settings.hashSector);
Diletant 149:abbf7663d27d 248 uint16_t hashCapacity = sectorLength / sizeof(DeviceFlashHash);
Diletant 149:abbf7663d27d 249 uint32_t sectorAddress = AddressFromSector(device.flash.settings.hashSector);
Diletant 149:abbf7663d27d 250 DeviceFlashHash * item = (DeviceFlashHash *)sectorAddress;
Diletant 149:abbf7663d27d 251 for (uint16_t i = 0; i < hashCapacity; i++){
Diletant 149:abbf7663d27d 252 if (item->hash == 0) break;
Diletant 149:abbf7663d27d 253 if (item->hash == hash) return item;
Diletant 149:abbf7663d27d 254 item++;
Diletant 149:abbf7663d27d 255 }
Diletant 149:abbf7663d27d 256 return 0;
Diletant 149:abbf7663d27d 257 }
Diletant 149:abbf7663d27d 258
Diletant 149:abbf7663d27d 259 void FlashReadAll(void){
Diletant 149:abbf7663d27d 260 uint16_t count = 0;
Diletant 149:abbf7663d27d 261 uint16_t sectorLength = LengthFromSector(device.flash.settings.hashSector);
Diletant 149:abbf7663d27d 262 uint16_t hashCapacity = sectorLength / sizeof(DeviceFlashHash);
Diletant 149:abbf7663d27d 263 uint32_t sectorAddress = AddressFromSector(device.flash.settings.hashSector);
Diletant 149:abbf7663d27d 264 DeviceFlashHash * item = (DeviceFlashHash *)sectorAddress;
Diletant 149:abbf7663d27d 265 for (uint16_t i = 0; i < hashCapacity; i++){
Diletant 149:abbf7663d27d 266 if (item->hash == 0) break; //Cleared
Diletant 149:abbf7663d27d 267 if (item->hash == 0xffffffff) break; //Erased
Diletant 149:abbf7663d27d 268 for (uint32_t j = 0; j < HASH_PARAM_COUNT; j++){
Diletant 149:abbf7663d27d 269 if (item->hash == hashParamTable[j].hash){
Diletant 149:abbf7663d27d 270 //if (item->size == hashParamTable[j].size){
Diletant 149:abbf7663d27d 271 uint8_t * src = (uint8_t *)item->address;
Diletant 149:abbf7663d27d 272 uint8_t * dst = hashParamTable[j].ref;
Diletant 149:abbf7663d27d 273 for (uint16_t k = 0; k < hashParamTable[j].size; k++){
Diletant 149:abbf7663d27d 274 *dst = *src; src++; dst++;
Diletant 149:abbf7663d27d 275 }
Diletant 149:abbf7663d27d 276 //}
Diletant 149:abbf7663d27d 277 }
Diletant 149:abbf7663d27d 278 }
Diletant 149:abbf7663d27d 279 item++;
Diletant 149:abbf7663d27d 280 count++;
Diletant 149:abbf7663d27d 281 }
Diletant 149:abbf7663d27d 282 sprintf(tmp,"FlashReadAll(): %d\r\n",count); WriteCon(tmp);
Diletant 149:abbf7663d27d 283 }
Diletant 149:abbf7663d27d 284
Diletant 149:abbf7663d27d 285 void FlashOperationWritePage(DeviceFlashWriteOperation * op){
Diletant 149:abbf7663d27d 286 uint32_t res;
Diletant 149:abbf7663d27d 287 if (op->sectorPosition == 0){
Diletant 149:abbf7663d27d 288 //Prepare new sector for write operation
Diletant 149:abbf7663d27d 289 res = u32IAP_PrepareSectors(op->sector, op->sector);
Diletant 149:abbf7663d27d 290 sprintf(tmp,"PrepareSectors(): %02d %08x\r\n",op->sector, res); WriteCon(tmp);
Diletant 149:abbf7663d27d 291 //Erase new sector
Diletant 149:abbf7663d27d 292 res = u32IAP_EraseSectors(op->sector, op->sector);
Diletant 149:abbf7663d27d 293 sprintf(tmp,"EraseSectors(): %02d %08x\r\n",op->sector, res); WriteCon(tmp);
Diletant 149:abbf7663d27d 294 }
Diletant 149:abbf7663d27d 295 if (op->bytes < op->maxBytes){
Diletant 149:abbf7663d27d 296 //Prepare sector for write operation
Diletant 149:abbf7663d27d 297 res = u32IAP_PrepareSectors(op->sector, op->sector);
Diletant 149:abbf7663d27d 298 sprintf(tmp,"PrepareSectors(): %02d %08x\r\n",op->sector, res); WriteCon(tmp);
Diletant 149:abbf7663d27d 299 //Copy page buffer to flash
Diletant 149:abbf7663d27d 300 res = u32IAP_CopyRAMToFlash(op->sectorAddress + op->sectorPosition, (uint32_t)&op->pageBuffer[0], FLASH_PAGE_SIZE);
Diletant 149:abbf7663d27d 301 sprintf(tmp,"CopyRAMToFlash(): %8x %08x\r\n", op->sectorAddress + op->sectorPosition, res); WriteCon(tmp);
Diletant 149:abbf7663d27d 302 //Update bytes count
Diletant 149:abbf7663d27d 303 op->bytes += FLASH_PAGE_SIZE;
Diletant 149:abbf7663d27d 304 //Update sector position
Diletant 149:abbf7663d27d 305 op->sectorPosition += FLASH_PAGE_SIZE;
Diletant 149:abbf7663d27d 306 if (op->sectorPosition == op->sectorLength){
Diletant 149:abbf7663d27d 307 //Update sector address
Diletant 149:abbf7663d27d 308 op->sectorAddress += op->sectorLength;
Diletant 149:abbf7663d27d 309 //Clear sector position
Diletant 149:abbf7663d27d 310 op->sectorPosition = 0;
Diletant 149:abbf7663d27d 311 //Update sector
Diletant 149:abbf7663d27d 312 op->sector += 1;
Diletant 149:abbf7663d27d 313 }
Diletant 149:abbf7663d27d 314 //Update page position
Diletant 149:abbf7663d27d 315 op->pagePosition = 0;
Diletant 149:abbf7663d27d 316 }
Diletant 149:abbf7663d27d 317 }
Diletant 149:abbf7663d27d 318
Diletant 149:abbf7663d27d 319 void FlashOperationAppend(DeviceFlashWriteOperation * op, void * src, uint16_t count){
Diletant 149:abbf7663d27d 320 uint8_t * ptr = (uint8_t*) src;
Diletant 149:abbf7663d27d 321 for (uint16_t i = 0; i < count; i++){
Diletant 149:abbf7663d27d 322 op->pageBuffer[op->pagePosition] = *ptr;
Diletant 149:abbf7663d27d 323 op->pagePosition++;
Diletant 149:abbf7663d27d 324 ptr++;
Diletant 149:abbf7663d27d 325 //Write page buffer
Diletant 149:abbf7663d27d 326 if (op->pagePosition == FLASH_PAGE_SIZE){
Diletant 149:abbf7663d27d 327 FlashOperationWritePage(op);
Diletant 149:abbf7663d27d 328 }
Diletant 149:abbf7663d27d 329 }
Diletant 149:abbf7663d27d 330 }
Diletant 149:abbf7663d27d 331
Diletant 149:abbf7663d27d 332 void FlashOperationComplete(DeviceFlashWriteOperation * op){
Diletant 149:abbf7663d27d 333 for (uint16_t i = op->pagePosition; i < FLASH_PAGE_SIZE; i++){
Diletant 149:abbf7663d27d 334 op->pageBuffer[op->pagePosition] = 0xff;
Diletant 149:abbf7663d27d 335 op->pagePosition++;
Diletant 149:abbf7663d27d 336 }
Diletant 149:abbf7663d27d 337 FlashOperationWritePage(op);
Diletant 149:abbf7663d27d 338 }
Diletant 149:abbf7663d27d 339
Diletant 149:abbf7663d27d 340 void FlashWriteAll(void){
Diletant 149:abbf7663d27d 341 //#pragma pack(push) /* push current alignment to stack */
Diletant 149:abbf7663d27d 342 //#pragma pack(4) /* set alignment to 4 byte boundary */
Diletant 149:abbf7663d27d 343 DeviceFlashWriteOperation hash;
Diletant 149:abbf7663d27d 344 //#pragma pack(pop) /* restore original alignment from stack */
Diletant 149:abbf7663d27d 345 hash.sector = device.flash.settings.hashSector;
Diletant 149:abbf7663d27d 346 hash.sectorAddress = AddressFromSector(hash.sector);
Diletant 149:abbf7663d27d 347 hash.sectorLength = LengthFromSector(hash.sector);
Diletant 149:abbf7663d27d 348 hash.sectorPosition = 0;
Diletant 149:abbf7663d27d 349 hash.pagePosition = 0;
Diletant 149:abbf7663d27d 350 //hash.pageLength = device.flash.settings.hashPageLength;
Diletant 149:abbf7663d27d 351 hash.bytes = 0;
Diletant 149:abbf7663d27d 352 hash.maxBytes = hash.sectorLength;
Diletant 149:abbf7663d27d 353
Diletant 149:abbf7663d27d 354 DeviceFlashWriteOperation data;
Diletant 149:abbf7663d27d 355 data.sector = device.flash.settings.dataSector;
Diletant 149:abbf7663d27d 356 data.sectorAddress = AddressFromSector(data.sector);
Diletant 149:abbf7663d27d 357 data.sectorLength = LengthFromSector(data.sector);
Diletant 149:abbf7663d27d 358 data.sectorPosition = 0;
Diletant 149:abbf7663d27d 359 data.pagePosition = 0;
Diletant 149:abbf7663d27d 360 //data.pageLength = device.flash.settings.dataPageLength;
Diletant 149:abbf7663d27d 361 data.bytes = 0;
Diletant 149:abbf7663d27d 362 data.maxBytes = FLASH_SECTOR29_END - data.sectorAddress;
Diletant 149:abbf7663d27d 363
Diletant 149:abbf7663d27d 364 NVIC_DisableIRQ(TIMER1_IRQn);
Diletant 149:abbf7663d27d 365 NVIC_DisableIRQ(TIMER2_IRQn);
Diletant 149:abbf7663d27d 366 NVIC_DisableIRQ(EINT3_IRQn);
Diletant 149:abbf7663d27d 367 //SystemInitDef();
Diletant 149:abbf7663d27d 368
Diletant 149:abbf7663d27d 369 for (uint32_t i = 0; i < HASH_PARAM_COUNT; i++){
Diletant 149:abbf7663d27d 370 FlashOperationAppend(&hash, &hashParamTable[i].hash, 4);
Diletant 149:abbf7663d27d 371 uint32_t address = data.sectorAddress + data.sectorPosition + data.pagePosition;
Diletant 149:abbf7663d27d 372 FlashOperationAppend(&hash, &address, 4);
Diletant 149:abbf7663d27d 373 FlashOperationAppend(&data, hashParamTable[i].ref, hashParamTable[i].size);
Diletant 149:abbf7663d27d 374 }
Diletant 149:abbf7663d27d 375 FlashOperationComplete(&hash);
Diletant 149:abbf7663d27d 376 FlashOperationComplete(&data);
Diletant 149:abbf7663d27d 377
Diletant 149:abbf7663d27d 378 NVIC_EnableIRQ(TIMER1_IRQn);
Diletant 149:abbf7663d27d 379 NVIC_EnableIRQ(TIMER2_IRQn);
Diletant 149:abbf7663d27d 380 NVIC_EnableIRQ(EINT3_IRQn);
Diletant 149:abbf7663d27d 381 }