diff --git a/Multiprotocol/FQ777_nrf24l01.ino b/Multiprotocol/FQ777_nrf24l01.ino index 0585689a..6b8a807a 100644 --- a/Multiprotocol/FQ777_nrf24l01.ino +++ b/Multiprotocol/FQ777_nrf24l01.ino @@ -128,8 +128,8 @@ static void __attribute__((unused)) FQ777_send_packet() packet_ori[1] = convert_channel_16b_limit(RUDDER,0,0xE1); packet_ori[2] = convert_channel_16b_limit(AILERON,0xE1,0); // reverse channel packet_ori[3] = convert_channel_16b_limit(ELEVATOR,0xE1,0); // reverse channel - packet_ori[4] = (convert_channel_8b(CH13) << 2) + 1; // ele trim (01..20..40) front ^ plus 0x01, back - minus 0x01 per click - packet_ori[5] = 0x3F - (convert_channel_8b(CH14) << 2) // ail trim (40..20..01) left <- plus 0x01, right -> minus 0x01 per click + packet_ori[4] = (convert_channel_8b(CH13) >> 2) + 1; // ele trim (01..20..40) front ^ plus 0x01, back - minus 0x01 per click + packet_ori[5] = 0x3F - (convert_channel_8b(CH14) >> 2) // ail trim (40..20..01) left <- plus 0x01, right -> minus 0x01 per click | GET_FLAG(CH12_SW, XBM37_B5_OK); // bit7 = OK button ...unknown use for this model? uint8_t rate_bits;