Refactor IMTQ handling #384
@ -173,6 +173,7 @@ void ImtqPollingTask::handleActuateStep() {
|
|||||||
if (i2cCmdExecActuate(imtq::CC::GET_ENG_HK_DATA) != returnvalue::OK) {
|
if (i2cCmdExecActuate(imtq::CC::GET_ENG_HK_DATA) != returnvalue::OK) {
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
sif::debug << "measure with torque done" << std::endl;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -324,6 +324,7 @@ ReturnValue_t ImtqHandler::interpretDeviceReply(DeviceCommandId_t id, const uint
|
|||||||
status = result;
|
status = result;
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
|
sif::debug << "handle measure with torque" << std::endl;
|
||||||
requestStep = imtq::RequestType::MEASURE_NO_ACTUATION;
|
requestStep = imtq::RequestType::MEASURE_NO_ACTUATION;
|
||||||
ImtqRepliesWithTorque replies(packet);
|
ImtqRepliesWithTorque replies(packet);
|
||||||
if (replies.wasDipoleActuationRead()) {
|
if (replies.wasDipoleActuationRead()) {
|
||||||
@ -357,9 +358,9 @@ ReturnValue_t ImtqHandler::interpretDeviceReply(DeviceCommandId_t id, const uint
|
|||||||
status = result;
|
status = result;
|
||||||
}
|
}
|
||||||
fillEngHkDataset(hkDatasetNoTorque, engHkReply);
|
fillEngHkDataset(hkDatasetNoTorque, engHkReply);
|
||||||
}
|
if (firstReplyCycle) {
|
||||||
if (firstReplyCycle) {
|
firstReplyCycle = false;
|
||||||
firstReplyCycle = false;
|
}
|
||||||
}
|
}
|
||||||
return status;
|
return status;
|
||||||
}
|
}
|
||||||
|
@ -81,7 +81,8 @@ ReturnValue_t CfdpTmFunnel::handlePacket(TmTcMessage& msg) {
|
|||||||
} else {
|
} else {
|
||||||
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
||||||
sif::error << "PusTmFunnel::handlePacket: Store too full to create data copy or store "
|
sif::error << "PusTmFunnel::handlePacket: Store too full to create data copy or store "
|
||||||
"error" << std::endl;
|
"error"
|
||||||
|
<< std::endl;
|
||||||
#endif
|
#endif
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
Loading…
Reference in New Issue
Block a user