MockEepromAbstraction.h

#ifndef _MOCK_EEPROM_ABSTRACTION_H_
#define _MOCK_EEPROM_ABSTRACTION_H_
 
#include "EepromAbstraction.h"
#include <IoLogging.h>


class MockEepromAbstraction : public EepromAbstraction {
private:
    bool errorFlag;
    uint8_t *data;
    unsigned int memSize;
public:
    explicit MockEepromAbstraction(unsigned int size = 128) {
        data = new uint8_t[size];
        errorFlag = false;
        memSize = size;
        memset(data, 0, memSize);
    }
    ~MockEepromAbstraction() override {
        delete[] data;
    }
 
    bool hasErrorOccurred() override { return errorFlag;}
    void clearError() {errorFlag = false;}
 
    void checkBounds(EepromPosition pos, int len) {
        if(uint16_t(pos + len) >= memSize) {
            serlogF2(SER_DEBUG, "checkbounds exceeded: ", pos+len);
            errorFlag = true;
        }
    }
 
    void reset() {
        memset(data, 0, memSize);
    }
 
    uint8_t read8(EepromPosition position) override {
        checkBounds(position, 1);
        return data[position];
    }
 
    void write8(EepromPosition position, uint8_t val) override {
        checkBounds(position, 1);
        data[position] = val;
    }
 
    uint16_t read16(EepromPosition position) override {
        return read8(position) | (read8(position + 1) << 8);
    }
 
    void write16(EepromPosition position, uint16_t val) override {
        write8(position, val);
        write8(position + 1, val >> 8);
    }
 
    virtual uint32_t read32(EepromPosition position) override {
        checkBounds(position, 4);
        return (uint32_t)read8(position) | ((uint32_t)read8(position + 1) << 8) | ((uint32_t)read8(position + 2) << 16) | ((uint32_t)read8(position + 3) << 24);
    }
 
    virtual void write32(EepromPosition position, uint32_t val) override {
        checkBounds(position, 4);
        write8(position, val);
        write8(position + 1, val >> 8);
        write8(position + 2, val >> 16);
        write8(position + 3, val >> 24);
    }
 
    virtual void readIntoMemArray(uint8_t* memDest, EepromPosition romSrc, uint8_t len) override {
        checkBounds(romSrc, len);
        memcpy(memDest, &data[romSrc], len);
    }
 
    virtual void writeArrayToRom(EepromPosition romDest, const uint8_t* memSrc, uint8_t len) override {
        checkBounds(romDest, len);
        memcpy(&data[romDest], memSrc, len);
    }
 
    void serPrintContents(int start, int len) {
        if(len >= 63) {
            serlogF(SER_DEBUG, "Mock rom debug - len too big");
            return;
        }
        char str[64];
        str[0] = 0;
        int i;
        for(i=0; i<len; i++) {
            if(data[i + start] >= 30)
                str[i] = data[i + start];
            else
                str[i] = '?';
        }
        str[i] = 0;
        serlogF4(SER_DEBUG, "MockRom contents start, len, data: ", start, len, str);
    }
};
 
#endif