summaryrefslogtreecommitdiffstats
path: root/tmk_core/common/chibios/eeprom_stm32.c
blob: a869985501282495006cc2726d70da0d7d8bae40 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
523
524
525
526
527
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
581
582
583
584
585
586
587
588
589
590
591
592
593
594
595
596
597
598
599
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
619
620
621
622
623
624
625
626
627
628
629
630
631
632
633
634
635
636
637
638
639
640
641
642
643
644
645
646
647
648
649
650
651
652
653
654
655
656
657
658
659
660
661
662
663
664
665
666
667
668
669
670
671
672
673
/*
 * This software is experimental and a work in progress.
 * Under no circumstances should these files be used in relation to any critical system(s).
 * Use of these files is at your own risk.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED,
 * INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR
 * PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
 * LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
 * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
 * DEALINGS IN THE SOFTWARE.
 *
 * This files are free to use from https://github.com/rogerclarkmelbourne/Arduino_STM32 and
 * https://github.com/leaflabs/libmaple
 *
 * Modifications for QMK and STM32F303 by Yiancar
 */

#include "eeprom_stm32.h"

    FLASH_Status EE_ErasePage(uint32_t);

    uint16_t EE_CheckPage(uint32_t, uint16_t);
    uint16_t EE_CheckErasePage(uint32_t, uint16_t);
    uint16_t EE_Format(void);
    uint32_t EE_FindValidPage(void);
    uint16_t EE_GetVariablesCount(uint32_t, uint16_t);
    uint16_t EE_PageTransfer(uint32_t, uint32_t, uint16_t);
    uint16_t EE_VerifyPageFullWriteVariable(uint16_t, uint16_t);

    uint32_t PageBase0 = EEPROM_PAGE0_BASE;
    uint32_t PageBase1 = EEPROM_PAGE1_BASE;
    uint32_t PageSize = EEPROM_PAGE_SIZE;
    uint16_t Status = EEPROM_NOT_INIT;

// See http://www.st.com/web/en/resource/technical/document/application_note/CD00165693.pdf

/**
  * @brief  Check page for blank
  * @param  page base address
  * @retval Success or error
  *     EEPROM_BAD_FLASH:   page not empty after erase
  *     EEPROM_OK:          page blank
  */
uint16_t EE_CheckPage(uint32_t pageBase, uint16_t status)
{
    uint32_t pageEnd = pageBase + (uint32_t)PageSize;

    // Page Status not EEPROM_ERASED and not a "state"
    if ((*(__IO uint16_t*)pageBase) != EEPROM_ERASED && (*(__IO uint16_t*)pageBase) != status)
        return EEPROM_BAD_FLASH;
    for(pageBase += 4; pageBase < pageEnd; pageBase += 4)
        if ((*(__IO uint32_t*)pageBase) != 0xFFFFFFFF)  // Verify if slot is empty
            return EEPROM_BAD_FLASH;
    return EEPROM_OK;
}

/**
  * @brief  Erase page with increment erase counter (page + 2)
  * @param  page base address
  * @retval Success or error
  *         FLASH_COMPLETE: success erase
  *         - Flash error code: on write Flash error
  */
FLASH_Status EE_ErasePage(uint32_t pageBase)
{
    FLASH_Status FlashStatus;
    uint16_t data = (*(__IO uint16_t*)(pageBase));
    if ((data == EEPROM_ERASED) || (data == EEPROM_VALID_PAGE) || (data == EEPROM_RECEIVE_DATA))
        data = (*(__IO uint16_t*)(pageBase + 2)) + 1;
    else
        data = 0;

    FlashStatus = FLASH_ErasePage(pageBase);
    if (FlashStatus == FLASH_COMPLETE)
        FlashStatus = FLASH_ProgramHalfWord(pageBase + 2, data);

    return FlashStatus;
}

/**
  * @brief  Check page for blank and erase it
  * @param  page base address
  * @retval Success or error
  *         - Flash error code: on write Flash error
  *         - EEPROM_BAD_FLASH: page not empty after erase
  *         - EEPROM_OK:            page blank
  */
