72 lines
1.3 KiB
C
72 lines
1.3 KiB
C
|
|
//EEPPROM compatibility support for simulator
|
|
|
|
#include <stdint.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
|
|
#define EEPROM_SIZE 1024
|
|
|
|
static FILE * fp;
|
|
|
|
static uint8_t eemem[EEPROM_SIZE];
|
|
|
|
static uint8_t inited;
|
|
static void init(){
|
|
if(!inited){
|
|
inited = 1;
|
|
char* filename = ".simulated_eeprom.bin";
|
|
size_t size;
|
|
fp = fopen(filename, "r+");
|
|
if(fp == 0){
|
|
fp = fopen(filename, "w+");
|
|
if(fp == 0){
|
|
printf("Failed to open %s\n",filename );
|
|
exit (1);
|
|
}
|
|
}
|
|
size = fread (eemem, 1, EEPROM_SIZE, fp);
|
|
if(size < EEPROM_SIZE){
|
|
memset(eemem, 0xff, EEPROM_SIZE);
|
|
}
|
|
}
|
|
}
|
|
|
|
uint16_t conv_addr(uint8_t * p){
|
|
uint16_t addr;
|
|
addr = (unsigned int)p;
|
|
if(addr >= EEPROM_SIZE){
|
|
printf ("warning: eeprom write to %X\n",addr);
|
|
}
|
|
addr &= (EEPROM_SIZE-1);
|
|
return addr;
|
|
}
|
|
|
|
void eeprom_write_byte (uint8_t *p, uint8_t value){
|
|
init();
|
|
eemem[conv_addr(p)] = value;
|
|
fseek(fp, 0, SEEK_SET);
|
|
fwrite(eemem, 1, EEPROM_SIZE, fp);
|
|
}
|
|
|
|
void eeprom_write_word (uint16_t *p, uint16_t value){
|
|
init();
|
|
eemem[conv_addr(p) ] = value & 0xff;
|
|
eemem[conv_addr(p)+1] = value >> 8;
|
|
|
|
fseek(fp, 0, SEEK_SET);
|
|
fwrite(eemem, 1, EEPROM_SIZE, fp);
|
|
fflush(fp);
|
|
}
|
|
|
|
uint8_t eeprom_read_byte (uint8_t *p){
|
|
init();
|
|
return eemem[conv_addr(p)];
|
|
}
|
|
|
|
uint16_t eeprom_read_word (uint16_t *p){
|
|
init();
|
|
return eemem[conv_addr(p)] | (eemem[conv_addr(p)+1]<<8);
|
|
}
|