2023-04-04 22:19:24 +03:00

96 lines
2.0 KiB
C++

/*
* EEPROMWrapper.cpp
*
* Created on: Dec 4, 2022
* Author: tylen
*/
#include <EEPROMWrapper.h>
EEPROM_Wrapper::EEPROM_Wrapper ()
{
/* Enable EEPROM clock and reset EEPROM controller */
Chip_Clock_EnablePeriphClock (SYSCTL_CLOCK_EEPROM);
Chip_SYSCTL_PeriphReset (RESET_EEPROM);
iap_exec = reinterpret_cast<IAP_call> (IAP_ENTRY_LOCATION);
}
EEPROM_Wrapper::~EEPROM_Wrapper ()
{
// TODO Auto-generated destructor stub
}
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
EEPROM_Wrapper::eeprom_execute (EEPROM *rom)
{
command[0] = rom->mode;
command[1] = rom->addr;
command[2] = rom->data;
command[3] = rom->size;
command[4] = rom->clock;
this->iap_exec (command, result);
}
void
EEPROM_Wrapper::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;
#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);
}
std::string
EEPROM_Wrapper::str_read_from (uint32_t addr, uint32_t amount)
{
eeprom_use (buffer, addr, amount, READ);
std::string str = (char *)buffer;
return str;
}
void
EEPROM_Wrapper::write_to (uint32_t addr, std::string str)
{
std::copy (str.begin (), str.end (), std::begin (buffer));
eeprom_use (buffer, addr, str.length (), WRITE);
}
void *
EEPROM_Wrapper::read_from (uint32_t addr, uint32_t amount)
{
eeprom_use (buffer, addr, amount, READ);
void *data = (void *)buffer;
return data;
}
void
EEPROM_Wrapper::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);
}