79 lines
2.9 KiB
C++
79 lines
2.9 KiB
C++
#include "PersistentLogTmStoreTask.h"
|
|
|
|
#include <fsfw/tasks/TaskFactory.h>
|
|
#include <fsfw/timemanager/Stopwatch.h>
|
|
|
|
PersistentLogTmStoreTask::PersistentLogTmStoreTask(object_id_t objectId, StorageManagerIF& ipcStore,
|
|
LogStores stores, VirtualChannel& channel,
|
|
SdCardMountedIF& sdcMan,
|
|
const std::atomic_bool& ptmeLocked)
|
|
: TmStoreTaskBase(objectId, ipcStore, channel, sdcMan, ptmeLocked),
|
|
stores(stores),
|
|
okStoreContext(persTmStore::DUMP_OK_STORE_DONE, persTmStore::DUMP_OK_CANCELLED),
|
|
notOkStoreContext(persTmStore::DUMP_NOK_STORE_DONE, persTmStore::DUMP_NOK_CANCELLED),
|
|
miscStoreContext(persTmStore::DUMP_MISC_STORE_DONE, persTmStore::DUMP_MISC_CANCELLED) {}
|
|
|
|
ReturnValue_t PersistentLogTmStoreTask::performOperation(uint8_t opCode) {
|
|
bool someonesBusy = false;
|
|
bool vcBusyDuringDump = false;
|
|
auto stateHandlingForStore = [&](bool storeIsBusy, DumpContext& ctx) {
|
|
if (storeIsBusy) {
|
|
someonesBusy = true;
|
|
}
|
|
if (fileHasSwapped) {
|
|
someFileWasSwapped = fileHasSwapped;
|
|
}
|
|
if (ctx.vcBusyDuringDump) {
|
|
vcBusyDuringDump = true;
|
|
}
|
|
};
|
|
while (true) {
|
|
readCommandQueue();
|
|
|
|
if (not cyclicStoreCheck()) {
|
|
continue;
|
|
}
|
|
someonesBusy = false;
|
|
someFileWasSwapped = false;
|
|
vcBusyDuringDump = false;
|
|
stateHandlingForStore(handleOneStore(stores.okStore, okStoreContext), okStoreContext);
|
|
stateHandlingForStore(handleOneStore(stores.notOkStore, notOkStoreContext), notOkStoreContext);
|
|
stateHandlingForStore(handleOneStore(stores.miscStore, miscStoreContext), miscStoreContext);
|
|
if (not someonesBusy) {
|
|
TaskFactory::delayTask(100);
|
|
} else if (vcBusyDuringDump) {
|
|
// TODO: Might not be necessary
|
|
sif::debug << "VC busy, delaying" << std::endl;
|
|
TaskFactory::delayTask(10);
|
|
} else {
|
|
// TODO: Would be best to remove this, but not delaying here can lead to evil issues.
|
|
// Polling the PAPB of the PTME core too often leads to scheuduling issues.
|
|
TaskFactory::delayTask(2);
|
|
}
|
|
}
|
|
}
|
|
|
|
bool PersistentLogTmStoreTask::initStoresIfPossible() {
|
|
if (sdcMan.isSdCardUsable(std::nullopt)) {
|
|
stores.okStore.initializeTmStore();
|
|
stores.miscStore.initializeTmStore();
|
|
stores.notOkStore.initializeTmStore();
|
|
return true;
|
|
}
|
|
return false;
|
|
}
|
|
|
|
void PersistentLogTmStoreTask::startTransition(Mode_t mode, Submode_t submode) {
|
|
if (mode == MODE_OFF) {
|
|
bool channelIsOn = channel.isTxOn();
|
|
cancelDump(okStoreContext, stores.okStore, channelIsOn);
|
|
cancelDump(notOkStoreContext, stores.notOkStore, channelIsOn);
|
|
cancelDump(miscStoreContext, stores.miscStore, channelIsOn);
|
|
this->mode = MODE_OFF;
|
|
} else if (mode == MODE_ON) {
|
|
this->mode = MODE_ON;
|
|
}
|
|
modeHelper.modeChanged(mode, submode);
|
|
announceMode(false);
|
|
}
|