DEVO telemetry: reduce the voltage and RSSI refresh frequency

This commit is contained in:
Pascal Langer 2021-03-02 17:37:28 +01:00
parent ca9e2870ab
commit 07df1a8959

View File

@ -210,13 +210,7 @@ static void __attribute__((unused)) DEVO_parse_telemetry_packet()
return; // Previous telemetry not sent yet... return; // Previous telemetry not sent yet...
} }
//RSSI //Debug telem RX
TX_RSSI = CYRF_ReadRegister(CYRF_13_RSSI) & 0x1F;
TX_RSSI = (TX_RSSI << 1) + TX_RSSI;
RX_RSSI = TX_RSSI;
telemetry_link |= 1;
//debug
//for(uint8_t i=0;i<12;i++) //for(uint8_t i=0;i<12;i++)
// debug("%02X ",packet[i]); // debug("%02X ",packet[i]);
//debugln(""); //debugln("");
@ -227,6 +221,11 @@ static void __attribute__((unused)) DEVO_parse_telemetry_packet()
switch(packet[0]) switch(packet[0])
{ {
case 0x30: // Volt and RPM packet case 0x30: // Volt and RPM packet
//RSSI and voltage
TX_RSSI = CYRF_ReadRegister(CYRF_13_RSSI) & 0x1F;
TX_RSSI = (TX_RSSI << 1) + TX_RSSI;
RX_RSSI = TX_RSSI;
telemetry_link |= 1;
v_lipo1 = packet[1] << 1; v_lipo1 = packet[1] << 1;
v_lipo2 = packet[3] << 1; v_lipo2 = packet[3] << 1;
//packet[5] = 127; // 12.7V //packet[5] = 127; // 12.7V
@ -295,6 +294,10 @@ static void __attribute__((unused)) DEVO_parse_telemetry_packet()
#else #else
if(packet[0] == 0x30) if(packet[0] == 0x30)
{ {
TX_RSSI = CYRF_ReadRegister(CYRF_13_RSSI) & 0x1F;
TX_RSSI = (TX_RSSI << 1) + TX_RSSI;
RX_RSSI = TX_RSSI;
telemetry_link |= 1;
v_lipo1 = packet[1] << 1; v_lipo1 = packet[1] << 1;
v_lipo2 = packet[3] << 1; v_lipo2 = packet[3] << 1;
} }