2020-07-14 20:54:14 +02:00
|
|
|
// Copyright 2020 Lukas Haubaum
|
|
|
|
//
|
|
|
|
// Licensed under the GNU Affero General Public License, Version 3;
|
|
|
|
// you may not use this file except in compliance with the License.
|
|
|
|
// You may obtain a copy of the License at
|
|
|
|
|
|
|
|
// https://www.gnu.org/licenses/agpl-3.0.html
|
|
|
|
//
|
|
|
|
// Unless required by applicable law or agreed to in writing, software
|
|
|
|
// distributed under the License is distributed on an "AS IS" BASIS,
|
|
|
|
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
|
|
// See the License for the specific language governing permissions and
|
|
|
|
// limitations under the License.
|
2020-07-11 12:11:34 +02:00
|
|
|
#include <string.h>
|
|
|
|
#include "freertos/FreeRTOS.h"
|
|
|
|
#include "freertos/task.h"
|
|
|
|
#include "esp_log.h"
|
2020-07-15 22:22:54 +02:00
|
|
|
#include "esp_partition.h"
|
2020-07-11 12:11:34 +02:00
|
|
|
|
|
|
|
#include "ena-storage.h"
|
|
|
|
#include "ena-crypto.h"
|
|
|
|
|
2020-07-13 20:32:53 +02:00
|
|
|
#define BLOCK_SIZE (4096)
|
2020-07-11 12:11:34 +02:00
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
const int ENA_STORAGE_TEK_COUNT_ADDRESS = (ENA_STORAGE_START_ADDRESS); // starting address for TEK COUNT
|
2020-07-14 20:54:14 +02:00
|
|
|
const int ENA_STORAGE_TEK_START_ADDRESS = (ENA_STORAGE_TEK_COUNT_ADDRESS + sizeof(uint32_t));
|
2020-07-15 22:22:54 +02:00
|
|
|
const int ENA_STORAGE_TEMP_BEACONS_COUNT_ADDRESS = (ENA_STORAGE_TEK_START_ADDRESS + sizeof(ena_tek_t) * ENA_STORAGE_TEK_MAX);
|
|
|
|
const int ENA_STORAGE_TEMP_BEACONS_START_ADDRESS = (ENA_STORAGE_TEMP_BEACONS_COUNT_ADDRESS + sizeof(uint32_t));
|
|
|
|
const int ENA_STORAGE_BEACONS_COUNT_ADDRESS = (ENA_STORAGE_TEMP_BEACONS_START_ADDRESS + sizeof(ena_temp_beacon_t) * ENA_STORAGE_TEMP_BEACONS_MAX);
|
|
|
|
const int ENA_STORAGE_BEACONS_START_ADDRESS = (ENA_STORAGE_BEACONS_COUNT_ADDRESS + sizeof(uint32_t));
|
2020-07-13 20:32:53 +02:00
|
|
|
|
|
|
|
void ena_storage_read(size_t address, void *data, size_t size)
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "START ena_storage_read");
|
|
|
|
const esp_partition_t *partition = esp_partition_find_first(
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_PARTITION_TYPE_DATA, ESP_PARTITION_SUBTYPE_ANY, ENA_STORAGE_PARTITION_NAME);
|
2020-07-11 12:11:34 +02:00
|
|
|
assert(partition);
|
|
|
|
ESP_ERROR_CHECK(esp_partition_read(partition, address, data, size));
|
|
|
|
vTaskDelay(1);
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "read data at %u", address);
|
|
|
|
ESP_LOG_BUFFER_HEXDUMP(ENA_STORAGE_LOG, data, size, ESP_LOG_DEBUG);
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "END ena_storage_read");
|
|
|
|
}
|
|
|
|
|
2020-07-13 20:32:53 +02:00
|
|
|
void ena_storage_write(size_t address, void *data, size_t size)
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "START ena_storage_write");
|
|
|
|
const int block_num = address / BLOCK_SIZE;
|
2020-07-13 20:32:53 +02:00
|
|
|
// check for overflow
|
|
|
|
if (address + size <= (block_num + 1) * BLOCK_SIZE)
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
2020-07-13 20:32:53 +02:00
|
|
|
const esp_partition_t *partition = esp_partition_find_first(
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_PARTITION_TYPE_DATA, ESP_PARTITION_SUBTYPE_ANY, ENA_STORAGE_PARTITION_NAME);
|
2020-07-13 20:32:53 +02:00
|
|
|
assert(partition);
|
2020-07-11 12:11:34 +02:00
|
|
|
const int block_start = block_num * BLOCK_SIZE;
|
|
|
|
const int block_address = address - block_start;
|
2020-07-13 20:32:53 +02:00
|
|
|
void *buffer = malloc(BLOCK_SIZE);
|
2020-07-11 12:11:34 +02:00
|
|
|
if (buffer == NULL)
|
|
|
|
{
|
|
|
|
ESP_LOGE(ENA_STORAGE_LOG, "Warning %s malloc low memory", "buffer");
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "read block %d buffer: start %d size %u", block_num, block_start, BLOCK_SIZE);
|
|
|
|
ESP_ERROR_CHECK(esp_partition_read(partition, block_start, buffer, BLOCK_SIZE));
|
|
|
|
vTaskDelay(1);
|
|
|
|
ESP_ERROR_CHECK(esp_partition_erase_range(partition, block_start, BLOCK_SIZE));
|
|
|
|
|
2020-07-13 20:32:53 +02:00
|
|
|
memcpy((buffer + block_address), data, size);
|
2020-07-12 14:14:06 +02:00
|
|
|
|
2020-07-11 12:11:34 +02:00
|
|
|
ESP_ERROR_CHECK(esp_partition_write(partition, block_start, buffer, BLOCK_SIZE));
|
|
|
|
free(buffer);
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "write data at %u", address);
|
|
|
|
ESP_LOG_BUFFER_HEXDUMP(ENA_STORAGE_LOG, data, size, ESP_LOG_DEBUG);
|
|
|
|
}
|
2020-07-13 20:32:53 +02:00
|
|
|
else
|
|
|
|
{
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "overflow block at address %u with size %d (block %d)", address, size, block_num);
|
|
|
|
const size_t block2_address = (block_num + 1) * BLOCK_SIZE;
|
|
|
|
const size_t data2_size = address + size - block2_address;
|
|
|
|
const size_t data1_size = size - data2_size;
|
2020-07-14 20:54:14 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "block1_address %d, block1_size %d (block %d)", address, data1_size, block_num);
|
2020-07-13 20:32:53 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "block2_address %d, block2_size %d (block %d)", block2_address, data2_size, block_num + 1);
|
|
|
|
void *data1 = malloc(data1_size);
|
|
|
|
memcpy(data1, data, data1_size);
|
2020-07-14 20:54:14 +02:00
|
|
|
ena_storage_write(address, data1, data1_size);
|
2020-07-13 20:32:53 +02:00
|
|
|
free(data1);
|
|
|
|
|
|
|
|
void *data2 = malloc(data2_size);
|
|
|
|
memcpy(data2, (data + data1_size), data2_size);
|
|
|
|
ena_storage_write(block2_address, data2, data2_size);
|
|
|
|
free(data2);
|
|
|
|
}
|
2020-07-11 12:11:34 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "END ena_storage_write");
|
|
|
|
}
|
|
|
|
|
2020-07-12 14:14:06 +02:00
|
|
|
void ena_storage_shift_delete(size_t address, size_t end_address, size_t size)
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "START ena_storage_shift_delete");
|
|
|
|
|
2020-07-12 14:14:06 +02:00
|
|
|
int block_num_start = address / BLOCK_SIZE;
|
2020-07-13 20:32:53 +02:00
|
|
|
// check for overflow
|
2020-07-14 20:54:14 +02:00
|
|
|
if (address + size <= (block_num_start + 1) * BLOCK_SIZE)
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
2020-07-12 14:14:06 +02:00
|
|
|
const esp_partition_t *partition = esp_partition_find_first(
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_PARTITION_TYPE_DATA, ESP_PARTITION_SUBTYPE_ANY, ENA_STORAGE_PARTITION_NAME);
|
2020-07-12 14:14:06 +02:00
|
|
|
assert(partition);
|
2020-07-11 12:11:34 +02:00
|
|
|
|
2020-07-12 14:14:06 +02:00
|
|
|
int block_num_end = end_address / BLOCK_SIZE;
|
|
|
|
size_t block_start = address - block_num_start * BLOCK_SIZE;
|
|
|
|
while (block_num_end >= block_num_start)
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
2020-07-12 14:14:06 +02:00
|
|
|
|
2020-07-13 20:32:53 +02:00
|
|
|
void *buffer = malloc(BLOCK_SIZE);
|
2020-07-12 14:14:06 +02:00
|
|
|
ESP_ERROR_CHECK(esp_partition_read(partition, block_num_start * BLOCK_SIZE, buffer, BLOCK_SIZE));
|
|
|
|
vTaskDelay(1);
|
|
|
|
// shift inside buffer
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "shift block %d from %u to %u with size %u", block_num_start, (block_start + size), block_start, (BLOCK_SIZE - block_start - size));
|
2020-07-13 20:32:53 +02:00
|
|
|
memcpy((buffer + block_start), (buffer + block_start + size), BLOCK_SIZE - block_start - size);
|
2020-07-12 14:14:06 +02:00
|
|
|
if (block_num_end > block_num_start)
|
|
|
|
{
|
2020-07-13 20:32:53 +02:00
|
|
|
void *buffer_next_block = malloc(BLOCK_SIZE);
|
2020-07-12 14:14:06 +02:00
|
|
|
|
|
|
|
ESP_ERROR_CHECK(esp_partition_read(partition, (block_num_start + 1) * BLOCK_SIZE, buffer_next_block, BLOCK_SIZE));
|
|
|
|
vTaskDelay(1);
|
|
|
|
// shift from next block
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "shift next block size %u", size);
|
2020-07-13 20:32:53 +02:00
|
|
|
memcpy((buffer + BLOCK_SIZE - size), buffer_next_block, size);
|
2020-07-12 14:14:06 +02:00
|
|
|
free(buffer_next_block);
|
|
|
|
}
|
|
|
|
|
|
|
|
ESP_ERROR_CHECK(esp_partition_erase_range(partition, block_num_start * BLOCK_SIZE, BLOCK_SIZE));
|
|
|
|
ESP_ERROR_CHECK(esp_partition_write(partition, block_num_start * BLOCK_SIZE, buffer, BLOCK_SIZE));
|
|
|
|
free(buffer);
|
|
|
|
|
|
|
|
block_num_start++;
|
|
|
|
block_start = 0;
|
2020-07-11 12:11:34 +02:00
|
|
|
}
|
|
|
|
}
|
2020-07-13 20:32:53 +02:00
|
|
|
else
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
2020-07-13 20:32:53 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "overflow block at address %u with size %d (block %d)", address, size, block_num_start);
|
|
|
|
const size_t block1_address = address;
|
|
|
|
const size_t block2_address = (block_num_start + 1) * BLOCK_SIZE;
|
|
|
|
const size_t data2_size = address + size - block2_address;
|
|
|
|
const size_t data1_size = size - data2_size;
|
2020-07-14 20:54:14 +02:00
|
|
|
ena_storage_shift_delete(block1_address, block2_address, data1_size);
|
2020-07-13 20:32:53 +02:00
|
|
|
ena_storage_shift_delete(block2_address, end_address - data1_size, data2_size);
|
2020-07-11 12:11:34 +02:00
|
|
|
}
|
2020-07-13 20:32:53 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "END ena_storage_shift_delete");
|
2020-07-11 12:11:34 +02:00
|
|
|
}
|
|
|
|
|
2020-07-14 20:54:14 +02:00
|
|
|
uint32_t ena_storage_read_last_tek(ena_tek_t *tek)
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
2020-07-13 20:32:53 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "START ena_storage_read_tek");
|
2020-07-14 20:54:14 +02:00
|
|
|
uint32_t tek_count = 0;
|
|
|
|
ena_storage_read(ENA_STORAGE_TEK_COUNT_ADDRESS, &tek_count, sizeof(uint32_t));
|
2020-07-11 12:11:34 +02:00
|
|
|
if (tek_count < 1)
|
|
|
|
{
|
|
|
|
return 0;
|
|
|
|
}
|
2020-07-15 22:22:54 +02:00
|
|
|
uint8_t index = (tek_count % ENA_STORAGE_TEK_MAX) - 1;
|
2020-07-14 20:54:14 +02:00
|
|
|
ena_storage_read(ENA_STORAGE_TEK_START_ADDRESS + index * sizeof(ena_tek_t), tek, sizeof(ena_tek_t));
|
2020-07-11 12:11:34 +02:00
|
|
|
|
2020-07-13 20:32:53 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "read last tek %u:", tek->enin);
|
|
|
|
ESP_LOG_BUFFER_HEXDUMP(ENA_STORAGE_LOG, tek->key_data, ENA_KEY_LENGTH, ESP_LOG_DEBUG);
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "END ena_storage_read_tek");
|
|
|
|
return tek_count;
|
2020-07-11 12:11:34 +02:00
|
|
|
}
|
|
|
|
|
2020-07-13 20:32:53 +02:00
|
|
|
void ena_storage_write_tek(ena_tek_t *tek)
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
2020-07-13 20:32:53 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "START ena_storage_write_tek");
|
|
|
|
|
2020-07-14 20:54:14 +02:00
|
|
|
uint32_t tek_count = 0;
|
|
|
|
ena_storage_read(ENA_STORAGE_TEK_COUNT_ADDRESS, &tek_count, sizeof(uint32_t));
|
2020-07-15 22:22:54 +02:00
|
|
|
uint8_t index = (tek_count % ENA_STORAGE_TEK_MAX);
|
2020-07-14 20:54:14 +02:00
|
|
|
ena_storage_write(ENA_STORAGE_TEK_START_ADDRESS + index * sizeof(ena_tek_t), tek, sizeof(ena_tek_t));
|
2020-07-13 20:32:53 +02:00
|
|
|
|
|
|
|
tek_count++;
|
2020-07-14 20:54:14 +02:00
|
|
|
ena_storage_write(ENA_STORAGE_TEK_COUNT_ADDRESS, &tek_count, sizeof(uint32_t));
|
2020-07-11 12:11:34 +02:00
|
|
|
|
2020-07-13 20:32:53 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "write tek: ENIN %u", tek->enin);
|
|
|
|
ESP_LOG_BUFFER_HEXDUMP(ENA_STORAGE_LOG, tek->key_data, ENA_KEY_LENGTH, ESP_LOG_DEBUG);
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "END ena_storage_write_tek");
|
2020-07-11 12:11:34 +02:00
|
|
|
}
|
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
uint32_t ena_storage_temp_beacons_count(void)
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "START ena_storage_temp_beacons_count");
|
2020-07-13 20:32:53 +02:00
|
|
|
uint32_t count = 0;
|
2020-07-15 22:22:54 +02:00
|
|
|
ena_storage_read(ENA_STORAGE_TEMP_BEACONS_COUNT_ADDRESS, &count, sizeof(uint32_t));
|
2020-07-11 12:11:34 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "read temp contancts count: %u", count);
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "END ena_storage_temp_beacons_count");
|
2020-07-11 12:11:34 +02:00
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
void ena_storage_get_temp_beacon(uint32_t index, ena_temp_beacon_t *beacon)
|
2020-07-13 20:32:53 +02:00
|
|
|
{
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "START ena_storage_read_temp_beacon");
|
|
|
|
ena_storage_read(ENA_STORAGE_TEMP_BEACONS_START_ADDRESS + index * sizeof(ena_temp_beacon_t), beacon, sizeof(ena_temp_beacon_t));
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "read temp beacon: first %u, last %u and rssi %d", beacon->timestamp_first, beacon->timestamp_last, beacon->rssi);
|
|
|
|
ESP_LOG_BUFFER_HEXDUMP(ENA_STORAGE_LOG, beacon->rpi, ENA_KEY_LENGTH, ESP_LOG_DEBUG);
|
|
|
|
ESP_LOG_BUFFER_HEXDUMP(ENA_STORAGE_LOG, beacon->aem, ENA_AEM_METADATA_LENGTH, ESP_LOG_DEBUG);
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "END ena_storage_read_temp_beacon");
|
2020-07-13 20:32:53 +02:00
|
|
|
}
|
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
uint32_t ena_storage_add_temp_beacon(ena_temp_beacon_t *beacon)
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "START ena_storage_add_temp_beacon");
|
|
|
|
uint32_t count = ena_storage_temp_beacons_count();
|
|
|
|
// overwrite older temporary beacons?!
|
|
|
|
uint8_t index = count % ENA_STORAGE_TEMP_BEACONS_MAX;
|
|
|
|
ena_storage_set_temp_beacon(index, beacon);
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "add temp beacon at %u: first %u, last %u and rssi %d", index, beacon->timestamp_first, beacon->timestamp_last, beacon->rssi);
|
|
|
|
ESP_LOG_BUFFER_HEXDUMP(ENA_STORAGE_LOG, beacon->rpi, ENA_KEY_LENGTH, ESP_LOG_DEBUG);
|
|
|
|
ESP_LOG_BUFFER_HEXDUMP(ENA_STORAGE_LOG, beacon->aem, ENA_AEM_METADATA_LENGTH, ESP_LOG_DEBUG);
|
2020-07-13 20:32:53 +02:00
|
|
|
count++;
|
2020-07-15 22:22:54 +02:00
|
|
|
ena_storage_write(ENA_STORAGE_TEMP_BEACONS_COUNT_ADDRESS, &count, sizeof(uint32_t));
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "END ena_storage_add_temp_beacon");
|
2020-07-14 20:54:14 +02:00
|
|
|
return count - 1;
|
|
|
|
}
|
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
void ena_storage_set_temp_beacon(uint32_t index, ena_temp_beacon_t *beacon)
|
2020-07-14 20:54:14 +02:00
|
|
|
{
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "START ena_storage_set_temp_beacon");
|
|
|
|
ena_storage_write(ENA_STORAGE_TEMP_BEACONS_START_ADDRESS + index * sizeof(ena_temp_beacon_t), beacon, sizeof(ena_temp_beacon_t));
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "set temp beacon at %u: first %u, last %u and rssi %d", index, beacon->timestamp_first, beacon->timestamp_last, beacon->rssi);
|
|
|
|
ESP_LOG_BUFFER_HEXDUMP(ENA_STORAGE_LOG, beacon->rpi, ENA_KEY_LENGTH, ESP_LOG_DEBUG);
|
|
|
|
ESP_LOG_BUFFER_HEXDUMP(ENA_STORAGE_LOG, beacon->aem, ENA_AEM_METADATA_LENGTH, ESP_LOG_DEBUG);
|
2020-07-11 12:11:34 +02:00
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "END ena_storage_set_temp_beacon");
|
2020-07-11 12:11:34 +02:00
|
|
|
}
|
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
void ena_storage_remove_temp_beacon(uint32_t index)
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "START ena_storage_remove_temp_beacon");
|
|
|
|
uint32_t count = ena_storage_temp_beacons_count();
|
|
|
|
size_t address_from = ENA_STORAGE_TEMP_BEACONS_START_ADDRESS + index * sizeof(ena_temp_beacon_t);
|
|
|
|
size_t address_to = ENA_STORAGE_TEMP_BEACONS_START_ADDRESS + count * sizeof(ena_temp_beacon_t);
|
2020-07-13 20:32:53 +02:00
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
ena_storage_shift_delete(address_from, address_to, sizeof(ena_temp_beacon_t));
|
2020-07-12 14:14:06 +02:00
|
|
|
|
2020-07-11 12:11:34 +02:00
|
|
|
count--;
|
2020-07-15 22:22:54 +02:00
|
|
|
ena_storage_write(ENA_STORAGE_TEMP_BEACONS_COUNT_ADDRESS, &count, sizeof(uint32_t));
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "remove temp beacon: %u", index);
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "END ena_storage_remove_temp_beacon");
|
2020-07-11 12:11:34 +02:00
|
|
|
}
|
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
uint32_t ena_storage_beacons_count(void)
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "START ena_storage_beacons_count");
|
2020-07-13 20:32:53 +02:00
|
|
|
uint32_t count = 0;
|
2020-07-15 22:22:54 +02:00
|
|
|
ena_storage_read(ENA_STORAGE_BEACONS_COUNT_ADDRESS, &count, sizeof(uint32_t));
|
2020-07-11 12:11:34 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "read contancts count: %u", count);
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "END ena_storage_beacons_count");
|
2020-07-11 12:11:34 +02:00
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
void ena_storage_get_beacon(uint32_t index, ena_beacon_t *beacon)
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "START ena_storage_read_beacon");
|
|
|
|
ena_storage_read(ENA_STORAGE_BEACONS_START_ADDRESS + index * sizeof(ena_beacon_t), beacon, sizeof(ena_beacon_t));
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "read beacon: timestamp %u and rssi %d", beacon->timestamp, beacon->rssi);
|
|
|
|
ESP_LOG_BUFFER_HEXDUMP(ENA_STORAGE_LOG, beacon->rpi, ENA_KEY_LENGTH, ESP_LOG_DEBUG);
|
|
|
|
ESP_LOG_BUFFER_HEXDUMP(ENA_STORAGE_LOG, beacon->aem, ENA_AEM_METADATA_LENGTH, ESP_LOG_DEBUG);
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "END ena_storage_read_beacon");
|
2020-07-11 12:11:34 +02:00
|
|
|
}
|
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
void ena_storage_add_beacon(ena_beacon_t *beacon)
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "START ena_storage_write_beacon");
|
|
|
|
ESP_LOG_BUFFER_HEXDUMP(ENA_STORAGE_LOG, beacon->rpi, ENA_KEY_LENGTH, ESP_LOG_DEBUG);
|
|
|
|
uint32_t count = ena_storage_beacons_count();
|
|
|
|
ena_storage_write(ENA_STORAGE_BEACONS_START_ADDRESS + count * sizeof(ena_beacon_t), beacon, sizeof(ena_beacon_t));
|
2020-07-13 20:32:53 +02:00
|
|
|
count++;
|
2020-07-15 22:22:54 +02:00
|
|
|
ena_storage_write(ENA_STORAGE_BEACONS_COUNT_ADDRESS, &count, sizeof(uint32_t));
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "write beacon: timestamp %u and rssi %d", beacon->timestamp, beacon->rssi);
|
|
|
|
ESP_LOG_BUFFER_HEXDUMP(ENA_STORAGE_LOG, beacon->rpi, ENA_KEY_LENGTH, ESP_LOG_DEBUG);
|
|
|
|
ESP_LOG_BUFFER_HEXDUMP(ENA_STORAGE_LOG, beacon->aem, ENA_AEM_METADATA_LENGTH, ESP_LOG_DEBUG);
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "END ena_storage_write_beacon");
|
2020-07-11 12:11:34 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
void ena_storage_erase(void)
|
|
|
|
{
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "START ena_storage_erase");
|
|
|
|
const esp_partition_t *partition = esp_partition_find_first(
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_PARTITION_TYPE_DATA, ESP_PARTITION_SUBTYPE_ANY, ENA_STORAGE_PARTITION_NAME);
|
2020-07-11 12:11:34 +02:00
|
|
|
assert(partition);
|
|
|
|
ESP_ERROR_CHECK(esp_partition_erase_range(partition, 0, partition->size));
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_LOGI(ENA_STORAGE_LOG, "erased partition %s!", ENA_STORAGE_PARTITION_NAME);
|
2020-07-11 12:11:34 +02:00
|
|
|
|
2020-07-13 20:32:53 +02:00
|
|
|
uint32_t count = 0;
|
2020-07-14 20:54:14 +02:00
|
|
|
ena_storage_write(ENA_STORAGE_TEK_COUNT_ADDRESS, &count, sizeof(uint32_t));
|
2020-07-15 22:22:54 +02:00
|
|
|
ena_storage_write(ENA_STORAGE_TEMP_BEACONS_COUNT_ADDRESS, &count, sizeof(uint32_t));
|
|
|
|
ena_storage_write(ENA_STORAGE_BEACONS_COUNT_ADDRESS, &count, sizeof(uint32_t));
|
2020-07-11 12:11:34 +02:00
|
|
|
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "END ena_storage_erase");
|
|
|
|
}
|
|
|
|
|
2020-07-14 20:54:14 +02:00
|
|
|
void ena_storage_erase_tek(void)
|
|
|
|
{
|
|
|
|
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "START ena_storage_erase_teks");
|
|
|
|
uint32_t tek_count = 0;
|
|
|
|
ena_storage_read(ENA_STORAGE_TEK_COUNT_ADDRESS, &tek_count, sizeof(uint32_t));
|
2020-07-15 22:22:54 +02:00
|
|
|
uint8_t stored = ENA_STORAGE_TEK_MAX;
|
2020-07-14 20:54:14 +02:00
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
if (tek_count < ENA_STORAGE_TEK_MAX)
|
2020-07-14 20:54:14 +02:00
|
|
|
{
|
|
|
|
stored = tek_count;
|
|
|
|
}
|
|
|
|
|
|
|
|
size_t size = sizeof(uint32_t) + stored * sizeof(ena_tek_t);
|
|
|
|
uint8_t *zeros = calloc(size, sizeof(uint8_t));
|
|
|
|
ena_storage_write(ENA_STORAGE_TEK_COUNT_ADDRESS, zeros, size);
|
|
|
|
free(zeros);
|
|
|
|
ESP_LOGI(ENA_STORAGE_LOG, "erased %d teks (size %u at %u)", stored, size, ENA_STORAGE_TEK_COUNT_ADDRESS);
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "END ena_storage_erase_teks");
|
|
|
|
}
|
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
void ena_storage_erase_temporary_beacon(void)
|
2020-07-14 20:54:14 +02:00
|
|
|
{
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "START ena_storage_erase_temporary_beacons");
|
|
|
|
uint32_t beacon_count = 0;
|
|
|
|
ena_storage_read(ENA_STORAGE_TEMP_BEACONS_COUNT_ADDRESS, &beacon_count, sizeof(uint32_t));
|
|
|
|
uint32_t stored = ENA_STORAGE_TEMP_BEACONS_MAX;
|
2020-07-14 20:54:14 +02:00
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
if (beacon_count < ENA_STORAGE_TEMP_BEACONS_MAX)
|
2020-07-14 20:54:14 +02:00
|
|
|
{
|
2020-07-15 22:22:54 +02:00
|
|
|
stored = beacon_count;
|
2020-07-14 20:54:14 +02:00
|
|
|
}
|
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
size_t size = sizeof(uint32_t) + stored * sizeof(ena_temp_beacon_t);
|
2020-07-14 20:54:14 +02:00
|
|
|
uint8_t *zeros = calloc(size, sizeof(uint8_t));
|
2020-07-15 22:22:54 +02:00
|
|
|
ena_storage_write(ENA_STORAGE_TEMP_BEACONS_COUNT_ADDRESS, zeros, size);
|
2020-07-14 20:54:14 +02:00
|
|
|
free(zeros);
|
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_LOGI(ENA_STORAGE_LOG, "erased %d temporary beacons (size %u at %u)", stored, size, ENA_STORAGE_TEMP_BEACONS_COUNT_ADDRESS);
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "END ena_storage_erase_temporary_beacons");
|
2020-07-14 20:54:14 +02:00
|
|
|
}
|
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
void ena_storage_erase_beacon(void)
|
2020-07-14 20:54:14 +02:00
|
|
|
{
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "START ena_storage_erase_beacon");
|
|
|
|
uint32_t beacon_count = 0;
|
|
|
|
ena_storage_read(ENA_STORAGE_BEACONS_COUNT_ADDRESS, &beacon_count, sizeof(uint32_t));
|
2020-07-14 20:54:14 +02:00
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
size_t size = sizeof(uint32_t) + beacon_count * sizeof(ena_beacon_t);
|
2020-07-14 20:54:14 +02:00
|
|
|
uint8_t *zeros = calloc(size, sizeof(uint8_t));
|
2020-07-15 22:22:54 +02:00
|
|
|
ena_storage_write(ENA_STORAGE_BEACONS_COUNT_ADDRESS, zeros, size);
|
2020-07-14 20:54:14 +02:00
|
|
|
free(zeros);
|
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_LOGI(ENA_STORAGE_LOG, "erased %d beacons (size %u at %u)", beacon_count, size, ENA_STORAGE_BEACONS_COUNT_ADDRESS);
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "END ena_storage_erase_beacon");
|
2020-07-14 20:54:14 +02:00
|
|
|
}
|
|
|
|
|
2020-07-12 14:14:06 +02:00
|
|
|
void ena_storage_dump_hash_array(uint8_t *data, size_t size)
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
|
|
|
for (int i = 0; i < size; i++)
|
|
|
|
{
|
|
|
|
if (i == 0)
|
|
|
|
{
|
2020-07-13 20:32:53 +02:00
|
|
|
printf("%02x", data[i]);
|
2020-07-11 12:11:34 +02:00
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
2020-07-13 20:32:53 +02:00
|
|
|
printf(" %02x", data[i]);
|
2020-07-11 12:11:34 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void ena_storage_dump_tek(void)
|
|
|
|
{
|
2020-07-13 20:32:53 +02:00
|
|
|
ena_tek_t tek;
|
2020-07-14 20:54:14 +02:00
|
|
|
uint32_t tek_count = 0;
|
|
|
|
ena_storage_read(ENA_STORAGE_TEK_COUNT_ADDRESS, &tek_count, sizeof(uint32_t));
|
2020-07-15 22:22:54 +02:00
|
|
|
uint8_t stored = ENA_STORAGE_TEK_MAX;
|
2020-07-14 20:54:14 +02:00
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
if (tek_count < ENA_STORAGE_TEK_MAX)
|
2020-07-14 20:54:14 +02:00
|
|
|
{
|
|
|
|
stored = tek_count;
|
|
|
|
}
|
|
|
|
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "%u TEKs (%u stored)\n", tek_count, stored);
|
2020-07-15 22:22:54 +02:00
|
|
|
printf("#,enin,tek,rolling_period\n");
|
2020-07-14 20:54:14 +02:00
|
|
|
for (int i = 0; i < stored; i++)
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
|
|
|
|
2020-07-13 20:32:53 +02:00
|
|
|
size_t address = ENA_STORAGE_TEK_START_ADDRESS + i * sizeof(ena_tek_t);
|
|
|
|
ena_storage_read(address, &tek, sizeof(ena_tek_t));
|
|
|
|
printf("%d,%u,", i, tek.enin);
|
|
|
|
ena_storage_dump_hash_array(tek.key_data, ENA_KEY_LENGTH);
|
2020-07-15 22:22:54 +02:00
|
|
|
printf(",%u\n", tek.rolling_period);
|
2020-07-11 12:11:34 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
void ena_storage_dump_temp_beacons(void)
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
2020-07-15 22:22:54 +02:00
|
|
|
ena_temp_beacon_t beacon;
|
|
|
|
uint32_t beacon_count = 0;
|
|
|
|
ena_storage_read(ENA_STORAGE_TEMP_BEACONS_COUNT_ADDRESS, &beacon_count, sizeof(uint32_t));
|
|
|
|
uint32_t stored = ENA_STORAGE_TEMP_BEACONS_MAX;
|
2020-07-14 20:54:14 +02:00
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
if (beacon_count < ENA_STORAGE_TEMP_BEACONS_MAX)
|
2020-07-14 20:54:14 +02:00
|
|
|
{
|
2020-07-15 22:22:54 +02:00
|
|
|
stored = beacon_count;
|
2020-07-14 20:54:14 +02:00
|
|
|
}
|
2020-07-15 22:22:54 +02:00
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "%u temporary beacons (%u stored)\n", beacon_count, stored);
|
2020-07-13 20:32:53 +02:00
|
|
|
printf("#,timestamp_first,timestamp_last,rpi,aem,rssi\n");
|
2020-07-14 20:54:14 +02:00
|
|
|
for (int i = 0; i < stored; i++)
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
2020-07-15 22:22:54 +02:00
|
|
|
ena_storage_get_temp_beacon(i, &beacon);
|
|
|
|
printf("%d,%u,%u,", i, beacon.timestamp_first, beacon.timestamp_last);
|
|
|
|
ena_storage_dump_hash_array(beacon.rpi, ENA_KEY_LENGTH);
|
2020-07-11 12:11:34 +02:00
|
|
|
printf(",");
|
2020-07-15 22:22:54 +02:00
|
|
|
ena_storage_dump_hash_array(beacon.aem, ENA_AEM_METADATA_LENGTH);
|
|
|
|
printf(",%d\n", beacon.rssi);
|
2020-07-11 12:11:34 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
void ena_storage_dump_beacons(void)
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
2020-07-13 20:32:53 +02:00
|
|
|
|
2020-07-15 22:22:54 +02:00
|
|
|
ena_beacon_t beacon;
|
|
|
|
uint32_t beacon_count = 0;
|
|
|
|
ena_storage_read(ENA_STORAGE_BEACONS_COUNT_ADDRESS, &beacon_count, sizeof(uint32_t));
|
|
|
|
ESP_LOGD(ENA_STORAGE_LOG, "%u beacons\n", beacon_count);
|
2020-07-13 20:32:53 +02:00
|
|
|
printf("#,timestamp,rpi,aem,rssi\n");
|
2020-07-15 22:22:54 +02:00
|
|
|
for (int i = 0; i < beacon_count; i++)
|
2020-07-11 12:11:34 +02:00
|
|
|
{
|
2020-07-15 22:22:54 +02:00
|
|
|
ena_storage_get_beacon(i, &beacon);
|
|
|
|
printf("%d,%u,", i, beacon.timestamp);
|
|
|
|
ena_storage_dump_hash_array(beacon.rpi, ENA_KEY_LENGTH);
|
2020-07-11 12:11:34 +02:00
|
|
|
printf(",");
|
2020-07-15 22:22:54 +02:00
|
|
|
ena_storage_dump_hash_array(beacon.aem, ENA_AEM_METADATA_LENGTH);
|
|
|
|
printf(",%d\n", beacon.rssi);
|
2020-07-11 12:11:34 +02:00
|
|
|
}
|
|
|
|
}
|