uint16_t EE_CheckErasePage(uint32_t pageBase, uint16_t status)
{
    uint16_t FlashStatus;
    if (EE_CheckPage(pageBase, status) != EEPROM_OK)
    {
        FlashStatus = EE_ErasePage(pageBase);
        if (FlashStatus != FLASH_COMPLETE)
            return FlashStatus;
        return EE_CheckPage(pageBase, status);
    }
    return EEPROM_OK;
}

/**
  * @brief  Find valid Page for write or read operation
  * @param  Page0: Page0 base address
  *         Page1: Page1 base address
  * @retval Valid page address (PAGE0 or PAGE1) or NULL in case of no valid page was found
  */
uint32_t EE_FindValidPage(void)
{
    uint16_t status0 = (*(__IO uint16_t*)PageBase0);        // Get Page0 actual status
    uint16_t status1 = (*(__IO uint16_t*)PageBase1);        // Get Page1 actual status

    if (status0 == EEPROM_VALID_PAGE && status1 == EEPROM_ERASED)
        return PageBase0;
    if (status1 == EEPROM_VALID_PAGE && status0 == EEPROM_ERASED)
        return PageBase1;

    return 0;
}

/**
  * @brief  Calculate unique variables in EEPROM
  * @param  start: address of first slot to check (page + 4)
  * @param  end: page end address
  * @param  address: 16 bit virtual address of the variable to excluse (or 0XFFFF)
  * @retval count of variables
  */
uint16_t EE_GetVariablesCount(uint32_t pageBase, uint16_t skipAddress)
{
    uint16_t varAddress, nextAddress;
    uint32_t idx;
    uint32_t pageEnd = pageBase + (uint32_t)PageSize;
    uint16_t count = 0;

    for (pageBase += 6; pageBase < pageEnd; pageBase += 4)
    {
        varAddress = (*(__IO uint16_t*)pageBase);
        if (varAddress == 0xFFFF || varAddress == skipAddress)
            continue;

        count++;
        for(idx = pageBase + 4; idx < pageEnd; idx += 4)
        {
            nextAddress = (*(__IO uint16_t*)idx);
            if (nextAddress == varAddress)
            {
                count--;
                break;
            }
        }
    }
    return count;
}

/**
  * @brief  Transfers last updated variables data from the full Page to an empty one.
  * @param  newPage: new page base address
  * @param  oldPage: old page base address
  * @param  SkipAddress: 16 bit virtual address of the variable (or 0xFFFF)
  * @retval Success or error status:
  *           - FLASH_COMPLETE: on success
  *           - EEPROM_OUT_SIZE: if valid new page is full
  *           - Flash error code: on write Flash error
  */
uint16_t EE_PageTransfer(uint32_t newPage, uint32_t oldPage, uint16_t SkipAddress)
{
    uint32_t oldEnd, newEnd;
    uint32_t oldIdx, newIdx, idx;
    uint16_t address, data, found;
    FLASH_Status FlashStatus;

    // Transfer process: transfer variables from old to the new active page
    newEnd = newPage + ((uint32_t)PageSize);

    // Find first free element in new page
    for (newIdx = newPage + 4; newIdx < newEnd; newIdx += 4)
        if ((*(__IO uint32_t*)newIdx) == 0xFFFFFFFF)    // Verify if element
            break;                                  //  contents are 0xFFFFFFFF
    if (newIdx >= newEnd)
        return EEPROM_OUT_SIZE;

    oldEnd = oldPage + 4;
    oldIdx = oldPage + (uint32_t)(PageSize - 2);

    for (; oldIdx > oldEnd; oldIdx -= 4)
    {
        address = *(__IO uint16_t*)oldIdx;
        if (address == 0xFFFF || address == SkipAddress)
            continue;                       // it's means that power off after write data

        found = 0;
        for (idx = newPage + 6; idx < newIdx; idx += 4)
            if ((*(__IO uint16_t*)(idx)) == address)
            {
                found = 1;
                break;
            }

        if (found)
            continue;

        if (newIdx < newEnd)
        {
            data = (*(__IO uint16_t*)(oldIdx - 2));

            FlashStatus = FLASH_ProgramHalfWord(newIdx, data);
            if (FlashStatus != FLASH_COMPLETE)
                return FlashStatus;

            FlashStatus = FLASH_ProgramHalfWord(newIdx + 2, address);
            if (FlashStatus != FLASH_COMPLETE)
                return FlashStatus;

            newIdx += 4;
        }
        else
            return EEPROM_OUT_SIZE;
    }

    // Erase the old Page: Set old Page status to EEPROM_EEPROM_ERASED status
    data = EE_CheckErasePage(oldPage, EEPROM_ERASED);
    if (data != EEPROM_OK)
        return data;

    // Set new Page status
    FlashStatus = FLASH_ProgramHalfWord(newPage, EEPROM_VALID_PAGE);
    if (FlashStatus != FLASH_COMPLETE)
        return FlashStatus;

    return EEPROM_OK;
}

