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

Add: Telemetry display for Hubsan TX RSSI

Browse Source
This commit is contained in:
pascallanger
2016-01-28 17:25:15 +01:00
parent c74de12ceb
commit 85548d6e8e
3 changed files with 29 additions and 21 deletions
Download Patch File Download Diff File Expand all files Collapse all files

32
Multiprotocol/Hubsan_a7105.ino
View File

@@ -181,14 +181,16 @@ static void __attribute__((unused)) hubsan_build_packet()
}
#if defined(TELEMETRY)
/*static uint8_t hubsan_check_integrity()
static __attribute__((unused)) uint8_t hubsan_check_integrity()
{
int sum = 0;
if( (packet[0]&0xFE) != 0xE0 )
return 0;
return 1;
uint8_t sum = 0;
for(uint8_t i = 0; i < 15; i++)
sum += packet[i];
return packet[15] == ((256 - (sum % 256)) & 0xFF);
return ( packet[15] == (uint8_t)(-sum) );
}
*/
#endif
uint16_t ReadHubsan()
@@ -295,7 +297,8 @@ uint16_t ReadHubsan()
}
else {
#if defined(TELEMETRY)
if( rfMode == A7105_TX) {// switch to rx mode 3ms after packet sent
if( rfMode == A7105_TX)
{// switch to rx mode 3ms after packet sent
for( i=0; i<10; i++)
{
if( !(A7105_ReadReg(A7105_00_MODE) & 0x01)) {// wait for tx completion
@@ -306,15 +309,23 @@ uint16_t ReadHubsan()
}
}
}
if( rfMode == A7105_RX) { // check for telemetry frame
for( i=0; i<10; i++) {
if( !(A7105_ReadReg(A7105_00_MODE) & 0x01)) { // data received
if( rfMode == A7105_RX)
{ // check for telemetry frame
for( i=0; i<10; i++)
{
if( !(A7105_ReadReg(A7105_00_MODE) & 0x01))
{ // data received
A7105_ReadData();
if( !(A7105_ReadReg(A7105_00_MODE) & 0x01)){ // data received
v_lipo=packet[13];// hubsan lipo voltage 8bits the real value is h_lipo/10(0x2A=42-4.2V)
if( hubsan_check_integrity() )
{
v_lipo=packet[13];// hubsan lipo voltage 8bits the real value is h_lipo/10(0x2A=42 -> 4.2V)
telemetry_link=1;
}
A7105_Strobe(A7105_RX);
// Read TX RSSI
RSSI_dBm=256-(A7105_ReadReg(A7105_1D_RSSI_THOLD)*8)/5; // value from A7105 is between 8 for maximum signal strength to 160 or less
if(RSSI_dBm<0) RSSI_dBm=0;
else if(RSSI_dBm>255) RSSI_dBm=255;
break;
}
}
@@ -344,7 +355,6 @@ uint16_t initHubsan() {
packet_count=0;
id_data=ID_NORMAL;
#if defined(TELEMETRY)
v_lipo=0;
telemetry_link=0;
#endif
return 10000;