rusefi
/
atbetaflight
mirror of https://github.com/rusefi/atbetaflight.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Added some improvements to FrSky X SPI.

This commit is contained in:
mikeller 2018-10-28 21:47:07 +13:00
parent c677b1c19c
commit fa542cc02d
1 changed files with 2 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
src/main/rx/cc2500_frsky_x.c
View File

@ -283,12 +283,9 @@ void frSkyXSetRcData(uint16_t *rcData, const uint8_t *packet)
c[7] = (uint16_t)((packet[20] << 4) & 0xFF0) | (packet[19] >> 4); c[7] = (uint16_t)((packet[20] << 4) & 0xFF0) | (packet[19] >> 4);
for (unsigned i = 0; i < 8; i++) { for (unsigned i = 0; i < 8; i++) {
bool channelIsShifted = false; const bool channelIsShifted = c[i] & 0x800;
if (c[i] & 0x800) {
channelIsShifted = true;
}
const uint16_t channelValue = c[i] & 0x7FF; const uint16_t channelValue = c[i] & 0x7FF;
rcData[channelIsShifted ? i + 8 : i] = channelValue * 2.0f / 3 + 860 - 64 * 2 / 3; rcData[channelIsShifted ? i + 8 : i] = ((channelValue - 64) * 2 + 860 * 3) / 3;
} }
} }