Robin Mueller
d09b53f6df
All checks were successful
EIVE/eive-obsw/pipeline/pr-develop This commit looks good
52 lines
1.8 KiB
C++
52 lines
1.8 KiB
C++
#include <fsfw/tasks/TaskFactory.h>
|
|
#include <fsfw/timemanager/Stopwatch.h>
|
|
#include <mission/tmtc/PersistentSingleTmStoreTask.h>
|
|
#include <unistd.h>
|
|
|
|
PersistentSingleTmStoreTask::PersistentSingleTmStoreTask(
|
|
object_id_t objectId, StorageManagerIF& ipcStore, PersistentTmStoreWithTmQueue& tmStore,
|
|
VirtualChannel& channel, Event eventIfDumpDone, Event eventIfCancelled, SdCardMountedIF& sdcMan)
|
|
: TmStoreTaskBase(objectId, ipcStore, channel, sdcMan),
|
|
storeWithQueue(tmStore),
|
|
dumpContext(eventIfDumpDone, eventIfCancelled) {}
|
|
|
|
ReturnValue_t PersistentSingleTmStoreTask::performOperation(uint8_t opCode) {
|
|
ReturnValue_t result = returnvalue::OK;
|
|
uint32_t delaysVcBusyDuringDump = 0;
|
|
uint32_t delaysFlowControl = 0;
|
|
uint32_t delayNotBusy = 0;
|
|
uint32_t delayHotLoop = 0;
|
|
while (true) {
|
|
// Delay done by the check
|
|
if (not cyclicStoreCheck()) {
|
|
continue;
|
|
}
|
|
bool busy = handleOneStore(storeWithQueue, dumpContext);
|
|
if (not busy) {
|
|
TaskFactory::delayTask(100);
|
|
delayNotBusy++;
|
|
} else if (dumpContext.vcBusyDuringDump) {
|
|
// TODO: Might not be necessary
|
|
delaysVcBusyDuringDump++;
|
|
TaskFactory::delayTask(10);
|
|
} else {
|
|
delayHotLoop++;
|
|
}
|
|
// if ((delaysVcBusyDuringDump + delaysFlowControl + delayNotBusy + delayHotLoop) % 2000 ==
|
|
// 0) {
|
|
// sif::debug << "DLY NBUSY: " << delayNotBusy << std::endl;
|
|
// sif::debug << "DLY FLCTRL: " << delaysFlowControl << std::endl;
|
|
// sif::debug << "DLY BUSYDUMP: " << delaysVcBusyDuringDump << std::endl;
|
|
// sif::debug << "DLY HOTLOOP: " << delayHotLoop << std::endl;
|
|
// }
|
|
}
|
|
}
|
|
|
|
bool PersistentSingleTmStoreTask::initStoresIfPossible() {
|
|
if (sdcMan.isSdCardUsable(std::nullopt)) {
|
|
storeWithQueue.initializeTmStore();
|
|
return true;
|
|
}
|
|
return false;
|
|
}
|