/**
  * @brief  Verify if active page is full and Writes variable in EEPROM.
  * @param  Address: 16 bit virtual address of the variable
  * @param  Data: 16 bit data to be written as variable value
  * @retval Success or error status:
  *           - FLASH_COMPLETE: on success
  *           - EEPROM_PAGE_FULL: if valid page is full (need page transfer)
  *           - EEPROM_NO_VALID_PAGE: if no valid page was found
  *           - EEPROM_OUT_SIZE: if EEPROM size exceeded
  *           - Flash error code: on write Flash error
  */
uint16_t EE_VerifyPageFullWriteVariable(uint16_t Address, uint16_t Data)
{
    FLASH_Status FlashStatus;
    uint32_t idx, pageBase, pageEnd, newPage;
    uint16_t count;

    // Get valid Page for write operation
    pageBase = EE_FindValidPage();
    if (pageBase == 0)
        return  EEPROM_NO_VALID_PAGE;

    // Get the valid Page end Address
    pageEnd = pageBase + PageSize;          // Set end of page

    for (idx = pageEnd - 2; idx > pageBase; idx -= 4)
    {
        if ((*(__IO uint16_t*)idx) == Address)      // Find last value for address
        {
            count = (*(__IO uint16_t*)(idx - 2));   // Read last data
            if (count == Data)
                return EEPROM_OK;
            if (count == 0xFFFF)
            {
                FlashStatus = FLASH_ProgramHalfWord(idx - 2, Data); // Set variable data
                if (FlashStatus == FLASH_COMPLETE)
                    return EEPROM_OK;
            }
            break;
        }
    }

    // Check each active page address starting from begining
    for (idx = pageBase + 4; idx < pageEnd; idx += 4)
        if ((*(__IO uint32_t*)idx) == 0xFFFFFFFF)               // Verify if element
        {                                                   //  contents are 0xFFFFFFFF
            FlashStatus = FLASH_ProgramHalfWord(idx, Data); // Set variable data
            if (FlashStatus != FLASH_COMPLETE)
                return FlashStatus;
            FlashStatus = FLASH_ProgramHalfWord(idx + 2, Address);  // Set variable virtual address
            if (FlashStatus != FLASH_COMPLETE)
                return FlashStatus;
            return EEPROM_OK;
        }

    // Empty slot not found, need page transfer
    // Calculate unique variables in page
    count = EE_GetVariablesCount(pageBase, Address) + 1;
    if (count >= (PageSize / 4 - 1))
        return EEPROM_OUT_SIZE;

    if (pageBase == PageBase1)
        newPage = PageBase0;        // New page address where variable will be moved to
    else
        newPage = PageBase1;

    // Set the new Page status to RECEIVE_DATA status
    FlashStatus = FLASH_ProgramHalfWord(newPage, EEPROM_RECEIVE_DATA);
    if (FlashStatus != FLASH_COMPLETE)
        return FlashStatus;

    // Write the variable passed as parameter in the new active page
    FlashStatus = FLASH_ProgramHalfWord(newPage + 4, Data);
    if (FlashStatus != FLASH_COMPLETE)
        return FlashStatus;

    FlashStatus = FLASH_ProgramHalfWord(newPage + 6, Address);
    if (FlashStatus != FLASH_COMPLETE)
        return FlashStatus;

    return EE_PageTransfer(newPage, pageBase, Address);
}

/*EEPROMClass::EEPROMClass(void)
{
    PageBase0 = EEPROM_PAGE0_BASE;
    PageBase1 = EEPROM_PAGE1_BASE;
    PageSize = EEPROM_PAGE_SIZE;
    Status = EEPROM_NOT_INIT;
}*/
/*
uint16_t EEPROM_init(uint32_t pageBase0, uint32_t pageBase1, uint32_t pageSize)
{
    PageBase0 = pageBase0;
    PageBase1 = pageBase1;
    PageSize = pageSize;
    return EEPROM_init();
}*/

