Options mostly working (pinmap is ok), TRACES still included

This commit is contained in:
3djc
2019-03-11 09:16:04 +01:00
parent a44dad9bb2
commit bc4248c4ff
3 changed files with 24 additions and 17 deletions
+10 -8
View File
@@ -62,15 +62,17 @@ void processGetHardwareInfoFrame(uint8_t module, uint8_t * frame)
void processReceiverSettingsFrame(uint8_t module, uint8_t * frame)
{
if (reusableBuffer.receiverSetup.state == RECEIVER_WAITING_RESPONSE) {
for (uint8_t pin = 0; pin < 24; pin++) {
reusableBuffer.receiverSetup.channelMapping[pin] = frame[5 + pin];
}
reusableBuffer.receiverSetup.pwmRate = frame[4] & 0x30;
reusableBuffer.receiverSetup.state = RECEIVER_OK;
reusableBuffer.receiverSetup.timeout = 0;
moduleSettings[module].mode = MODULE_MODE_NORMAL;
TRACE("Got Option frame");
for (uint8_t pin = 0; pin < 24; pin++) {
reusableBuffer.receiverSetup.channelMapping[pin] = frame[5 + pin];
}
if(frame[4] & PXX2_RECV_OPTION_MASK_FASTPWM)
reusableBuffer.receiverSetup.pwmRate = 1;
if(frame[4] & PXX2_RECV_OPTION_MASK_TELEMETRY)
reusableBuffer.receiverSetup.telemetryEnabled = 1;
reusableBuffer.receiverSetup.state = RECEIVER_OK;
reusableBuffer.receiverSetup.timeout = 0;
moduleSettings[module].mode = MODULE_MODE_NORMAL;
}
void processRegisterFrame(uint8_t module, uint8_t * frame)