bool SendACK(uint16_t sequence_number) {
uint16_t payload = ToLE16(sequence_number);
FLARM::FrameHeader header =
FLARM::PrepareFrameHeader(sequence_number, FLARM::MT_ACK,
&payload, sizeof(payload));
return port->Write(FLARM::START_FRAME) &&
FLARM::SendEscaped(*port, &header, sizeof(header), *env, 2000) &&
FLARM::SendEscaped(*port, &payload, sizeof(payload), *env, 2000);
}
void SetCRC(uint16_t _crc) {
crc = ToLE16(_crc);
}
void SetLength(uint16_t _length) {
length = ToLE16(_length);
}
void IOBuffer::storeUI16LE(rx_uint16 data) {
ensureSize(2);
data = ToLE16(data);
memcpy(buffer+published, &data, 2);
published += 2;
}
