gomaomao/DIY-Multiprotocol-TX-Module
1
0
Fork 0
mirror of https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git synced 2026-01-02 03:53:15 +00:00
Code Issues Projects Releases Wiki Activity

Bayang: generic frsky hub function

Browse Source
This commit is contained in:
Pascal Langer
2021-02-04 12:05:57 +01:00
parent c866d07743
commit a917227ddc
4 changed files with 34 additions and 22 deletions
Download Patch File Download Diff File Expand all files Collapse all files

26
Multiprotocol/Bayang_nrf24l01.ino
View File

@@ -230,32 +230,16 @@ static void __attribute__((unused)) BAYANG_check_rx(void)
//Flags
//uint8_t flags = packet[3] >> 3;
// battery low: flags & 1
telemetry_link=1;
#if defined HUB_TELEMETRY
// Multiplexed P, I, D values in packet[8] and packet[9].
// The two most significant bits specify which term is sent.
// Remaining 14 bits represent the value: 0 .. 16383 telemetry_in_buffer[6] = 4;
telemetry_in_buffer[6] = 0x04;
telemetry_in_buffer[7] = 0x00;
telemetry_in_buffer[8] = 0x5E;
telemetry_in_buffer[9] = 0x24+(packet[8]>>6); //0x24 = ACCEL_X_ID, so ACCEL_X_ID=P, ACCEL_Y_ID=I, ACCEL_Z_ID=D
uint8_t pos=11;
telemetry_in_buffer[10] = packet[9];
if(telemetry_in_buffer[10] == 0x5D || telemetry_in_buffer[10] == 0x5E)
{// Byte stuffing... I'm not sure if we really care about these 2 values, may be it would be simpler and shorter to just send the value above or below.
telemetry_in_buffer[11] = telemetry_in_buffer[10] ^ 0x60;
telemetry_in_buffer[10] = 0x5D;
telemetry_in_buffer[6]++;
pos++;
}
telemetry_in_buffer[pos] = packet[8] & 0x3F;
// Remaining 14 bits represent the value: 0 .. 16383
frsky_send_user_frame(0x24+(packet[8]>>6), packet[9], packet[8] & 0x3F ); //0x24 = ACCEL_X_ID, so ACCEL_X_ID=P, ACCEL_Y_ID=I, ACCEL_Z_ID=D
#endif
telemetry_counter++;
if(telemetry_lost==0)
#if defined HUB_TELEMETRY
telemetry_link=3;
#else
telemetry_link=1;
#endif
if(telemetry_lost)
telemetry_link=0; // Don't send anything yet
}
}
NRF24L01_SetTxRxMode(TXRX_OFF);