linux/devices/SusPolling.cpp

@@ -2,6 +2,7 @@
 
 #include <fsfw/tasks/SemaphoreFactory.h>
 #include <fsfw/tasks/TaskFactory.h>
+#include <fsfw/timemanager/Stopwatch.h>
 #include <fsfw_hal/linux/spi/SpiCookie.h>
 #include <mission/controller/acs/AcsParameters.h>
 #include <mission/devices/max1227.h>
@@ -26,7 +27,11 @@ ReturnValue_t SusPolling::performOperation(uint8_t operationCode) {
     semaphore->acquire();
     // Give SUS handlers a chance to submit all requests.
     TaskFactory::delayTask(2);
-    handleSusPolling();
+    {
+      // Takes 4-5 ms in debug mode.
+      // Stopwatch watch;
+      handleSusPolling();
+    }
     // Protection against tardy tasks unlocking the thread again immediately.
     TaskFactory::delayTask(20);
   }