Repository navigation
Expand file tree
/
Copy pathMemoryI2C.cpp
More file actions
142 lines (116 loc) · 3.33 KB
/
Copy pathMemoryI2C.cpp
File metadata and controls
142 lines (116 loc) · 3.33 KB
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
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
#include "MemoryI2C.h"
boolean MemoryI2C::begin(size_t flashSize, size_t pageSize) {
return begin(0, flashSize, pageSize);
}
boolean MemoryI2C::begin(int addr, size_t flashSize, size_t pageSize) {
this->addr = MEMORY_I2C_ADDRESS | min(0b111, addr);
this->flashSize = flashSize;
this->pageSize = pageSize;
return checkChip();
}
boolean MemoryI2C::assertAddress(int address) {
return address >= 0 && address < getFlashSize();
}
boolean MemoryI2C::assertAddress(int address, size_t size) {
return assertAddress(address) && assertAddress(address + size);
}
boolean MemoryI2C::checkChip() {
Wire.beginTransmission(addr);
return Wire.endTransmission() == 0;
}
void MemoryI2C::waitForChip() {
delay(MEMORY_MIN_WAIT_TIME);
int start = millis();
while (millis() - start < MEMORY_WAIT_TIMEOUT) {
if (checkChip())
return;
delay(5);
}
}
size_t MemoryI2C::getFlashSize() {
return flashSize;
}
size_t MemoryI2C::getPageSize() {
return pageSize;
}
uint8_t MemoryI2C::readPage(int start, uint8_t* buffer, size_t size) {
if (!assertAddress(start, size))
return MEMORY_ERROR_WRONG_PARAMETERS;
if (size == 0)
return 0;
Wire.beginTransmission(addr);
if (getFlashSize() > 256)
Wire.write((uint8_t)(start >> 8));
Wire.write((uint8_t)(start & 0xFF));
uint8_t error = Wire.endTransmission();
if (error != 0)
return error;
if (Wire.requestFrom(addr, size) < size)
return MEMORY_ERROR_READ_ERROR;
for (int i = 0; i < size; i++)
buffer[i] = Wire.read();
return 0;
}
uint8_t MemoryI2C::readByte(int address) {
uint8_t buffer[1];
if (readBytes(address, buffer, sizeof(buffer)) != 0)
return 0;
return buffer[0];
}
uint8_t MemoryI2C::readBytes(int start, uint8_t* buffer, size_t size) {
if (!assertAddress(start, size))
return MEMORY_ERROR_WRONG_PARAMETERS;
if (buffer == NULL)
return MEMORY_ERROR_WRONG_PARAMETERS;
while (size > 0) {
size_t bytesToRead = min(min(size, getPageSize()), MEMORY_PAGE_SIZE);
uint8_t error = readPage(start, buffer, bytesToRead);
if (error != 0)
return error;
start += bytesToRead;
buffer += bytesToRead;
size -= bytesToRead;
}
return 0;
}
uint8_t MemoryI2C::writePage(int start, uint8_t* buffer, size_t size) {
if (!assertAddress(start, size))
return MEMORY_ERROR_WRONG_PARAMETERS;
if (size == 0)
return 0;
int bufferPosition = start % getPageSize();
if (bufferPosition + size > getPageSize())
return MEMORY_ERROR_PAGE_OVERFLOW;
Wire.beginTransmission(addr);
if (getFlashSize() > 256)
Wire.write((uint8_t)(start >> 8));
Wire.write((uint8_t)(start & 0xFF));
for (int i = 0; i < size; i++)
Wire.write(buffer[i]);
uint8_t error = Wire.endTransmission();
if (error == 0)
waitForChip();
return error;
}
uint8_t MemoryI2C::writeByte(int address, uint8_t value) {
uint8_t buffer[1];
buffer[0] = value;
return writeBytes(address, buffer, sizeof(buffer));
}
uint8_t MemoryI2C::writeBytes(int start, uint8_t* buffer, size_t size) {
if (!assertAddress(start, size))
return MEMORY_ERROR_WRONG_PARAMETERS;
if (buffer == NULL)
return MEMORY_ERROR_WRONG_PARAMETERS;
while (size > 0) {
int pagePos = start % getPageSize();
size_t bytesToWrite = min(min(size, getPageSize() - pagePos), MEMORY_PAGE_SIZE);
uint8_t error = writePage(start, buffer, bytesToWrite);
if (error != 0)
return error;
start += bytesToWrite;
buffer += bytesToWrite;
size -= bytesToWrite;
}
return 0;
}