From 690b41777b57397de0f2148b6e3ce55b1e3ae34f Mon Sep 17 00:00:00 2001
From: Jakob Meier <meier-jakob@gmx.de>
Date: Mon, 2 May 2022 13:48:34 +0200
Subject: [PATCH] bugfix pcdu handler command queue reading

---
 mission/devices/PCDUHandler.cpp | 8 ++------
 1 file changed, 2 insertions(+), 6 deletions(-)

diff --git a/mission/devices/PCDUHandler.cpp b/mission/devices/PCDUHandler.cpp
index 10d12cf8..260c99c2 100644
--- a/mission/devices/PCDUHandler.cpp
+++ b/mission/devices/PCDUHandler.cpp
@@ -100,14 +100,10 @@ void PCDUHandler::readCommandQueue() {
 
   for (result = commandQueue->receiveMessage(&command); result == RETURN_OK;
        result = commandQueue->receiveMessage(&command)) {
-    result = commandQueue->receiveMessage(&command);
-    if (result != RETURN_OK) {
-      return;
-    }
-
     result = poolManager.handleHousekeepingMessage(&command);
+    sif::debug << "PCDUHandler: Received message" << std::endl;
     if (result == RETURN_OK) {
-      return;
+      continue;
     }
   }
 }