|
30 | 30 | #include "common-hal/alarm/SleepMemory.h"
|
31 | 31 | #include "shared-bindings/alarm/SleepMemory.h"
|
32 | 32 |
|
| 33 | +__attribute__((section(".uninitialized"))) static uint8_t _sleepmem[SLEEP_MEMORY_LENGTH]; |
| 34 | +__attribute__((section(".uninitialized"))) static uint32_t _sleepmem_magicnum; |
| 35 | +#define SLEEP_MEMORY_DATA_GUARD 0xad0000af |
| 36 | +#define SLEEP_MEMORY_DATA_GUARD_MASK 0xff0000ff |
| 37 | + |
| 38 | +static int is_sleep_memory_valid(void) { |
| 39 | + if ((_sleepmem_magicnum & SLEEP_MEMORY_DATA_GUARD_MASK) |
| 40 | + == SLEEP_MEMORY_DATA_GUARD) { |
| 41 | + return 1; |
| 42 | + } |
| 43 | + return 0; |
| 44 | +} |
| 45 | + |
| 46 | +static void initialize_sleep_memory(void) { |
| 47 | + memset((uint8_t *)_sleepmem, 0, SLEEP_MEMORY_LENGTH); |
| 48 | + |
| 49 | + _sleepmem_magicnum = SLEEP_MEMORY_DATA_GUARD; |
| 50 | +} |
| 51 | + |
33 | 52 | void alarm_sleep_memory_reset(void) {
|
| 53 | + if (!is_sleep_memory_valid()) { |
| 54 | + initialize_sleep_memory(); |
| 55 | + } |
34 | 56 | }
|
35 | 57 |
|
36 | 58 | uint32_t common_hal_alarm_sleep_memory_get_length(alarm_sleep_memory_obj_t *self) {
|
37 |
| - return 0; |
| 59 | + return sizeof(_sleepmem); |
38 | 60 | }
|
39 | 61 |
|
40 | 62 | bool common_hal_alarm_sleep_memory_set_bytes(alarm_sleep_memory_obj_t *self, uint32_t start_index, const uint8_t *values, uint32_t len) {
|
41 |
| - mp_raise_NotImplementedError(translate("Sleep Memory not available")); |
42 |
| - return false; |
| 63 | + if (start_index + len > sizeof(_sleepmem)) { |
| 64 | + return false; |
| 65 | + } |
| 66 | + |
| 67 | + memcpy((uint8_t *)(_sleepmem + start_index), values, len); |
| 68 | + return true; |
43 | 69 | }
|
44 | 70 |
|
45 | 71 | void common_hal_alarm_sleep_memory_get_bytes(alarm_sleep_memory_obj_t *self, uint32_t start_index, uint8_t *values, uint32_t len) {
|
46 |
| - mp_raise_NotImplementedError(translate("Sleep Memory not available")); |
| 72 | + if (start_index + len > sizeof(_sleepmem)) { |
| 73 | + return; |
| 74 | + } |
| 75 | + memcpy(values, (uint8_t *)(_sleepmem + start_index), len); |
47 | 76 | }
|
0 commit comments