rusefi
/
atbetaflight
mirror of https://github.com/rusefi/atbetaflight.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Added DSHOT beacon config to MSP_(SET_)BEEPER

This commit is contained in:
Bas Delfos 2018-01-31 23:12:08 +01:00
parent b4d399eb3a
commit ff68f0da0d
1 changed files with 3 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
src/main/interface/msp.c
View File

@ -40,6 +40,7 @@
#include "config/feature.h" #include "config/feature.h"
#include "pg/pg.h" #include "pg/pg.h"
#include "pg/pg_ids.h" #include "pg/pg_ids.h"
#include "pg/beeper.h"
#include "drivers/accgyro/accgyro.h" #include "drivers/accgyro/accgyro.h"
#include "drivers/bus_i2c.h" #include "drivers/bus_i2c.h"
@ -473,6 +474,7 @@ static bool mspCommonProcessOutCommand(uint8_t cmdMSP, sbuf_t *dst, mspPostProce
#ifdef BEEPER #ifdef BEEPER
case MSP_BEEPER_CONFIG: case MSP_BEEPER_CONFIG:
sbufWriteU32(dst, getBeeperOffMask()); sbufWriteU32(dst, getBeeperOffMask());
sbufWriteU8(dst, beeperConfig()->dshotBeaconTone);
break; break;
#endif #endif
@ -1839,6 +1841,7 @@ static mspResult_e mspProcessInCommand(uint8_t cmdMSP, sbuf_t *src)
case MSP_SET_BEEPER_CONFIG: case MSP_SET_BEEPER_CONFIG:
beeperOffClearAll(); beeperOffClearAll();
setBeeperOffMask(sbufReadU32(src)); setBeeperOffMask(sbufReadU32(src));
beeperConfigMutable()->dshotBeaconTone = sbufReadU8(src);
break; break;
#endif #endif