Fix scaling for +125%

This commit is contained in:
Goebish 2019-10-05 18:20:26 +02:00
parent c2bf63991f
commit 1baf99efe5

View File

@ -45,10 +45,8 @@ static void __attribute__((unused)) AFHDS2A_Rx_build_telemetry_packet()
uint32_t val = packet[9+i*2] | (packet[10+i*2] << 8); uint32_t val = packet[9+i*2] | (packet[10+i*2] << 8);
if (val < 860) if (val < 860)
val = 860; val = 860;
else if (val > 2139)
val = 2139;
// convert ppm (860-2140) to Multi (0-2047) // convert ppm (860-2140) to Multi (0-2047)
val = ((val-860)<<3)/5; val = min(((val-860)<<3)/5, 2047);
bits |= val << bitsavailable; bits |= val << bitsavailable;
bitsavailable += 11; bitsavailable += 11;