uint16_t EEPROM_init(void)
{
    uint16_t status0 = 6, status1 = 6;
    FLASH_Status FlashStatus;

    FLASH_Unlock();
    Status = EEPROM_NO_VALID_PAGE;

    status0 = (*(__IO uint16_t *)PageBase0);
    status1 = (*(__IO uint16_t *)PageBase1);

    switch (status0)
    {
/*
        Page0               Page1
        -----               -----
    EEPROM_ERASED       EEPROM_VALID_PAGE           Page1 valid, Page0 erased
                        EEPROM_RECEIVE_DATA         Page1 need set to valid, Page0 erased
                        EEPROM_ERASED               make EE_Format
                        any                         Error: EEPROM_NO_VALID_PAGE
*/
    case EEPROM_ERASED:
        if (status1 == EEPROM_VALID_PAGE)           // Page0 erased, Page1 valid
            Status = EE_CheckErasePage(PageBase0, EEPROM_ERASED);
        else if (status1 == EEPROM_RECEIVE_DATA)    // Page0 erased, Page1 receive
        {
            FlashStatus = FLASH_ProgramHalfWord(PageBase1, EEPROM_VALID_PAGE);
            if (FlashStatus != FLASH_COMPLETE)
                Status = FlashStatus;
            else
                Status = EE_CheckErasePage(PageBase0, EEPROM_ERASED);
        }
        else if (status1 == EEPROM_ERASED)          // Both in erased state so format EEPROM
            Status = EEPROM_format();
        break;
/*
        Page0               Page1
        -----               -----
    EEPROM_RECEIVE_DATA EEPROM_VALID_PAGE           Transfer Page1 to Page0
                        EEPROM_ERASED               Page0 need set to valid, Page1 erased
                        any                         EEPROM_NO_VALID_PAGE
*/
    case EEPROM_RECEIVE_DATA:
        if (status1 == EEPROM_VALID_PAGE)           // Page0 receive, Page1 valid
            Status = EE_PageTransfer(PageBase0, PageBase1, 0xFFFF);
        else if (status1 == EEPROM_ERASED)          // Page0 receive, Page1 erased
        {
            Status = EE_CheckErasePage(PageBase1, EEPROM_ERASED);
            if (Status == EEPROM_OK)
            {
                FlashStatus = FLASH_ProgramHalfWord(PageBase0, EEPROM_VALID_PAGE);
                if (FlashStatus != FLASH_COMPLETE)
                    Status = FlashStatus;
                else
                    Status = EEPROM_OK;
            }
        }
        break;
/*
        Page0               Page1
        -----               -----
    EEPROM_VALID_PAGE   EEPROM_VALID_PAGE           Error: EEPROM_NO_VALID_PAGE
                        EEPROM_RECEIVE_DATA         Transfer Page0 to Page1
                        any                         Page0 valid, Page1 erased
*/
    case EEPROM_VALID_PAGE:
        if (status1 == EEPROM_VALID_PAGE)           // Both pages valid
            Status = EEPROM_NO_VALID_PAGE;
        else if (status1 == EEPROM_RECEIVE_DATA)
            Status = EE_PageTransfer(PageBase1, PageBase0, 0xFFFF);
        else
            Status = EE_CheckErasePage(PageBase1, EEPROM_ERASED);
        break;
/*
        Page0               Page1
        -----               -----
        any             EEPROM_VALID_PAGE           Page1 valid, Page0 erased
                        EEPROM_RECEIVE_DATA         Page1 valid, Page0 erased
                        any                         EEPROM_NO_VALID_PAGE
*/
    default:
        if (status1 == EEPROM_VALID_PAGE)
            Status = EE_CheckErasePage(PageBase0, EEPROM_ERASED);   // Check/Erase Page0
        else if (status1 == EEPROM_RECEIVE_DATA)
        {
            FlashStatus = FLASH_ProgramHalfWord(PageBase1, EEPROM_VALID_PAGE);
            if (FlashStatus != FLASH_COMPLETE)
                Status = FlashStatus;
            else
                Status = EE_CheckErasePage(PageBase0, EEPROM_ERASED);
        }
        break;
    }
    return Status;
}

