Razvalyaev/OptoTest
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

codex init

Browse Source
This commit is contained in:
Razvalyaev
2026-08-05 16:49:05 +03:00
commit 3399e194ad
23 changed files with 1484 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

22
OpticalChannelTester/Protocol.cpp Normal file
View File

@@ -0,0 +1,22 @@
#include "Protocol.h"
#include <stddef.h>
uint16_t packetCrc(const ProtocolPacket &p) {
const uint8_t *data = reinterpret_cast<const uint8_t *>(&p);
uint16_t crc = 0xFFFF;
for (size_t i = 0; i < offsetof(ProtocolPacket, crc); ++i) {
crc ^= static_cast<uint16_t>(data[i]) << 8;
for (uint8_t b = 0; b < 8; ++b) crc = (crc & 0x8000) ? (crc << 1) ^ 0x1021 : crc << 1;
}
return crc;
}
void finalizePacket(ProtocolPacket &p) {
p.magic = PROTOCOL_MAGIC; p.version = PROTOCOL_VERSION; p.crc = packetCrc(p);
}
bool validPacket(const ProtocolPacket &p) {
return p.magic == PROTOCOL_MAGIC && p.version == PROTOCOL_VERSION &&
p.type <= static_cast<uint8_t>(MessageType::ABORT) && p.crc == packetCrc(p);
}