Mirror/inav
1
0
Fork 0
mirror of https://github.com/iNavFlight/inav.git synced 2025-07-25 17:25:18 +03:00
Code Issues Wiki Activity

MSP to get logic conditions status

Browse source
This commit is contained in:
Pawel Spychalski (DzikuVx) 2019-09-13 11:11:12 +02:00
parent cc2b2c6753
commit 50bb6c7fe6
2 changed files with 7 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

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

@ -490,6 +490,11 @@ static bool mspFcProcessOutCommand(uint16_t cmdMSP, sbuf_t *dst, mspPostProcessF
sbufWriteU8(dst, logicConditions(i)->flags); sbufWriteU8(dst, logicConditions(i)->flags);
} }
break; break;
case MSP2_INAV_LOGIC_CONDITIONS_STATUS:
for (int i = 0; i < MAX_LOGIC_CONDITIONS; i++) {
sbufWriteU32(dst, logicConditionGetValue(i));
}
break;
#endif #endif
case MSP2_COMMON_MOTOR_MIXER: case MSP2_COMMON_MOTOR_MIXER:
for (uint8_t i = 0; i < MAX_SUPPORTED_MOTORS; i++) { for (uint8_t i = 0; i < MAX_SUPPORTED_MOTORS; i++) {

2
src/main/msp/msp_protocol_v2_inav.h
View file

@ -57,6 +57,8 @@
#define MSP2_INAV_SET_SERVO_MIXER 0x2021 #define MSP2_INAV_SET_SERVO_MIXER 0x2021
#define MSP2_INAV_LOGIC_CONDITIONS 0x2022 #define MSP2_INAV_LOGIC_CONDITIONS 0x2022
#define MSP2_INAV_SET_LOGIC_CONDITIONS 0x2023 #define MSP2_INAV_SET_LOGIC_CONDITIONS 0x2023
#define MSP2_INAV_LOGIC_CONDITIONS_STATUS 0x2026
#define MSP2_PID 0x2030 #define MSP2_PID 0x2030
#define MSP2_SET_PID 0x2031 #define MSP2_SET_PID 0x2031