gomaomao/DIY-Multiprotocol-TX-Module
1
0
Fork 0
mirror of https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git synced 2025-02-04 16:28:10 +00:00
Code Issues Projects Releases Wiki Activity

Futaba S-FHSS: Fist attempt to fix failsafe

Browse Source
This commit is contained in:
Pascal Langer 2021-02-01 11:54:16 +01:00
parent 983debe6ce
commit 9c35f6f73c
2 changed files with 5 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
Multiprotocol/Futaba_cc2500.ino
View File

@ -164,16 +164,14 @@ static void __attribute__((unused)) SFHSS_build_data_packet()
// 3584-4095 -> looks to be used for the throttle channel with values ranging from 880µs to 1520µs
for(uint8_t i=0;i<4;i++)
{
ch[i]=Failsafe_data[CH_AETR[ch_offset+i]];
if(ch[i]==FAILSAFE_CHANNEL_HOLD)
uint16_t val=Failsafe_data[CH_AETR[ch_offset+i]];
if(val==FAILSAFE_CHANNEL_HOLD)
ch[i]=1024;
else if(ch[i]==FAILSAFE_CHANNEL_NOPULSES)
else if(val==FAILSAFE_CHANNEL_NOPULSES)
ch[i]=0;
else
{ //Use channel value
ch[i]=(ch[i]>>1)+2560;
//if(IS_DISABLE_CH_MAP_off && ch_offset+i==CH3 && ch[i]<3072) // Throttle
// ch[i]+=1024;
ch[i] = convert_channel_16b_nolimit(CH_AETR[ch_offset+i],3472,2672,true);
}
}
}

2
Multiprotocol/Multiprotocol.h
View File

@ -19,7 +19,7 @@
#define VERSION_MAJOR 1
#define VERSION_MINOR 3
#define VERSION_REVISION 2
#define VERSION_PATCH_LEVEL 15
#define VERSION_PATCH_LEVEL 16
//******************
// Protocols