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

View File

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