mavlink: fix for new dataman while reading transfer_dataman_id

This commit is contained in:
Igor Mišić
2021-07-22 14:48:25 +02:00
parent f95c899d18
commit bb6bf89913
+6 -1
View File
@@ -1018,8 +1018,13 @@ MavlinkMissionManager::next_transfer_dataman_id()
transfer_dataman_id = (_dataman_id == DM_KEY_WAYPOINTS_OFFBOARD_0 ? DM_KEY_WAYPOINTS_OFFBOARD_1 :
DM_KEY_WAYPOINTS_OFFBOARD_0); // use inactive storage for transmission
} else if (ret == 0) {
//dataman is empty (new or formatted SD card)
transfer_dataman_id = DM_KEY_WAYPOINTS_OFFBOARD_0;
} else {
PX4_ERR("Can't read DM_KEY_MISSION_STATE");
PX4_ERR("Dataman can't read DM_KEY_MISSION_STATE. The actual size of readout is %d, expected size is %d.", ret,
static_cast<int>(sizeof(mission_s)));
}
return transfer_dataman_id;