This commit is contained in:
bsongis
2015-01-01 20:16:27 +01:00
parent 661657588e
commit ea6dd2c9c4
+4 -6
View File
@@ -83,12 +83,10 @@ const FrSkySportSensor * getFrSkySportSensor(uint16_t id)
bool checkSportPacket(uint8_t *packet)
{
short crc = 0;
for (int i=1; i<FRSKY_SPORT_PACKET_SIZE; i++) {
crc += packet[i]; //0-1FF
crc += crc >> 8; //0-100
crc &= 0x00ff;
crc += crc >> 8; //0-0FF
crc &= 0x00ff;
for (int i=1; i<FRSKY_SPORT_PACKET_SIZE; ++i) {
crc += packet[i]; // 0-1FE
crc += crc >> 8; // 0-1FF
crc &= 0x00ff; // 0-FF
}
return (crc == 0x00ff);
}