This commit is contained in:
@ -785,30 +785,30 @@ void IMTQHandler::fillRawMtmDataset(const uint8_t* packet) {
|
||||
int32_t yRaw = 0;
|
||||
int32_t zRaw = 0;
|
||||
uint32_t coilActStatus = 0;
|
||||
auto res = SerializeAdapter::deSerialize(&xRaw, &dataStart, &deSerLen,
|
||||
SerializeIF::Endianness::LITTLE);
|
||||
if(res != HasReturnvaluesIF::RETURN_OK) {
|
||||
auto res =
|
||||
SerializeAdapter::deSerialize(&xRaw, &dataStart, &deSerLen, SerializeIF::Endianness::LITTLE);
|
||||
if (res != HasReturnvaluesIF::RETURN_OK) {
|
||||
return;
|
||||
}
|
||||
res = SerializeAdapter::deSerialize(&yRaw, &dataStart, &deSerLen,
|
||||
SerializeIF::Endianness::LITTLE);
|
||||
if(res != HasReturnvaluesIF::RETURN_OK) {
|
||||
res =
|
||||
SerializeAdapter::deSerialize(&yRaw, &dataStart, &deSerLen, SerializeIF::Endianness::LITTLE);
|
||||
if (res != HasReturnvaluesIF::RETURN_OK) {
|
||||
return;
|
||||
}
|
||||
res = SerializeAdapter::deSerialize(&zRaw, &dataStart, &deSerLen,
|
||||
SerializeIF::Endianness::LITTLE);
|
||||
if(res != HasReturnvaluesIF::RETURN_OK) {
|
||||
res =
|
||||
SerializeAdapter::deSerialize(&zRaw, &dataStart, &deSerLen, SerializeIF::Endianness::LITTLE);
|
||||
if (res != HasReturnvaluesIF::RETURN_OK) {
|
||||
return;
|
||||
}
|
||||
res = SerializeAdapter::deSerialize(&coilActStatus, &dataStart, &deSerLen,
|
||||
SerializeIF::Endianness::LITTLE);
|
||||
if(res != HasReturnvaluesIF::RETURN_OK) {
|
||||
SerializeIF::Endianness::LITTLE);
|
||||
if (res != HasReturnvaluesIF::RETURN_OK) {
|
||||
return;
|
||||
}
|
||||
rawMtmMeasurementSet.mtmRawNt[0] = xRaw * 7.5;
|
||||
rawMtmMeasurementSet.mtmRawNt[1] = yRaw * 7.5;
|
||||
rawMtmMeasurementSet.mtmRawNt[2] = zRaw * 7.5;
|
||||
rawMtmMeasurementSet.coilActuationStatus = static_cast<uint8_t>(coilActStatus);
|
||||
rawMtmMeasurementSet.coilActuationStatus = static_cast<uint8_t>(coilActStatus);
|
||||
rawMtmMeasurementSet.setValidity(true, true);
|
||||
if (debugMode) {
|
||||
#if OBSW_VERBOSE_LEVEL >= 1
|
||||
|
Reference in New Issue
Block a user