diff --git a/linux/devices/SusPolling.cpp b/linux/devices/SusPolling.cpp index c42bad75..9ee0051a 100644 --- a/linux/devices/SusPolling.cpp +++ b/linux/devices/SusPolling.cpp @@ -2,6 +2,7 @@ #include #include +#include #include #include #include @@ -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); }