blob: 8f8bd67859873fe28a2d09f3578da71a8001e39f (
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
|
// fsm-eeprom.c: EEPROM API for SpaghettiMonster.
// Copyright (C) 2017-2023 Selene ToyKeeper
// SPDX-License-Identifier: GPL-3.0-or-later
#pragma once
#include "fsm/eeprom.h"
#ifdef USE_EEPROM
#ifdef EEPROM_OVERRIDE
uint8_t *eeprom;
#else
uint8_t eeprom[EEPROM_BYTES];
#endif
uint8_t load_eeprom() {
#if defined(LED_ENABLE_PIN) || defined(LED2_ENABLE_PIN)
delay_4ms(2); // wait for power to stabilize
#endif
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() {
#if defined(LED_ENABLE_PIN) || defined(LED2_ENABLE_PIN)
delay_4ms(2); // wait for power to stabilize
#endif
cli();
// save the actual data
for(uint8_t i=0; i<EEPROM_BYTES; i++) {
eeprom_update_byte((uint8_t *)(EEP_START+1+i), eeprom[i]);
}
// save the marker last, to indicate the transaction is complete
eeprom_update_byte((uint8_t *)EEP_START, EEP_MARKER);
sei();
}
#endif
#ifdef USE_EEPROM_WL
uint8_t eeprom_wl[EEPROM_WL_BYTES];
uint8_t * eep_wl_prev_offset;
uint8_t load_eeprom_wl() {
#if defined(LED_ENABLE_PIN) || defined(LED2_ENABLE_PIN)
delay_4ms(2); // wait for power to stabilize
#endif
cli();
// check if eeprom has been initialized; abort if it hasn't
uint8_t found = 0;
uint8_t * offset;
for(offset = 0;
offset < (uint8_t *)(EEP_WL_SIZE - EEPROM_WL_BYTES - 1);
offset += (EEPROM_WL_BYTES + 1)) {
if (eeprom_read_byte(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(offset+1+i);
}
}
sei();
return found;
}
void save_eeprom_wl() {
#if defined(LED_ENABLE_PIN) || defined(LED2_ENABLE_PIN)
delay_4ms(2); // wait for power to stabilize
#endif
cli();
// erase old state
uint8_t * offset = eep_wl_prev_offset;
for (uint8_t i = 0; i < EEPROM_WL_BYTES+1; i ++) {
eeprom_update_byte(offset+i, 0xFF);
}
// save new state
offset += EEPROM_WL_BYTES+1;
if (offset > (uint8_t *)(EEP_WL_SIZE-EEPROM_WL_BYTES-1)) offset = 0;
eep_wl_prev_offset = offset;
// marker byte
// FIXME: write the marker last, to signal completed transaction
eeprom_update_byte(offset, EEP_MARKER);
offset ++;
// user data
for(uint8_t i=0; i<EEPROM_WL_BYTES; i++, offset++) {
eeprom_update_byte(offset, eeprom_wl[i]);
}
sei();
}
#endif
|
