Futaba S-FHSS: Fist attempt to fix failsafe

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

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 // 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++) for(uint8_t i=0;i<4;i++)
{ {
ch[i]=Failsafe_data[CH_AETR[ch_offset+i]]; uint16_t val=Failsafe_data[CH_AETR[ch_offset+i]];
if(ch[i]==FAILSAFE_CHANNEL_HOLD) if(val==FAILSAFE_CHANNEL_HOLD)
ch[i]=1024; ch[i]=1024;
else if(ch[i]==FAILSAFE_CHANNEL_NOPULSES) else if(val==FAILSAFE_CHANNEL_NOPULSES)
ch[i]=0; ch[i]=0;
else else
{ //Use channel value { //Use channel value
ch[i]=(ch[i]>>1)+2560; ch[i] = convert_channel_16b_nolimit(CH_AETR[ch_offset+i],3472,2672,true);
//if(IS_DISABLE_CH_MAP_off && ch_offset+i==CH3 && ch[i]<3072) // Throttle
// ch[i]+=1024;
} }
} }
} }

View File

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