blob: 45cd3fa0d3c4fdcb6db5192988749538b7a52ff7 (
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
|
/*
* fsm-eeprom.c: EEPROM API for SpaghettiMonster.
*
* Copyright (C) 2017 Selene ToyKeeper
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>.
*/
#ifndef FSM_EEPROM_C
#define FSM_EEPROM_C
#include "fsm-eeprom.h"
#if EEPROM_BYTES > 0
uint8_t eeprom[EEPROM_BYTES];
uint8_t load_eeprom() {
cli();
// check if eeprom has been initialized; abort if it hasn't
uint8_t marker = eeprom_read_byte((uint8_t *)EEP_START);
if (marker != EEP_MARKER) { sei(); return 0; }
// load the actual data
for(uint8_t i=0; i<EEPROM_BYTES; i++) {
eeprom[i] = eeprom_read_byte((uint8_t *)(EEP_START+1+i));
}
sei();
return 1;
}
void save_eeprom() {
cli();
eeprom_update_byte((uint8_t *)EEP_START, EEP_MARKER);
// save the actual data
for(uint8_t i=0; i<EEPROM_BYTES; i++) {
eeprom_update_byte((uint8_t *)(EEP_START+1+i), eeprom[i]);
}
sei();
}
#endif
#if EEPROM_WL_BYTES > 0
uint8_t eeprom_wl[EEPROM_WL_BYTES];
EEP_OFFSET_T eep_wl_prev_offset;
uint8_t load_eeprom_wl() {
cli();
// check if eeprom has been initialized; abort if it hasn't
uint8_t found = 0;
EEP_OFFSET_T offset;
for(offset = 0;
offset < EEP_WL_SIZE - EEPROM_WL_BYTES - 1;
offset += (EEPROM_WL_BYTES + 1)) {
if (eeprom_read_byte((uint8_t *)offset) == EEP_MARKER) {
found = 1;
eep_wl_prev_offset = offset;
break;
}
}
if (found) {
// load the actual data
for(uint8_t i=0; i<EEPROM_WL_BYTES; i++) {
eeprom_wl[i] = eeprom_read_byte((uint8_t *)(offset+1+i));
}
}
sei();
return found;
}
void save_eeprom_wl() {
cli();
// erase old state
EEP_OFFSET_T offset = eep_wl_prev_offset;
for (uint8_t i = 0; i < EEPROM_WL_BYTES+1; i ++) {
eeprom_update_byte((uint8_t *)offset+i, 0xFF);
}
// save new state
offset += EEPROM_WL_BYTES+1;
if (offset > EEP_WL_SIZE-EEPROM_WL_BYTES-1) offset = 0;
eep_wl_prev_offset = offset;
// marker byte
eeprom_update_byte((uint8_t *)offset, EEP_MARKER);
offset ++;
// user data
for(uint8_t i=0; i<EEPROM_WL_BYTES; i++, offset++) {
eeprom_update_byte((uint8_t *)(offset), eeprom_wl[i]);
}
sei();
}
#endif
#endif
|
