|
@@ -485,12 +485,13 @@ static uint8_t crsfSchedule[CRSF_SCHEDULE_COUNT_MAX];
|
|
|
|
|
|
|
|
static bool mspReplyPending;
|
|
static bool mspReplyPending;
|
|
|
|
|
|
|
|
-void crsfScheduleMspResponse(void)
|
|
|
|
|
|
|
+void crsfScheduleMspResponse(uint8_t requestOriginID)
|
|
|
{
|
|
{
|
|
|
|
|
+ UNUSED(requestOriginID);
|
|
|
mspReplyPending = true;
|
|
mspReplyPending = true;
|
|
|
}
|
|
}
|
|
|
|
|
|
|
|
-void crsfSendMspResponse(uint8_t *payload)
|
|
|
|
|
|
|
+void crsfSendMspResponse(uint8_t *payload, const uint8_t requestOriginID)
|
|
|
{
|
|
{
|
|
|
sbuf_t crsfPayloadBuf;
|
|
sbuf_t crsfPayloadBuf;
|
|
|
sbuf_t *dst = &crsfPayloadBuf;
|
|
sbuf_t *dst = &crsfPayloadBuf;
|
|
@@ -498,7 +499,7 @@ void crsfSendMspResponse(uint8_t *payload)
|
|
|
crsfInitializeFrame(dst);
|
|
crsfInitializeFrame(dst);
|
|
|
sbufWriteU8(dst, CRSF_FRAME_TX_MSP_FRAME_SIZE + CRSF_FRAME_LENGTH_EXT_TYPE_CRC);
|
|
sbufWriteU8(dst, CRSF_FRAME_TX_MSP_FRAME_SIZE + CRSF_FRAME_LENGTH_EXT_TYPE_CRC);
|
|
|
crsfSerialize8(dst, CRSF_FRAMETYPE_MSP_RESP);
|
|
crsfSerialize8(dst, CRSF_FRAMETYPE_MSP_RESP);
|
|
|
- crsfSerialize8(dst, CRSF_ADDRESS_RADIO_TRANSMITTER);
|
|
|
|
|
|
|
+ crsfSerialize8(dst, requestOriginID);
|
|
|
crsfSerialize8(dst, CRSF_ADDRESS_FLIGHT_CONTROLLER);
|
|
crsfSerialize8(dst, CRSF_ADDRESS_FLIGHT_CONTROLLER);
|
|
|
crsfSerializeData(dst, (const uint8_t*)payload, CRSF_FRAME_TX_MSP_FRAME_SIZE);
|
|
crsfSerializeData(dst, (const uint8_t*)payload, CRSF_FRAME_TX_MSP_FRAME_SIZE);
|
|
|
crsfFinalize(dst);
|
|
crsfFinalize(dst);
|