/**
  * @brief  Erases PAGE0 and PAGE1 and writes EEPROM_VALID_PAGE / 0 header to PAGE0
  * @param  PAGE0 and PAGE1 base addresses
  * @retval Status of the last operation (Flash write or erase) done during EEPROM formating
  */
uint16_t EEPROM_format(void)
{
    uint16_t status;
    FLASH_Status FlashStatus;

    FLASH_Unlock();

    // Erase Page0
    status = EE_CheckErasePage(PageBase0, EEPROM_VALID_PAGE);
    if (status != EEPROM_OK)
        return status;
    if ((*(__IO uint16_t*)PageBase0) == EEPROM_ERASED)
    {
        // Set Page0 as valid page: Write VALID_PAGE at Page0 base address
        FlashStatus = FLASH_ProgramHalfWord(PageBase0, EEPROM_VALID_PAGE);
        if (FlashStatus != FLASH_COMPLETE)
            return FlashStatus;
    }
    // Erase Page1
    return EE_CheckErasePage(PageBase1, EEPROM_ERASED);
}

/**
  * @brief  Returns the erase counter for current page
  * @param  Data: Global variable contains the read variable value
  * @retval Success or error status:
  *         - EEPROM_OK: if erases counter return.
  *         - EEPROM_NO_VALID_PAGE: if no valid page was found.
  */
uint16_t EEPROM_erases(uint16_t *Erases)
{
    uint32_t pageBase;
    if (Status != EEPROM_OK)
        if (EEPROM_init() != EEPROM_OK)
            return Status;

    // Get active Page for read operation
    pageBase = EE_FindValidPage();
    if (pageBase == 0)
        return  EEPROM_NO_VALID_PAGE;

    *Erases = (*(__IO uint16_t*)pageBase+2);
    return EEPROM_OK;
}

/**
  * @brief  Returns the last stored variable data, if found,
  *         which correspond to the passed virtual address
  * @param  Address: Variable virtual address
  * @retval Data for variable or EEPROM_DEFAULT_DATA, if any errors
  */
/*
uint16_t EEPROM_read (uint16_t Address)
{
    uint16_t data;
    EEPROM_read(Address, &data);
    return data;
}*/

/**
  * @brief  Returns the last stored variable data, if found,
  *         which correspond to the passed virtual address
  * @param  Address: Variable virtual address
  * @param  Data: Pointer to data variable
  * @retval Success or error status:
  *           - EEPROM_OK: if variable was found
  *           - EEPROM_BAD_ADDRESS: if the variable was not found
  *           - EEPROM_NO_VALID_PAGE: if no valid page was found.
  */
uint16_t EEPROM_read(uint16_t Address, uint16_t *Data)
{
    uint32_t pageBase, pageEnd;

    // Set default data (empty EEPROM)
    *Data = EEPROM_DEFAULT_DATA;

    if (Status == EEPROM_NOT_INIT)
        if (EEPROM_init() != EEPROM_OK)
            return Status;

    // Get active Page for read operation
    pageBase = EE_FindValidPage();
    if (pageBase == 0)
        return  EEPROM_NO_VALID_PAGE;

    // Get the valid Page end Address
    pageEnd = pageBase + ((uint32_t)(PageSize - 2));

    // Check each active page address starting from end
    for (pageBase += 6; pageEnd >= pageBase; pageEnd -= 4)
        if ((*(__IO uint16_t*)pageEnd) == Address)      // Compare the read address with the virtual address
        {
            *Data = (*(__IO uint16_t*)(pageEnd - 2));       // Get content of Address-2 which is variable value
            return EEPROM_OK;
        }

    // Return ReadStatus value: (0: variable exist, 1: variable doesn't exist)
    return EEPROM_BAD_ADDRESS;
}

/**
  * @brief  Writes/upadtes variable data in EEPROM.
  * @param  VirtAddress: Variable virtual address
  * @param  Data: 16 bit data to be written
  * @retval Success or error status:
  *         - FLASH_COMPLETE: on success
  *         - EEPROM_BAD_ADDRESS: if address = 0xFFFF
  *         - EEPROM_PAGE_FULL: if valid page is full
  *         - EEPROM_NO_VALID_PAGE: if no valid page was found
  *         - EEPROM_OUT_SIZE: if no empty EEPROM variables
  *         - Flash error code: on write Flash error
  */
