ArduinoDatalogger/EEPROMStream.cpp at master · rihteri/ArduinoDatalogger · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
#include "Arduino.h"
#include <EEPROM.h>

#include "EEPROMStream.h"

EEPROMStream::EEPROMStream(int address) :
    _addr(address),
    _pos(0) { }

void EEPROMStream::seek(int position)
{
    _pos = position;
}

boolean EEPROMStream::isValid()
{
    return _addr >= 0;
}

// write
////////

void EEPROMStream::write(int value)
{
    write((void*)&value, sizeof(value));
}

void EEPROMStream::write(unsigned long value)
{
    write((void*)&value, sizeof(value));
}

void EEPROMStream::write(char value)
{
    write((void*)&value, sizeof(value));
}

void EEPROMStream::write(double value, int precision)
{
    if (precision >= 0)
    {
        for (int i = 0; i < precision; i++)
        {
            value = value * 10;
        }

        value = round(value);

        for (int i = 0; i < precision; i++)
        {
            value = value / 10;
        }
    }

    write((void*)&value, sizeof(value));
}

void EEPROMStream::write(void* data, int size)
{
    if (_addr < 0) return;

    byte* data_byte = (byte*)data;

    for (int i = 0; i < size; i++)
    {
        byte curVal = EEPROM.read(_addr + _pos);

        if (curVal != *data_byte)
        {
            EEPROM.write(_addr + _pos, *data_byte);
        }

        _pos++; data_byte++;
    }
}


// read
///////

int EEPROMStream::readInt()
{
    int ret = 0;

    read((void*)&ret, sizeof(ret));

    return ret;
}


unsigned long EEPROMStream::readULong()
{
    unsigned long ret = 0;

    read((void*)&ret, sizeof(ret));

    return ret;
}

char EEPROMStream::readByte()
{
    char ret = 0;

    read((void*)&ret, sizeof(ret));

    return ret;
}

double EEPROMStream::readDouble()
{
    double ret = 0.0;

    read((void*)&ret, sizeof(ret));

    return ret;
}

void EEPROMStream::read(void* value, int size)
{
    byte* data = (byte*)value;
    for (int i = 0; i < size; i++)
    {
        *data++ = EEPROM.read(_addr + _pos++);
    }
}