81 lines
1.7 KiB
C++
81 lines
1.7 KiB
C++
/*
|
|
* EEPROMio.cpp
|
|
*
|
|
* Created on: Dec 4, 2022
|
|
* Author: tylen
|
|
*/
|
|
|
|
#include <EEPROMio.h>
|
|
#include "Log.h"
|
|
|
|
static void
|
|
e_memcpy (void *from, void *to, unsigned int n)
|
|
{
|
|
if (!from)
|
|
return;
|
|
char *source = (char *)from;
|
|
char *dest = (char *)to;
|
|
while (n)
|
|
{
|
|
(*dest++) = (*source++);
|
|
n--;
|
|
}
|
|
}
|
|
|
|
void
|
|
EEPROMio::eeprom_execute (EEPROM *rom)
|
|
{
|
|
command[0] = rom->mode;
|
|
command[1] = rom->addr;
|
|
command[2] = rom->data;
|
|
command[3] = rom->size;
|
|
command[4] = rom->clock;
|
|
iap_entry(command, result);
|
|
}
|
|
|
|
void
|
|
EEPROMio::eeprom_use (uint8_t *data, uint32_t addr, uint32_t size,
|
|
bool mode)
|
|
{
|
|
rom.addr = addr;
|
|
rom.data = (uint32_t)data;
|
|
rom.mode = (mode) ? IAP_EEPROM_READ : IAP_EEPROM_WRITE;
|
|
rom.size = size;
|
|
rom.clock = SystemCoreClock / 1000;
|
|
#if INCLUDE_vTaskSuspend
|
|
vTaskSuspendAll ();
|
|
#endif
|
|
/* Main execution of eeprom r/w */
|
|
eeprom_execute (&rom);
|
|
#if INCLUDE_vTaskSuspend
|
|
xTaskResumeAll ();
|
|
#endif
|
|
assert (result[0] == IAP_CMD_SUCCESS);
|
|
}
|
|
|
|
void
|
|
EEPROMio::write_to (uint32_t addr, std::string str)
|
|
{
|
|
std::copy (str.begin (), str.end (), std::begin (buffer));
|
|
eeprom_use (buffer, addr, str.length (), WRITE);
|
|
LOG_DEBUG("%dB written to EEPROM", str.length ());
|
|
}
|
|
|
|
void *
|
|
EEPROMio::read_from (uint32_t addr, uint32_t amount)
|
|
{
|
|
eeprom_use (buffer, addr, amount, READ);
|
|
void *data = (void *)buffer;
|
|
LOG_DEBUG("%dB read from EEPROM", amount);
|
|
return data;
|
|
}
|
|
void
|
|
EEPROMio::write_to (uint32_t addr, void *data, uint32_t size_of_data)
|
|
{
|
|
assert (size_of_data < EEPROM_MAX_BUFER_SIZE);
|
|
e_memcpy (data, buffer, size_of_data);
|
|
eeprom_use (buffer, addr, size_of_data, WRITE);
|
|
LOG_DEBUG("%dB written to EEPROM", size_of_data);
|
|
}
|
|
|