uint16_t EEPROM_write(uint16_t Address, uint16_t Data)
{
    if (Status == EEPROM_NOT_INIT)
        if (EEPROM_init() != EEPROM_OK)
            return Status;

    if (Address == 0xFFFF)
        return EEPROM_BAD_ADDRESS;

    // Write the variable virtual address and value in the EEPROM
    uint16_t status = EE_VerifyPageFullWriteVariable(Address, Data);
    return status;
}

/**
  * @brief  Writes/upadtes variable data in EEPROM.
            The value is written only if differs from the one already saved at the same address.
  * @param  VirtAddress: Variable virtual address
  * @param  Data: 16 bit data to be written
  * @retval Success or error status:
  *         - EEPROM_SAME_VALUE: If new Data matches existing EEPROM Data
  *         - FLASH_COMPLETE: on success
  *         - EEPROM_BAD_ADDRESS: if address = 0xFFFF
  *         - EEPROM_PAGE_FULL: if valid page is full
  *         - EEPROM_NO_VALID_PAGE: if no valid page was found
  *         - EEPROM_OUT_SIZE: if no empty EEPROM variables
  *         - Flash error code: on write Flash error
  */
uint16_t EEPROM_update(uint16_t Address, uint16_t Data)
{
    uint16_t temp;
    EEPROM_read(Address, &temp);
    if (temp == Data)
        return EEPROM_SAME_VALUE;
    else
        return EEPROM_write(Address, Data);
}

/**
  * @brief  Return number of variable
  * @retval Number of variables
  */
uint16_t EEPROM_count(uint16_t *Count)
{
    if (Status == EEPROM_NOT_INIT)
        if (EEPROM_init() != EEPROM_OK)
            return Status;

    // Get valid Page for write operation
    uint32_t pageBase = EE_FindValidPage();
    if (pageBase == 0)
        return EEPROM_NO_VALID_PAGE;    // No valid page, return max. numbers

    *Count = EE_GetVariablesCount(pageBase, 0xFFFF);
    return EEPROM_OK;
}

uint16_t EEPROM_maxcount(void)
{
    return ((PageSize / 4)-1);
}


uint8_t eeprom_read_byte (const uint8_t *Address)
{
    const uint16_t p = (const uint32_t) Address;
    uint16_t temp;
    EEPROM_read(p, &temp);
    return (uint8_t) temp;
}

void eeprom_write_byte (uint8_t *Address, uint8_t Value)
{
    uint16_t p = (uint32_t) Address;
    EEPROM_write(p, (uint16_t) Value);
}

void eeprom_update_byte (uint8_t *Address, uint8_t Value)
{
    uint16_t p = (uint32_t) Address;
    EEPROM_update(p, (uint16_t) Value);
}

uint16_t eeprom_read_word (const uint16_t *Address)
{
    const uint16_t p = (const uint32_t) Address;
    uint16_t temp;
    EEPROM_read(p, &temp);
    return temp;
}

void eeprom_write_word (uint16_t *Address, uint16_t Value)
{
    uint16_t p = (uint32_t) Address;
    EEPROM_write(p, Value);
}

void eeprom_update_word (uint16_t *Address, uint16_t Value)
{
    uint16_t p = (uint32_t) Address;
    EEPROM_update(p, Value);
}

uint32_t eeprom_read_dword (const uint32_t *Address)
{
    const uint16_t p = (const uint32_t) Address;
    uint16_t temp1, temp2;
    EEPROM_read(p, &temp1);
    EEPROM_read(p + 1, &temp2);
    return temp1 | (temp2 << 16);
}

void eeprom_write_dword (uint32_t *Address, uint32_t Value)
{
    uint16_t temp = (uint16_t) Value;
    uint16_t p = (uint32_t) Address;
    EEPROM_write(p, temp);
    temp = (uint16_t) (Value >> 16);
    EEPROM_write(p + 1, temp);
}

void eeprom_update_dword (uint32_t *Address, uint32_t Value)
{
    uint16_t temp = (uint16_t) Value;
    uint16_t p = (uint32_t) Address;
    EEPROM_update(p, temp);
    temp = (uint16_t) (Value >> 16);
    EEPROM_update(p + 1, temp);
}