gomaomao/DIY-Multiprotocol-TX-Module
1
0
Fork 0
mirror of https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git synced 2025-12-25 04:43:18 +00:00
Code Issues Projects Releases Wiki Activity

Failsafe: default for PPM and set on radio for Serial

Browse Source
This commit is contained in:
Pascal Langer
2017-12-07 16:02:18 +01:00
parent ebd44d9628
commit 4418cab3a5
12 changed files with 255 additions and 237 deletions
Download Patch File Download Diff File Expand all files Collapse all files

16
Multiprotocol/WK2x01_cyrf6936.ino
View File

@@ -317,8 +317,17 @@ static void __attribute__((unused)) WK_build_beacon_pkt_2801()
bind_state = 0x99;
for (uint8_t i = 0; i < 4; i++)
{ // failsafe info: WARNING All channels are set to 0 instead of midstick and 0 for throttle
packet[i+1] = 0;
{
#ifdef FAILSAFE_ENABLE
uint16_t failsafe=Failsafe_data[CH_AETR[i + WK_last_beacon * 4]];
if(failsafe!=FAILSAFE_CHANNEL_HOLD && IS_FAILSAFE_VALUES_on)
{
packet[i+1] = failsafe>>3; //0..255
en |= 1 << i;
}
else
#endif
packet[i+1] = 0;
}
packet[0] = en;
packet[5] = packet[4];
@@ -453,7 +462,8 @@ uint16_t WK_cb()
return 1200;
}
uint16_t WK_setup() {
uint16_t WK_setup()
{
wk2x01_cyrf_init();
CYRF_SetTxRxMode(TX_EN);