Fix FM RSSI reading tag byte instead of RSSI data

This commit is contained in:
Ember 2026-04-05 17:48:32 -07:00
parent a2309124c7
commit 9d236515ab

View file

@ -108,8 +108,8 @@ bool CFMControl::writeModem(const unsigned char* data, unsigned int length)
if (data[0U] == TAG_RSSI) {
uint16_t raw = 0U;
raw |= (data[0U] << 8) & 0xFF00U;
raw |= (data[1U] << 0) & 0x00FFU;
raw |= (data[1U] << 8) & 0xFF00U;
raw |= (data[2U] << 0) & 0x00FFU;
// Convert the raw RSSI to dBm
int rssi = m_rssiMapper->interpolate(raw);