115class HardwareService {
119 void setStream(
Stream* str) { io = str; }
122 uint16_t val = (uint16_t)call;
123 io->write((uint8_t*)&val,
sizeof(uint16_t));
126 void send(uint8_t data) { io->write((uint8_t*)&data,
sizeof(data)); }
128 void send(uint16_t dataIn) {
130 io->write((uint8_t*)&data,
sizeof(data));
133 void send(uint32_t dataIn) {
135 io->write((uint8_t*)&data,
sizeof(data));
138 void send(uint64_t dataIn) {
139 uint64_t data = swap_uint64(dataIn);
140 io->write((uint8_t*)&data,
sizeof(data));
143 void send(int32_t dataIn) {
145 io->write((uint8_t*)&data,
sizeof(data));
147 void send(int64_t dataIn) {
148 int64_t data = swap_int64(dataIn);
149 io->write((uint8_t*)&data,
sizeof(data));
152 void send(
bool data) { io->write((uint8_t*)&data,
sizeof(data)); }
154 void send(
void* data,
size_t len) { io->write((uint8_t*)data, len); }
156 void flush() { io->flush(); }
158 uint16_t receive16() {
160 blockingRead((
char*)&result,
sizeof(uint16_t));
164 uint32_t receive32() {
166 blockingRead((
char*)&result,
sizeof(uint32_t));
170 uint64_t receive64() {
172 blockingRead((
char*)&result,
sizeof(uint64_t));
173 return swap_uint64(result);
178 blockingRead((
char*)&result,
sizeof(uint8_t));
182 uint16_t receive(
void* data,
int len) {
183 return blockingRead((
char*)data, len);
186 operator bool() {
return io !=
nullptr; }
190 bool isLittleEndian = !is_big_endian();
191 int timeout_ms = 1000;
193 uint16_t blockingRead(
void* data,
int len,
int timeout = 1000) {
195 unsigned long start = millis();
196 while (offset < len && (millis() - start) < (
unsigned long)timeout) {
197 int n = io->readBytes((
char*)data + offset, len - offset);
204 bool is_big_endian(
void) {
208 } bint = {0x01020304};
210 return bint.c[0] == 1;
215 if (isLittleEndian)
return val;
216 return (val << 8) | (val >> 8);
221 if (isLittleEndian)
return val;
222 return (val << 8) | ((val >> 8) & 0xFF);
227 if (isLittleEndian)
return val;
228 val = ((val << 8) & 0xFF00FF00) | ((val >> 8) & 0xFF00FF);
229 return (val << 16) | (val >> 16);
234 if (isLittleEndian)
return val;
235 val = ((val << 8) & 0xFF00FF00) | ((val >> 8) & 0xFF00FF);
236 return (val << 16) | ((val >> 16) & 0xFFFF);
239 int64_t swap_int64(int64_t val) {
240 if (isLittleEndian)
return val;
241 val = ((val << 8) & 0xFF00FF00FF00FF00ULL) |
242 ((val >> 8) & 0x00FF00FF00FF00FFULL);
243 val = ((val << 16) & 0xFFFF0000FFFF0000ULL) |
244 ((val >> 16) & 0x0000FFFF0000FFFFULL);
245 return (val << 32) | ((val >> 32) & 0xFFFFFFFFULL);
248 uint64_t swap_uint64(uint64_t val) {
249 if (isLittleEndian)
return val;
250 val = ((val << 8) & 0xFF00FF00FF00FF00ULL) |
251 ((val >> 8) & 0x00FF00FF00FF00FFULL);
252 val = ((val << 16) & 0xFFFF0000FFFF0000ULL) |
253 ((val >> 16) & 0x0000FFFF0000FFFFULL);
254 return (val << 32) | (val >> 32);