Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-21 23:35:34 +03:00
Code Issues Wiki Activity

Added transponder config

Browse source
This commit is contained in:
Martin Budden 2017-02-24 22:42:00 +00:00
parent ff40e8c844
commit a897f5e23b
6 changed files with 29 additions and 16 deletions
Download patch file Download diff file Expand all files Collapse all files

12
src/main/fc/fc_msp.c
View file

@ -1062,8 +1062,8 @@ static bool mspFcProcessOutCommand(uint8_t cmdMSP, sbuf_t *dst, mspPostProcessFn
case MSP_TRANSPONDER_CONFIG:
#ifdef TRANSPONDER
sbufWriteU8(dst, 1); //Transponder supported
for (unsigned int i = 0; i < sizeof(masterConfig.transponderData); i++) {
sbufWriteU8(dst, masterConfig.transponderData[i]);
for (unsigned int i = 0; i < sizeof(transponderConfig()->data); i++) {
sbufWriteU8(dst, transponderConfig()->data[i]);
}
#else
sbufWriteU8(dst, 0); // Transponder not supported
@ -1601,13 +1601,13 @@ static mspResult_e mspFcProcessInCommand(uint8_t cmdMSP, sbuf_t *src)
#ifdef TRANSPONDER
case MSP_SET_TRANSPONDER_CONFIG:
if (dataSize != sizeof(masterConfig.transponderData)) {
if (dataSize != sizeof(transponderConfig()->data)) {
return MSP_RESULT_ERROR;
}
for (unsigned int i = 0; i < sizeof(masterConfig.transponderData); i++) {
masterConfig.transponderData[i] = sbufReadU8(src);
for (unsigned int i = 0; i < sizeof(transponderConfig()->data); i++) {
transponderConfigMutable()->data[i] = sbufReadU8(src);
}
transponderUpdateData(masterConfig.transponderData);
transponderUpdateData();
break;
#endif