chore: Reduce AFHDS3 console noise when running simulator (#4075)
This commit is contained in:
+29
-29
@@ -417,7 +417,7 @@ void ProtoState::setupFrame()
|
|||||||
}
|
}
|
||||||
|
|
||||||
if (this->state == ModuleState::STATE_NOT_READY) {
|
if (this->state == ModuleState::STATE_NOT_READY) {
|
||||||
TRACE("AFHDS3 [GET MODULE READY]");
|
// TRACE("AFHDS3 [GET MODULE READY]");
|
||||||
trsp.putFrame(COMMAND::MODULE_READY, FRAME_TYPE::REQUEST_GET_DATA);
|
trsp.putFrame(COMMAND::MODULE_READY, FRAME_TYPE::REQUEST_GET_DATA);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
@@ -429,7 +429,7 @@ void ProtoState::setupFrame()
|
|||||||
|
|
||||||
if (moduleMode == ::ModuleSettingsMode::MODULE_MODE_BIND) {
|
if (moduleMode == ::ModuleSettingsMode::MODULE_MODE_BIND) {
|
||||||
if (state != STATE_BINDING) {
|
if (state != STATE_BINDING) {
|
||||||
TRACE("AFHDS3 [BIND]");
|
// TRACE("AFHDS3 [BIND]");
|
||||||
applyConfigFromModel();
|
applyConfigFromModel();
|
||||||
|
|
||||||
trsp.putFrame(COMMAND::MODULE_SET_CONFIG,
|
trsp.putFrame(COMMAND::MODULE_SET_CONFIG,
|
||||||
@@ -457,12 +457,12 @@ void ProtoState::setupFrame()
|
|||||||
if (modelID != newModelID)
|
if (modelID != newModelID)
|
||||||
{
|
{
|
||||||
if (this->state != ModuleState::STATE_STANDBY) {
|
if (this->state != ModuleState::STATE_STANDBY) {
|
||||||
TRACE("AFHDS3 [Model ID Changed] Switch to STATE_STANDBY");
|
// TRACE("AFHDS3 [Model ID Changed] Switch to STATE_STANDBY");
|
||||||
auto mode = (uint8_t)MODULE_MODE_E::STANDBY;
|
auto mode = (uint8_t)MODULE_MODE_E::STANDBY;
|
||||||
trsp.putFrame(COMMAND::MODULE_MODE, FRAME_TYPE::REQUEST_SET_EXPECT_DATA, &mode, 1);
|
trsp.putFrame(COMMAND::MODULE_MODE, FRAME_TYPE::REQUEST_SET_EXPECT_DATA, &mode, 1);
|
||||||
return;
|
return;
|
||||||
} else {
|
} else {
|
||||||
TRACE("AFHDS3 [Model ID Changed] Set ModelID to %d", newModelID);
|
// TRACE("AFHDS3 [Model ID Changed] Set ModelID to %d", newModelID);
|
||||||
modelID = newModelID;
|
modelID = newModelID;
|
||||||
trsp.putFrame(COMMAND::MODEL_ID, FRAME_TYPE::REQUEST_SET_EXPECT_DATA,
|
trsp.putFrame(COMMAND::MODEL_ID, FRAME_TYPE::REQUEST_SET_EXPECT_DATA,
|
||||||
&modelID, 1);
|
&modelID, 1);
|
||||||
@@ -510,7 +510,7 @@ void ProtoState::setupFrame()
|
|||||||
uint16_t failSafe[AFHDS3_MAX_CHANNELS + 1] = {
|
uint16_t failSafe[AFHDS3_MAX_CHANNELS + 1] = {
|
||||||
((AFHDS3_MAX_CHANNELS << 8) | CHANNELS_DATA_MODE::FAIL_SAFE), 0};
|
((AFHDS3_MAX_CHANNELS << 8) | CHANNELS_DATA_MODE::FAIL_SAFE), 0};
|
||||||
setFailSafe((int16_t*)(&failSafe[1]), len);
|
setFailSafe((int16_t*)(&failSafe[1]), len);
|
||||||
TRACE("AFHDS ONE WAY FAILSAFE");
|
// TRACE("AFHDS ONE WAY FAILSAFE");
|
||||||
trsp.putFrame(COMMAND::CHANNELS_FAILSAFE_DATA,
|
trsp.putFrame(COMMAND::CHANNELS_FAILSAFE_DATA,
|
||||||
FRAME_TYPE::REQUEST_SET_NO_RESP, (uint8_t*)failSafe,
|
FRAME_TYPE::REQUEST_SET_NO_RESP, (uint8_t*)failSafe,
|
||||||
AFHDS3_MAX_CHANNELS * 2 + 2);
|
AFHDS3_MAX_CHANNELS * 2 + 2);
|
||||||
@@ -557,7 +557,7 @@ void ProtoState::init(uint8_t moduleIndex, void* buffer,
|
|||||||
|
|
||||||
void ProtoState::clearFrameData()
|
void ProtoState::clearFrameData()
|
||||||
{
|
{
|
||||||
TRACE("AFHDS3 clearFrameData");
|
// TRACE("AFHDS3 clearFrameData");
|
||||||
trsp.clear();
|
trsp.clear();
|
||||||
|
|
||||||
cmdCount = 0;
|
cmdCount = 0;
|
||||||
@@ -600,7 +600,7 @@ void ProtoState::setState(ModuleState state)
|
|||||||
if (state == ModuleState::STATE_SYNC_DONE)
|
if (state == ModuleState::STATE_SYNC_DONE)
|
||||||
{
|
{
|
||||||
// Update power config
|
// Update power config
|
||||||
TRACE("Added PWM CMD");
|
// TRACE("Added PWM CMD");
|
||||||
DIRTY_CMD((&cfg), afhds3::DirtyConfig::DC_RX_CMD_TX_PWR);
|
DIRTY_CMD((&cfg), afhds3::DirtyConfig::DC_RX_CMD_TX_PWR);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@@ -626,7 +626,7 @@ void ProtoState::parseData(uint8_t* rxBuffer, uint8_t rxBufferCount)
|
|||||||
if (containsData((enum FRAME_TYPE) responseFrame->frameType)) {
|
if (containsData((enum FRAME_TYPE) responseFrame->frameType)) {
|
||||||
switch (responseFrame->command) {
|
switch (responseFrame->command) {
|
||||||
case COMMAND::MODULE_READY:
|
case COMMAND::MODULE_READY:
|
||||||
TRACE("AFHDS3 [MODULE_READY] %02X", responseFrame->value);
|
// TRACE("AFHDS3 [MODULE_READY] %02X", responseFrame->value);
|
||||||
if (responseFrame->value == MODULE_STATUS_READY) {
|
if (responseFrame->value == MODULE_STATUS_READY) {
|
||||||
setState(ModuleState::STATE_READY);
|
setState(ModuleState::STATE_READY);
|
||||||
// requestInfoAndRun();
|
// requestInfoAndRun();
|
||||||
@@ -637,22 +637,22 @@ void ProtoState::parseData(uint8_t* rxBuffer, uint8_t rxBufferCount)
|
|||||||
break;
|
break;
|
||||||
case COMMAND::MODULE_GET_CONFIG: {
|
case COMMAND::MODULE_GET_CONFIG: {
|
||||||
// modelcfgGet = false;
|
// modelcfgGet = false;
|
||||||
TRACE("AFHDS3 [MODULE_GET_CONFIG]");
|
// TRACE("AFHDS3 [MODULE_GET_CONFIG]");
|
||||||
size_t len = min<size_t>(sizeof(cfg.buffer), rxBufferCount);
|
size_t len = min<size_t>(sizeof(cfg.buffer), rxBufferCount);
|
||||||
std::memcpy((void*) cfg.buffer, &responseFrame->value, len);
|
std::memcpy((void*) cfg.buffer, &responseFrame->value, len);
|
||||||
moduleData->afhds3.emi = cfg.v0.EMIStandard;
|
moduleData->afhds3.emi = cfg.v0.EMIStandard;
|
||||||
moduleData->afhds3.telemetry = cfg.v0.IsTwoWay;
|
moduleData->afhds3.telemetry = cfg.v0.IsTwoWay;
|
||||||
moduleData->afhds3.phyMode = cfg.v0.PhyMode;
|
moduleData->afhds3.phyMode = cfg.v0.PhyMode;
|
||||||
cfg.others.ExternalBusType = cfg.v0.ExternalBusType;
|
cfg.others.ExternalBusType = cfg.v0.ExternalBusType;
|
||||||
TRACE("PhyMode %d, emi %d", moduleData->afhds3.phyMode, moduleData->afhds3.emi);
|
// TRACE("PhyMode %d, emi %d", moduleData->afhds3.phyMode, moduleData->afhds3.emi);
|
||||||
SET_DIRTY();
|
SET_DIRTY();
|
||||||
cfg.others.lastUpdated = get_tmr10ms();
|
cfg.others.lastUpdated = get_tmr10ms();
|
||||||
} break;
|
} break;
|
||||||
case COMMAND::MODULE_VERSION:
|
case COMMAND::MODULE_VERSION:
|
||||||
std::memcpy((void*) &version, &responseFrame->value, sizeof(version));
|
std::memcpy((void*) &version, &responseFrame->value, sizeof(version));
|
||||||
TRACE("AFHDS3 [MODULE_VERSION] Product %d, HW %d, BOOT %d, FW %d",
|
// TRACE("AFHDS3 [MODULE_VERSION] Product %d, HW %d, BOOT %d, FW %d",
|
||||||
version.productNumber, version.hardwareVersion,
|
// version.productNumber, version.hardwareVersion,
|
||||||
version.bootloaderVersion, version.firmwareVersion);
|
// version.bootloaderVersion, version.firmwareVersion);
|
||||||
break;
|
break;
|
||||||
case COMMAND::MODULE_STATE:
|
case COMMAND::MODULE_STATE:
|
||||||
// TRACE("AFHDS3 [MODULE_STATE] %02X", responseFrame->value);
|
// TRACE("AFHDS3 [MODULE_STATE] %02X", responseFrame->value);
|
||||||
@@ -677,7 +677,7 @@ void ProtoState::parseData(uint8_t* rxBuffer, uint8_t rxBufferCount)
|
|||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
case COMMAND::MODULE_MODE:
|
case COMMAND::MODULE_MODE:
|
||||||
TRACE("AFHDS3 [MODULE_MODE] %02X", responseFrame->value);
|
// TRACE("AFHDS3 [MODULE_MODE] %02X", responseFrame->value);
|
||||||
if (responseFrame->value != CMD_RESULT::SUCCESS) {
|
if (responseFrame->value != CMD_RESULT::SUCCESS) {
|
||||||
setState(ModuleState::STATE_NOT_READY);
|
setState(ModuleState::STATE_NOT_READY);
|
||||||
}
|
}
|
||||||
@@ -686,12 +686,12 @@ void ProtoState::parseData(uint8_t* rxBuffer, uint8_t rxBufferCount)
|
|||||||
if (responseFrame->value != CMD_RESULT::SUCCESS) {
|
if (responseFrame->value != CMD_RESULT::SUCCESS) {
|
||||||
setState(ModuleState::STATE_NOT_READY);
|
setState(ModuleState::STATE_NOT_READY);
|
||||||
}
|
}
|
||||||
TRACE("AFHDS3 [MODULE_SET_CONFIG], %02X", responseFrame->value);
|
// TRACE("AFHDS3 [MODULE_SET_CONFIG], %02X", responseFrame->value);
|
||||||
break;
|
break;
|
||||||
case COMMAND::MODEL_ID:
|
case COMMAND::MODEL_ID:
|
||||||
TRACE("AFHDS3 [MODEL_ID]");
|
// TRACE("AFHDS3 [MODEL_ID]");
|
||||||
if (responseFrame->value == CMD_RESULT::SUCCESS) {
|
if (responseFrame->value == CMD_RESULT::SUCCESS) {
|
||||||
TRACE("Enqueue get config");
|
// TRACE("Enqueue get config");
|
||||||
// trsp.enqueue(COMMAND::MODULE_GET_CONFIG, FRAME_TYPE::REQUEST_GET_DATA);
|
// trsp.enqueue(COMMAND::MODULE_GET_CONFIG, FRAME_TYPE::REQUEST_GET_DATA);
|
||||||
// trsp.enqueue(COMMAND::MODULE_GET_CONFIG, FRAME_TYPE::REQUEST_GET_DATA);
|
// trsp.enqueue(COMMAND::MODULE_GET_CONFIG, FRAME_TYPE::REQUEST_GET_DATA);
|
||||||
// modelcfgGet = true;
|
// modelcfgGet = true;
|
||||||
@@ -770,7 +770,7 @@ void ProtoState::parseData(uint8_t* rxBuffer, uint8_t rxBufferCount)
|
|||||||
default:
|
default:
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
TRACE("AFHDS3 [CMD Result] Cmd: %X, Result: %d, DirtyFlag: %X", cmd_code, result, cfg->others.dirtyFlag);
|
// TRACE("AFHDS3 [CMD Result] Cmd: %X, Result: %d, DirtyFlag: %X", cmd_code, result, cfg->others.dirtyFlag);
|
||||||
} break;
|
} break;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@@ -806,7 +806,7 @@ bool ProtoState::syncSettings()
|
|||||||
// Sync settings when dirty flag is set
|
// Sync settings when dirty flag is set
|
||||||
if (checkDirtyFlag(DC_RX_CMD_TX_PWR))
|
if (checkDirtyFlag(DC_RX_CMD_TX_PWR))
|
||||||
{
|
{
|
||||||
TRACE("AFHDS3 [RX_CMD_TX_PWR] %d", AFHDS3_POWER[moduleData->afhds3.rfPower] / 4);
|
// TRACE("AFHDS3 [RX_CMD_TX_PWR] %d", AFHDS3_POWER[moduleData->afhds3.rfPower] / 4);
|
||||||
uint8_t data[] = { (uint8_t)(RX_CMD_TX_PWR&0xFF), (uint8_t)((RX_CMD_TX_PWR>>8)&0xFF), 2,
|
uint8_t data[] = { (uint8_t)(RX_CMD_TX_PWR&0xFF), (uint8_t)((RX_CMD_TX_PWR>>8)&0xFF), 2,
|
||||||
(uint8_t)(AFHDS3_POWER[moduleData->afhds3.rfPower]&0xFF), (uint8_t)((AFHDS3_POWER[moduleData->afhds3.rfPower]>>8)&0xFF)};
|
(uint8_t)(AFHDS3_POWER[moduleData->afhds3.rfPower]&0xFF), (uint8_t)((AFHDS3_POWER[moduleData->afhds3.rfPower]>>8)&0xFF)};
|
||||||
trsp.putFrame(COMMAND::SEND_COMMAND, FRAME_TYPE::REQUEST_SET_EXPECT_DATA, data, sizeof(data));
|
trsp.putFrame(COMMAND::SEND_COMMAND, FRAME_TYPE::REQUEST_SET_EXPECT_DATA, data, sizeof(data));
|
||||||
@@ -816,7 +816,7 @@ bool ProtoState::syncSettings()
|
|||||||
|
|
||||||
if (checkDirtyFlag(DC_RX_CMD_RSSI_CHANNEL_SETUP))
|
if (checkDirtyFlag(DC_RX_CMD_RSSI_CHANNEL_SETUP))
|
||||||
{
|
{
|
||||||
TRACE("AFHDS3 [RX_CMD_RSSI_CHANNEL_SETUP]");
|
// TRACE("AFHDS3 [RX_CMD_RSSI_CHANNEL_SETUP]");
|
||||||
uint8_t data[] = { (uint8_t)(RX_CMD_RSSI_CHANNEL_SETUP&0xFF), (uint8_t)((RX_CMD_RSSI_CHANNEL_SETUP>>8)&0xFF), 1, cfg->v1.SignalStrengthRCChannelNb };
|
uint8_t data[] = { (uint8_t)(RX_CMD_RSSI_CHANNEL_SETUP&0xFF), (uint8_t)((RX_CMD_RSSI_CHANNEL_SETUP>>8)&0xFF), 1, cfg->v1.SignalStrengthRCChannelNb };
|
||||||
trsp.putFrame(COMMAND::SEND_COMMAND, FRAME_TYPE::REQUEST_SET_EXPECT_DATA, data, sizeof(data));
|
trsp.putFrame(COMMAND::SEND_COMMAND, FRAME_TYPE::REQUEST_SET_EXPECT_DATA, data, sizeof(data));
|
||||||
return true;
|
return true;
|
||||||
@@ -824,14 +824,14 @@ bool ProtoState::syncSettings()
|
|||||||
|
|
||||||
if (checkDirtyFlag(DC_RX_CMD_OUT_PWM_PPM_MODE))
|
if (checkDirtyFlag(DC_RX_CMD_OUT_PWM_PPM_MODE))
|
||||||
{
|
{
|
||||||
TRACE("AFHDS3 [RX_CMD_OUT_PWM_PPM_MODE]");
|
// TRACE("AFHDS3 [RX_CMD_OUT_PWM_PPM_MODE]");
|
||||||
uint8_t data[] = { (uint8_t)(RX_CMD_OUT_PWM_PPM_MODE&0xFF), (uint8_t)((RX_CMD_OUT_PWM_PPM_MODE>>8)&0xFF), 1, cfg->v0.AnalogOutput };
|
uint8_t data[] = { (uint8_t)(RX_CMD_OUT_PWM_PPM_MODE&0xFF), (uint8_t)((RX_CMD_OUT_PWM_PPM_MODE>>8)&0xFF), 1, cfg->v0.AnalogOutput };
|
||||||
trsp.putFrame(COMMAND::SEND_COMMAND, FRAME_TYPE::REQUEST_SET_EXPECT_DATA, data, sizeof(data));
|
trsp.putFrame(COMMAND::SEND_COMMAND, FRAME_TYPE::REQUEST_SET_EXPECT_DATA, data, sizeof(data));
|
||||||
return true;
|
return true;
|
||||||
}
|
}
|
||||||
if (checkDirtyFlag(DC_RX_CMD_FREQUENCY_V0))
|
if (checkDirtyFlag(DC_RX_CMD_FREQUENCY_V0))
|
||||||
{
|
{
|
||||||
TRACE("AFHDS3 [RX_CMD_FREQUENCY_V0]");
|
// TRACE("AFHDS3 [RX_CMD_FREQUENCY_V0]");
|
||||||
uint16_t Frequency = ((cfg->v0.PWMFrequency.Synchronized<<15)| cfg->v0.PWMFrequency.Frequency);
|
uint16_t Frequency = ((cfg->v0.PWMFrequency.Synchronized<<15)| cfg->v0.PWMFrequency.Frequency);
|
||||||
uint8_t data[] = { (uint8_t)(RX_CMD_FREQUENCY_V0&0xFF), (uint8_t)((RX_CMD_FREQUENCY_V0>>8)&0xFF), 2,
|
uint8_t data[] = { (uint8_t)(RX_CMD_FREQUENCY_V0&0xFF), (uint8_t)((RX_CMD_FREQUENCY_V0>>8)&0xFF), 2,
|
||||||
(uint8_t)(Frequency&0xFF), (uint8_t)((Frequency>>8)&0xFF) };
|
(uint8_t)(Frequency&0xFF), (uint8_t)((Frequency>>8)&0xFF) };
|
||||||
@@ -841,7 +841,7 @@ bool ProtoState::syncSettings()
|
|||||||
|
|
||||||
if (checkDirtyFlag(DC_RX_CMD_PORT_TYPE_V1))
|
if (checkDirtyFlag(DC_RX_CMD_PORT_TYPE_V1))
|
||||||
{
|
{
|
||||||
TRACE("AFHDS3 [RX_CMD_PORT_TYPE_V1]");
|
// TRACE("AFHDS3 [RX_CMD_PORT_TYPE_V1]");
|
||||||
uint8_t data[] = { (uint8_t)(RX_CMD_PORT_TYPE_V1&0xFF), (uint8_t)((RX_CMD_PORT_TYPE_V1>>8)&0xFF), 4, 0, 0, 0, 0 };
|
uint8_t data[] = { (uint8_t)(RX_CMD_PORT_TYPE_V1&0xFF), (uint8_t)((RX_CMD_PORT_TYPE_V1>>8)&0xFF), 4, 0, 0, 0, 0 };
|
||||||
std::memcpy(&data[3], &cfg->v1.NewPortTypes, SES_NPT_NB_MAX_PORTS);
|
std::memcpy(&data[3], &cfg->v1.NewPortTypes, SES_NPT_NB_MAX_PORTS);
|
||||||
trsp.putFrame(COMMAND::SEND_COMMAND, FRAME_TYPE::REQUEST_SET_EXPECT_DATA, data, sizeof(data));
|
trsp.putFrame(COMMAND::SEND_COMMAND, FRAME_TYPE::REQUEST_SET_EXPECT_DATA, data, sizeof(data));
|
||||||
@@ -850,7 +850,7 @@ bool ProtoState::syncSettings()
|
|||||||
|
|
||||||
if (checkDirtyFlag(DC_RX_CMD_FREQUENCY_V1))
|
if (checkDirtyFlag(DC_RX_CMD_FREQUENCY_V1))
|
||||||
{
|
{
|
||||||
TRACE("AFHDS3 [RX_CMD_FREQUENCY_V1]");
|
// TRACE("AFHDS3 [RX_CMD_FREQUENCY_V1]");
|
||||||
uint8_t data[32 + 3 + 3] = { (uint8_t)(RX_CMD_FREQUENCY_V1&0xFF), (uint8_t)((RX_CMD_FREQUENCY_V1>>8)&0xFF), 32+3};
|
uint8_t data[32 + 3 + 3] = { (uint8_t)(RX_CMD_FREQUENCY_V1&0xFF), (uint8_t)((RX_CMD_FREQUENCY_V1>>8)&0xFF), 32+3};
|
||||||
data[3] = 0;
|
data[3] = 0;
|
||||||
std::memcpy(&data[4], &cfg->v1.PWMFrequenciesV1.PWMFrequencies[0], 32);
|
std::memcpy(&data[4], &cfg->v1.PWMFrequenciesV1.PWMFrequencies[0], 32);
|
||||||
@@ -863,7 +863,7 @@ bool ProtoState::syncSettings()
|
|||||||
|
|
||||||
if (checkDirtyFlag(DC_RX_CMD_FREQUENCY_V1_2))
|
if (checkDirtyFlag(DC_RX_CMD_FREQUENCY_V1_2))
|
||||||
{
|
{
|
||||||
TRACE("AFHDS3 [RX_CMD_FREQUENCY_V1_2]");
|
// TRACE("AFHDS3 [RX_CMD_FREQUENCY_V1_2]");
|
||||||
uint8_t data[32 + 3 + 3] = { (uint8_t)(RX_CMD_FREQUENCY_V1_2&0xFF), (uint8_t)((RX_CMD_FREQUENCY_V1_2>>8)&0xFF), 32+3};
|
uint8_t data[32 + 3 + 3] = { (uint8_t)(RX_CMD_FREQUENCY_V1_2&0xFF), (uint8_t)((RX_CMD_FREQUENCY_V1_2>>8)&0xFF), 32+3};
|
||||||
data[3] = 1;
|
data[3] = 1;
|
||||||
std::memcpy(&data[4], &cfg->v1.PWMFrequenciesV1.PWMFrequencies[16], 32);
|
std::memcpy(&data[4], &cfg->v1.PWMFrequenciesV1.PWMFrequencies[16], 32);
|
||||||
@@ -875,7 +875,7 @@ bool ProtoState::syncSettings()
|
|||||||
|
|
||||||
if (checkDirtyFlag(DC_RX_CMD_BUS_TYPE_V0))
|
if (checkDirtyFlag(DC_RX_CMD_BUS_TYPE_V0))
|
||||||
{
|
{
|
||||||
TRACE("AFHDS3 [RX_CMD_BUS_TYPE_V0]");
|
// TRACE("AFHDS3 [RX_CMD_BUS_TYPE_V0]");
|
||||||
bool onlySupportIBUSOut = (1==receiver_type(rx_version.ProductNumber));
|
bool onlySupportIBUSOut = (1==receiver_type(rx_version.ProductNumber));
|
||||||
|
|
||||||
if (onlySupportIBUSOut && cfg->others.ExternalBusType == EB_BT_IBUS1_IN)
|
if (onlySupportIBUSOut && cfg->others.ExternalBusType == EB_BT_IBUS1_IN)
|
||||||
@@ -889,7 +889,7 @@ bool ProtoState::syncSettings()
|
|||||||
|
|
||||||
if (checkDirtyFlag(DC_RX_CMD_BUS_TYPE_V0_2))
|
if (checkDirtyFlag(DC_RX_CMD_BUS_TYPE_V0_2))
|
||||||
{
|
{
|
||||||
TRACE("AFHDS3 [RX_CMD_BUS_TYPE_V0]");
|
// TRACE("AFHDS3 [RX_CMD_BUS_TYPE_V0]");
|
||||||
bool onlySupportIBUSOut = (1==receiver_type(rx_version.ProductNumber));
|
bool onlySupportIBUSOut = (1==receiver_type(rx_version.ProductNumber));
|
||||||
|
|
||||||
if (onlySupportIBUSOut && cfg->others.ExternalBusType == EB_BT_IBUS1_IN)
|
if (onlySupportIBUSOut && cfg->others.ExternalBusType == EB_BT_IBUS1_IN)
|
||||||
@@ -912,7 +912,7 @@ bool ProtoState::syncSettings()
|
|||||||
bus_dir = BUS_OUT;
|
bus_dir = BUS_OUT;
|
||||||
else
|
else
|
||||||
bus_dir = BUS_IN;
|
bus_dir = BUS_IN;
|
||||||
TRACE("AFHDS3 [RX_CMD_IBUS_DIRECTION]");
|
// TRACE("AFHDS3 [RX_CMD_IBUS_DIRECTION]");
|
||||||
uint8_t data[4] = { (uint8_t)(RX_CMD_IBUS_DIRECTION&0xFF), (uint8_t)((RX_CMD_IBUS_DIRECTION>>8)&0xFF), 1, bus_dir };
|
uint8_t data[4] = { (uint8_t)(RX_CMD_IBUS_DIRECTION&0xFF), (uint8_t)((RX_CMD_IBUS_DIRECTION>>8)&0xFF), 1, bus_dir };
|
||||||
trsp.putFrame( COMMAND::SEND_COMMAND, FRAME_TYPE::REQUEST_SET_EXPECT_DATA, data, sizeof(data) );
|
trsp.putFrame( COMMAND::SEND_COMMAND, FRAME_TYPE::REQUEST_SET_EXPECT_DATA, data, sizeof(data) );
|
||||||
return true;
|
return true;
|
||||||
@@ -948,7 +948,7 @@ void ProtoState::sendChannelsData()
|
|||||||
|
|
||||||
void ProtoState::stop()
|
void ProtoState::stop()
|
||||||
{
|
{
|
||||||
TRACE("AFHDS3 STOP");
|
// TRACE("AFHDS3 STOP");
|
||||||
auto mode = (uint8_t)MODULE_MODE_E::STANDBY;
|
auto mode = (uint8_t)MODULE_MODE_E::STANDBY;
|
||||||
trsp.putFrame(COMMAND::MODULE_MODE, FRAME_TYPE::REQUEST_SET_EXPECT_DATA, &mode, 1);
|
trsp.putFrame(COMMAND::MODULE_MODE, FRAME_TYPE::REQUEST_SET_EXPECT_DATA, &mode, 1);
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -135,7 +135,7 @@ bool FrameTransport::processTelemetryData(uint8_t byte, uint8_t* rxBuffer,
|
|||||||
uint8_t maxSize)
|
uint8_t maxSize)
|
||||||
{
|
{
|
||||||
if (rxBufferCount == 0 && byte != START) {
|
if (rxBufferCount == 0 && byte != START) {
|
||||||
TRACE("AFHDS3 [SKIP] %02X", byte);
|
// TRACE("AFHDS3 [SKIP] %02X", byte);
|
||||||
this->esc_state = 0;
|
this->esc_state = 0;
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
@@ -280,11 +280,11 @@ bool Transport::processQueue()
|
|||||||
trsp.putFrame(f->command, f->frameType, &f->payload, f->payloadSize,
|
trsp.putFrame(f->command, f->frameType, &f->payload, f->payloadSize,
|
||||||
f->useFrameNumber ? f->frameNumber : frameIndex);
|
f->useFrameNumber ? f->frameNumber : frameIndex);
|
||||||
|
|
||||||
TRACE(
|
// TRACE(
|
||||||
"AFHDS3 [CMD QUEUE] cmd: 0x%02x frameType 0x%02x, useFrameNumber %d "
|
// "AFHDS3 [CMD QUEUE] cmd: 0x%02x frameType 0x%02x, useFrameNumber %d "
|
||||||
"frame Number %d size %d",
|
// "frame Number %d size %d",
|
||||||
f->command, f->frameType, f->useFrameNumber, f->frameNumber,
|
// f->command, f->frameType, f->useFrameNumber, f->frameNumber,
|
||||||
f->payloadSize);
|
// f->payloadSize);
|
||||||
|
|
||||||
if (!f->useFrameNumber) frameIndex++;
|
if (!f->useFrameNumber) frameIndex++;
|
||||||
fifo.skip();
|
fifo.skip();
|
||||||
@@ -300,7 +300,7 @@ bool Transport::handleRetransmissions(bool& error)
|
|||||||
return true; // re-send
|
return true; // re-send
|
||||||
}
|
}
|
||||||
|
|
||||||
TRACE("AFHDS3 [NO RESP]");
|
// TRACE("AFHDS3 [NO RESP]");
|
||||||
error = true;
|
error = true;
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
@@ -333,9 +333,9 @@ bool Transport::handleReply(uint8_t* buffer, uint8_t len)
|
|||||||
return true;
|
return true;
|
||||||
}
|
}
|
||||||
|
|
||||||
TRACE("AFHDS3 [SEND ACK] cmd %02X type %02X number %02X",
|
// TRACE("AFHDS3 [SEND ACK] cmd %02X type %02X number %02X",
|
||||||
responseFrame->command, responseFrame->frameType,
|
// responseFrame->command, responseFrame->frameType,
|
||||||
responseFrame->frameNumber);
|
// responseFrame->frameNumber);
|
||||||
|
|
||||||
auto command = (enum COMMAND)responseFrame->command;
|
auto command = (enum COMMAND)responseFrame->command;
|
||||||
trsp.putFrame(command, FRAME_TYPE::RESPONSE_ACK, nullptr, 0,
|
trsp.putFrame(command, FRAME_TYPE::RESPONSE_ACK, nullptr, 0,
|
||||||
|
|||||||
Reference in New Issue
Block a user