gomaomao/DIY-Multiprotocol-TX-Module
1
0
Fork 0
mirror of https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git synced 2026-01-01 10:44:44 +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

20
Multiprotocol/Devo_cyrf6936.ino
View File

@@ -94,15 +94,29 @@ static void __attribute__((unused)) DEVO_add_pkt_suffix()
static void __attribute__((unused)) DEVO_build_beacon_pkt(uint8_t upper)
{
packet[0] = (DEVO_NUM_CHANNELS << 4) | 0x07;
uint8_t max = 8;
uint8_t max = 8, offset = 0, enable = 0;
if (upper)
{
packet[0] += 1;
max = 4;
offset = 8;
}
for(uint8_t i = 0; i < max; i++)
packet[i+1] = 0;
packet[9] = 0;
{
#ifdef FAILSAFE_ENABLE
uint16_t failsafe=Failsafe_data[CH_EATR[i+offset]];
if(i + offset < DEVO_NUM_CHANNELS && failsafe!=FAILSAFE_CHANNEL_HOLD && IS_FAILSAFE_VALUES_on)
{
enable |= 0x80 >> i;
packet[i+1] = ((failsafe*25)>>8)-100;
}
else
#else
(void)offset;
#endif
packet[i+1] = 0;
}
packet[9] = enable;
DEVO_add_pkt_suffix();
}