implemented missing queue handling

mission/com/LiveTmTask.cpp

@@ -116,14 +116,44 @@ void LiveTmTask::readCommandQueue(void) {
   }
 }
 
-ReturnValue_t LiveTmTask::handleRegularTmQueue() { return returnvalue::OK; }
+ReturnValue_t LiveTmTask::handleRegularTmQueue() { return handleGenericTmQueue(*regularTmQueue); }
 
-ReturnValue_t LiveTmTask::handleCfdpTmQueue() { return returnvalue::OK; }
+ReturnValue_t LiveTmTask::handleCfdpTmQueue() { return handleGenericTmQueue(*cfdpTmQueue); }
+
+ReturnValue_t LiveTmTask::handleGenericTmQueue(MessageQueueIF& queue) {
+  TmTcMessage message;
+  ReturnValue_t result = queue.receiveMessage(&message);
+  if (result == MessageQueueIF::EMPTY) {
+    return result;
+  }
+  store_address_t storeId = message.getStorageId();
+  const uint8_t* data = nullptr;
+  size_t size = 0;
+  result = tmStore->getData(storeId, &data, &size);
+  if (result != returnvalue::OK) {
+    sif::warning << "VirtualChannel::performOperation: Failed to read data from TM store"
+                 << std::endl;
+    tmStore->deleteData(storeId);
+    return result;
+  }
+
+  if (ptmeLocked) {
+    result = channel.write(data, size);
+  }
+  // Try delete in any case, ignore failures (which should not happen), it is more important to
+  // propagate write errors.
+  tmStore->deleteData(storeId);
+  return result;
+}
 
 ModeTreeChildIF& LiveTmTask::getModeTreeChildIF() { return *this; }
 
 ReturnValue_t LiveTmTask::initialize() {
   modeHelper.initialize();
+  tmStore = ObjectManager::instance()->get<StorageManagerIF>(objects::TM_STORE);
+  if (tmStore == nullptr) {
+    return ObjectManagerIF::CHILD_INIT_FAILED;
+  }
   return returnvalue::OK;
 }